added WS2812 support
This commit is contained in:
@@ -332,8 +332,9 @@ PC5.GPIOParameters=GPIO_Label
|
|||||||
PC5.GPIO_Label=LOCK_B
|
PC5.GPIO_Label=LOCK_B
|
||||||
PC5.Locked=true
|
PC5.Locked=true
|
||||||
PC5.Signal=GPIO_Output
|
PC5.Signal=GPIO_Output
|
||||||
PC9.GPIOParameters=GPIO_Label
|
PC9.GPIOParameters=GPIO_Speed,GPIO_Label
|
||||||
PC9.GPIO_Label=LED_DATA
|
PC9.GPIO_Label=LED_DATA
|
||||||
|
PC9.GPIO_Speed=GPIO_SPEED_FREQ_HIGH
|
||||||
PC9.Locked=true
|
PC9.Locked=true
|
||||||
PC9.Signal=GPIO_Output
|
PC9.Signal=GPIO_Output
|
||||||
PD0.Locked=true
|
PD0.Locked=true
|
||||||
|
|||||||
@@ -41,3 +41,5 @@ void LED_Task();
|
|||||||
void LED_Write();
|
void LED_Write();
|
||||||
void LED_Init();
|
void LED_Init();
|
||||||
void LED_SetColor(RGB_Cycle_t *color);
|
void LED_SetColor(RGB_Cycle_t *color);
|
||||||
|
void RGB_SetColor(RGB_t *color);
|
||||||
|
void WS2812_SetColor(RGB_t *color);
|
||||||
|
|||||||
+218
-218
@@ -1,218 +1,218 @@
|
|||||||
/* USER CODE BEGIN Header */
|
/* USER CODE BEGIN Header */
|
||||||
|
|
||||||
/* USER CODE END Header */
|
/* USER CODE END Header */
|
||||||
/* Includes ------------------------------------------------------------------*/
|
/* Includes ------------------------------------------------------------------*/
|
||||||
#include "adc.h"
|
#include "adc.h"
|
||||||
|
|
||||||
/* USER CODE BEGIN 0 */
|
/* USER CODE BEGIN 0 */
|
||||||
#include "isr_opt.h"
|
#include "isr_opt.h"
|
||||||
static volatile uint16_t adc_dma_raw[6];
|
static volatile uint16_t adc_dma_raw[6];
|
||||||
volatile ADC_ScanData_t adc_data = {0};
|
volatile ADC_ScanData_t adc_data = {0};
|
||||||
static volatile uint8_t adc_scan_data_ready = 0u;
|
static volatile uint8_t adc_scan_data_ready = 0u;
|
||||||
|
|
||||||
void ADC_ScanStart(void)
|
void ADC_ScanStart(void)
|
||||||
{
|
{
|
||||||
if (HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_raw, 6u) != HAL_OK)
|
if (HAL_ADC_Start_DMA(&hadc1, (uint32_t *)adc_dma_raw, 6u) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
ISR_FAST void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef *hadc)
|
ISR_FAST void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef *hadc)
|
||||||
{
|
{
|
||||||
if (hadc->Instance != ADC1)
|
if (hadc->Instance != ADC1)
|
||||||
{
|
{
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
adc_data.in3_raw = adc_dma_raw[0];
|
adc_data.in3_raw = adc_dma_raw[0];
|
||||||
adc_data.cp_raw = adc_dma_raw[1];
|
adc_data.cp_raw = adc_dma_raw[1];
|
||||||
adc_data.ntc1_raw = adc_dma_raw[2];
|
adc_data.ntc1_raw = adc_dma_raw[2];
|
||||||
adc_data.ntc2_raw = adc_dma_raw[3];
|
adc_data.ntc2_raw = adc_dma_raw[3];
|
||||||
adc_data.temp_sensor_raw = adc_dma_raw[4];
|
adc_data.temp_sensor_raw = adc_dma_raw[4];
|
||||||
adc_data.vrefint_raw = adc_dma_raw[5];
|
adc_data.vrefint_raw = adc_dma_raw[5];
|
||||||
adc_scan_data_ready = 1u;
|
adc_scan_data_ready = 1u;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* USER CODE END 0 */
|
/* USER CODE END 0 */
|
||||||
|
|
||||||
ADC_HandleTypeDef hadc1;
|
ADC_HandleTypeDef hadc1;
|
||||||
DMA_HandleTypeDef hdma_adc1;
|
DMA_HandleTypeDef hdma_adc1;
|
||||||
|
|
||||||
/* ADC1 init function */
|
/* ADC1 init function */
|
||||||
void MX_ADC1_Init(void)
|
void MX_ADC1_Init(void)
|
||||||
{
|
{
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 0 */
|
/* USER CODE BEGIN ADC1_Init 0 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 0 */
|
/* USER CODE END ADC1_Init 0 */
|
||||||
|
|
||||||
ADC_ChannelConfTypeDef sConfig = {0};
|
ADC_ChannelConfTypeDef sConfig = {0};
|
||||||
|
|
||||||
/* USER CODE BEGIN ADC1_Init 1 */
|
/* USER CODE BEGIN ADC1_Init 1 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 1 */
|
/* USER CODE END ADC1_Init 1 */
|
||||||
|
|
||||||
/** Common config
|
/** Common config
|
||||||
*/
|
*/
|
||||||
hadc1.Instance = ADC1;
|
hadc1.Instance = ADC1;
|
||||||
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
hadc1.Init.ScanConvMode = ADC_SCAN_ENABLE;
|
||||||
hadc1.Init.ContinuousConvMode = DISABLE;
|
hadc1.Init.ContinuousConvMode = DISABLE;
|
||||||
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
hadc1.Init.DiscontinuousConvMode = DISABLE;
|
||||||
hadc1.Init.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T3_TRGO;
|
hadc1.Init.ExternalTrigConv = ADC_EXTERNALTRIGCONV_T3_TRGO;
|
||||||
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
|
||||||
hadc1.Init.NbrOfConversion = 6;
|
hadc1.Init.NbrOfConversion = 6;
|
||||||
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
if (HAL_ADC_Init(&hadc1) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_3;
|
sConfig.Channel = ADC_CHANNEL_3;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_1;
|
sConfig.Rank = ADC_REGULAR_RANK_1;
|
||||||
sConfig.SamplingTime = ADC_SAMPLETIME_41CYCLES_5;
|
sConfig.SamplingTime = ADC_SAMPLETIME_41CYCLES_5;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_4;
|
sConfig.Channel = ADC_CHANNEL_4;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_2;
|
sConfig.Rank = ADC_REGULAR_RANK_2;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_8;
|
sConfig.Channel = ADC_CHANNEL_8;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_3;
|
sConfig.Rank = ADC_REGULAR_RANK_3;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_9;
|
sConfig.Channel = ADC_CHANNEL_9;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_4;
|
sConfig.Rank = ADC_REGULAR_RANK_4;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
|
sConfig.Channel = ADC_CHANNEL_TEMPSENSOR;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_5;
|
sConfig.Rank = ADC_REGULAR_RANK_5;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
/** Configure Regular Channel
|
/** Configure Regular Channel
|
||||||
*/
|
*/
|
||||||
sConfig.Channel = ADC_CHANNEL_VREFINT;
|
sConfig.Channel = ADC_CHANNEL_VREFINT;
|
||||||
sConfig.Rank = ADC_REGULAR_RANK_6;
|
sConfig.Rank = ADC_REGULAR_RANK_6;
|
||||||
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
if (HAL_ADC_ConfigChannel(&hadc1, &sConfig) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
/* USER CODE BEGIN ADC1_Init 2 */
|
/* USER CODE BEGIN ADC1_Init 2 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_Init 2 */
|
/* USER CODE END ADC1_Init 2 */
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
|
void HAL_ADC_MspInit(ADC_HandleTypeDef* adcHandle)
|
||||||
{
|
{
|
||||||
|
|
||||||
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
GPIO_InitTypeDef GPIO_InitStruct = {0};
|
||||||
if(adcHandle->Instance==ADC1)
|
if(adcHandle->Instance==ADC1)
|
||||||
{
|
{
|
||||||
/* USER CODE BEGIN ADC1_MspInit 0 */
|
/* USER CODE BEGIN ADC1_MspInit 0 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_MspInit 0 */
|
/* USER CODE END ADC1_MspInit 0 */
|
||||||
/* ADC1 clock enable */
|
/* ADC1 clock enable */
|
||||||
__HAL_RCC_ADC1_CLK_ENABLE();
|
__HAL_RCC_ADC1_CLK_ENABLE();
|
||||||
|
|
||||||
__HAL_RCC_GPIOA_CLK_ENABLE();
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
||||||
__HAL_RCC_GPIOB_CLK_ENABLE();
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
||||||
/**ADC1 GPIO Configuration
|
/**ADC1 GPIO Configuration
|
||||||
PA3 ------> ADC1_IN3
|
PA3 ------> ADC1_IN3
|
||||||
PA4 ------> ADC1_IN4
|
PA4 ------> ADC1_IN4
|
||||||
PB0 ------> ADC1_IN8
|
PB0 ------> ADC1_IN8
|
||||||
PB1 ------> ADC1_IN9
|
PB1 ------> ADC1_IN9
|
||||||
*/
|
*/
|
||||||
GPIO_InitStruct.Pin = GPIO_PIN_3|CP_ADC_Pin;
|
GPIO_InitStruct.Pin = GPIO_PIN_3|CP_ADC_Pin;
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
||||||
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);
|
||||||
|
|
||||||
GPIO_InitStruct.Pin = ADC_NTC1_Pin|ADC_NTC2_Pin;
|
GPIO_InitStruct.Pin = ADC_NTC1_Pin|ADC_NTC2_Pin;
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
GPIO_InitStruct.Mode = GPIO_MODE_ANALOG;
|
||||||
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
|
||||||
|
|
||||||
/* ADC1 DMA Init */
|
/* ADC1 DMA Init */
|
||||||
/* ADC1 Init */
|
/* ADC1 Init */
|
||||||
hdma_adc1.Instance = DMA1_Channel1;
|
hdma_adc1.Instance = DMA1_Channel1;
|
||||||
hdma_adc1.Init.Direction = DMA_PERIPH_TO_MEMORY;
|
hdma_adc1.Init.Direction = DMA_PERIPH_TO_MEMORY;
|
||||||
hdma_adc1.Init.PeriphInc = DMA_PINC_DISABLE;
|
hdma_adc1.Init.PeriphInc = DMA_PINC_DISABLE;
|
||||||
hdma_adc1.Init.MemInc = DMA_MINC_ENABLE;
|
hdma_adc1.Init.MemInc = DMA_MINC_ENABLE;
|
||||||
hdma_adc1.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
|
hdma_adc1.Init.PeriphDataAlignment = DMA_PDATAALIGN_HALFWORD;
|
||||||
hdma_adc1.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
|
hdma_adc1.Init.MemDataAlignment = DMA_MDATAALIGN_HALFWORD;
|
||||||
hdma_adc1.Init.Mode = DMA_CIRCULAR;
|
hdma_adc1.Init.Mode = DMA_CIRCULAR;
|
||||||
hdma_adc1.Init.Priority = DMA_PRIORITY_MEDIUM;
|
hdma_adc1.Init.Priority = DMA_PRIORITY_MEDIUM;
|
||||||
if (HAL_DMA_Init(&hdma_adc1) != HAL_OK)
|
if (HAL_DMA_Init(&hdma_adc1) != HAL_OK)
|
||||||
{
|
{
|
||||||
Error_Handler();
|
Error_Handler();
|
||||||
}
|
}
|
||||||
|
|
||||||
__HAL_LINKDMA(adcHandle,DMA_Handle,hdma_adc1);
|
__HAL_LINKDMA(adcHandle,DMA_Handle,hdma_adc1);
|
||||||
|
|
||||||
/* ADC1 interrupt Init */
|
/* ADC1 interrupt Init */
|
||||||
HAL_NVIC_SetPriority(ADC1_2_IRQn, 7, 0);
|
HAL_NVIC_SetPriority(ADC1_2_IRQn, 7, 0);
|
||||||
HAL_NVIC_EnableIRQ(ADC1_2_IRQn);
|
HAL_NVIC_EnableIRQ(ADC1_2_IRQn);
|
||||||
/* USER CODE BEGIN ADC1_MspInit 1 */
|
/* USER CODE BEGIN ADC1_MspInit 1 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_MspInit 1 */
|
/* USER CODE END ADC1_MspInit 1 */
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
|
void HAL_ADC_MspDeInit(ADC_HandleTypeDef* adcHandle)
|
||||||
{
|
{
|
||||||
|
|
||||||
if(adcHandle->Instance==ADC1)
|
if(adcHandle->Instance==ADC1)
|
||||||
{
|
{
|
||||||
/* USER CODE BEGIN ADC1_MspDeInit 0 */
|
/* USER CODE BEGIN ADC1_MspDeInit 0 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_MspDeInit 0 */
|
/* USER CODE END ADC1_MspDeInit 0 */
|
||||||
/* Peripheral clock disable */
|
/* Peripheral clock disable */
|
||||||
__HAL_RCC_ADC1_CLK_DISABLE();
|
__HAL_RCC_ADC1_CLK_DISABLE();
|
||||||
|
|
||||||
/**ADC1 GPIO Configuration
|
/**ADC1 GPIO Configuration
|
||||||
PA3 ------> ADC1_IN3
|
PA3 ------> ADC1_IN3
|
||||||
PA4 ------> ADC1_IN4
|
PA4 ------> ADC1_IN4
|
||||||
PB0 ------> ADC1_IN8
|
PB0 ------> ADC1_IN8
|
||||||
PB1 ------> ADC1_IN9
|
PB1 ------> ADC1_IN9
|
||||||
*/
|
*/
|
||||||
HAL_GPIO_DeInit(GPIOA, GPIO_PIN_3|CP_ADC_Pin);
|
HAL_GPIO_DeInit(GPIOA, GPIO_PIN_3|CP_ADC_Pin);
|
||||||
|
|
||||||
HAL_GPIO_DeInit(GPIOB, ADC_NTC1_Pin|ADC_NTC2_Pin);
|
HAL_GPIO_DeInit(GPIOB, ADC_NTC1_Pin|ADC_NTC2_Pin);
|
||||||
|
|
||||||
/* ADC1 DMA DeInit */
|
/* ADC1 DMA DeInit */
|
||||||
HAL_DMA_DeInit(adcHandle->DMA_Handle);
|
HAL_DMA_DeInit(adcHandle->DMA_Handle);
|
||||||
|
|
||||||
/* ADC1 interrupt Deinit */
|
/* ADC1 interrupt Deinit */
|
||||||
HAL_NVIC_DisableIRQ(ADC1_2_IRQn);
|
HAL_NVIC_DisableIRQ(ADC1_2_IRQn);
|
||||||
/* USER CODE BEGIN ADC1_MspDeInit 1 */
|
/* USER CODE BEGIN ADC1_MspDeInit 1 */
|
||||||
|
|
||||||
/* USER CODE END ADC1_MspDeInit 1 */
|
/* USER CODE END ADC1_MspDeInit 1 */
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/* USER CODE BEGIN 1 */
|
/* USER CODE BEGIN 1 */
|
||||||
|
|
||||||
/* USER CODE END 1 */
|
/* USER CODE END 1 */
|
||||||
|
|||||||
+5
-5
@@ -54,15 +54,15 @@ void MX_GPIO_Init(void)
|
|||||||
/*Configure GPIO pin Output Level */
|
/*Configure GPIO pin Output Level */
|
||||||
HAL_GPIO_WritePin(GPIOD, RELAY_DC_Pin|USART2_DIR_Pin, GPIO_PIN_RESET);
|
HAL_GPIO_WritePin(GPIOD, RELAY_DC_Pin|USART2_DIR_Pin, GPIO_PIN_RESET);
|
||||||
|
|
||||||
/*Configure GPIO pin : DBG1_Pin */
|
/*Configure GPIO pins : DBG1_Pin LED_DATA_Pin */
|
||||||
GPIO_InitStruct.Pin = DBG1_Pin;
|
GPIO_InitStruct.Pin = DBG1_Pin|LED_DATA_Pin;
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_HIGH;
|
||||||
HAL_GPIO_Init(DBG1_GPIO_Port, &GPIO_InitStruct);
|
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
|
||||||
|
|
||||||
/*Configure GPIO pins : RELAY_CP_Pin LOCK_A_Pin LOCK_B_Pin LED_DATA_Pin */
|
/*Configure GPIO pins : RELAY_CP_Pin LOCK_A_Pin LOCK_B_Pin */
|
||||||
GPIO_InitStruct.Pin = RELAY_CP_Pin|LOCK_A_Pin|LOCK_B_Pin|LED_DATA_Pin;
|
GPIO_InitStruct.Pin = RELAY_CP_Pin|LOCK_A_Pin|LOCK_B_Pin;
|
||||||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||||||
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
GPIO_InitStruct.Pull = GPIO_NOPULL;
|
||||||
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
|
||||||
|
|||||||
+152
-3
@@ -6,6 +6,15 @@
|
|||||||
#include "tim.h"
|
#include "tim.h"
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
|
|
||||||
|
/* Второй светодиод в цепочке WS2812 */
|
||||||
|
static RGB_t ws2812_led1 = { .R = 0, .G = 0, .B = 0 };
|
||||||
|
|
||||||
|
#define WS2812_ERROR_BLINK_MS 100
|
||||||
|
#define WS2812_ERROR_BLINK_PAUSE 30
|
||||||
|
|
||||||
|
/* Яркость обоих WS2812 на плате, 0..255 */
|
||||||
|
#define WS2812_BRIGHTNESS 60
|
||||||
|
|
||||||
RGB_State_t LED_State;
|
RGB_State_t LED_State;
|
||||||
RGB_Cycle_t LED_Cycle;
|
RGB_Cycle_t LED_Cycle;
|
||||||
|
|
||||||
@@ -179,10 +188,147 @@ void interpolateColors(RGB_t* color1, RGB_t* color2, uint16_t a, uint16_t b, RGB
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
#pragma GCC push_options
|
||||||
|
#pragma GCC optimize("O2")
|
||||||
|
|
||||||
|
|
||||||
|
#define WS2812_T0H_NOP 25
|
||||||
|
#define WS2812_T0L_NOP 52
|
||||||
|
#define WS2812_T1H_NOP 52
|
||||||
|
#define WS2812_T1L_NOP 25
|
||||||
|
|
||||||
|
#define _WS2812_DELAY_NOPS(n) __asm volatile(".rept " #n "\nnop\n.endr" ::: "memory")
|
||||||
|
#define WS2812_DELAY_NOPS(n) _WS2812_DELAY_NOPS(n)
|
||||||
|
|
||||||
|
static void ws2812_send_pixel(uint8_t r, uint8_t g, uint8_t b)
|
||||||
|
{
|
||||||
|
uint32_t tmp = ~(((uint32_t)g << 16) | ((uint32_t)r << 8) | (uint32_t)b);
|
||||||
|
|
||||||
|
for (int i = 0; i < 24; i++) {
|
||||||
|
LED_DATA_GPIO_Port->BSRR = LED_DATA_Pin;
|
||||||
|
if (tmp & (1U << 23)) {
|
||||||
|
WS2812_DELAY_NOPS(WS2812_T0H_NOP);
|
||||||
|
LED_DATA_GPIO_Port->BRR = LED_DATA_Pin;
|
||||||
|
WS2812_DELAY_NOPS(WS2812_T0L_NOP);
|
||||||
|
} else {
|
||||||
|
WS2812_DELAY_NOPS(WS2812_T1H_NOP);
|
||||||
|
LED_DATA_GPIO_Port->BRR = LED_DATA_Pin;
|
||||||
|
WS2812_DELAY_NOPS(WS2812_T1L_NOP);
|
||||||
|
}
|
||||||
|
tmp <<= 1;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ws2812_update(RGB_t *led0, RGB_t *led1)
|
||||||
|
{
|
||||||
|
uint32_t primask = __get_PRIMASK();
|
||||||
|
|
||||||
|
__disable_irq();
|
||||||
|
ws2812_send_pixel(led0->R, led0->G, led0->B);
|
||||||
|
ws2812_send_pixel(led1->R, led1->G, led1->B);
|
||||||
|
__set_PRIMASK(primask);
|
||||||
|
}
|
||||||
|
|
||||||
|
#pragma GCC pop_options
|
||||||
|
|
||||||
|
static RGB_t RGB_ScaleBrightness(const RGB_t *color)
|
||||||
|
{
|
||||||
|
RGB_t out = {
|
||||||
|
.R = (uint8_t)((uint16_t)color->R * WS2812_BRIGHTNESS / 255),
|
||||||
|
.G = (uint8_t)((uint16_t)color->G * WS2812_BRIGHTNESS / 255),
|
||||||
|
.B = (uint8_t)((uint16_t)color->B * WS2812_BRIGHTNESS / 255),
|
||||||
|
};
|
||||||
|
return out;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Моргание красным на втором WS2812 при chargingError > 0.
|
||||||
|
* Логика как Slave-LB24 LED_Task: N вспышек = код ошибки, пауза 30×100 ms.
|
||||||
|
* Вызывается из LED_Task каждые 20 ms; шаг FSM — 100 ms.
|
||||||
|
*/
|
||||||
|
static void LED_Ws2812ErrorBlinkUpdate(void)
|
||||||
|
{
|
||||||
|
static uint8_t err_counter;
|
||||||
|
static uint8_t led_state;
|
||||||
|
static uint8_t led_pause;
|
||||||
|
static uint32_t blink_tick;
|
||||||
|
static uint32_t flash_until;
|
||||||
|
static CONN_Error_t last_error = CONN_NO_ERROR;
|
||||||
|
|
||||||
|
const CONN_Error_t err = CONN.chargingError;
|
||||||
|
const uint32_t now = HAL_GetTick();
|
||||||
|
|
||||||
|
if (err == CONN_NO_ERROR) {
|
||||||
|
err_counter = 0;
|
||||||
|
led_state = 0;
|
||||||
|
led_pause = 0;
|
||||||
|
flash_until = 0;
|
||||||
|
last_error = CONN_NO_ERROR;
|
||||||
|
ws2812_led1.R = 0;
|
||||||
|
ws2812_led1.G = 0;
|
||||||
|
ws2812_led1.B = 0;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (err != last_error) {
|
||||||
|
err_counter = 0;
|
||||||
|
led_state = 0;
|
||||||
|
led_pause = 0;
|
||||||
|
flash_until = 0;
|
||||||
|
last_error = err;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (now < flash_until) {
|
||||||
|
ws2812_led1.R = 255;
|
||||||
|
ws2812_led1.G = 0;
|
||||||
|
ws2812_led1.B = 0;
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
ws2812_led1.R = 0;
|
||||||
|
ws2812_led1.G = 0;
|
||||||
|
ws2812_led1.B = 0;
|
||||||
|
|
||||||
|
if ((now - blink_tick) < WS2812_ERROR_BLINK_MS) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
blink_tick = now;
|
||||||
|
|
||||||
|
uint8_t led_flash = 0;
|
||||||
|
|
||||||
|
if (led_pause > 0) {
|
||||||
|
led_pause--;
|
||||||
|
} else if (err_counter < (uint8_t)err) {
|
||||||
|
if (led_state == 0) {
|
||||||
|
led_state = 1;
|
||||||
|
} else {
|
||||||
|
led_flash = 1;
|
||||||
|
led_state = 0;
|
||||||
|
err_counter++;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
err_counter = 0;
|
||||||
|
led_pause = WS2812_ERROR_BLINK_PAUSE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (led_flash) {
|
||||||
|
flash_until = now + WS2812_ERROR_BLINK_MS;
|
||||||
|
ws2812_led1.R = 255;
|
||||||
|
ws2812_led1.G = 0;
|
||||||
|
ws2812_led1.B = 0;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void RGB_SetColor(RGB_t *color){
|
void RGB_SetColor(RGB_t *color){
|
||||||
htim4.Instance->CCR2 = color->R * 100 / 255;
|
htim4.Instance->CCR2 = color->R * 100 / 255;
|
||||||
htim4.Instance->CCR3 = color->G * 100 / 255;
|
htim4.Instance->CCR3 = color->G * 100 / 255;
|
||||||
htim4.Instance->CCR4 = color->B * 100 / 255;
|
htim4.Instance->CCR4 = color->B * 100 / 255;
|
||||||
|
}
|
||||||
|
|
||||||
|
void WS2812_SetColor(RGB_t *color){
|
||||||
|
RGB_t led0 = RGB_ScaleBrightness(color);
|
||||||
|
RGB_t led1 = RGB_ScaleBrightness(&ws2812_led1);
|
||||||
|
ws2812_update(&led0, &led1);
|
||||||
}
|
}
|
||||||
|
|
||||||
void LED_SetColor(RGB_Cycle_t *color){
|
void LED_SetColor(RGB_Cycle_t *color){
|
||||||
@@ -196,6 +342,7 @@ void LED_Init(){
|
|||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_3);
|
||||||
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
HAL_TIM_PWM_Start(&htim4, TIM_CHANNEL_4);
|
||||||
RGB_SetColor(&color);
|
RGB_SetColor(&color);
|
||||||
|
WS2812_SetColor(&color);
|
||||||
}
|
}
|
||||||
|
|
||||||
void LED_Task(){
|
void LED_Task(){
|
||||||
@@ -239,6 +386,8 @@ void LED_Task(){
|
|||||||
default:
|
default:
|
||||||
LED_State.state = LED_RISING;
|
LED_State.state = LED_RISING;
|
||||||
}
|
}
|
||||||
|
LED_Ws2812ErrorBlinkUpdate();
|
||||||
RGB_SetColor(&LED_State.color);
|
RGB_SetColor(&LED_State.color);
|
||||||
|
WS2812_SetColor(&LED_State.color);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Binary file not shown.
Binary file not shown.
+3404
-3341
File diff suppressed because it is too large
Load Diff
+20713
-20092
File diff suppressed because it is too large
Load Diff
+1213
-1183
File diff suppressed because it is too large
Load Diff
+3404
-3340
File diff suppressed because it is too large
Load Diff
@@ -1,6 +1,11 @@
|
|||||||
../Core/Src/rgb_controller.c:102:6:LED_Write 18
|
../Core/Src/rgb_controller.c:111:6:LED_Write 18
|
||||||
../Core/Src/rgb_controller.c:164:6:interpolateColors 3
|
../Core/Src/rgb_controller.c:173:6:interpolateColors 3
|
||||||
../Core/Src/rgb_controller.c:182:6:RGB_SetColor 1
|
../Core/Src/rgb_controller.c:203:13:ws2812_send_pixel 3
|
||||||
../Core/Src/rgb_controller.c:188:6:LED_SetColor 1
|
../Core/Src/rgb_controller.c:222:13:ws2812_update 1
|
||||||
../Core/Src/rgb_controller.c:193:6:LED_Init 1
|
../Core/Src/rgb_controller.c:234:14:RGB_ScaleBrightness 1
|
||||||
../Core/Src/rgb_controller.c:201:6:LED_Task 10
|
../Core/Src/rgb_controller.c:249:13:LED_Ws2812ErrorBlinkUpdate 9
|
||||||
|
../Core/Src/rgb_controller.c:322:6:RGB_SetColor 1
|
||||||
|
../Core/Src/rgb_controller.c:328:6:WS2812_SetColor 1
|
||||||
|
../Core/Src/rgb_controller.c:334:6:LED_SetColor 1
|
||||||
|
../Core/Src/rgb_controller.c:339:6:LED_Init 1
|
||||||
|
../Core/Src/rgb_controller.c:348:6:LED_Task 10
|
||||||
|
|||||||
Reference in New Issue
Block a user