SumProject/applications/indicator_led.c

#include "indicator_led.h"
#include "rtdevice.h"

#define LED_BREATH_PERIOD 4000
#define LED_BREATH_MDELAY 20
#define LED_BREATH_HALF_TIMES (LED_BREATH_PERIOD / LED_BREATH_MDELAY / 2)
const uint8_t gamma_table[256] = {
    0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,  0,
    0,  1,  1,  1,  1,  1,  1,  1,  1,  1,  1,  1,  2,  2,  2,  2,
    2,  2,  2,  3,  3,  3,  3,  3,  4,  4,  4,  4,  4,  5,  5,  5,
    5,  6,  6,  6,  7,  7,  7,  7,  8,  8,  8,  9,  9, 10, 10, 10,
   11, 11, 11, 12, 12, 13, 13, 13, 14, 14, 15, 15, 16, 16, 17, 17,
   18, 18, 19, 19, 20, 20, 21, 21, 22, 23, 23, 24, 24, 25, 26, 26,
   27, 28, 28, 29, 30, 30, 31, 32, 32, 33, 34, 35, 35, 36, 37, 38,
   38, 39, 40, 41, 42, 42, 43, 44, 45, 46, 47, 48, 49, 49, 50, 51,
   52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 66, 67,
   69, 70, 71, 72, 73, 74, 75, 76, 78, 79, 80, 81, 82, 84, 85, 86,
   87, 89, 90, 91, 92, 94, 95, 96, 98, 99,100,102,103,104,106,107,
  109,110,112,113,114,116,117,119,120,122,123,125,126,128,130,131,
  133,134,136,138,139,141,143,144,146,148,149,151,153,154,156,158,
  160,161,163,165,167,169,170,172,174,176,178,180,182,183,185,187,
  189,191,193,195,197,199,201,203,205,207,209,211,213,215,218,220,
  222,224,226,228,230,233,235,237,239,241,244,246,248,250,253,255,
};


rt_thread_t led_blink_thread = RT_NULL;
rt_thread_t led_breath_thread = RT_NULL;
rt_thread_t led_reflash_thread = RT_NULL;

// 灯是否处于特定颜色还是闪烁状态
uint8_t LED_State[LED_NUM] = {LED_NOT_BLINKING};
// 灯闪烁颜色缓存
RGBColor_TypeDef LED_Color[LED_NUM] = {0};
// 灯闪烁（呼吸）颜色当前值
RGBColor_TypeDef LED_Tmp_Color = {0};

/**
 * @brief           设置特定LED的颜色或开关
 * @param  LedId    LED的序号(0~LED_NUM-1)
 * @param  Color    颜色/开关 LED_RED,LED_BLUE,LED_OFF,LED_ON(白色)……
 */
void LED_Set(uint16_t LedId, RGBColor_TypeDef Color)
{
    LED_State[LedId] = LED_NOT_BLINKING;
    Set_LEDColor(LedId, Color);
    RGB_Reflash();
}
/**
 * @brief           设置连续多个特定LED的颜色或开关
 * @param  LedId_begin    LED的序号(0~LED_NUM-1)开始
 * @param  LedId_end    LED的序号(0~LED_NUM-1)结束
 * @param  Color    颜色/开关 LED_RED,LED_BLUE,LED_OFF,LED_ON(白色)……
 */
void LED_SetMore(uint16_t LedId_begin, uint16_t LedId_end, RGBColor_TypeDef Color)
{
    for (int LedId = LedId_begin; LedId <= LedId_end; LedId++)
    {
        LED_State[LedId] = LED_NOT_BLINKING;
        Set_LEDColor(LedId, Color);
    }
    RGB_Reflash();
}

/**
 * @brief           设置特定LED的闪烁
 * @param  LedId    LED的序号(0~LED_NUM-1)
 * @param  Color    颜色 LED_RED,LED_BLUE……
 */
void LED_Blink(uint16_t LedId, RGBColor_TypeDef Color)
{
    LED_State[LedId] = LED_IS_BLINKING;
    LED_Color[LedId] = Color;
}
/**
 * @brief           设置连续多个特定LED的闪烁
 * @param  LedId_begin    LED的序号(0~LED_NUM-1)开始
 * @param  LedId_end    LED的序号(0~LED_NUM-1)结束
 * @param  Color    颜色 LED_RED,LED_BLUE……
 */
void LED_BlinkMore(uint16_t LedId_begin, uint16_t LedId_end, RGBColor_TypeDef Color)
{
    for (int LedId = LedId_begin; LedId <= LedId_end; LedId++)
    {
        LED_State[LedId] = LED_IS_BLINKING;
        LED_Color[LedId] = Color;
    }
}
/**
 * @brief           设置特定LED的呼吸
 * @param  LedId    LED的序号(0~LED_NUM-1)
 * @param  Color    颜色 LED_RED,LED_BLUE……
 */
