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
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
|
// Sofirn LT1-t1616 PWM helpers
// Copyright (C) 2023 SiteRelEnby, Selene ToyKeeper
// (adapted from emisar-2ch 15/10/2023)
#pragma once
#include "chan-aux.c"
void set_level_zero();
void set_level_ch1(uint8_t level);
void set_level_ch2(uint8_t level);
void set_level_both(uint8_t level);
void set_level_blend(uint8_t level);
void set_level_auto(uint8_t level);
bool gradual_tick_ch1(uint8_t gt);
bool gradual_tick_ch2(uint8_t gt);
bool gradual_tick_both(uint8_t gt);
bool gradual_tick_blend(uint8_t gt);
bool gradual_tick_auto(uint8_t gt);
Channel channels[] = {
{ // channel 1 only
.set_level = set_level_ch1,
.gradual_tick = gradual_tick_ch1,
.has_args = 0
},
{ // channel 2 only
.set_level = set_level_ch2,
.gradual_tick = gradual_tick_ch2,
.has_args = 0
},
{ // both channels, tied together (max "200%" power)
.set_level = set_level_both,
.gradual_tick = gradual_tick_both,
.has_args = 0
},
{ // both channels, manual blend (max "100%" power)
.set_level = set_level_blend,
.gradual_tick = gradual_tick_blend,
.has_args = 1
},
{ // both channels, auto blend
.set_level = set_level_auto,
.gradual_tick = gradual_tick_auto,
.has_args = 1
},
AUX_CHANNELS
};
void set_level_zero() {
CH1_PWM = 0;
CH2_PWM = 0;
}
void set_pwms(PWM_DATATYPE ch1_pwm, PWM_DATATYPE ch2_pwm) {
CH1_PWM = ch1_pwm;
CH2_PWM = ch2_pwm;
}
void set_level_ch1(uint8_t level) {
set_pwms(PWM_GET(pwm1_levels, level), 0);
}
void set_level_ch2(uint8_t level) {
set_pwms(0, PWM_GET(pwm1_levels, level));
}
void set_level_both(uint8_t level) {
PWM_DATATYPE pwm = PWM_GET(pwm1_levels, level);
set_pwms(pwm, pwm);
}
void set_level_blend(uint8_t level) {
PWM_DATATYPE ch1_pwm, ch2_pwm;
PWM_DATATYPE brightness = PWM_GET(pwm1_levels, level);
uint8_t blend = cfg.channel_mode_args[channel_mode];
calc_2ch_blend(&ch1_pwm, &ch2_pwm, brightness, PWM_TOP_INIT, blend);
set_pwms(ch1_pwm, ch2_pwm);
}
void set_level_auto(uint8_t level) {
PWM_DATATYPE ch1_pwm, ch2_pwm;
PWM_DATATYPE brightness = PWM_GET(pwm1_levels, level);
uint8_t blend = 255 * (uint16_t)level / RAMP_SIZE;
if (cfg.channel_mode_args[channel_mode] & 0b01000000)
blend = 255 - blend;
calc_2ch_blend(&ch1_pwm, &ch2_pwm, brightness, PWM_TOP_INIT, blend);
set_pwms(ch1_pwm, ch2_pwm);
}
///// bump each channel toward a target value /////
bool gradual_adjust(uint16_t ch1_pwm, uint16_t ch2_pwm) {
GRADUAL_ADJUST_SIMPLE(ch1_pwm, CH1_PWM);
GRADUAL_ADJUST_SIMPLE(ch2_pwm, CH2_PWM);
// check for completion
if ((ch1_pwm == CH1_PWM)
&& (ch2_pwm == CH2_PWM)) {
return true; // done
}
return false; // not done yet
}
bool gradual_tick_ch1(uint8_t gt) {
PWM_DATATYPE pwm = PWM_GET(pwm1_levels, gt);
return gradual_adjust(pwm, 0);
}
bool gradual_tick_ch2(uint8_t gt) {
PWM_DATATYPE pwm = PWM_GET(pwm1_levels, gt);
return gradual_adjust(0, pwm);
}
bool gradual_tick_both(uint8_t gt) {
PWM_DATATYPE pwm = PWM_GET(pwm1_levels, gt);
return gradual_adjust(pwm, pwm);
}
bool gradual_tick_blend(uint8_t gt) {
PWM_DATATYPE ch1_pwm, ch2_pwm;
PWM_DATATYPE brightness = PWM_GET(pwm1_levels, gt);
uint8_t blend = cfg.channel_mode_args[channel_mode];
calc_2ch_blend(&ch1_pwm, &ch2_pwm, brightness, PWM_TOP_INIT, blend);
return gradual_adjust(ch1_pwm, ch2_pwm);
}
bool gradual_tick_auto(uint8_t gt) {
PWM_DATATYPE ch1_pwm, ch2_pwm;
PWM_DATATYPE brightness = PWM_GET(pwm1_levels, gt);
uint8_t blend = 255 * (uint16_t)gt / RAMP_SIZE;
if (cfg.channel_mode_args[channel_mode] & 0b01000000)
blend = 255 - blend;
calc_2ch_blend(&ch1_pwm, &ch2_pwm, brightness, PWM_TOP_INIT, blend);
return gradual_adjust(ch1_pwm, ch2_pwm);
}
|
