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
197 changes: 197 additions & 0 deletions docs/ground/ride_comfort_transmissibility.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,197 @@
# 乘坐舒适性传递率

路面不是平的。同一辆车,40 km/h 过某段路很难受,60 km/h 反而平稳 —— 这不是错觉,
是**悬架对不同频率的输入放大倍数不同**。把这件事算清楚,就是本模块要讲的传递率。

这个模块用纯标准库实现一个单自由度悬架模型,给出共振在哪个频率、放大多少倍、
按 ISO 2631-1 属于哪个舒适度等级,并用四条断言把「算得对不对」钉住。
不需要 CARLA、不需要显示器、不需要 numpy,Ubuntu 18.04 + ROS Melodic 直接可跑。

## 一、为什么需要这个包

仓库里 `src/ground/` 下的地面载具模块,纵向有 `braking_distance_check`、横向有
`rollover_margin` 与 `lateral_stability_margin`,**垂直方向是空白**:

| 方向 | 已有模块 | 管什么 |
|---|---|---|
| 纵向 | `braking_distance_check` | 反应距离 + 制动距离 |
| 横向(侧翻) | `rollover_margin` | 载荷转移与临界车速 |
| 横向(转向) | `lateral_stability_margin` | 不足转向梯度与特征车速 |
| 执行器 | `steering_actuator_lag` | 转向机构的一阶滞后 |
| **垂直** | **本模块** | **悬架传递率、共振、舒适度等级** |

一条真实的工程链条是:悬架把路面震动放大到人体 → 人难受 → 驾驶员反应变慢 →
制动距离变长。前面三个模块都假设「驾驶员状态正常」,本模块补上这个前提被破坏时的量化依据。

## 二、模型

单自由度基础激励(只看垂直方向,忽略俯仰与侧倾耦合):

```
r = f / f_n 频率比(激励频率 / 固有频率)
T(r) = sqrt((1 + (2ζr)²) / ((1 − r²)² + (2ζr)²)) 位移传递率
a_w = T(r) · a_in 加权加速度 RMS
```

三个解析结论:

```
峰值位置 r_p = sqrt(1 − 2ζ²)
峰值大小 T_p = sqrt((1 + 4ζ²(1−2ζ²)) / (4ζ²(1−ζ²)))
低频/高频 T(0) = 1;T(∞) = 0
```

**峰值不在 r = 1**。r = 1 处 `T = sqrt(1+(2ζ)²)/(2ζ)`,ζ = 0.25 时是 2.236;
真正的极值在 r_p = 0.935,峰值 2.280,高出约 2%。阻尼越大偏得越多。

`damping` 被限制在 `(0, 1/√2)`:超过 0.7071 后 `sqrt(1−2ζ²)` 无实数意义,闭式峰位失效,
程序直接抛 `RideError`,而不是给一个错的数。现实里的悬架阻尼比也不会到 0.8。

舒适度等级(ISO 2631-1,`a_w` 单位 m/s² RMS):

| a_w 区间 | 等级 |
|---|---|
| < 0.315 | 舒适 |
| 0.315 ~ 0.63 | 略有不适 |
| 0.63 ~ 1.0 | 不适 |
| 1.0 ~ 1.6 | 很不适 |
| 1.6 ~ 2.5 | 极不适 |
| > 2.5 | 无法忍受 |

## 三、四条断言

| 断言 | 判据 | 默认实测 | 结果 |
|---|---|---|---|
| 共振位置 | 扫描峰位与 `sqrt(1−2ζ²)` 的偏差 ≤ 0.02 | 偏差 0.0132 | PASS |
| 峰值倍率 | 扫描峰值与闭式峰值的相对偏差 ≤ 5% | 偏差 0.0012(0.12%) | PASS |
| 高频衰减 | `T(r=10) ≤ 0.1` | 0.051440 | PASS |
| 输入线性 | 输入加倍后 `a_w` 精确加倍 | 相对偏差 0.0000 | PASS |

四条互相独立:位置管「峰在哪」、倍率管「峰多高」、衰减管「隔振行不行」、
线性管「叠加原理成不成立」。任何一条失败都能定位到具体环节。

## 四、默认数字

参数:`fn_hz = 1.2`、`damping = 0.25`、`input_accel = 0.5`、`freq_hz = 6.0`

