Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
188 changes: 188 additions & 0 deletions docs/ground/rollover_margin.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,188 @@
# 横向载荷转移与侧翻裕度

## 这一页解决什么问题

「这车会不会翻」听起来像仿真问题,准静态下其实只由三个参数决定:轮距、质心高度、质量。
本页给出纯代数、可断言、不依赖 CARLA 的实现,并把 SSF、临界加速度、内外侧轮垂向力、
极限车速算成具体数字,在终端里画出横向载荷条与车速扫描表。

## 模型

```
SSF = track / (2·h_cg) 静态稳定因子
a_crit = SSF · g 侧翻临界侧向加速度
ΔF_z = m · a_y · h_cg / track 横向载荷转移
F_inner = m·g/2 − ΔF_z
F_outer = m·g/2 + ΔF_z
v_max = sqrt(a_crit · R) 给定半径的极限车速
```

两个自洽关系(也是断言的依据):

- 抬轮发生在 `ΔF_z = m·g/2`,即 `a_y = a_crit`;
- `ΔF_z / F_z0` 恒等于 `a_y / a_crit`。

注意 `F_inner + F_outer = m·g` 始终成立(垂向力守恒),这是模型自检的第一条。

## 默认参数下的数字

车辆:轮距 `1.54 m`、质心高 `0.55 m`、质量 `1500 kg`;工况:半径 `30 m`、车速 `60 km/h`。

| 量 | 值 |
|---|---|
| SSF | `1.4000` |
| 临界加速度 | `13.734 m/s²`(1.40 g) |
| 侧向加速度 | `9.259 m/s²`(`v²/R`) |
| 裕度 `a_y/a_crit` | `0.674` |
| 载荷转移 | `4960.3 N`(占静态 67.4%) |
| 内侧轮 | `2397.2 N` |
| 外侧轮 | `12317.8 N` |
| 极限车速 | `73.1 km/h`(余量 13.1 km/h) |

车速扫描(R = 30 m):

| 车速 | `a_y` | 裕度 | 内侧轮 | 抬轮 |
|---|---|---|---|---|
| 30 | 2.315 | 0.169 | 6117.4 | 否 |
| 40 | 4.115 | 0.300 | 5152.9 | 否 |
| 50 | 6.430 | 0.468 | 3912.8 | 否 |
| 60 | 9.259 | 0.674 | 2397.2 | 否 |
| 70 | 12.603 | 0.918 | 606.0 | 否 |
| 80 | 16.461 | 1.199 | −1460.8 | **是** |
| 90 | 20.833 | 1.517 | −3803.2 | **是** |

抬轮发生在 70~80 km/h 之间,与极限车速 73.1 km/h 吻合。

## 四条断言

| 断言 | 判据 | 失败意味着 |
|---|---|---|
| **侧翻裕度** | `a_y/a_crit ≤ rollover_margin`(默认 0.70) | 过弯太快或车太高 |
| **内侧轮载荷** | `F_inner > 0` | 已抬轮,准静态模型失效 |
| **极限车速** | `v ≤ sqrt(a_crit·R)` | 车速超过该半径的物理上限 |
| **载荷转移** | `|ΔF_z/F_z0 − a_y/a_crit| ≤ tolerance` | 模型实现不自洽 |

前三条描述安全性,第四条描述实现正确性 —— 所以抬高质心会让前三条一起翻,第四条依然通过。
这种「安全类断言联动、自洽类断言独立」的分工,正是把物理关系做成断言的价值。

## 参数

