RogiStandard-hal
STM32 向けサークル共通ライブラリ
読み取り中…
検索中…
一致する文字列を見つけられません
WS2815B.cpp
[詳解]
1#include "WS2815B.hpp"
2#include "math.h"
3
4#define NUM_LEDS 50
5#define PI 3.14
6
7WS2815B::WS2815B(TIM_HandleTypeDef *htim, uint32_t tim_channel_x) {
8 HTIM = htim;
9 TIM_CHANNEL_X = tim_channel_x;
10 pwm_buf_status = 0; // 追加
11 anim_playing = false; // 追加
12}
13
14void WS2815B::set_rgb(uint16_t PIXEL_NUM, uint8_t red, uint8_t green,
15 uint8_t blue) {
16 if (PIXEL_NUM < LED_NUM) {
17 rgb_buf[PIXEL_NUM][0] = red;
18 rgb_buf[PIXEL_NUM][1] = green;
19 rgb_buf[PIXEL_NUM][2] = blue;
20 }
21}
22
24
26 if (pwm_buf_status == 1 && !dma_busy) {
27 for (int i = 0; i < RST; i++) {
28 pwm_buf[i] = 0;
29 }
30
31 for (int i = 0; i < LED_NUM; i++) {
32 const int grb_order[3] = {1, 0, 2}; // G, R, B
33 for (int j = 0; j < 3; j++) {
34 for (int k = 7; k >= 0; k--) {
35 int x = (rgb_buf[i][grb_order[j]] >> k) & 1;
36 if (x == 1) {
37 pwm_buf[RST + (i * 24) + (j * 8) + (7 - k)] = HIGH;
38 } else {
39 pwm_buf[RST + (i * 24) + (j * 8) + (7 - k)] = LOW;
40 }
41 }
42 }
43 }
44 // LEDの番号によってHighかLowを決める
45 // rgb_bufは色の値が入る? rgb_buf[i][j]はi個目のLEDのRGB(j)の値
46
47 dma_busy = true;
48 HAL_TIM_PWM_Start_DMA(HTIM, TIM_CHANNEL_X, (const uint32_t *)pwm_buf,
49 RST + (LED_NUM * 24));
51 } else {
52 }
53}
54
56 for (int i = 0; i < RST; i++) {
57 pwm_buf[i] = 0;
58 }
59
60 for (int i = RST; i < RST + (LED_NUM * 24); i++) {
61 pwm_buf[i] = LOW;
62 }
63
64 dma_busy = true;
65 HAL_TIM_PWM_Start_DMA(HTIM, TIM_CHANNEL_X, (const uint32_t *)pwm_buf,
66 RST + (LED_NUM * 24));
67}
68
70 for (int i = 0; i < LED_NUM; i++) {
71 rgb_buf[i][0] = 0;
72 rgb_buf[i][1] = 0;
73 rgb_buf[i][2] = 0;
74 }
76}
77
78// HSV(色相・彩度・明度)からRGBに変換し、RGBの合計が180以下になるようにスケール
79void WS2815B::hsv_to_rgb(float h, float s, float v, int *r, int *g, int *b) {
80 float c = v * s;
81 float x = c * (1 - fabs(fmod(h / 60.0, 2) - 1));
82 float m = v - c;
83 float r_temp, g_temp, b_temp;
84
85 if (h >= 0 && h < 60) {
86 r_temp = c, g_temp = x, b_temp = 0;
87 } else if (h >= 60 && h < 120) {
88 r_temp = x, g_temp = c, b_temp = 0;
89 } else if (h >= 120 && h < 180) {
90 r_temp = 0, g_temp = c, b_temp = x;
91 } else if (h >= 180 && h < 240) {
92 r_temp = 0, g_temp = x, b_temp = c;
93 } else if (h >= 240 && h < 300) {
94 r_temp = x, g_temp = 0, b_temp = c;
95 } else {
96 r_temp = c, g_temp = 0, b_temp = x;
97 }
98
99 *r = (int)((r_temp + m) * 255);
100 *g = (int)((g_temp + m) * 255);
101 *b = (int)((b_temp + m) * 255);
102
103 // RGBの合計が180を超えないようにスケール
104 int sum = *r + *g + *b;
105 if (sum > 180) {
106 float scale = 180.0 / sum;
107 *r = (int)(*r * scale);
108 *g = (int)(*g * scale);
109 *b = (int)(*b * scale);
110 }
111}
112
113// LEDを12段階の色変化で往復させる
115 float hue_start[] = {0, 30, 60, 90, 120, 150,
116 180, 210, 240, 270, 300, 330}; // 12段階の色
117 float hue_end[] = {30, 60, 90, 120, 150, 180,
118 210, 240, 270, 300, 330, 360}; // 次の色にスムーズに移行
119 int delay_start = 10; // 最初は遅く
120 int delay_end = 3; // 最後は速く
121
122 for (int k = 0; k < 12; k++) { // 12段階の色変化
123 for (int i = 0; i <= NUM_LEDS; i++) {
124 int index =
125 (k % 2 == 0) ? i : (NUM_LEDS - i); // 偶数段階: 0→20, 奇数段階: 20→0
126
127 float ratio = (float)i / NUM_LEDS; // 0〜1の割合
128 float hue = hue_start[k] * (1 - ratio) +
129 hue_end[k] * ratio; // 色相をスムーズに遷移
130 int r, g, b;
131
132 this->hsv_to_rgb(hue, 1.0, 0.8, &r, &g, &b); // 彩度1.0, 明度0.8で変換
133 this->set_rgb(index, r, g, b);
134 show();
135 execute();
136
137 // 遅延時間を滑らかに短くする
138 int delay_time = (int)(delay_start * (1 - ratio) + delay_end * ratio);
139 HAL_Delay(delay_time);
140 this->clear();
141 }
142 }
143}
144
146 anim_k = 0;
147 anim_i = 0;
148 anim_last_tick = HAL_GetTick();
149 anim_playing = true;
150}
151
152// loop()から毎回呼ぶ。完了したらtrueを返す。
154 if (!anim_playing)
155 return true;
156
157 float hue_start[] = {0, 30, 60, 90, 120, 150, 180, 210, 240, 270, 300, 330};
158 float hue_end[] = {30, 60, 90, 120, 150, 180, 210, 240, 270, 300, 330, 360};
159 int delay_start = 10, delay_end = 3;
160
161 float ratio = (float)anim_i / NUM_LEDS;
162 int delay_time = (int)(delay_start * (1 - ratio) + delay_end * ratio);
163
164 // 前回の更新からdelay_time ms経過していなければ何もしない(ノンブロッキング)
165 if (HAL_GetTick() - anim_last_tick < (uint32_t)delay_time)
166 return false;
167 anim_last_tick = HAL_GetTick();
168
169 // 前フレームをクリアしてから次の色をセット(黒フレームが挟まらないよう先に色を入れる)
170 clear();
171 int index = (anim_k % 2 == 0) ? anim_i : (NUM_LEDS - anim_i);
172 float hue = hue_start[anim_k] * (1 - ratio) + hue_end[anim_k] * ratio;
173 int r, g, b;
174 hsv_to_rgb(hue, 1.0f, 0.8f, &r, &g, &b);
175 set_rgb(index, r, g, b);
176 show();
177 execute();
178
179 // カウンタ更新
180 anim_i++;
181 if (anim_i > NUM_LEDS) {
182 anim_i = 0;
183 anim_k++;
184 if (anim_k >= 12) {
185 anim_playing = false;
186 return true; // 完了
187 }
188 }
189 return false;
190}
191
192void WS2815B::stop_fanfare() { anim_playing = false; }
193
195 HAL_TIM_PWM_Stop_DMA(HTIM, TIM_CHANNEL_X);
196 dma_busy = false;
197}
#define NUM_LEDS
Definition WS2815B.cpp:4
#define HIGH
Definition WS2815B.hpp:16
#define LED_NUM
Definition WS2815B.hpp:15
#define LOW
Definition WS2815B.hpp:17
#define RST
Definition WS2815B.hpp:14
void smooth_color_transition()
Definition WS2815B.cpp:114
void hsv_to_rgb(float h, float s, float v, int *r, int *g, int *b)
Definition WS2815B.cpp:79
void show()
Definition WS2815B.cpp:23
void start_fanfare()
Definition WS2815B.cpp:145
void clear()
Definition WS2815B.cpp:69
void dma_complete_callback()
Definition WS2815B.cpp:194
void execute()
Definition WS2815B.cpp:25
WS2815B(TIM_HandleTypeDef *htim, uint32_t tim_channel_x)
Definition WS2815B.cpp:7
uint8_t pwm_buf_status
Definition WS2815B.hpp:31
bool update_fanfare()
Definition WS2815B.cpp:153
void init()
Definition WS2815B.cpp:55
void set_rgb(uint16_t PIXEL_NUM, uint8_t red, uint8_t green, uint8_t blue)
Definition WS2815B.cpp:14
void stop_fanfare()
Definition WS2815B.cpp:192