Repository navigation
feat(ground): 新增 lateral_stability_margin,把「不足转向」做成可离线校验的稳态转向角与稳定裕度核算 - #1254
Conversation
|
看了 head 1. 当前 head 的 - - VRU 冲突风险图: './ground/vru_conflict_risk_map.md'
- - 里程计健康监视: './ground/odom_health_monitor.md'
+(空行)这两条对应已合并的 #1245 和 #1244, 2. 本模块自己的页面没进导航
3.
前两条修完、第三条补上,我这边就可以合了。 |
# Conflicts: # docs/index.md # mkdocs.yml
xingwunian
left a comment
There was a problem hiding this comment.
@jiaohua745-blip 三条按你说的都补了,代码本身没动,只在作者分支上做了合并与挂接:
mkdocs.yml/docs/index.md删 master 入口 —— 把master(0b70e466,已含 #1246/#1249/#1250/#1252)合进本分支,冲突只在mkdocs.yml/docs/index.md。处理方式是保留 master 已有的「VRU 冲突风险图」「里程计健康监视」两条入口,再把本模块加进去;git diff master..HEAD --numstat现在是 added 1349 / deleted 0,没有任何删除。- 导航补上
lateral_stability——mkdocs.yml里- 不足转向梯度与侧向稳定裕度: './ground/lateral_stability_margin.md',docs/index.md也加了对应链接。 - 测试没人跑 —— 新增
.github/workflows/ground_module_tests.yml,matrix 跑五个模块的tests/test_*_local.py(轮胎滑移率、侧翻裕度、工况能耗、舒适性传递率、本 PR 的侧向稳定裕度),paths 挂src/ground/<module>/**与对应测试文件。这样本 PR 的测试有 workflow 覆盖了,前面四个模块也一并纳入。
本地验证:tests/test_lateral_stability_margin_local.py 通过 116 项,失败 0 项(结论 PASSED)。
按贡献指南用 Squash and merge。
修改概述
新增
src/ground/lateral_stability_margin模块:从整车质量、轴距、质心位置与前后轴侧偏刚度出发,算不足转向梯度 K、稳态转向角、特征车速/临界车速,并用「轴荷分配 / 不足转向裕度 / 稳态转向角 /
低速阿克曼」四条断言判断车辆是偏安全(不足转向)还是偏危险(过多转向)。纯标准库实现,不依赖 CARLA。
配套新增
docs/ground/lateral_stability_margin.md文档页。修改的详细描述
1. 为什么需要这个包
rollover_margin管的是「横向加速度太大把车掀翻」,本模块管的是另一件事:同样的方向盘转角,车是往弯里多转还是少转。前者是翻车,后者是甩尾/推头,
两者物理机制不同、判据也不同:
rollover_margintire_slip_curve三者串起来才是完整的横向安全链条:轮胎饱和(
tire_slip_curve)→ 车辆响应变差(本模块)→ 侧翻(rollover_margin)。2. 模型
K里那个/g是关键:W/C量纲是 rad/(m/s²)·g,不除以 g 会让δ多出一个 g 的量级(我第一版就这么写错了,见第 7 节)。
由此得到两条恒等式,测试 I 组专门核对:
3. 四条断言
m·g,偏差 ≤ 1 NK ≥ understeer_min(默认 0.0)δ − L/R = K·a_y,相对偏差 ≤ 5%δ与L/R相对偏差 ≤ 0.02第 4 条限定在低速:阿克曼假设「无侧偏」,中高速下必然偏离,所以只在
ackermann_speed_kmh(默认 2.0 km/h)处校验。4. 默认数字
m = 1500 kg、L = 2.7 m、l_f = 1.2 m、C_f = 80000、C_r = 95000、R = 50 m、v = 40 km/h:车速扫描(20~120 km/h):3.21°/11.00、3.57°/39.57、4.18°/76.22、5.02°/112.78、6.10°/144.96、7.42°/171.55。
5. 参数与话题
12 个参数:
/vehicle/{mass,wheelbase,cg_to_front}、/tire/{front_cornering,rear_cornering}、/scene/{radius,speed_kmh}、/check/{understeer_min,ackermann_speed_kmh,ackermann_tolerance}、/gravity、/rate/publish_hz。三路 latched 话题:
/stability/report(String)、/stability/circle(Float64MultiArray,[K, δ, δ_ackermann, a_y, v_char_or_crit])、/stability/table(Float64MultiArray,6 行扫描)。6. 结构约定
config/+launch/main.launch(12 个带doc的<arg>)+scripts/{main,*_core,*_node}.pytests/test_*_local.py+docs/ground/*.md;*_core.py不 import rospy,*_node.py用_log()转 byte str。三个脚本都是「第 1 行 shebang、第 2 行 coding 声明」。7. 自查修掉的两处
K = W_f/C_f − W_r/C_r直接返回,得到 K = 0.0333、40 km/h 处 δ = 0.136 rad(7.81°)、灵敏度 18.11 —— 全部差一个 g。
改成
(W_f/C_f − W_r/C_r)/g后 K = 0.003399、δ = 0.0624 rad(3.57°),且
L + K·v_char² = 2L这条恒等式才成立。ASSERT_NAMES不一致:core 里先算「稳态转向角」后算「低速阿克曼」,而名字元组写的是反序,报告与测试对不上。已统一为 轴荷 → 裕度 → 稳态转向角 → 低速阿克曼。
8. 没改动什么
没有修改既有模块、
mkdocs.yml、docs/index.md。测试
Ubuntu 18.04 + ROS Melodic(Python 2.7.17):
通过 116 项,失败 0 项。11 组:A 几何与轴荷 / B 梯度与特性 / C 圆周工况 /
D 四条断言正反例 / E 车速扫描 / F 字符图 / G 参数与非法值 / H 报告排版 /
I 闭式恒等式(
L+K·v_char²=2L、L+K·v_crit²=0)/ J 工程约定 / K 编码声明回归。运行效果
断言:4 通过 / 0 失败(共 4 条)、结论:PASSED。两个反例:
front_cornering:=160000 rear_cornering:=40000→ K 变负、特性「过多转向」、临界车速 15.350 m/s(55.3 km/h),只翻「不足转向裕度」;ackermann_speed_kmh:=60→ 只翻「低速阿克曼」(偏差 0.3497)。图 1 离线测试通过 116 项

图 2 默认

结论:PASSED(K = 0.003399、δ = 3.57°、特征车速 101.5 km/h)图 3 前后胎刚度对调 → 过多转向、临界车速 55.3 km/h

图 4

ackermann_speed_kmh:=60→ 只翻「低速阿克曼」图 5 终端 B 三条

rosparam get回显所使用具体的大模型声明
使用大模型辅助代码编写、测试编写与文档整理,提交内容由本人负责。