| 参数 | 默认 | 说明 |
|---|---|---|
| `vehicle/track` | `1.54` | 轮距(m) |
| `vehicle/cg_height` | `0.55` | 质心高度(m) |
| `vehicle/mass` | `1500.0` | 质量(kg) |
| `vehicle/gravity` | `9.81` | 重力加速度 |
| `corner/radius` | `30.0` | 弯道半径(m) |
| `corner/speed_kmh` | `60.0` | 过弯车速(km/h) |
| `check/rollover_margin` | `0.70` | 裕度上限 |
| `check/transfer_tolerance` | `0.02` | 自洽性容差 |
| `rate/publish_hz` | `10.0` | 挂起循环频率 |
| `topic/report` | `/rollover/report` | 报告 |
| `topic/loads` | `/rollover/loads` | 车速扫描 CSV |
| `topic/critical_speed` | `/rollover/critical_speed` | 极限车速 |

## 话题

| 话题 | 类型 | 内容 |
|---|---|---|
| `/rollover/report` | `std_msgs/String`(latched) | 完整报告(含载荷条与扫描表) |
| `/rollover/loads` | `std_msgs/String`(latched) | `speed_kmh,lateral_accel,inner_load,outer_load,lift_off` 共 7 行 |
| `/rollover/critical_speed` | `std_msgs/Float64`(latched) | 该半径极限车速(km/h) |

## 运行

```bash
cd ~/catkin_ws17
catkin_make
source devel/setup.bash
roslaunch rollover_margin main.launch
```

## 实际输出(默认)

```
车辆:轮距 1.54 m,质心高 0.55 m,质量 1500 kg
SSF = 1.4000,侧翻临界加速度 13.734 m/s²(1.40 g)
工况:半径 30.0 m,车速 60.0 km/h(16.67 m/s)
侧向加速度 9.259 m/s²,裕度比值 0.674
载荷转移 4960.3 N(占比 0.674),内侧 2397.2 N / 外侧 12317.8 N
该半径极限车速 73.1 km/h(余量 13.1 km/h)
断言:4 通过 / 0 失败(共 4 条)
[PASS] 侧翻裕度 a_y 9.259 m/s²,a_crit 13.734 m/s²,比值 0.674(上限 0.70)
[PASS] 内侧轮载荷 内侧轮 2397.2 N,外侧轮 12317.8 N(静态 7357.5 N)
[PASS] 极限车速 当前 60.0 km/h,该半径极限 73.1 km/h(余量 13.1 km/h)
[PASS] 载荷转移 ΔF_z/F_z0 = 0.6742,a_y/a_crit = 0.6742
结论:PASSED
```

## 两个反例

**反例一:裕度上限收到 0.5** —— 只翻第一条

```bash
roslaunch rollover_margin main.launch rollover_margin:=0.5
```

```
[FAIL] 侧翻裕度 a_y 9.259 m/s²,a_crit 13.734 m/s²,比值 0.674(上限 0.50)
断言:3 通过 / 1 失败
结论:FAILED
```

**反例二:质心抬到 0.90 m** —— 安全相关的三条一起翻

```bash
roslaunch rollover_margin main.launch cg_height:=0.90
```

```
SSF = 0.8556,侧翻临界加速度 8.393 m/s²(0.86 g)
[FAIL] 侧翻裕度 a_y 9.259 m/s²,a_crit 8.393 m/s²,比值 1.103(上限 0.70)
[FAIL] 内侧轮载荷 内侧轮 -759.4 N,外侧轮 15474.4 N(静态 7357.5 N)
[FAIL] 极限车速 当前 60.0 km/h,该半径极限 57.1 km/h(余量 -2.9 km/h)
[PASS] 载荷转移 ΔF_z/F_z0 = 1.1032,a_y/a_crit = 1.1032
断言:1 通过 / 3 失败
结论:FAILED
```

内侧轮载荷为负,物理含义是这一侧已经离地 —— 准静态模型到此为止。

## 离线测试

```bash
cd ~/catkin_ws17
python3 tests/test_rollover_margin_local.py
```

只依赖标准库;在仓库根目录执行时还会校验本页是否存在、断言名是否齐全。

## 与已有模块的分工