| 项 | 值 |
|---|---|
| 理论峰位 / 峰值 | **0.935414 / 2.280351** |
| 扫描峰位 / 峰值 | 0.948625 / 2.283149 |
| r = 1 处传递率 | 2.236068 |
| r = 10 处传递率 | 0.051440 |
| 6 Hz 处加权加速度 | 0.055794 m/s² → 等级「舒适」 |

扫描表(10 个频率比,报告里原样打印):

| r | f Hz | T | a_w m/s² |
|---|---|---|---|
| 0.25 | 0.300 | 1.066 | 0.533 |
| 0.50 | 0.600 | 1.304 | 0.652 |
| 0.75 | 0.900 | 1.853 | 0.927 |
| 1.00 | 1.200 | 2.236 | 1.118 |
| 1.25 | 1.500 | 1.402 | 0.701 |
| 1.50 | 1.800 | 0.857 | 0.429 |
| 2.00 | 2.400 | 0.447 | 0.224 |
| 3.00 | 3.600 | 0.221 | 0.111 |
| 5.00 | 6.000 | 0.112 | 0.056 |
| 10.00 | 12.000 | 0.051 | 0.026 |

`r ≤ 1.5` 时 T > 1(放大),`r ≥ 2` 后迅速掉下来(隔振)。这就是过减速带要慢、
跑高速反而稳的物理原因。

## 五、参数

| 参数 | 默认 | 说明 |
|---|---|---|
| `/suspension/fn_hz` | 1.2 | 悬架固有频率 Hz |
| `/suspension/damping` | 0.25 | 阻尼比,必须在 (0, 0.7071) 开区间 |
| `/road/input_accel` | 0.5 | 路面输入加速度 RMS m/s² |
| `/road/freq_hz` | 6.0 | 关心的激励频率 Hz |
| `/check/pos_tolerance` | 0.02 | 峰位容差(频率比) |
| `/check/peak_tolerance` | 0.05 | 峰值相对容差 |
| `/check/high_freq_limit` | 0.1 | r=10 时传递率上限 |
| `/check/linear_tolerance` | 0.02 | 输入加倍的线性容差 |
| `/scan/low` `/scan/high` `/scan/steps` | 0.05 / 4.0 / 400 | 扫描区间与步数 |
| `/rate/publish_hz` | 1.0 | 保活重发频率 Hz |

## 六、话题

| 话题 | 类型 | 内容 |
|---|---|---|
| `/ride/report` | `std_msgs/String` | 整份报告(含断言与结论) |
| `/ride/curve` | `std_msgs/Float64MultiArray` | 每个频率比三元组 `[r, T, a_w]`,共 30 个数 |
| `/ride/peak` | `std_msgs/Float64MultiArray` | `[理论峰位, 理论峰值, 扫描峰位, 扫描峰值, 激励处 a_w]` |

三条都 `latch=True`。

## 七、运行

```bash
mkdir -p ~/catkin_ws19/src/ground ~/catkin_ws19/tests ~/catkin_ws19/docs/ground
# 把包放进来,改 shebang,catkin_make,source,roslaunch
roslaunch ride_comfort_transmissibility main.launch
```

默认输出 `结论:PASSED`。两个反例:

```bash
# ① 容差收到 0.001:扫描精度不够,只翻「共振位置」
roslaunch ride_comfort_transmissibility main.launch pos_tolerance:=0.001

# ② 阻尼 0.02(坏减振器)+ 激励挪到 1.2 Hz:峰值 25 倍,等级「无法忍受」
roslaunch ride_comfort_transmissibility main.launch damping:=0.02 freq_hz:=1.2
```

反例②值得多看一眼:四条断言**全部通过**(物理上它自洽),但舒适等级从「舒适」
变成「无法忍受」。**断言管的是「算得对不对」,等级管的是「人坐着难受不难受」** ——
两者不能互相替代,这也是我特意把等级做成独立输出的原因。

## 八、离线测试

```bash
python3 tests/test_ride_comfort_transmissibility_local.py
```

**通过 112 项,失败 0 项**,覆盖:

| 组 | 内容 |
|---|---|
| A | 传递率基本形(T(0)=1、T(1)、单调段) |
| B | 闭式峰位与峰值 |
| C | 舒适度等级分档 |
| D | 四条断言的正反例 |
| E | 扫描表数值与单调性 |
| F | 字符图排版 |
| G | 参数读取与非法值拒绝 |
| H | 报告排版(表头、行数、结论) |
| I | 闭式恒等式(r_p 处取 T 就是 T_p) |
| J | 三个脚本的工程约定(shebang、coding、保活) |
| K | 编码声明回归(防 `Non-ASCII character` 报错) |

