phase.c

Go to the documentation of this file.

#include "hw/hw_phase.h"

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

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

#include <drv/timer.h>
#include <drv/phase.h>

#include <math.h>

static Triac triacs[TRIAC_CNT];

DB(bool phase_initialized;)

DEFINE_ZEROCROSS_ISR()
{
    ticks_t period, now;
    static ticks_t prev_time;
    TriacDev dev;

    now = timer_clock_unlocked();
    period = now - prev_time;

    for (dev = 0; dev < TRIAC_CNT; dev++)
    {
        /* Only turn off triac if duty is != 100% */
        if (triacs[dev].duty != CONFIG_TRIAC_MAX_DUTY)
            TRIAC_OFF(dev);
        /* Compute delay from duty */
        timer_setDelay(&triacs[dev].timer, DIV_ROUND(period * (CONFIG_TRIAC_MAX_DUTY - triacs[dev].duty), CONFIG_TRIAC_MAX_DUTY));

        /* This check avoids inserting the same timer twice
         * in case of an intempestive zerocross or spike */
        if (triacs[dev].running)
        {
            timer_abort(&triacs[dev].timer);
            //kprintf("[%lu]\n", timer_clock());
        }

        triacs[dev].running = true;
        timer_add(&triacs[dev].timer);
    }
    prev_time = now;
}



void phase_setDuty(TriacDev dev, triac_duty_t duty)
{
    cpu_flags_t flags;
    IRQ_SAVE_DISABLE(flags);

    phase_setDutyUnlock(dev,duty);

    IRQ_RESTORE(flags);
}



void phase_setDutyUnlock(TriacDev dev, triac_duty_t duty)
{
    triacs[dev].duty = MIN(duty, (triac_duty_t)CONFIG_TRIAC_MAX_DUTY);
}



void phase_setPower(TriacDev dev, triac_power_t power)
{
    bool greater_fifty = false;
    triac_duty_t duty;

    power = MIN(power, (triac_power_t)CONFIG_TRIAC_MAX_POWER);

    if (power > CONFIG_TRIAC_MAX_POWER / 2)
    {
        greater_fifty = true;
        power = CONFIG_TRIAC_MAX_POWER - power;
    }

    duty = TRIAC_POWER_K * sqrt(power);

    if (greater_fifty)
        duty = CONFIG_TRIAC_MAX_DUTY - duty;
    phase_setDuty(dev, duty);
}



static void phase_softint(void *_dev)
{
    TriacDev dev = (TriacDev)_dev;

    /* Only turn on if duty is !=0 */
    if (triacs[dev].duty)
        TRIAC_ON(dev);
    triacs[dev].running = false;
}



void phase_init(void)
{
    cpu_flags_t flags;
    TriacDev dev;

    /* Init timers and ensure that all triac are off */
    for (dev = 0; dev < TRIAC_CNT; dev++)
    {
        triacs[dev].duty = 0;
        triacs[dev].running = false;
        SET_TRIAC_DDR(dev);
        TRIAC_OFF(dev);
        timer_setSoftint(&triacs[dev].timer, (Hook)phase_softint, (void *)dev);
    }
    IRQ_SAVE_DISABLE(flags);

    /* Init zero cross interrupt */
    PHASE_HW_INIT;
    DB(phase_initialized = true;)
    IRQ_RESTORE(flags);
}