| 模块 | 关心什么 |
|---|---|
| `tire_slip_curve` | 附着系数从哪来 |
| `braking_distance_check` | 纵向距离 |
| `turning_sweep_check` | 转弯时的几何包络(车身占多宽) |
| **`rollover_margin`(本页)** | **横向载荷与稳定性(会不会抬轮、极限多快)** |

`turning_sweep_check` 回答「这个弯能不能转过去(不压线)」,本页回答「这个弯能不能转过去
(不翻车)」—— 一个管空间,一个管稳定性。

## 常见问题

**Q:为什么不建模悬架与轮胎侧偏?**
A:准静态阈值主要由 `track/2h_cg` 决定,悬架柔度一般让实际阈值低 5~10%。本页要把公式
讲清楚,闭式解更容易校验;真车标定时把 `rollover_margin` 收到 0.6 即可覆盖这一偏差。

**Q:为什么「极限车速」和「侧翻裕度」会同时失败?**
A:二者物理同源:裕度到 1 时 `v = sqrt(a_crit·R)` 刚好达到。所以抬高质心会让它们一起翻,
这不是实现问题,而是模型的必然结论。

**Q:能不能直接给一个「安全车速」?**
A:可以,`safe_speed(margin)` 就是干这个的:默认裕度 0.7 时该车在该半径上的安全车速是
`61.1 km/h`(更保守的 0.5 对应 `51.7 km/h`)。

---

所使用具体的大模型声明:使用大模型辅助代码编写、测试编写与文档整理,提交内容由本人负责。
1 change: 1 addition & 0 deletions docs/index.md
Original file line number Diff line number Diff line change
Expand Up @@ -243,6 +243,7 @@ ROS 2 服务与参数基础实验(无人机模式切换与在线调参):[c
* [VRU 冲突风险图](./ground/vru_conflict_risk_map.md) —— 按时间对齐自车与行人、儿童和骑行者轨迹,输出最小距离、TTC 和风险等级
* [里程计健康监视(打滑 / 堵转 / 反向检测)](./ground/odom_health_monitor.md) —— 比较 `/cmd_vel` 与 `/odom` 的速度比值,识别打滑、堵转与反向运动
* [轮胎滑移率-附着曲线](./ground/tire_slip_curve.md) —— 用简化刷子轮胎模型输出滑移率与附着系数关系,标出峰值附着与 ABS 目标滑移带
* [横向载荷转移与侧翻裕度](./ground/rollover_margin.md) —— 用 SSF、临界侧向加速度和内外侧轮垂向力算「这车会不会翻」,纯代数、不依赖 CARLA

## 5. 空域载具 <span id='air_vehicle'></span>

Expand Down
1 change: 1 addition & 0 deletions mkdocs.yml
Original file line number Diff line number Diff line change
Expand Up @@ -237,6 +237,7 @@ nav:
- VRU 冲突风险图: './ground/vru_conflict_risk_map.md'
- 里程计健康监视: './ground/odom_health_monitor.md'
- 轮胎滑移率-附着曲线: './ground/tire_slip_curve.md'
- 横向载荷转移与侧翻裕度: './ground/rollover_margin.md'
- 空域载具:
- MuJoCo 城市屋顶光伏覆盖率测量: './air/mujoco_uav_rooftop_pv_coverage_survey.md'
- MuJoCo 屋顶光伏覆盖率测量第二天: './air/mujoco_uav_rooftop_pv_coverage_survey_day2.md'
Expand Down
21 changes: 21 additions & 0 deletions src/ground/rollover_margin/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,21 @@
cmake_minimum_required(VERSION 3.0.2)
project(rollover_margin)

find_package(catkin REQUIRED COMPONENTS
rospy
std_msgs
)

catkin_package()

catkin_install_python(PROGRAMS
scripts/main.py
scripts/rollover_core.py
scripts/rollover_node.py
DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
)

install(DIRECTORY launch config
DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}
USE_SOURCE_PERMISSIONS
)
157 changes: 157 additions & 0 deletions src/ground/rollover_margin/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,157 @@
# rollover_margin —— 横向载荷转移与侧翻裕度

