Compare commits

...

3 Commits

Author SHA1 Message Date
d11e9edf36 升级功能优化 2024-01-05 17:04:46 +08:00
4ffcff9f1b 添加‘投影激光设备’的控制 2023-12-29 11:50:36 +08:00
20a463febf 处理IO中断偶然性丢失数据的BUG 2023-12-20 17:13:54 +08:00
5 changed files with 97 additions and 47 deletions

View File

@ -23,6 +23,7 @@ static uint16_t upgrade_write_index = 0;
/* 升级包数据接收长度 */ /* 升级包数据接收长度 */
static uint8_t upgrade_rx_buffer[1024] = {0}; static uint8_t upgrade_rx_buffer[1024] = {0};
static void api_write_upgrade_buffer(void);
static void api_notify_upgrade(uint8_t *buffer, uint16_t length); static void api_notify_upgrade(uint8_t *buffer, uint16_t length);
static void api_notify_get_fhss_channel(void); static void api_notify_get_fhss_channel(void);
static void api_package(uint8_t type, uint8_t command, uint8_t *data, uint8_t length); static void api_package(uint8_t type, uint8_t command, uint8_t *data, uint8_t length);
@ -199,6 +200,16 @@ void api_upload_data_forwarding(uint8_t type, uint8_t value)
__weak void api_notify_data_forwarding(uint8_t type, uint8_t value) { } __weak void api_notify_data_forwarding(uint8_t type, uint8_t value) { }
static void api_write_upgrade_buffer(void)
{
/* 写入升级包数据 */
fmc_write_bytes(FMC_ADDRESS_UPGRADE_BUFFER + upgrade_write_index * FMC_PAGE_SIZE, upgrade_rx_buffer, upgrade_rx_index / 4 + (upgrade_rx_index % 4 ? 1 : 0));
upgrade_write_index++;
upgrade_rx_length += upgrade_rx_index;
upgrade_rx_index = 0;
}
/** /**
* @brief * @brief
*/ */
@ -226,24 +237,22 @@ static void api_notify_upgrade(uint8_t *buffer, uint16_t length)
upgrade_pack_index = 0; upgrade_pack_index = 0;
} }
for (uint16_t i = 0; i < pack_length; i++)
upgrade_rx_buffer[upgrade_rx_index++] = buffer[i + 9];
if (index == upgrade_pack_index + 1) if (index == upgrade_pack_index + 1)
{ {
/* 更改ARM接收到的升级包序号 */ /* 更改ARM接收到的升级包序号 */
upgrade_pack_index = index; upgrade_pack_index = index;
if (upgrade_rx_index >= 1024 || upgrade_pack_index == upgrade_pack_count) for (uint16_t i = 0; i < pack_length; i++)
{ {
/* 写入升级包数据 */ upgrade_rx_buffer[upgrade_rx_index++] = buffer[i + 9];
fmc_write_bytes(FMC_ADDRESS_UPGRADE_BUFFER + upgrade_write_index * FMC_PAGE_SIZE, upgrade_rx_buffer, upgrade_rx_index / 4 + (upgrade_rx_index % 4 ? 1 : 0));
upgrade_write_index++; if (upgrade_rx_index >= 1024)
upgrade_rx_length += upgrade_rx_index; api_write_upgrade_buffer();
upgrade_rx_index = 0;
} }
if (upgrade_pack_index == upgrade_pack_count)
api_write_upgrade_buffer();
/* 通知上位机当前升级包成功接收 */ /* 通知上位机当前升级包成功接收 */
api_response_success(API_COMMAND_UPGRADE); api_response_success(API_COMMAND_UPGRADE);

View File

@ -22,7 +22,7 @@
#define API_FRAME_RESPONSE (0x01) /* 响应帧 */ #define API_FRAME_RESPONSE (0x01) /* 响应帧 */
#define API_FRAME_NOTIFICATION (0x02) /* 通知帧 */ #define API_FRAME_NOTIFICATION (0x02) /* 通知帧 */
#define SOFTWARE_VERSION ("V1.25") #define SOFTWARE_VERSION ("V1.28")
#define HARDWARE_VERSION ("V1.01") #define HARDWARE_VERSION ("V1.01")
extern uint8_t api_upgrade_mode; extern uint8_t api_upgrade_mode;

View File

@ -12,12 +12,13 @@ static uint64_t diaodu_rx_led_timestamp = 0;
static uint64_t run_led_timestamp = 0; static uint64_t run_led_timestamp = 0;
static uint64_t diaodu_status_rx_timestamp = 0; static uint64_t diaodu_status_rx_timestamp = 0;
static uint8_t vehicle_status_trigger_mode = 0; /* 车辆状态触发方式:0 IO; 1 CAN */
static uint8_t door_front_status = 1, door_front_status_temporary = 1; static uint8_t door_front_status = 1, door_front_status_temporary = 1;
static uint8_t door_back_status = 1, door_back_status_temporary = 1; static uint8_t door_back_status = 1, door_back_status_temporary = 1;
static uint8_t door_status = 2, door_status_temporary = 2; static uint8_t door_status = 2, door_status_temporary = 2;
static uint8_t turn_left_type = 0, turn_left_status = 1, turn_left_status_temporary = 1; /* turn_left_type:0 IO; 1 CAN */ static uint8_t turn_left_status = 1, turn_left_status_temporary = 1;
static uint8_t turn_left_parsing_count = 0; /* 转向接收次数 */ static uint8_t turn_left_parsing_count = 0; /* 转向接收次数 */
static uint8_t turn_right_type = 1, turn_right_status = 1, turn_right_status_temporary = 1; static uint8_t turn_right_status = 1, turn_right_status_temporary = 1;
static uint8_t turn_right_parsing_count = 0; /* 转向接收次数 */ static uint8_t turn_right_parsing_count = 0; /* 转向接收次数 */
static uint8_t emergency_flashers_status = 1, emergency_flashers_status_temporary = 1; /* 双闪 */ static uint8_t emergency_flashers_status = 1, emergency_flashers_status_temporary = 1; /* 双闪 */
static uint8_t reversing_status = 1, reversing_status_temporary = 1; static uint8_t reversing_status = 1, reversing_status_temporary = 1;
@ -51,6 +52,8 @@ static uint8_t diaodu_upload_status = 0;
static void strobe_light_reset(void); static void strobe_light_reset(void);
/* 频闪灯闪烁*/ /* 频闪灯闪烁*/
static void strobe_light_toggle(uint8_t count); static void strobe_light_toggle(uint8_t count);
/* 投影灯控制 */
static void lp_light_write(uint8_t status);
/* 设置音量级别 */ /* 设置音量级别 */
static void set_volume_level(uint8_t level); static void set_volume_level(uint8_t level);
@ -88,30 +91,33 @@ void gpio_interrupt_callback(uint32_t pin)
switch (pin) switch (pin)
{ {
case DOOR_FRONT_PIN: case DOOR_FRONT_PIN:
door_front_status_temporary = gpio_input_bit_get(DOOR_FRONT_PERIPH, DOOR_FRONT_PIN);
door_front_upload_status = 0x01; door_front_upload_status = 0x01;
vehicle_status_trigger_mode = 0;
door_front_status_temporary = gpio_input_bit_get(DOOR_FRONT_PERIPH, DOOR_FRONT_PIN);
break; break;
case DOOR_BACK_PIN: case DOOR_BACK_PIN:
door_back_status_temporary = gpio_input_bit_get(DOOR_BACK_PERIPH, DOOR_BACK_PIN);
door_back_upload_status = 0x01; door_back_upload_status = 0x01;
vehicle_status_trigger_mode = 0;
door_back_status_temporary = gpio_input_bit_get(DOOR_BACK_PERIPH, DOOR_BACK_PIN);
break; break;
case TURN_LEFT_PIN: case TURN_LEFT_PIN:
turn_left_type = 0;
turn_left_status_temporary = gpio_input_bit_get(TURN_LEFT_PERIPH, TURN_LEFT_PIN);
turn_left_upload_status = 0x01; turn_left_upload_status = 0x01;
vehicle_status_trigger_mode = 0;
turn_left_status_temporary = gpio_input_bit_get(TURN_LEFT_PERIPH, TURN_LEFT_PIN);
break; break;
case TURN_RIGHT_PIN: case TURN_RIGHT_PIN:
turn_right_type = 0;
turn_right_status_temporary = gpio_input_bit_get(TURN_RIGHT_PERIPH, TURN_RIGHT_PIN);
turn_right_upload_status = 0x01; turn_right_upload_status = 0x01;
vehicle_status_trigger_mode = 0;
turn_right_status_temporary = gpio_input_bit_get(TURN_RIGHT_PERIPH, TURN_RIGHT_PIN);
break; break;
case REVERSING_PIN: case REVERSING_PIN:
reversing_status_temporary = gpio_input_bit_get(REVERSING_PERIPH, REVERSING_PIN);
reversing_upload_status = 0x01; reversing_upload_status = 0x01;
vehicle_status_trigger_mode = 0;
reversing_status_temporary = gpio_input_bit_get(REVERSING_PERIPH, REVERSING_PIN);
break; break;
} }
} }
@ -196,6 +202,9 @@ void app_init(void)
static void strobe_light_reset(void) static void strobe_light_reset(void)
{ {
gpio_bit_write(LED_STROBE_PERIPH, LED_STROBE_PIN, RESET); gpio_bit_write(LED_STROBE_PERIPH, LED_STROBE_PIN, RESET);
/* 恢复投影灯状态 */
lp_light_write(0);
} }
static void strobe_light_toggle(uint8_t count) static void strobe_light_toggle(uint8_t count)
@ -209,6 +218,14 @@ static void strobe_light_toggle(uint8_t count)
} }
} }
static void lp_light_write(uint8_t status)
{
/* 激光投影设备 */
gpio_bit_write(LP_FRONT_DOOR_PERIPH, LP_FRONT_DOOR_PIN, (bit_status)status);
gpio_bit_write(LP_BACK_DOOR_PERIPH, LP_BACK_DOOR_PIN, (bit_status)status);
gpio_bit_write(LP_CAR_REAR_PERIPH, LP_CAR_REAR_PIN, (bit_status)status);
}
static void led_parsing_task(uint8_t uuid) static void led_parsing_task(uint8_t uuid)
{ {
/* 超过 2s 未检测到CAN数据变化熄灭发送指示灯 */ /* 超过 2s 未检测到CAN数据变化熄灭发送指示灯 */
@ -350,24 +367,26 @@ static void can_parsing_task(uint8_t uuid)
{ {
can_channge_status = 1; can_channge_status = 1;
door_front_upload_status = 0x01; door_front_upload_status = 0x01;
vehicle_status_trigger_mode = 1;
} }
if (door_back_status_temporary != door_back_status) if (door_back_status_temporary != door_back_status)
{ {
can_channge_status = 1; can_channge_status = 1;
door_back_upload_status = 0x01; door_back_upload_status = 0x01;
vehicle_status_trigger_mode = 1;
} }
if (turn_left_status_temporary != turn_left_status) if (turn_left_status_temporary != turn_left_status)
{ {
turn_left_type = 1;
can_channge_status = 1; can_channge_status = 1;
turn_left_upload_status = 0x01; turn_left_upload_status = 0x01;
vehicle_status_trigger_mode = 1;
} }
if (turn_right_status_temporary != turn_right_status) if (turn_right_status_temporary != turn_right_status)
{ {
turn_right_type = 1; vehicle_status_trigger_mode = 1;
can_channge_status = 1; can_channge_status = 1;
turn_right_upload_status = 0x01; turn_right_upload_status = 0x01;
} }
@ -376,6 +395,7 @@ static void can_parsing_task(uint8_t uuid)
{ {
can_channge_status = 1; can_channge_status = 1;
reversing_upload_status = 0x01; reversing_upload_status = 0x01;
vehicle_status_trigger_mode = 1;
} }
if (can_channge_status == 1) if (can_channge_status == 1)
@ -400,6 +420,9 @@ static void strobe_light_operate_task(uint8_t uuid)
return; return;
} }
lp_light_write(1);
strobe_light_flashing_count += 1; strobe_light_flashing_count += 1;
if (strobe_light_flashing_mode == 0) if (strobe_light_flashing_mode == 0)
@ -418,8 +441,6 @@ static void strobe_light_operate_task(uint8_t uuid)
/* 频闪 */ /* 频闪 */
gpio_bit_write(LED_STROBE_PERIPH, LED_STROBE_PIN, !(strobe_light_flashing_count % 2)); gpio_bit_write(LED_STROBE_PERIPH, LED_STROBE_PIN, !(strobe_light_flashing_count % 2));
// gpio_bit_toggle(LED_STROBE_PERIPH, LED_STROBE_PIN);
if (strobe_light_flashing_count >= 4) if (strobe_light_flashing_count >= 4)
{ {
strobe_light_flashing_count = 0; strobe_light_flashing_count = 0;
@ -470,6 +491,10 @@ static void vehicle_status_parsing_task(uint8_t uuid)
uint8_t door_change = 0; uint8_t door_change = 0;
/* IO状态下必须保持是实时状态 */
if (vehicle_status_trigger_mode == 0)
reversing_status_temporary = gpio_input_bit_get(REVERSING_PERIPH, REVERSING_PIN);
/* 倒车状态判断 */ /* 倒车状态判断 */
if (reversing_status != reversing_status_temporary) if (reversing_status != reversing_status_temporary)
{ {
@ -498,10 +523,17 @@ static void vehicle_status_parsing_task(uint8_t uuid)
if (reversing_status == 0) if (reversing_status == 0)
return; return;
if (door_front_status_temporary != door_front_status) /* IO状态下必须保持是实时状态 */
if (vehicle_status_trigger_mode == 0)
{
door_front_status_temporary = gpio_input_bit_get(DOOR_FRONT_PERIPH, DOOR_FRONT_PIN);
door_back_status_temporary = gpio_input_bit_get(DOOR_BACK_PERIPH, DOOR_BACK_PIN);
}
if (door_front_status != door_front_status_temporary)
door_front_status = door_front_status_temporary; door_front_status = door_front_status_temporary;
if (door_back_status_temporary != door_back_status) if (door_back_status != door_back_status_temporary)
door_back_status = door_back_status_temporary; door_back_status = door_back_status_temporary;
door_status_temporary = door_front_status_temporary & door_back_status_temporary; door_status_temporary = door_front_status_temporary & door_back_status_temporary;
@ -579,7 +611,6 @@ static void vehicle_status_parsing_task(uint8_t uuid)
goto EXECUTE; goto EXECUTE;
} }
} }
} }
@ -598,7 +629,7 @@ static void vehicle_status_parsing_task(uint8_t uuid)
if (turn_left_status != turn_left_status_temporary) if (turn_left_status != turn_left_status_temporary)
{ {
/* 只有通过IO接收的数据才需要做脉冲判断 */ /* 只有通过IO接收的数据才需要做脉冲判断 */
if (turn_left_type == 0) if (vehicle_status_trigger_mode == 0)
{ {
/* 如果未触发状态, 需进行二次判断 */ /* 如果未触发状态, 需进行二次判断 */
if (turn_left_status_temporary == 1) if (turn_left_status_temporary == 1)
@ -634,7 +665,7 @@ TURN_RIGHT_STATUS_TAG2:
if (turn_right_status != turn_right_status_temporary) if (turn_right_status != turn_right_status_temporary)
{ {
/* 只有通过IO接收的数据才需要做脉冲判断 */ /* 只有通过IO接收的数据才需要做脉冲判断 */
if (turn_right_type == 0) if (vehicle_status_trigger_mode == 0)
{ {
/* 如果未触发状态, 需进行二次判断 */ /* 如果未触发状态, 需进行二次判断 */
if (turn_right_status_temporary == 1) if (turn_right_status_temporary == 1)

View File

@ -49,19 +49,11 @@ static void bsp_initialization(void)
gpio_config(VOLUME_3_PERIPH, VOLUME_3_PIN, GPIO_MODE_IN_FLOATING, GPIO_OSPEED_50MHZ, nullptr); gpio_config(VOLUME_3_PERIPH, VOLUME_3_PIN, GPIO_MODE_IN_FLOATING, GPIO_OSPEED_50MHZ, nullptr);
gpio_config(VOLUME_4_PERIPH, VOLUME_4_PIN, GPIO_MODE_IN_FLOATING, GPIO_OSPEED_50MHZ, nullptr); gpio_config(VOLUME_4_PERIPH, VOLUME_4_PIN, GPIO_MODE_IN_FLOATING, GPIO_OSPEED_50MHZ, nullptr);
/* 前门 检测引脚 初始化 */ /* 前门 后门 左转弯 右转弯 倒车 检测引脚 初始化 */
gpio_interrupt_config(DOOR_FRONT_PERIPH, DOOR_FRONT_PIN, EXTI_TRIG_BOTH); gpio_interrupt_config(DOOR_FRONT_PERIPH, DOOR_FRONT_PIN, EXTI_TRIG_BOTH);
/* 后门 检测引脚 初始化 */
gpio_interrupt_config(DOOR_BACK_PERIPH, DOOR_BACK_PIN, EXTI_TRIG_BOTH); gpio_interrupt_config(DOOR_BACK_PERIPH, DOOR_BACK_PIN, EXTI_TRIG_BOTH);
/* 左转弯 检测引脚 初始化 */
gpio_interrupt_config(TURN_LEFT_PERIPH, TURN_LEFT_PIN, EXTI_TRIG_BOTH); gpio_interrupt_config(TURN_LEFT_PERIPH, TURN_LEFT_PIN, EXTI_TRIG_BOTH);
/* 右转弯 检测引脚 初始化 */
gpio_interrupt_config(TURN_RIGHT_PERIPH, TURN_RIGHT_PIN, EXTI_TRIG_BOTH); gpio_interrupt_config(TURN_RIGHT_PERIPH, TURN_RIGHT_PIN, EXTI_TRIG_BOTH);
/* 倒车 检测引脚 初始化 */
gpio_interrupt_config(REVERSING_PERIPH, REVERSING_PIN, EXTI_TRIG_BOTH); gpio_interrupt_config(REVERSING_PERIPH, REVERSING_PIN, EXTI_TRIG_BOTH);
/* 功放控制脚,默认开启 */ /* 功放控制脚,默认开启 */
@ -75,6 +67,12 @@ static void bsp_initialization(void)
iic_config(M62429_SDA_PERIPH, M62429_SDA_PIN, M62429_SCL_PERIPH, M62429_SCL_PIN); iic_config(M62429_SDA_PERIPH, M62429_SDA_PIN, M62429_SCL_PERIPH, M62429_SCL_PIN);
/* 激光投影设备 控制引脚 初始化 */
gpio_config(LP_FRONT_DOOR_PERIPH, LP_FRONT_DOOR_PIN, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, RESET);
gpio_config(LP_BACK_DOOR_PERIPH, LP_BACK_DOOR_PIN, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, RESET);
gpio_config(LP_CAR_REAR_PERIPH, LP_CAR_REAR_PIN, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, RESET);
/* CAN指示灯 控制引脚 初始化 */ /* CAN指示灯 控制引脚 初始化 */
gpio_config(LED_CAN_PERIPH, LED_CAN_PIN, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, RESET); gpio_config(LED_CAN_PERIPH, LED_CAN_PIN, GPIO_MODE_OUT_PP, GPIO_OSPEED_50MHZ, RESET);

View File

@ -104,6 +104,18 @@
#define M62429_SDA_PERIPH GPIOB #define M62429_SDA_PERIPH GPIOB
#define M62429_SDA_PIN GPIO_PIN_11 #define M62429_SDA_PIN GPIO_PIN_11
/* 激光投影设备(前门) */
#define LP_FRONT_DOOR_PERIPH GPIOC
#define LP_FRONT_DOOR_PIN GPIO_PIN_13
/* 激光投影设备(后门) */
#define LP_BACK_DOOR_PERIPH GPIOC
#define LP_BACK_DOOR_PIN GPIO_PIN_14
/* 激光投影设备(车尾) */
#define LP_CAR_REAR_PERIPH GPIOC
#define LP_CAR_REAR_PIN GPIO_PIN_15
#define LED_CAN_PERIPH GPIOA #define LED_CAN_PERIPH GPIOA
#define LED_CAN_PIN GPIO_PIN_5 #define LED_CAN_PIN GPIO_PIN_5