pwm.c

Go to the documentation of this file.

#include <cpu/types.h>
#include <cpu/irq.h>

#include <drv/pwm.h>
#include <drv/pwm_at91.h>

#include <cfg/macros.h>
#include <cfg/debug.h>


void pwm_setDuty(PwmDev dev, pwm_duty_t duty)
{
    pwm_period_t period = 0;
    pwm_duty_t real_duty = 0;

    duty = MIN(duty, (pwm_duty_t)PWM_MAX_DUTY);

    period = pwm_hw_getPeriod(dev);

    real_duty = (uint64_t)(duty * period) >> (uint64_t)PWM_MAX_PERIOD_LOG2;

//  TRACEMSG("real_duty[%d] duty[%d], period[%d]", real_duty, duty, period);
    pwm_hw_setDutyUnlock(dev, real_duty);
}

void pwm_setFrequency(PwmDev dev, pwm_freq_t freq)
{
    pwm_hw_setFrequency(dev, freq);
}

void pwm_enable(PwmDev dev, bool state)
{
    if (state)
        pwm_hw_enable(dev);
    else
        pwm_hw_disable(dev);
}

void pwm_init(void)
{
    cpuflags_t flags;
    PwmDev dev;

    IRQ_SAVE_DISABLE(flags);

    pwm_hw_init();

    /* set all pwm to 0 */
    for (dev = 0; dev < PWM_CNT; dev++)
        pwm_setDuty(dev, 0);

    IRQ_RESTORE(flags);
}