Skip to content

fix(exchange): 交换模式下电机状态按 motor_hz 投递,不再每次交换都投递 - #38

Merged
Vertax42 merged 1 commit into
mainfrom
fix/exchange-dedupe-motor-status
Nov 20, 2026
Merged

Vertax42 merged 1 commit into
mainfrom
fix/exchange-dedupe-motor-status

Conversation

@Vertax42

Copy link
Copy Markdown
Collaborator

问题

start_exchange(motor_hz=100, imu_hz>100) 时每个交换应答都带最新电机状态,SDK 原先把它们全部注入订阅者与控制通道:562 Hz IMU 时 250/s、1125 Hz 时 500/s。实测(0016s,RS00,固件 1.3.0-rc2,电机静止)其中 73% / 87% 与上一帧逐字节相同。控制器、记录程序对同一样本处理多次,也与 CHANGELOG 里"电机状态封顶 100 Hz"不符。用户决定:交换模式下电机状态按 motor_hz 投递,与推流模式一致。

改动

  • FollowerExchange 按到期时间投递电机状态:每投递一次,到期时间推进整一个 1/motor_hz,留半个交换周期余量,平均恰为 motor_hz。100 Hz 交换时每帧都到期,行为不变。
  • ExchangeStats.motor_skipped(C++ / Python)统计被跳过的记录;motor_samples 现在是实际投递数。
  • 新用例 ImuHighRate.FollowerHighRateExchangeCapsMotorStatusAtMotorHz;TargetsRideOnTheNextTelemetryExchangeAtHighRate 原先断言"80% 的交换带目标"(控制器每帧都下目标),改为按实际投递的状态数断言,"目标不额外占交换"这一条不变。

验证

  • 本地:C++ 624 passed(相关两组连跑 3 次稳定);pytest 166 passed / 2 skipped;ruff 通过。
  • 实机 0016s(1.3.0-rc2):
imu_hz 交换/s 投递/s 跳过/s IMU/s 丢样
100 99.9 99.9 0 100.0 0
562 250.0 100.0 150.0 570.9 0
1125 500.0 100.0 400.0 1142.7 0

1125 Hz 交换下 ForcePositionController 0.8→0.2→0.8→0.0→0.8 全部到位,target_update_hz 100.2,控制错误 0。

附带发现(固件侧,不在本 PR)

电机静止、控制环未运行时,固件对电机状态的真实刷新只有约 67 Hz(MIT 下电机主动上报约 15 ms 一帧),推流 100 Hz 时也有约 1/3 是重复帧。固件会话已在源码层定位,见协调看板。

🤖 Generated with Claude Code

IMU 高于 100 Hz 时每个交换应答都带最新电机状态,原先全部注入订阅者与控制通道:
562 Hz 时 250/s、1125 Hz 时 500/s,其中 73% / 87% 与上一帧完全相同(0016s RS00,
固件 1.3.0-rc2 实测)。控制器与记录程序对同一样本处理多次,也与 CHANGELOG
"电机状态封顶 100 Hz"不符。

按到期时间投递:每次投递后到期时间推进整一个 motor 周期,留半个交换周期的余量,
平均恰为 motor_hz;100 Hz 交换时每帧都到期,行为不变。多余的计入
ExchangeStats.motor_skipped(Python 同名属性)。

实机 0016s:100/562/1125 Hz 下订阅者都收到 100/s,IMU 570.9/1142.7/s 零丢;
1125 Hz 交换下力位控制 5/5 到位。新增 ImuHighRate.FollowerHighRateExchangeCaps-
MotorStatusAtMotorHz;高频目标随交换的用例改为按实际投递的状态数断言。

Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com>
@Vertax42
Vertax42 merged commit b1c0862 into main Nov 20, 2026
3 checks passed
@Vertax42
Vertax42 deleted the fix/exchange-dedupe-motor-status branch November 20, 2026 04:15
@Vertax42 Vertax42 mentioned this pull request Nov 20, 2026
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant