双目测距方案重构与其他小修改

This commit is contained in:
keita
2026-09-10 16:16:05 +08:00
parent 3325465359
commit 538ae4c6c7
39 changed files with 2285 additions and 1444 deletions
@@ -179,11 +179,11 @@ int main(int argc, char** argv) {
snapshot.track = tracker.LastResult();
snapshot.track_time_ms = now_ms;
// 雷达:正常阶段关联成立;Coast/刹车阶段取消关联(演示 §6.3 降级路径)
snapshot.radar_distance_m = 40.0 - 3.0 * elapsed_s;
snapshot.associated_to_target = (tick < normal_ticks) &&
snapshot.radar_distance_m > 0.0;
snapshot.radar_time_ms = now_ms;
// 双目距离:正常阶段有效;Coast/刹车阶段置无效(演示 §6.3 降级路径)
snapshot.target_distance_m = 40.0 - 3.0 * elapsed_s;
snapshot.distance_valid = (tick < normal_ticks) &&
snapshot.target_distance_m > 0.0;
snapshot.distance_time_ms = now_ms;
// 自机姿态:演示中始终新鲜有效(接入主工程时来自 FlightStateSnapshot)
snapshot.attitude_present = true;
@@ -209,11 +209,11 @@ int main(int argc, char** argv) {
if (tick % 10 == 0) {
spdlog::info(
"[t={:5.1f}s] 阶段={} 模式={}{} tracked={} vx={:+.2f} vy={:+.2f} "
"vz={:+.2f} yaw_rate={:+.1f}dps d={:5.1f}m 关联={}",
"vz={:+.2f} yaw_rate={:+.1f}dps d={:5.1f}m 有效={}",
elapsed_s, phase, ModeName(output.mode),
output.coast_active ? "(Coast)" : "", snapshot.track.tracked,
output.vx_mps, output.vy_mps, output.vz_mps, output.yaw_rate_dps,
snapshot.radar_distance_m, snapshot.associated_to_target);
snapshot.target_distance_m, snapshot.distance_valid);
}
std::this_thread::sleep_for(std::chrono::milliseconds(period_ms));