一辆车以 60 km/h 过半径 30 m 的弯,内侧车轮还剩多少垂向力?再快多少会抬轮?
这个包用三个参数(轮距、质心高度、质量)把答案算成一组可以断言的数字。

纯标准库,不依赖 CARLA / numpy / GUI;Melodic(Python 2.7)与 Noetic(Python 3)都能跑。

## 为什么需要这个模块

侧翻不是「车太轻」或「路太滑」,而是**横向载荷转移超过了内侧轮的静态载荷**。
准静态下只有三个量在起作用:

```
静态稳定因子 SSF = track / (2·h_cg)
侧翻临界加速度 a_crit = SSF · g
载荷转移 ΔF_z = m·a_y·h_cg / track
```

于是内侧轮 `F_inner = m·g/2 − ΔF_z`,抬轮恰好发生在 `ΔF_z = m·g/2`,
即 `a_y = g·track/(2h_cg) = a_crit` —— 两条定义自洽,`ΔF_z/F_z0` 恒等于 `a_y/a_crit`。
给定半径还能反推极限车速 `v_max = sqrt(a_crit·R)`。

这些全是代数式,可以被断言精确校验,不需要仿真器。

## 默认参数下的数字

车型:轮距 `1.54 m`、质心高 `0.55 m`、质量 `1500 kg`;工况:半径 `30 m`、车速 `60 km/h`。

| 量 | 值 |
|---|---|
| SSF | `1.4000` |
| 临界加速度 | `13.734 m/s²`(1.40 g) |
| 侧向加速度 | `9.259 m/s²` |
| 裕度 `a_y/a_crit` | `0.674` |
| 载荷转移 | `4960.3 N`(占静态 67.4%) |
| 内侧轮 / 外侧轮 | `2397.2 N` / `12317.8 N` |
| 该半径极限车速 | `73.1 km/h`(余量 13.1 km/h) |

车速扫描(R = 30 m):

| 车速 | `a_y` | 裕度 | 内侧轮 | 抬轮 |
|---|---|---|---|---|
| 30 | 2.315 | 0.169 | 6117.4 | 否 |
| 40 | 4.115 | 0.300 | 5152.9 | 否 |
| 50 | 6.430 | 0.468 | 3912.8 | 否 |
| 60 | 9.259 | 0.674 | 2397.2 | 否 |
| 70 | 12.603 | 0.918 | 606.0 | 否 |
| 80 | 16.461 | 1.199 | −1460.8 | **是** |
| 90 | 20.833 | 1.517 | −3803.2 | **是** |

抬轮落在 70~80 km/h 之间,与极限车速 73.1 km/h 吻合。

## 四条断言

| 断言 | 判据 | 失败意味着 |
|---|---|---|
| **侧翻裕度** | `a_y/a_crit ≤ rollover_margin`(默认 0.70) | 过弯太快或车太高 |
| **内侧轮载荷** | `F_inner > 0` | 已抬轮,准静态模型失效 |
| **极限车速** | `v ≤ sqrt(a_crit·R)` | 超过该半径的物理上限 |
| **载荷转移** | `|ΔF_z/F_z0 − a_y/a_crit| ≤ tolerance` | 实现不自洽 |

前三条讲安全性,第四条讲实现正确性 —— 所以抬高质心会让前三条一起翻,第四条仍然通过。

## 参数

| 参数 | 默认 | 说明 |
|---|---|---|
| `vehicle/track` | `1.54` | 轮距(m) |
| `vehicle/cg_height` | `0.55` | 质心高度(m) |
| `vehicle/mass` | `1500.0` | 质量(kg) |
| `vehicle/gravity` | `9.81` | 重力加速度 |
| `corner/radius` | `30.0` | 弯道半径(m) |
| `corner/speed_kmh` | `60.0` | 过弯车速(km/h) |
| `check/rollover_margin` | `0.70` | 裕度上限 |
| `check/transfer_tolerance` | `0.02` | 自洽性容差 |
| `rate/publish_hz` | `10.0` | 打印完保持挂起的循环频率 |
| `topic/report` | `/rollover/report` | 文本报告(latched) |
| `topic/loads` | `/rollover/loads` | 车速扫描 CSV(latched) |
| `topic/critical_speed` | `/rollover/critical_speed` | 极限车速 Float64(km/h) |