## 九、与已有模块的分工

前面第一节的表已经列了纵向/横向/执行器/垂直四块。补一句边界:
`steering_actuator_lag` 也是「频率响应」,但它是**转向机构**的一阶惯性;
本模块是**悬架**的二阶共振。两者都有「频率越高越跟不上」,但物理对象、微分方程阶数、
关心的频段完全不同(转向 2~10 Hz,车身 1~2 Hz)。

## 十、常见问题

**1. 为什么峰值不在 r = 1?**
因为 r = 1 只是「分母实部为 0」的位置,不是传递率对 r 的极值点。
`T(1) = sqrt(1+(2ζ)²)/(2ζ)`,极值点在 `r = sqrt(1−2ζ²)`,ζ = 0.25 时差 1.3%。
判据里写「峰位」而不是直接拿 r = 1 当峰,就是为了不让这个偏差蒙混过去。

**2. 为什么 `damping:=0.8` 直接报错?**
超过 `1/√2 ≈ 0.7071` 后曲线没有经典共振峰,`sqrt(1−2ζ²)` 是虚数。
与其返回一个错的峰位,不如判参数非法。测试 G15 就是查这个事情。

**3. 高通/低通行为怎么读?**
`r → 0` 时 `T → 1`(车身跟着路面一起动,等于没悬架);`r → ∞` 时 `T → 0`
(高频震动被滤掉)。所以舒适性设计的目标是:把共振峰挪到人最不敏感的低频、
同时把峰压下去 —— 后者靠加阻尼,前者靠改固有频率(也就是改悬架刚度与簧上质量)。

## 十一、大模型使用声明

