zhou yang和Claude Opus 5
ec31891429
需求 §10.3 落地。四件事： 1. 五任务表（tasks.c）：周期与优先级写在一张 const 表里，开机自检查的是 相对顺序（safety 唯一最高、log 唯一最低、thermal 与 actuator 同级）， 外加「巡检周期必须长于 INA226 一帧转换 8.8 ms」。不过就 abort。 2. 节拍器（sched.c）：记下一次该醒的绝对时刻，回绕安全（int32_t 差判先后）。 过载时跳过错过的整周期、保住相位，不补跑。 3. 两把锁（hal_lock）：I²C 与 74HC595，禁止嵌套持有 —— 这块板上两者没有交集， 「拿着 A 去拿 B」永远是写错了。ESP 侧用 mutex 取优先级继承。 4. t_safety 的一个周期：拿锁 → 6 片 INA226 的 V+I + PCA9555 两端口 → 放锁。 不死等锁（5 ms 超时就跳过这圈），一片读失败不中断整圈、保留上一圈的值。 I²C 占用由 HAL 按线上真实字节数记账（两个目标同一份代码），静态预算与实测 必须相等：一次寄存器读 48 位，一圈 13 次事务 = 1560 µs / 20 ms = 7.8 %， 与 §10.3 手算的「约 1.5 ms / 约 8 %」相符（本节的 46 位没数 STOP 和重复 START）。 sim 侧配套两样：假 I²C 事务真的把虚拟时钟花掉（否则时序测试是空话）， 以及可强制的加锁纪律检查（配一条反向测试，防止检查本身失灵）。 11 条 ctest（161 例）全绿，idf.py build 通过；16 个注错实验全部变红。 Co-Authored-By: Claude Opus 5 <[email protected]>
66 行
2.2 KiB
C
66 行
2.2 KiB
C
/* 两把互斥锁的 FreeRTOS 实现。静态分配（`xSemaphoreCreateMutexStatic`）——
|
||
两把锁的数量是编译期定死的，没有理由去堆上要内存，也就没有「创建失败」这条路径。
|
||
|
||
⚠️ 用的是 mutex 不是 binary semaphore：mutex 有**优先级继承**。
|
||
t_safety 是最高优先级且每 20 ms 就要总线，低优先级的 t_link 拿着 I²C 锁去读遥测时
|
||
如果没有继承，t_safety 会被一个中优先级任务无限期挡在门外（经典优先级反转）。 */
|
||
#include "freertos/FreeRTOS.h"
|
||
#include "freertos/semphr.h"
|
||
#include "freertos/task.h"
|
||
#include "hal_lock.h"
|
||
|
||
static StaticSemaphore_t s_buf[HAL_LOCK_COUNT];
|
||
static SemaphoreHandle_t s_mtx[HAL_LOCK_COUNT];
|
||
static uint32_t s_timeouts[HAL_LOCK_COUNT];
|
||
|
||
hal_err_t hal_lock_init(void)
|
||
{
|
||
for (int i = 0; i < HAL_LOCK_COUNT; i++) {
|
||
if (s_mtx[i] == NULL) {
|
||
s_mtx[i] = xSemaphoreCreateMutexStatic(&s_buf[i]);
|
||
s_timeouts[i] = 0;
|
||
}
|
||
}
|
||
return HAL_OK;
|
||
}
|
||
|
||
bool hal_lock_held(hal_lock_id_t id)
|
||
{
|
||
if (id < 0 || id >= HAL_LOCK_COUNT || s_mtx[id] == NULL) {
|
||
return false;
|
||
}
|
||
return xSemaphoreGetMutexHolder(s_mtx[id]) == xTaskGetCurrentTaskHandle();
|
||
}
|
||
|
||
hal_err_t hal_lock_take(hal_lock_id_t id, uint32_t timeout_ms)
|
||
{
|
||
if (id < 0 || id >= HAL_LOCK_COUNT || s_mtx[id] == NULL) {
|
||
return HAL_ERR_STATE;
|
||
}
|
||
/* 已经持有 = 重复加锁；持有另一把 = 嵌套。两者都是写错了，见 hal_lock.h。 */
|
||
for (int i = 0; i < HAL_LOCK_COUNT; i++) {
|
||
if (hal_lock_held((hal_lock_id_t)i)) {
|
||
return HAL_ERR_STATE;
|
||
}
|
||
}
|
||
const TickType_t ticks =
|
||
(timeout_ms == HAL_LOCK_FOREVER) ? portMAX_DELAY : pdMS_TO_TICKS(timeout_ms);
|
||
if (xSemaphoreTake(s_mtx[id], ticks) != pdTRUE) {
|
||
s_timeouts[id]++;
|
||
return HAL_ERR_TIMEOUT;
|
||
}
|
||
return HAL_OK;
|
||
}
|
||
|
||
void hal_lock_give(hal_lock_id_t id)
|
||
{
|
||
configASSERT(id >= 0 && id < HAL_LOCK_COUNT && s_mtx[id] != NULL);
|
||
configASSERT(hal_lock_held(id)); /* 不是自己拿的就别放 */
|
||
(void)xSemaphoreGive(s_mtx[id]);
|
||
}
|
||
|
||
uint32_t hal_lock_timeouts(hal_lock_id_t id)
|
||
{
|
||
return (id >= 0 && id < HAL_LOCK_COUNT) ? s_timeouts[id] : 0;
|
||
}
|