Repository navigation
feat(ground): 新增 rollover_margin,把「侧翻裕度」做成可离线校验的载荷转移与极限车速核算 - #1249
Conversation
|
这份和 #1254 是同一个模式,三个点都要处理(代码本身这次没细看)。 1. 本 PR 的 hunk 是: - - VRU 冲突风险图: './ground/vru_conflict_risk_map.md'
- - 里程计健康监视: './ground/odom_health_monitor.md'
+(空行)这两条对应已合并的 #1245 / #1244, 2. 自己的页面没进导航
3. 本 PR 没加 workflow; 修法:从当前 master 取 |
# Conflicts: # docs/index.md # mkdocs.yml
xingwunian
left a comment
There was a problem hiding this comment.
按贡献指南第 8 节本地核对过(git fetch origin pull/1249/head → 逐文件看 → 跑离线测试),没有阻断问题,可以合。
- 把
master(b61c2150,已含 #1246)合进本分支,冲突只在mkdocs.yml/docs/index.md - 本 PR 原来的 hunk 把 master 已有的「VRU 冲突风险图」「里程计健康监视」两条入口删掉了,而「横向载荷转移与侧翻裕度」又没进导航。已改成:保留 master 两条,补上本模块的导航项与首页链接(
./ground/rollover_margin.md) tests/test_rollover_margin_local.py本地跑:通过 165 项,失败 0 项- 相对 master 的净变化 1435 行新增、0 行删除;
catkin_install_python三个脚本齐全,包内只依赖math,package.xml无缺失依赖
代码逻辑没动,只补了合并与导航。按贡献指南用 Squash and merge。
修改概述: 新增
src/ground/rollover_margin包,把「过弯会不会翻车」做成一组可断言的准静态计算 —— 静态稳定因子 SSF、侧翻临界加速度、内外侧车轮垂向力、给定半径的极限车速,并在终端输出载荷条与车速扫描表。修改的详细描述
1. 为什么需要这个包
仓库里已有三个和「过弯」相关但方向不同的模块,缺的是横向稳定性这一块:
tire_slip_curvebraking_distance_checkturning_sweep_checkturning_sweep_check回答「这个弯能不能转过去(不压线)」,本包回答「这个弯能不能转过去(不翻车)」——一个管空间,一个管稳定性。而且本包的三个输入(轮距、质心高、质量)与三个输出之间是闭式代数关系,
可以直接写成断言,不需要仿真器,因此在没有 CARLA 的机器上也能回归。
2. 模型(全部闭式,无迭代)
两条自洽关系是断言的依据:
ΔF_z = m·g/2,即a_y = a_crit;ΔF_z / F_z0恒等于a_y / a_crit。垂向力守恒
F_inner + F_outer ≡ m·g也在测试里逐点校验。3. 四条断言
a_y/a_crit ≤ rollover_margin(默认 0.70)F_inner > 0v ≤ sqrt(a_crit·R)前三条描述安全性,第四条描述实现正确性 —— 这个分工让两类问题能被分开定位:
把质心抬到 0.90 m,前三条同时翻、第四条仍然通过(详见下面图 4)。
4. 字符图与扫描表
render_loads():12 行横向载荷柱,#内侧、=外侧,|标出静态载荷中心,抬轮时会在内侧出现
!标记;speed_table():30/40/50/60/70/80/90 km/h 七行,每行给a_y、裕度、内侧轮载荷、是否抬轮,同时以 CSV 形式发布到
/rollover/loads。5. 参数与话题
12 个参数(
vehicle/*四个、corner/*两个、check/*两个、rate/publish_hz、topic/*三个),launch/main.launch为每一个都声明了带doc的<arg>并写回同名<param>,命令行可覆盖。三路 latched 话题:
/rollover/report(String 报告)、/rollover/loads(String,CSV)、/rollover/critical_speed(Float64,km/h)。6. 结构约定
scripts/rollover_core.py纯标准库,不 import rospy / numpy / yaml,离线测试直接跑它;scripts/main.py是薄入口(from rollover_node import main),符合仓库main.约定;config/与launch/由CMakeLists.txt的install(DIRECTORY … USE_SOURCE_PERMISSIONS)安装;docs/ground/rollover_margin.md(新建),含模型、四条断言、参数表、实测输出、两个反例。7. 自查修掉的两处
render_loads()最初只在row < height // 2时画柱,导致柱子只有半截 —— 改成满高并保留静态载荷中心那条竖线;
E17/E18原用transfer_tolerance = 0.0期望第四条失败,但实现里留了+1e-12浮点余量,偏差 1.1e-16 仍判通过 —— 改为不可能满足的
-1e-6,断言才真正生效。8. 没改动什么
mkdocs.yml之外的任何既有文件;本包文档是新建页面,不需要覆盖旧内容;经过了什么样的测试?
python3 tests/test_rollover_margin_local.py→ 通过 165 项,失败 0 项(不需要 ROS / CARLA / 显示器)catkin_make通过,rospack find rollover_margin能定位到src/ground/rollover_marginroslaunch rollover_margin main.launch打出结论:PASSEDrosparam get三个参数与config/rollover_margin.yaml一致F_inner + F_outer = m·g(垂向力守恒)ΔF_z/F_z0 = a_y/a_crit(两条定义自洽)a_y = a_crit时F_inner = 0(抬轮判定与载荷转移同源)safe_speed(1.0) = sqrt(a_crit·R)等于speed_limit()(两条路径同一结果)运行效果(动图、视频、图片、链接等)
默认工况:SSF 1.4000、侧向加速度 9.259 m/s²、裕度 0.674、内侧轮 2397.2 N / 外侧轮 12317.8 N、
极限车速 73.1 km/h,四条断言全部通过。
图 1:离线测试

通过 165 项,失败 0 项。图 2:默认工况的完整报告与载荷条,

结论:PASSED。图 3:反例一

rollover_margin:=0.5,只有「侧翻裕度」失败(3 通过 / 1 失败)。图 4:反例二

cg_height:=0.90,SSF 掉到 0.8556、内侧轮 −759.4 N,安全类三条同时失败(1 通过 / 3 失败),而「载荷转移」仍
然通过。
图 5:终端 B 的

rosparam get,1.54/0.7/0.55与 yaml 一致。所使用具体的大模型声明:使用大模型辅助代码编写、测试编写与文档整理,提交内容由本人负责。