## 运行

```bash
roslaunch rollover_margin main.launch
roslaunch rollover_margin main.launch speed_kmh:=80
roslaunch rollover_margin main.launch rollover_margin:=0.5
roslaunch rollover_margin main.launch cg_height:=0.90
```

打印完节点保持挂起,方便另一个终端核对:

```bash
rosparam get /vehicle/track
rosparam get /check/rollover_margin
rosparam get /vehicle/cg_height
```

## 实测输出(默认)

```
车辆:轮距 1.54 m,质心高 0.55 m,质量 1500 kg
SSF = 1.4000,侧翻临界加速度 13.734 m/s²(1.40 g)
工况:半径 30.0 m,车速 60.0 km/h(16.67 m/s)
侧向加速度 9.259 m/s²,裕度比值 0.674
载荷转移 4960.3 N(占比 0.674),内侧 2397.2 N / 外侧 12317.8 N
该半径极限车速 73.1 km/h(余量 13.1 km/h)
断言:4 通过 / 0 失败(共 4 条)
[PASS] 侧翻裕度 a_y 9.259 m/s²,a_crit 13.734 m/s²,比值 0.674(上限 0.70)
[PASS] 内侧轮载荷 内侧轮 2397.2 N,外侧轮 12317.8 N(静态 7357.5 N)
[PASS] 极限车速 当前 60.0 km/h,该半径极限 73.1 km/h(余量 13.1 km/h)
[PASS] 载荷转移 ΔF_z/F_z0 = 0.6742,a_y/a_crit = 0.6742
结论:PASSED
```

## 两个反例

```bash
roslaunch rollover_margin main.launch rollover_margin:=0.5 # 只翻「侧翻裕度」
roslaunch rollover_margin main.launch cg_height:=0.90 # 裕度 + 内侧轮 + 极限车速 一起翻
```

第二个更有意思:质心抬到 0.90 m 后 SSF 掉到 `0.8556`,临界加速度 `8.393 m/s²`
低于 60 km/h 所需的 `9.259`,于是内侧轮载荷变成 **−759.4 N**(物理上已经翻了),
极限车速掉到 `57.1 km/h`;而「载荷转移」依然通过,因为它校验的是模型自洽而非安全性。

## 离线测试

```bash
cd ~/catkin_ws17
python3 tests/test_rollover_margin_local.py
```

不需要 ROS / CARLA / 显示器。

## 与已有模块的分工

| 模块 | 关心什么 |
|---|---|
| `tire_slip_curve` | 附着系数从哪来(滑移率决定 μ) |
| `braking_distance_check` | 纵向:从看到到停住要几米 |
| `turning_sweep_check` | 转弯时车身占多宽(几何包络) |
| **`rollover_margin`(本包)** | **横向:载荷转移多少、何时抬轮、极限车速** |

`turning_sweep_check` 回答「这个弯转得过去吗(不压线)」,本包回答「这个弯转得过去吗(不翻车)」。

## 常见问题

**Q:为什么不建模悬架和轮胎侧偏?**
A:准静态阈值主要由 `track/2h_cg` 决定,悬架柔度只让实际阈值低 5~10%。本包要把公式讲清楚,
闭式解更容易校验;真车标定时把 `rollover_margin` 收到 0.6 即可覆盖这一偏差。

**Q:内侧轮载荷为负代表什么?**
A:代表该侧车轮已离地,准静态模型到此失效(真实车辆此时绕外侧轮倾覆)。所以断言只判 `> 0`。

---

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