sundp
/
O7
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

revised for color

This commit is contained in:
Yunhorn 2025-07-30 13:45:31 +08:00
parent e1601d0b36
commit 0099747508
1 changed files with 55 additions and 207 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

254
Core/Src/sts_lamp_bar.c
View File

@ -36,21 +36,6 @@
#define WS2812B_DATA_LEN (LED_DATA_LEN * (LED_COUNT)) #define WS2812B_DATA_LEN (LED_DATA_LEN * (LED_COUNT))
#define RESET_PULSE (24) //(80) TO FIX DARK_COLOR AND SM2 #define RESET_PULSE (24) //(80) TO FIX DARK_COLOR AND SM2
typedef struct ws2812b_e {
//uint16_t head[3];
uint16_t GRB[WS2812B_DATA_LEN];
uint16_t tail;
} WS2812B_FrameTypeDef;
volatile WS2812B_FrameTypeDef rgb_buf = {
// .head[0] = 0,
// .head[1] = 0,
// .head[2] = 0,
.tail = 0
};
//uint8_t ws2812b_crr_value[LED_COUNT*24+RESET_PULSE]={00};
uint8_t ws2812b_crr_value[STS_LAMP_BAR_LED_NUM_MAX*24+RESET_PULSE]={00}; uint8_t ws2812b_crr_value[STS_LAMP_BAR_LED_NUM_MAX*24+RESET_PULSE]={00};
uint8_t ws2812b_data[STS_LAMP_BAR_LED_NUM_MAX*3]={0}; uint8_t ws2812b_data[STS_LAMP_BAR_LED_NUM_MAX*3]={0};
@ -107,7 +92,7 @@ void ws2812b_data_transfer(uint8_t *src, uint32_t len)
uint8_t i =0; uint8_t i =0;
uint32_t bits = 0; uint32_t bits = 0;
uint32_t bytes = 0; uint32_t bytes = 0;
HAL_TIM_PWM_Stop_DMA(&STS_LAMP_BAR_HTIM, STS_LAMP_BAR_TIM_CHANNEL); //HAL_TIM_PWM_Stop_DMA(&STS_LAMP_BAR_HTIM, STS_LAMP_BAR_TIM_CHANNEL);
memset(ws2812b_crr_value,0,sizeof(ws2812b_crr_value)); memset(ws2812b_crr_value,0,sizeof(ws2812b_crr_value));
while(len--) while(len--)
{ {
@ -175,23 +160,6 @@ void ws2812b_light_all(uint8_t color)
void STS_Lamp_Bar_Set_Dark(void) void STS_Lamp_Bar_Set_Dark(void)
{ {
ws2812b_light_all(STS_DARK); ws2812b_light_all(STS_DARK);
/*
//for (uint8_t i=0; i< STS_LAMP_BAR_LED_NUM; i++)
for (uint8_t i=0; i< LED_COUNT+1; i++)
{
STS_WS2812B_Set_RGB(0x00,0x00,0x00,i);
}
STS_WS2812B_Refresh();
*/
}
void STS_WS2812B_Refresh(void)
{
HAL_TIM_PWM_Start_DMA(&STS_LAMP_BAR_HTIM, STS_LAMP_BAR_TIM_CHANNEL, (uint32_t *)&rgb_buf, (WS2812B_DATA_LEN+RESET_PULSE));
//HAL_TIM_PWM_Start_IT(&STS_LAMP_BAR_HTIM, STS_LAMP_BAR_TIM_CHANNEL);
} }
void STS_Lamp_Bar_Init(void) void STS_Lamp_Bar_Init(void)
@ -224,88 +192,28 @@ void STS_Lamp_Bar_Scoller(uint8_t color, uint8_t lum_level)
ws2812b_data[i*3 + color] = lum_level; ws2812b_data[i*3 + color] = lum_level;
} }
} }
/*
STS_Lamp_Bar_Set_Dark();
//for(uint8_t i = 0; i<STS_LAMP_BAR_LED_NUM; i++)
for(uint8_t i = 0; i<LED_COUNT; i++)
{
HAL_Delay(10); //MAKE THIS LESS THAN 10 NOT TO BLOCK JOIN THE LORAWAN
STS_WS2812B_Set_RGB(color_rgb[color][0]*lum_level,color_rgb[color][1]*lum_level, color_rgb[color][2]*lum_level, i);
STS_WS2812B_Refresh();
}
*/
}
/*
void STS_WS2812B_Set_RGB(uint8_t red, uint8_t green, uint8_t blue, uint8_t idx)
{
for (uint8_t j = 0; j < 8; j ++)
{
rgb_buf.GRB[idx*24+j] = (uint16_t)(((green<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
rgb_buf.GRB[idx*24+8+j] = (uint16_t)(((red<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
rgb_buf.GRB[idx*24+16+j] = (uint16_t)(((blue<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
}
}
*/
void STS_Lamp_Bar_Set_RGB_Color(uint8_t red, uint8_t green, uint8_t blue )
{
//ws2812b_light_all();
/*
uint8_t i =0;
UTIL_MEM_set_8((void*)rgb_buf.GRB,0x00,(WS2812B_DATA_LEN+RESET_PULSE));
//for(i = 0; i < STS_LAMP_BAR_LED_NUM; i++)
for(i = 0; i < LED_COUNT; i++)
{
for (uint8_t j = 0; j < 8; j ++)
{
rgb_buf.GRB[i*24+j] = (uint16_t)(((green<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
rgb_buf.GRB[i*24+8+j] = (uint16_t)(((red<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
rgb_buf.GRB[i*24+16+j] = (uint16_t)(((blue<<j)&0x80)? ONE_PULSE : ZERO_PULSE);
}
}
STS_WS2812B_Refresh();
*/
}
/*
void STS_Lamp_Bar_Set_RGB_Color_Flow(void)
{
} }
*/
static void STS_Lamp_Bar_Set_RGB_Color_FadeIn(uint8_t red, uint8_t green, uint8_t blue, uint8_t start_position, uint8_t fade_length) static void STS_Lamp_Bar_Set_RGB_Color_FadeIn(uint8_t red, uint8_t green, uint8_t blue, uint8_t start_position, uint8_t fade_length)
{ {
uint8_t fade_len = fade_length; uint8_t fade_len = fade_length;
memset(ws2812b_data, 0, sizeof(ws2812b_data)); memset(ws2812b_data, 0, sizeof(ws2812b_data));
//UTIL_MEM_set_8((void*)rgb_buf.GRB,0x00,(WS2812B_DATA_LEN+RESET_PULSE));
//STS_WS2812B_Refresh();
for (uint8_t idx = 0; idx < LED_COUNT ; idx++) for (uint8_t idx = 0; idx < LED_COUNT ; idx++)
{ {
if (idx >= start_position) { if (idx >= start_position) {
// the most far tail end, the darker, the most head/first, the brighter // the most far tail end, the darker, the most head/first, the brighter
uint8_t rev = idx - start_position + 1; uint8_t rev = idx - start_position + 1;
uint8_t lin = (rev * 0xFF / fade_len); uint8_t lin = (rev * 0xFF / fade_len);
uint8_t bri = (lin * lin) >> 8; uint8_t bri = (lin * lin) >> 8;
//STS_WS2812B_Set_RGB((red*bri)>>8, (green*bri)>>8, (blue*bri)>>8, ((idx)));
//ws2812b_light_one_rgb((red*bri)>>8, (green*bri)>>8, (blue*bri)>>8, ((idx)));
{ {
ws2812b_data[3*idx] = (green*bri)>>8; ws2812b_data[3*idx] = (green*bri)>>8;
ws2812b_data[3*idx+1] = (red*bri)>>8; ws2812b_data[3*idx+1] = (red*bri)>>8;
ws2812b_data[3*idx+2] = (blue*bri)>>8; ws2812b_data[3*idx+2] = (blue*bri)>>8;
} }
} else if ((idx < start_position)||(idx > (start_position+fade_len))){ } else if ((idx < start_position)||(idx > (start_position+fade_len))){
// shorter than tail, set to dark // shorter than tail, set to dark
//STS_WS2812B_Set_RGB(red, green, blue, idx);
//STS_WS2812B_Set_RGB(0, 0, 0, idx);
ws2812b_data[3*idx] = 0; ws2812b_data[3*idx] = 0;
ws2812b_data[3*idx+1] = 0; ws2812b_data[3*idx+1] = 0;
ws2812b_data[3*idx+2] = 0; ws2812b_data[3*idx+2] = 0;
@ -317,7 +225,6 @@ static void STS_Lamp_Bar_Set_RGB_Color_FadeIn(uint8_t red, uint8_t green, uint8_
static void STS_Lamp_Bar_Set_RGB_Color_FadeOut(uint8_t red, uint8_t green, uint8_t blue, uint8_t start_position, uint8_t fade_length) static void STS_Lamp_Bar_Set_RGB_Color_FadeOut(uint8_t red, uint8_t green, uint8_t blue, uint8_t start_position, uint8_t fade_length)
{ {
uint8_t fade_len = fade_length; uint8_t fade_len = fade_length;
//UTIL_MEM_set_8((void*)rgb_buf.GRB,0x00,(WS2812B_DATA_LEN+RESET_PULSE));
memset(ws2812b_data, 0, sizeof(ws2812b_data)); memset(ws2812b_data, 0, sizeof(ws2812b_data));
for (uint8_t idx = 0; idx < LED_COUNT; idx++) for (uint8_t idx = 0; idx < LED_COUNT; idx++)
{ {
@ -326,25 +233,14 @@ static void STS_Lamp_Bar_Set_RGB_Color_FadeOut(uint8_t red, uint8_t green, uint8
uint8_t rev = fade_len -idx - start_position; uint8_t rev = fade_len -idx - start_position;
uint8_t lin = (rev * 0xFF / fade_length); uint8_t lin = (rev * 0xFF / fade_length);
uint8_t bri = (lin * lin) >> 8; uint8_t bri = (lin * lin) >> 8;
//uint8_t lin = (idx/(2*tail_len));
//uint8_t bri = lin;
//STS_WS2812B_Set_RGB((red*bri)>>8, (green*bri)>>8, (blue*bri)>>8, ((idx)));
//ws2812b_light_one_rgb((red*bri)>>8, (green*bri)>>8, (blue*bri)>>8, ((idx)));
{ {
ws2812b_data[3*idx] = (green*bri)>>8; ws2812b_data[3*idx] = (green*bri)>>8;
ws2812b_data[3*idx+1] = (red*bri)>>8; ws2812b_data[3*idx+1] = (red*bri)>>8;
ws2812b_data[3*idx+2] = (blue*bri)>>8; ws2812b_data[3*idx+2] = (blue*bri)>>8;
} }
//ws2812b_light_one_rgb(uint8_t red, uint8_t green, uint8_t blue, uint8_t idx)
//STS_WS2812B_Set_RGB((red*bri), (green*bri), (blue*bri), ((idx + start_position)%LED_COUNT));
} else if ((idx < start_position)||(idx > fade_len)) { } else if ((idx < start_position)||(idx > fade_len)) {
// shorter than start position or longer than fade length, set to dark // shorter than start position or longer than fade length, set to dark
//STS_WS2812B_Set_RGB(red, green, blue, idx);
//STS_WS2812B_Set_RGB(0, 0, 0, idx);
//ws2812b_light_one_rgb(0, 0, 0, (idx));
ws2812b_data[3*idx] = 0; ws2812b_data[3*idx] = 0;
ws2812b_data[3*idx+1] = 0; ws2812b_data[3*idx+1] = 0;
ws2812b_data[3*idx+2] = 0; ws2812b_data[3*idx+2] = 0;
@ -352,12 +248,7 @@ static void STS_Lamp_Bar_Set_RGB_Color_FadeOut(uint8_t red, uint8_t green, uint8
} }
ws2812b_data_transfer(ws2812b_data, sizeof(ws2812b_data)); ws2812b_data_transfer(ws2812b_data, sizeof(ws2812b_data));
} }
/*
void STS_Lamp_Bar_Refresh(void)
{
STS_Lamp_Bar_Set_STS_RGB_Color(sts_lamp_bar_color, luminance_level);
}
*/
void STS_Lamp_Bar_Set_STS_RGB_Color_FadeIn(uint8_t sts_lamp_color, uint8_t max_lum_level, uint8_t fade_length) void STS_Lamp_Bar_Set_STS_RGB_Color_FadeIn(uint8_t sts_lamp_color, uint8_t max_lum_level, uint8_t fade_length)
{ {
if (sts_lamp_color <=8) if (sts_lamp_color <=8)
@ -430,9 +321,7 @@ void STS_Lamp_Bar_Set_STS_RGB_Color_FadeOut(uint8_t sts_lamp_color, uint8_t max_
} }
void STS_Lamp_Bar_Set_STS_RGB_Color(uint8_t sts_lamp_color, uint8_t lum) void STS_Lamp_Bar_Set_STS_RGB_Color(uint8_t sts_lamp_color, uint8_t lum)
{ {
//ws2812b_light_all_with_lum_level(sts_lamp_color, lum);
luminance_level = lum; luminance_level = lum;
//ws2812b_light_all(color);
switch(sts_lamp_color) switch(sts_lamp_color)
{ {
case STS_DARK : ws2812b_light_custom(0, 0, 0); break; case STS_DARK : ws2812b_light_custom(0, 0, 0); break;
@ -444,38 +333,6 @@ void STS_Lamp_Bar_Set_STS_RGB_Color(uint8_t sts_lamp_color, uint8_t lum)
case STS_CYAN : ws2812b_light_custom(0, luminance_level, luminance_level ); break; case STS_CYAN : ws2812b_light_custom(0, luminance_level, luminance_level ); break;
case STS_WHITE : ws2812b_light_custom(luminance_level, luminance_level, luminance_level ); break; case STS_WHITE : ws2812b_light_custom(luminance_level, luminance_level, luminance_level ); break;
} }
/*
if (sts_lamp_color <=8)
{
switch (sts_lamp_color)
{
case STS_DARK:
STS_Lamp_Bar_Set_RGB_Color(0x0, 0x0, 0x0);
break;
case STS_GREEN:
STS_Lamp_Bar_Set_RGB_Color(0x0, lum, 0x0);
break;
case STS_RED:
STS_Lamp_Bar_Set_RGB_Color(lum, 0x0, 0x0);
break;
case STS_BLUE:
STS_Lamp_Bar_Set_RGB_Color(0x0, 0x0, lum);
break;
case STS_YELLOW:
STS_Lamp_Bar_Set_RGB_Color(lum, lum, 0x0);
break;
case STS_PINK:
STS_Lamp_Bar_Set_RGB_Color(lum, 0x0, lum);
break;
case STS_CYAN:
STS_Lamp_Bar_Set_RGB_Color(0x0, lum, lum);
break;
case STS_WHITE:
STS_Lamp_Bar_Set_RGB_Color(lum, lum, lum);
break;
}
}
*/
} }
void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim) void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim)
@ -487,89 +344,85 @@ void HAL_TIM_PWM_PulseFinishedCallback(TIM_HandleTypeDef *htim)
void STS_Lamp_Bar_Self_Test_Simple(void) void STS_Lamp_Bar_Self_Test_Simple(void)
{ {
uint8_t color=0, lum_level=DEFAULT_LUMINANCE_LEVEL; uint16_t color=0, lum_level=DEFAULT_LUMINANCE_LEVEL;
APP_LOG(TS_OFF, VLEVEL_H, "\r\n [#1] RGB Space Lumianance Level Testing Start\r\n"); APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Lumianance Level Testing Start\r\n");
for (color=STS_GREEN; color < STS_COLOR_MAX; color++) for (color=STS_GREEN; color < STS_COLOR_MAX; color++)
{ {
lum_level = 1; lum_level = 0;
do { do {
STS_Lamp_Bar_Set_STS_RGB_Color(color, lum_level); STS_Lamp_Bar_Set_STS_RGB_Color(color, lum_level);
HAL_Delay(20); HAL_Delay(20);
lum_level += 10; lum_level += 5;
} while (lum_level < 255); } while (lum_level < 250);
STS_Lamp_Bar_Set_Dark(); STS_Lamp_Bar_Set_Dark();
} }
APP_LOG(TS_OFF, VLEVEL_H, "\r\n [#1] RGB Space Lumianance Level Testing Finished\r\n"); APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Lumianance Level Testing Finished\r\n");
} }
void STS_Lamp_Bar_Self_Test_Fade(void) void STS_Lamp_Bar_Self_Test_Fade(void)
{ {
uint8_t color=0, lum_level=DEFAULT_LUMINANCE_LEVEL; uint16_t color=0, lum_level=DEFAULT_LUMINANCE_LEVEL;
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade Out Testing Start\r\n");
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade Out Testing Start\r\n");
for (color=STS_GREEN; color < STS_COLOR_MAX; color++) for (color=STS_GREEN; color < STS_COLOR_MAX; color++)
{ {
lum_level = 250; STS_Lamp_Bar_Set_STS_RGB_Color_FadeOut(color&0xff, lum_level&0xff, LED_COUNT/2);
//do { HAL_Delay(2000);
APP_LOG(TS_OFF, VLEVEL_M, "\rFade Out %04d\r", lum_level);
STS_Lamp_Bar_Set_STS_RGB_Color_FadeOut(color, lum_level, LED_COUNT/2);
HAL_Delay(1000);
//lum_level += 5;
//} while (lum_level < 200);
STS_Lamp_Bar_Set_Dark();
//STS_Lamp_Bar_Refresh();
} }
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade In Testing Start\r\n"); APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade In Testing Start\r\n");
for (color=STS_GREEN; color < STS_COLOR_MAX; color++) for (color=STS_GREEN; color < STS_COLOR_MAX; color++)
{ {
lum_level = 250; STS_Lamp_Bar_Set_STS_RGB_Color_FadeIn(color&0xff, lum_level&0xff, LED_COUNT/2);
// do { HAL_Delay(2000);
APP_LOG(TS_OFF, VLEVEL_M, "\rFade In %04d\r", lum_level);
STS_Lamp_Bar_Set_STS_RGB_Color_FadeIn(color, lum_level, LED_COUNT/2);
HAL_Delay(1000);
//lum_level += 5;
//} while (lum_level < 200);
STS_Lamp_Bar_Set_Dark();
//STS_Lamp_Bar_Refresh();
} }
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade Out / Fade In Testing Finished\r\n");
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] RGB Space Fade Out Fade In Testing Finished\r\n");
} }
void sts_test_scoller_bar(void)
{
for (uint8_t color = STS_GREEN; color < STS_COLOR_MAX; color++)
{
{
STS_Lamp_Bar_Scoller(color, DEFAULT_LUMINANCE_LEVEL);
}
}
}
void sts_test_color_with_lum_level(void)
{
for (uint8_t color = STS_GREEN; color < STS_COLOR_MAX; color++)
{
for (uint16_t lum_level=1; lum_level<250; lum_level+=5)
{
ws2812b_light_all_with_lum_level(color, lum_level&0xff);
HAL_Delay(50);
}
}
}
void STS_Lamp_Bar_Self_Test(void) void STS_Lamp_Bar_Self_Test(void)
{ {
uint8_t color=0, lum_level=DEFAULT_LUMINANCE_LEVEL; uint16_t lum_level=DEFAULT_LUMINANCE_LEVEL;
/*
APP_LOG(TS_OFF, VLEVEL_H, "\r\n YunHorn STS Indicative Lamp Self Test\r\n"); APP_LOG(TS_OFF, VLEVEL_M, "\r\n [##] YunHorn STS Indicative Lamp Self Test\r\n");
STS_Lamp_Bar_Self_Test_Simple(); STS_Lamp_Bar_Self_Test_Simple();
APP_LOG(TS_OFF, VLEVEL_H, "\r\n [#2] Scoller Testing\r\n");
for (color = STS_GREEN; color < STS_COLOR_MAX; color++)
{
//for (lum_level=1; lum_level<250; lum_level+=50)
{
STS_Lamp_Bar_Scoller(color, lum_level);
}
}
*/
for (color = STS_GREEN; color < STS_COLOR_MAX; color++)
{
//for (lum_level=1; lum_level<250; lum_level+=50)
{
ws2812b_light_all(color);
}
HAL_Delay(1000); HAL_Delay(1000);
} APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#1] Scoller Testing\r\n");
sts_test_scoller_bar();
HAL_Delay(1000);
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#2] Color with Lum Level \r\n");
sts_test_color_with_lum_level();
HAL_Delay(1000);
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#3] Color Set Dark \r\n");
STS_Lamp_Bar_Set_Dark(); STS_Lamp_Bar_Set_Dark();
HAL_Delay(1000); HAL_Delay(1000);
APP_LOG(TS_OFF, VLEVEL_M, "\r\n [#4] RGB Space Fade Out Testing Start\r\n");
STS_Lamp_Bar_Self_Test_Fade(); STS_Lamp_Bar_Self_Test_Fade();
APP_LOG(TS_OFF, VLEVEL_H, "\r\n [##] YunHorn STS Indicative Lamp Self Test Finished\r\n"); APP_LOG(TS_OFF, VLEVEL_M, "\r\n [##] YunHorn STS Indicative Lamp Self Test Finished\r\n");
if ((sts_work_mode == STS_WIRED_MODE) ) if ((sts_work_mode == STS_WIRED_MODE) )
{ {
STS_Lamp_Bar_Set_Dark(); STS_Lamp_Bar_Set_Dark();
@ -587,9 +440,6 @@ void sts_rgb_unit_test(void)
APP_LOG(TS_OFF, VLEVEL_L, "\r\n STS Lamp Bar Init...\r\n"); APP_LOG(TS_OFF, VLEVEL_L, "\r\n STS Lamp Bar Init...\r\n");
STS_Lamp_Bar_Set_Dark(); STS_Lamp_Bar_Set_Dark();
//STS_Lamp_Bar_Full_Color_Gradient();
STS_Lamp_Bar_Self_Test(); STS_Lamp_Bar_Self_Test();
do { do {
@ -604,8 +454,6 @@ void sts_rgb_unit_test(void)
} }
} while(1); } while(1);
} }