本模块的代码编写、测试编写与文档整理使用了 AI 编程助手辅助,提交内容由本人负责。
1 change: 1 addition & 0 deletions docs/index.md
Original file line number Diff line number Diff line change
Expand Up @@ -245,6 +245,7 @@ ROS 2 服务与参数基础实验(无人机模式切换与在线调参):[c
* [轮胎滑移率-附着曲线](./ground/tire_slip_curve.md) —— 用简化刷子轮胎模型输出滑移率与附着系数关系,标出峰值附着与 ABS 目标滑移带
* [横向载荷转移与侧翻裕度](./ground/rollover_margin.md) —— 用 SSF、临界侧向加速度和内外侧轮垂向力算「这车会不会翻」,纯代数、不依赖 CARLA
* [工况能耗与续航核算](./ground/drive_cycle_energy.md) —— 把一段行驶工况拆成滚阻、风阻、制动与动能项,算清楚电花在哪、还能跑多远
* [乘坐舒适性传递率](./ground/ride_comfort_transmissibility.md) —— 用二自由度悬架加 ISO 2631 频率加权算路面振动传到人身上剩多少,解释「40 难受、60 反而稳」

## 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 @@ -239,6 +239,7 @@ nav:
- 轮胎滑移率-附着曲线: './ground/tire_slip_curve.md'
- 横向载荷转移与侧翻裕度: './ground/rollover_margin.md'
- 工况能耗与续航核算: './ground/drive_cycle_energy.md'
- 乘坐舒适性传递率: './ground/ride_comfort_transmissibility.md'
- 空域载具:
- MuJoCo 城市屋顶光伏覆盖率测量: './air/mujoco_uav_rooftop_pv_coverage_survey.md'
- MuJoCo 屋顶光伏覆盖率测量第二天: './air/mujoco_uav_rooftop_pv_coverage_survey_day2.md'
Expand Down
18 changes: 18 additions & 0 deletions src/ground/ride_comfort_transmissibility/CMakeLists.txt
Original file line number Diff line number Diff line change
@@ -0,0 +1,18 @@
cmake_minimum_required(VERSION 3.0.2)
project(ride_comfort_transmissibility)

find_package(catkin REQUIRED)

catkin_package()

catkin_install_python(PROGRAMS
scripts/main.py
scripts/ride_core.py
scripts/ride_node.py
DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
)

install(DIRECTORY launch config
DESTINATION ${CATKIN_PACKAGE_SHARE_DESTINATION}
USE_SOURCE_PERMISSIONS
)
159 changes: 159 additions & 0 deletions src/ground/ride_comfort_transmissibility/README.md
Original file line number Diff line number Diff line change
@@ -0,0 +1,159 @@
# ride_comfort_transmissibility:乘坐舒适性传递率

路面是一段段不同频率的起伏。车过某段搓板路时抖得厉害、换个车速又平稳了,
原因是悬架对不同频率的输入放大倍数不一样 —— 这就是**传递率**。
这个模块把它算清楚:共振在哪个频率、放大多少倍、按 ISO 2631-1 属于哪个舒适度等级。

不依赖 CARLA、不需要显示器,纯 Python 标准库,Python 2.7 / 3.x 都能跑。

## 模型

单自由度基础激励(只看垂直方向):

```
r = f / f_n 频率比
T(r) = sqrt((1 + (2ζr)²) / ((1 − r²)² + (2ζr)²)) 位移传递率

峰值位置 r_p = sqrt(1 − 2ζ²) (ζ ≥ 1/√2 时没有经典共振峰)
峰值大小 T_p = sqrt((1 + 4ζ²(1−2ζ²)) / (4ζ²(1−ζ²)))
高频衰减 T(r) → 0,r = 10 时约 0.05
加权加速度 a_w = T(r) · a_in
```

ISO 2631-1 的舒适度等级(`a_w` 单位 m/s²,RMS):

| a_w | 等级 |
|---|---|
| < 0.315 | 舒适 |
| 0.315 ~ 0.63 | 略有不适 |
| 0.63 ~ 1.0 | 不适 |
| 1.0 ~ 1.6 | 很不适 |
| 1.6 ~ 2.5 | 极不适 |
| > 2.5 | 无法忍受 |

`damping` 被限制在 `(0, 1/√2)`:超过 0.7071 之后 `sqrt(1−2ζ²)` 没有实数意义,
闭式峰位失效,程序直接报 `RideError`,而不是给一个错的数。

## 默认数字(`config/ride_comfort_transmissibility.yaml`)

| 项 | 值 |
|---|---|
| 悬架固有频率 / 阻尼比 | 1.2 Hz / 0.25 |
| 路面输入 / 激励频率 | 0.5 m/s² / 6.0 Hz |
| 理论峰位 / 峰值 | **0.935414 / 2.280351** |
| 扫描峰位 / 峰值 | 0.948625 / 2.283149(与闭式差 0.12%) |
| r = 1 处传递率 | 2.236068 |
| r = 10 处传递率 | 0.051440 |
| 6 Hz 处加权加速度 | 0.055794 m/s² → 等级「舒适」 |

扫描表(10 个频率比):

| r | f Hz | T | a_w m/s² |
|---|---|---|---|
| 0.25 | 0.30 | 1.0655 | 0.5328 |
| 0.50 | 0.60 | 1.3038 | 0.6519 |
| 0.75 | 0.90 | 1.8535 | 0.9267 |
| 1.00 | 1.20 | 2.2361 | 1.1180 |
| 1.25 | 1.50 | 1.4024 | 0.7012 |
| 1.50 | 1.80 | 0.8575 | 0.4287 |
| 2.00 | 2.40 | 0.4472 | 0.2236 |
| 3.00 | 3.60 | 0.2215 | 0.1107 |
| 5.00 | 6.00 | 0.1116 | 0.0558 |
| 10.00 | 12.00 | 0.0514 | 0.0257 |

注意 r = 1(激励频率等于固有频率)时 T 是 2.236,但**真正的峰值 2.283 出现在
r ≈ 0.949**,略低于共振比 —— 阻尼越大,峰位越往左偏。这是很多人会算错的地方。

## 四条断言

| 断言 | 判据 | 默认结果 |
|---|---|---|
| 共振位置 | 扫描峰位与 `sqrt(1−2ζ²)` 的偏差 ≤ 0.02 | PASS(0.0132) |
| 峰值倍率 | 扫描峰值与闭式峰值的相对偏差 ≤ 5% | PASS(0.12%) |
| 高频衰减 | `T(r=10) ≤ 0.1` | PASS(0.0514) |
| 输入线性 | 输入加倍后 `a_w` 精确加倍 | PASS(0.0000) |

## 参数

| 参数 | 默认 | 说明 |
|---|---|---|
| `/suspension/fn_hz` | 1.2 | 悬架固有频率 Hz |
| `/suspension/damping` | 0.25 | 阻尼比,必须在 (0, 0.7071) 开区间 |
| `/road/input_accel` | 0.5 | 路面输入加速度 RMS m/s² |
| `/road/freq_hz` | 6.0 | 关心的激励频率 Hz |
| `/check/pos_tolerance` | 0.02 | 峰位容差(频率比) |
| `/check/peak_tolerance` | 0.05 | 峰值相对容差 |
| `/check/high_freq_limit` | 0.1 | r=10 时传递率上限 |
| `/check/linear_tolerance` | 0.02 | 输入加倍的线性容差 |
| `/scan/low` `/scan/high` `/scan/steps` | 0.05 / 4.0 / 400 | 扫描区间与步数 |
| `/rate/publish_hz` | 1.0 | 保活重发频率 Hz |

## 话题

| 话题 | 类型 | 内容 |
|---|---|---|
| `/ride/report` | `std_msgs/String` | 整份报告 |
| `/ride/curve` | `std_msgs/Float64MultiArray` | 每个频率比三元组 `[r, T, a_w]`,共 30 个数 |
| `/ride/peak` | `std_msgs/Float64MultiArray` | `[理论峰位, 理论峰值, 扫描峰位, 扫描峰值, 激励处 a_w]` |

三条都是 latched。

## 跑起来

```bash
cd ~/catkin_ws19 && catkin_make
source /opt/ros/melodic/setup.bash
source ~/catkin_ws19/devel/setup.bash
roslaunch ride_comfort_transmissibility main.launch
```

默认 `结论:PASSED`。两个有意思的反例:

```bash
# ① 容差收到 0.001 → 扫描精度不够,只翻「共振位置」
roslaunch ride_comfort_transmissibility main.launch pos_tolerance:=0.001

# ② 阻尼降到 0.02(坏减振器)→ 峰值 25 倍,激励频率挪到 1.2 Hz 就「无法忍受」
roslaunch ride_comfort_transmissibility main.launch damping:=0.02 freq_hz:=1.2
```

反例②很说明问题:四条断言**全部通过**(物理上它自洽),但舒适等级从「舒适」
变成「无法忍受」。断言管的是「算得对不对」,等级管的是「人坐着难受不难受」。

## 离线测试

```bash
python3 tests/test_ride_comfort_transmissibility_local.py
```

覆盖 A 传递率基本形、B 闭式峰位峰值、C 舒适等级、D 四条断言、E 扫描表、
F 字符图、G 参数读取、H 报告排版、I 闭式核对、J 工程文件约定、K 编码声明回归。

## 与已有模块的分工

| 模块 | 关注点 | 本模块的区别 |
|---|---|---|
| `rollover_margin` | 侧翻(横向载荷转移) | 管横向极限,本模块管垂直舒适性 |
| `lateral_stability_margin` | 不足转向/甩尾 | 管转向响应 |
| `braking_distance_check` | 纵向停车距离 | 管纵向制动 |
| `steering_actuator_lag` | 执行器一阶惯性 | 同是「频率响应」,但那是转向机构,本模块是悬架 |

## 常见问题

**1. 为什么峰值不在 r = 1?**
`T(1) = sqrt(1+(2ζ)²)/(2ζ)`,而真正的极值点在 `r = sqrt(1−2ζ²)`。ζ = 0.25 时
r_p = 0.935,峰值比 T(1) 高约 2%。阻尼越大偏得越多,这也是判据要写「峰位」
而不是直接拿 r=1 当峰的原因。

**2. `damping:=0.8` 为什么直接报错?**
超过 `1/√2 ≈ 0.7071` 以后曲线没有经典共振峰,`sqrt(1−2ζ²)` 是虚数。与其给一个
错的峰位,不如判参数非法 —— 现实里的悬架阻尼比也不会到 0.8。

**3. 高通/低通行为怎么读?**
`r → 0` 时 `T → 1`(车身跟着路面一起动,等于没有悬架);`r → ∞` 时
`T → 0`(悬架把高频震动滤掉了)。所以舒适性设计的目标是把共振峰挪到人最不敏感
的低频、同时把峰压下去,也就是「加大阻尼」。

## 大模型声明

本模块的代码编写、测试编写与文档整理使用了 AI 编程助手辅助,提交内容由本人负责。
Loading
Loading