aboutsummaryrefslogtreecommitdiff
path: root/hwdef-emisar-d4v2.c
blob: dce6c92d0804c2f65553ccfdee3305430a5851f9 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
// Emisar D4v2 PWM helper functions
// Copyright (C) 2017-2023 Selene ToyKeeper
// SPDX-License-Identifier: GPL-3.0-or-later

#pragma once

#include "chan-rgbaux.c"

// single set of LEDs with 2 stacked power channels, DDFET+1 or DDFET+linear
void set_level_stacked(uint8_t level) {
    if (level == 0) {
        LOW_PWM_LVL  = 0;
        HIGH_PWM_LVL = 0;
        PWM_CNT      = 0;  // reset phase
    } else {
        level --;  // PWM array index = level - 1
        LOW_PWM_LVL  = PWM_GET(pwm1_levels, level);
        HIGH_PWM_LVL = PWM_GET(pwm2_levels, level);
        // pulse frequency modulation, a.k.a. dynamic PWM
        uint16_t top = PWM_GET(pwm_tops, level);
        // wait to sync the counter and avoid flashes
        while(actual_level && (PWM_CNT > (top - 32))) {}
        PWM_TOP = top;
        // force reset phase when turning on from zero
        // (because otherwise the initial response is inconsistent)
        if (! actual_level) PWM_CNT = 0;
    }
}

bool gradual_tick_stacked(uint8_t gt) {
    GRADUAL_TICK_SETUP();

    GRADUAL_ADJUST(pwm1_levels, LOW_PWM_LVL, PWM_TOP_INIT);
    GRADUAL_ADJUST_1CH(pwm2_levels, HIGH_PWM_LVL);

    // did we go far enough to hit the next defined ramp level?
    // if so, update the main ramp level tracking var
    if (   (LOW_PWM_LVL  == PWM_GET(pwm1_levels, gt))
        && (HIGH_PWM_LVL == PWM_GET(pwm2_levels, gt))
       ) {
        return true;
    }
    return false;
}