2026-06-29 01:51:44 +08:00
|
|
|
|
/*
|
2026-07-08 02:51:38 +08:00
|
|
|
|
* can_feedback_task.cpp - 被动监听 GD32 主动推送的 CAN 反馈快照
|
2026-06-29 01:51:44 +08:00
|
|
|
|
*
|
2026-07-08 02:51:38 +08:00
|
|
|
|
* 架构(GD32 主动推送,ESP32 被动接收):
|
|
|
|
|
|
* GD32 APP 在主循环中调用 canFeedbackPushStep(),循环遍历 3 通道 × 2 页,
|
|
|
|
|
|
* 通过 requestEsp32Read(0xC1) 下拉 SPIready 主动按铃,将每页反馈 payload
|
|
|
|
|
|
* 推送给 ESP32。ESP32 本任务调用 checkGd32Request() 阻塞等待按铃,读到
|
|
|
|
|
|
* 一帧后用 canFdParseFeedbackPage() 解析并累积到 s_work[channel],再
|
|
|
|
|
|
* publish() 到 s_latest[channel] 供 Web/WebSocket 读取。
|
|
|
|
|
|
*
|
|
|
|
|
|
* 替代了原先 ESP32 1Hz 主动发 0xC1 轮询的逻辑,避免占用主线 SPI 带宽。
|
|
|
|
|
|
*
|
|
|
|
|
|
* OTA 期间通过 pauseCanFeedbackTask(true) 暂停本任务,避免与 OTA 抢占 SPI。
|
2026-06-29 01:51:44 +08:00
|
|
|
|
*/
|
|
|
|
|
|
#include "freertos/FreeRTOS.h"
|
|
|
|
|
|
#include "freertos/task.h"
|
|
|
|
|
|
#include "freertos/semphr.h"
|
|
|
|
|
|
|
|
|
|
|
|
#include "transport/canfd_bridge.h"
|
2026-07-08 02:51:38 +08:00
|
|
|
|
#include "transport/spi_master.h"
|
2026-06-29 01:51:44 +08:00
|
|
|
|
#include "monitor/debug_log.h"
|
|
|
|
|
|
#include "monitor/can_feedback_task.h"
|
|
|
|
|
|
|
|
|
|
|
|
#include <string.h>
|
|
|
|
|
|
|
|
|
|
|
|
namespace {
|
|
|
|
|
|
|
2026-07-08 02:51:38 +08:00
|
|
|
|
constexpr uint32_t kWaitRingMs = 500U; ///< 单次等待 GD32 按铃超时
|
|
|
|
|
|
constexpr uint32_t kPauseDelayMs = 100U; ///< 暂停时的轮询间隔
|
|
|
|
|
|
constexpr uint8_t kSpiCanFeedbackType = 0xC1U;
|
2026-07-14 12:10:13 +08:00
|
|
|
|
constexpr size_t kRingPayloadMax = SPI_OTA_FRAME_MAX; ///< 与变长读一致,避免截断
|
2026-06-29 01:51:44 +08:00
|
|
|
|
constexpr const char *kTag = "CAN_FB";
|
|
|
|
|
|
|
|
|
|
|
|
static can_feedback_result_t s_latest[CAN_CHANNEL_MAX];
|
|
|
|
|
|
static bool s_valid [CAN_CHANNEL_MAX];
|
|
|
|
|
|
static SemaphoreHandle_t s_mutex = nullptr;
|
|
|
|
|
|
static volatile bool s_paused = false;
|
2026-07-08 02:51:38 +08:00
|
|
|
|
|
|
|
|
|
|
/* 累积工作缓冲:跨 page 0/1 累积每通道的完整反馈 */
|
|
|
|
|
|
static can_feedback_result_t s_work [CAN_CHANNEL_MAX];
|
|
|
|
|
|
static uint8_t s_workIdx[CAN_CHANNEL_MAX];
|
2026-07-11 17:51:42 +08:00
|
|
|
|
static uint32_t s_lastLoggedError[CAN_CHANNEL_MAX];
|
2026-06-29 01:51:44 +08:00
|
|
|
|
|
|
|
|
|
|
static void publish(uint8_t ch, const can_feedback_result_t &fb)
|
|
|
|
|
|
{
|
|
|
|
|
|
if (s_mutex == nullptr) return;
|
|
|
|
|
|
if (xSemaphoreTake(s_mutex, pdMS_TO_TICKS(50)) == pdTRUE) {
|
|
|
|
|
|
s_latest[ch] = fb;
|
|
|
|
|
|
s_valid[ch] = true;
|
|
|
|
|
|
xSemaphoreGive(s_mutex);
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void taskLoop(void *)
|
|
|
|
|
|
{
|
2026-07-08 02:51:38 +08:00
|
|
|
|
DEBUG_INFO(kTag, "CAN 反馈被动监听任务启动 (GD32 主动推送, 0xC1)");
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t ring_type = 0U;
|
|
|
|
|
|
uint8_t ring_payload[kRingPayloadMax] = {};
|
|
|
|
|
|
size_t ring_len = 0U;
|
2026-06-29 01:51:44 +08:00
|
|
|
|
|
|
|
|
|
|
for (;;) {
|
|
|
|
|
|
if (s_paused) {
|
2026-07-08 02:51:38 +08:00
|
|
|
|
vTaskDelay(pdMS_TO_TICKS(kPauseDelayMs));
|
2026-06-29 01:51:44 +08:00
|
|
|
|
continue;
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-07-08 02:51:38 +08:00
|
|
|
|
/* 阻塞等待 GD32 按铃并读取一帧(超时则重试) */
|
|
|
|
|
|
esp_err_t ret = SpiMaster::instance().checkGd32Request(kWaitRingMs);
|
|
|
|
|
|
if (ret != ESP_OK) {
|
|
|
|
|
|
continue;
|
|
|
|
|
|
}
|
2026-06-29 01:51:44 +08:00
|
|
|
|
|
2026-07-08 02:51:38 +08:00
|
|
|
|
/* 取出 checkGd32Request 存入的 type/payload */
|
2026-07-14 12:10:13 +08:00
|
|
|
|
if (!SpiMaster::instance().takeEvent(&ring_type, ring_payload,
|
|
|
|
|
|
sizeof(ring_payload), &ring_len)) {
|
2026-07-08 02:51:38 +08:00
|
|
|
|
continue;
|
|
|
|
|
|
}
|
2026-06-29 01:51:44 +08:00
|
|
|
|
|
2026-07-08 02:51:38 +08:00
|
|
|
|
if (ring_type != kSpiCanFeedbackType || ring_len < 28U) {
|
|
|
|
|
|
continue;
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
const uint8_t ch = ring_payload[0];
|
|
|
|
|
|
if (ch >= CAN_CHANNEL_MAX) {
|
|
|
|
|
|
continue;
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/* 解析本页并累积到工作缓冲,page=0 会自动重置 */
|
|
|
|
|
|
if (canFdParseFeedbackPage(ring_payload, ring_len,
|
|
|
|
|
|
&s_work[ch], &s_workIdx[ch]) == 0) {
|
|
|
|
|
|
publish(ch, s_work[ch]);
|
|
|
|
|
|
|
2026-07-11 17:51:42 +08:00
|
|
|
|
/* 累计错误发生变化时才告警一次;P0/P1 携带相同统计,不能重复打印。 */
|
|
|
|
|
|
if (s_work[ch].stats.error_count != 0U
|
|
|
|
|
|
&& s_work[ch].stats.error_count != s_lastLoggedError[ch]) {
|
2026-07-09 02:49:24 +08:00
|
|
|
|
DEBUG_WARN(kTag,
|
2026-07-11 17:51:42 +08:00
|
|
|
|
"CH%u seq=%lu err=%lu TEC=%u REC=%u state=0x%02X",
|
2026-07-08 02:51:38 +08:00
|
|
|
|
static_cast<unsigned>(ch),
|
|
|
|
|
|
static_cast<unsigned long>(s_work[ch].stats.snapshot_seq),
|
2026-07-11 17:51:42 +08:00
|
|
|
|
static_cast<unsigned long>(s_work[ch].stats.error_count),
|
|
|
|
|
|
static_cast<unsigned>(s_work[ch].stats.tec),
|
|
|
|
|
|
static_cast<unsigned>(s_work[ch].stats.rec),
|
|
|
|
|
|
static_cast<unsigned>(s_work[ch].stats.bus_state));
|
|
|
|
|
|
s_lastLoggedError[ch] = s_work[ch].stats.error_count;
|
2026-06-29 01:51:44 +08:00
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
} // namespace
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
2026-07-08 02:51:38 +08:00
|
|
|
|
* @brief 启动 CAN 反馈被动监听任务(幂等)。
|
2026-06-29 01:51:44 +08:00
|
|
|
|
* @return true 表示任务已存在或创建成功。
|
|
|
|
|
|
*/
|
|
|
|
|
|
bool startCanFeedbackTask()
|
|
|
|
|
|
{
|
|
|
|
|
|
static bool s_started = false;
|
|
|
|
|
|
if (s_started) return true;
|
|
|
|
|
|
|
|
|
|
|
|
if (s_mutex == nullptr) {
|
|
|
|
|
|
s_mutex = xSemaphoreCreateMutex();
|
|
|
|
|
|
if (s_mutex == nullptr) {
|
|
|
|
|
|
DEBUG_ERR(kTag, "互斥量创建失败");
|
|
|
|
|
|
return false;
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
memset(s_latest, 0, sizeof(s_latest));
|
2026-07-11 17:51:42 +08:00
|
|
|
|
memset(s_lastLoggedError, 0, sizeof(s_lastLoggedError));
|
2026-06-29 01:51:44 +08:00
|
|
|
|
memset(s_valid, 0, sizeof(s_valid));
|
2026-07-08 02:51:38 +08:00
|
|
|
|
memset(s_work, 0, sizeof(s_work));
|
|
|
|
|
|
memset(s_workIdx, 0, sizeof(s_workIdx));
|
2026-06-29 01:51:44 +08:00
|
|
|
|
|
|
|
|
|
|
BaseType_t xRet = xTaskCreatePinnedToCore(
|
|
|
|
|
|
taskLoop,
|
|
|
|
|
|
"can_fb",
|
|
|
|
|
|
4096,
|
|
|
|
|
|
nullptr,
|
|
|
|
|
|
4,
|
|
|
|
|
|
nullptr,
|
|
|
|
|
|
0);
|
|
|
|
|
|
if (xRet != pdPASS) {
|
|
|
|
|
|
DEBUG_ERR(kTag, "任务创建失败");
|
|
|
|
|
|
return false;
|
|
|
|
|
|
}
|
|
|
|
|
|
s_started = true;
|
|
|
|
|
|
return true;
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void pauseCanFeedbackTask(bool pause)
|
|
|
|
|
|
{
|
2026-07-13 03:12:21 +08:00
|
|
|
|
if (s_paused == pause) return; // 幂等:状态未变时不重复日志
|
2026-06-29 01:51:44 +08:00
|
|
|
|
s_paused = pause;
|
|
|
|
|
|
if (pause) {
|
2026-07-08 02:51:38 +08:00
|
|
|
|
DEBUG_INFO(kTag, "CAN 监听已暂停(OTA 进行中)");
|
2026-06-29 01:51:44 +08:00
|
|
|
|
} else {
|
2026-07-08 02:51:38 +08:00
|
|
|
|
DEBUG_INFO(kTag, "CAN 监听已恢复");
|
2026-06-29 01:51:44 +08:00
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
* @brief 拷贝某通道的最新快照(线程安全)。
|
|
|
|
|
|
* @return true 表示拿到一份有效数据。
|
|
|
|
|
|
*/
|
|
|
|
|
|
bool getLatestCanFeedback(uint8_t channel, can_feedback_result_t *out)
|
|
|
|
|
|
{
|
|
|
|
|
|
if (channel >= CAN_CHANNEL_MAX || out == nullptr || s_mutex == nullptr) {
|
|
|
|
|
|
return false;
|
|
|
|
|
|
}
|
|
|
|
|
|
bool ok = false;
|
|
|
|
|
|
if (xSemaphoreTake(s_mutex, pdMS_TO_TICKS(50)) == pdTRUE) {
|
|
|
|
|
|
if (s_valid[channel]) {
|
|
|
|
|
|
*out = s_latest[channel];
|
|
|
|
|
|
ok = true;
|
|
|
|
|
|
}
|
|
|
|
|
|
xSemaphoreGive(s_mutex);
|
|
|
|
|
|
}
|
|
|
|
|
|
return ok;
|
|
|
|
|
|
}
|