void LED_Breath(uint16_t LedId, RGBColor_TypeDef Color)
{
    LED_State[LedId] = LED_IS_BREATHING;
    LED_Color[LedId] = Color;
}
/**
 * @brief           设置连续多个特定LED的呼吸
 * @param  LedId_begin    LED的序号(0~LED_NUM-1)开始
 * @param  LedId_end    LED的序号(0~LED_NUM-1)结束
 * @param  Color    颜色 LED_RED,LED_BLUE……
 */
void LED_BreathMore(uint16_t LedId_begin, uint16_t LedId_end, RGBColor_TypeDef Color)
{
    for (int LedId = LedId_begin; LedId <= LedId_end; LedId++)
    {
        LED_State[LedId] = LED_IS_BREATHING;
        LED_Color[LedId] = Color;
    }
}
/**
 * @brief 灯的闪烁，每0.5s判断各盏灯是否要翻转
 */
void led_blink_entry(void *parameter)
{
    (void)parameter;
    uint16_t LED_Blink_ON = 1, cnt_blink = 0;
    while (1)
    {
        cnt_blink = 0;
        for (int LedId = 0; LedId < LED_NUM; LedId++)
        {
            if (LED_State[LedId] == LED_IS_BLINKING)
            {
                cnt_blink++;
                if (LED_Blink_ON)
                {
                    Set_LEDColor(LedId, LED_Color[LedId]);
                }
                else
                {
                    Set_LEDColor(LedId, LEDI_OFF);
                }
            }
        }
        LED_Blink_ON = !LED_Blink_ON;
        if (cnt_blink)
            RGB_Reflash();
        rt_thread_mdelay(500);
    }
}

void breath_add(float *LED_Breath_Percentage)
{
    static int breath_cnt = 0;
    if(breath_cnt<=LED_BREATH_HALF_TIMES)
    {
        *LED_Breath_Percentage =gamma_table[(uint8_t)256.0*breath_cnt/LED_BREATH_HALF_TIMES];
    }
    else 
    {
        *LED_Breath_Percentage =gamma_table[(uint8_t)256.0*(LED_BREATH_HALF_TIMES*2-breath_cnt)/LED_BREATH_HALF_TIMES];
        if (breath_cnt>=LED_BREATH_HALF_TIMES*2)
        {
            breath_cnt=0;            
        }
        
    }
    breath_cnt++;
}

void led_breath_entry(void *parameter)
{
    (void)parameter;
    float  LED_Breath_Percentage = 255;
    uint16_t LED_Breath_ON = 1, breath_num=0;
    while (1)
    {
        breath_num = 0;
        for (int LedId = 0; LedId < LED_NUM; LedId++)
        {
            if (LED_State[LedId] == LED_IS_BREATHING)
            {
                breath_num++;
                LED_Tmp_Color.G = (uint8_t)LED_Color[LedId].G * LED_Breath_Percentage/255;
                LED_Tmp_Color.R = (uint8_t)LED_Color[LedId].R * LED_Breath_Percentage/255;
                LED_Tmp_Color.B = (uint8_t)LED_Color[LedId].B * LED_Breath_Percentage/255;
                Set_LEDColor(LedId, LED_Tmp_Color);
            }
        }
        breath_add(&LED_Breath_Percentage);
        if (breath_num)
            RGB_Reflash();
        rt_thread_mdelay(LED_BREATH_MDELAY);
    }
}

void led_reflash_entry(void *parameter)
{
    (void)parameter;
    while (1)
    {
        RGB_Reflash();
        rt_thread_mdelay(500);
    }
}
/**
 * @brief LED的初始化
 */
int led_init(void)
{

    led_blink_thread = rt_thread_create("ledblT", led_blink_entry, RT_NULL, 1024, 20, 20);
    if (led_blink_thread == RT_NULL)
    {
        rt_kprintf("led blink control thread creat failed!\n");
        return 0;
    }
    rt_thread_startup(led_blink_thread);

    led_breath_thread = rt_thread_create("ledbrT", led_breath_entry, RT_NULL, 1024, 20, 20);
    if (led_breath_thread == RT_NULL)
    {
        rt_kprintf("led breath control thread creat failed!\n");
        return 0;
    }
    rt_thread_startup(led_breath_thread);

    led_reflash_thread = rt_thread_create("ledreT", led_reflash_entry, RT_NULL, 1024, 20, 20);
    if (led_reflash_thread == RT_NULL)
    {
        rt_kprintf("led reflash control thread creat failed!\n");
        return 0;
    }
    rt_thread_startup(led_reflash_thread);
    return 0;
}