Skip to content

feat(ground): 新增 tire_slip_curve,把「轮胎附着随滑移率变化」做成可离线校验的曲线与 ABS 目标带 - #1246

Merged
xingwunian merged 7 commits into
OpenHUTB:masterfrom
Wist-sutton:feat-tire-slip-curve
Nov 11, 2026
Merged

xingwunian merged 7 commits into
OpenHUTB:masterfrom
Wist-sutton:feat-tire-slip-curve

Conversation

@Wist-sutton

Copy link
Copy Markdown
Contributor

修改概述:新增 tire_slip_curve 包,把「轮胎附着系数随滑移率先升后降」这件事做成一条有闭式解的解析曲线,可离线运行、可断言,用来解释峰值附着与 ABS 目标带。

修改的详细描述

1. 为什么加这个包

仓库里已有多个模块在使用附着系数(braking_distance_check 的减速度、turning_sweep_check 的转弯极限、reverse_parking_planner 的路径可行性),但没有一个模块回答「这个 μ 是哪来的」。而纵向控制里最容易出错的前提恰恰在这里:附着系数不是常数,它随滑移率先升后降,车轮抱死时只剩峰值的两三成,ABS 的目标就是把滑移率压在峰值附近。

本包补上这一环:输入峰值滑移率与峰值附着,输出整条曲线、峰值/锁死/初段刚度/目标带四个关键量。

2. 曲线模型(有闭式解,才能被断言)

以归一化滑移率 ŝ = s / s_peak 表示:

μ(ŝ) = μ_peak · 2·ŝ / (1 + ŝ²)
  • ŝ = 0 → μ = 0(自由滚动)
  • ŝ = 1 → μ = μ_peak(唯一极大)
  • s = 1.0(车轮抱死)→ μ = μ_peak·2k/(1+k²),k = 1/s_peak
  • 初段刚度闭式解:dμ/ds|₀ = 2·μ_peak / s_peak

默认参数(μ_peak=0.90、s_peak=0.12):锁死附着 0.2129(占峰值 23.7%)、初段刚度 15.000 1/s、ABS 目标带 [0.0960, 0.1440]。

选择这条曲线而不是魔术公式(Pacejka)的原因:魔术公式需要拟合 4 个系数、没有解析极大值,断言只能靠数值搜索;本包要讲的是「峰值 - 锁死 - 目标带」三个概念,有闭式解的曲线能被精确校验。真车标定时把 peak_slip / peak_friction 换成实测值即可,0~0.4 区间的形状已足够接近。

3. 四条断言

断言 判据 失败意味着
峰值唯一 采样点局部极大只有一个且在 (s_peak, μ_peak) 上 采样太粗抓不到峰值
锁死衰减 μ(1.0)/μ_peak ≤ lock_friction_ratio(默认 0.85) 曲线没体现过度滑移导致附着下降
初段线性 s→0 时 μ ≈ (2μ_peak/s_peak)·s,相对误差 ≤ 2% 原点附近不光滑
目标带覆盖峰值 目标带必须包含 s_peak 参数自相矛盾

默认工况 4 通过 / 0 失败,结论:PASSED。

4. 结构约定

  • scripts/main.py:入口(符合仓库 main.* 约定),只做 sys.path 注入与转发
  • scripts/tire_core.py:纯数学,不 import rospy / numpy,可单独 import 做离线测试
  • scripts/tire_node.py:ROS 收发,发布三个 latched 话题(/tire/report 文本、/tire/curve CSV、/tire/peak_slip Float64)
  • config/tire_slip_curve.yaml:12 个参数;launch/main.launch:12 个带 doc 的 <arg> + rosparam 载入 + 12 个 <param> 覆盖
  • 节点打完报告保持挂起,方便另一终端 rosparam get 核对参数

5. 离线与真机共用同一份数学

tire_core.py 不依赖 ROS,离线测试与 ROS 节点调用的都是同一个 TireSpec.friction();因此测试里写下的期望值就是运行时的真实输出,不存在「测试一套、节点另一套」。

6. 自查修掉的问题

  1. TireParams 最初把非法参数延迟到 spec() 才校验,导致构造成功、使用才崩 —— 改成构造即报错,测试也相应改成断言构造抛 TireError
  2. 初版字符图没有目标带底纹,看不出「峰值落在带内」—— 加了 . 底纹行
  3. render_curve 最初按 μ/1.0 定纵轴,μ_peak=0.35(雪地)时曲线挤在底部 —— 改成按 μ_peak·1.05 归一

7. 没改动什么

未修改 mkdocs.yml 之外任何已有文件;本包为纯新增。docs/index.md 与 mkdocs.yml 各加一行索引。

经过了什么样的测试?

  1. 操作系统:Ubuntu 18.04(ROS Melodic,Python 2.7)实测通过;Ubuntu 22.04(Python 3.10)离线测试通过
  2. Python 版本:3.6.9(虚拟机)/ 3.12.14(本机)
  3. 基础校验:
    • python3 tests/test_tire_slip_curve_local.py → 通过 161 项,失败 0 项,退出码 0(不需要 ROS / CARLA / 显示器)
    • 覆盖:参数校验、核心数学闭式解、曲线采样、关键量、四条断言(含 3 个反例)、报告与字符图、参数读取、工程文件约定
    • python -m pytest tests/test_tire_slip_curve_local.py -q → 8 组测试全部通过(_pytest_group 包装保证失败会真抛 AssertionError)
    • catkin_make 通过;roslaunch tire_slip_curve main.launch 默认工况 4 通过 / 0 失败、PASSED
    • 反例一 samples:=5 → 仅 [FAIL] 峰值唯一;反例二 lock_friction_ratio:=0.20 → 仅 [FAIL] 锁死衰减

运行效果(动图、视频、图片、链接等)

离线测试在无 ROS 环境下 161 项全过:

图 1
屏幕截图 2026-11-11 163822

默认工况 4 条断言全过,报告里给出峰值、锁死占比、初段刚度与 ABS 目标带:

图 2
屏幕截图 2026-11-11 164200

采样点数从 51 降到 5 后,s=0.12 的峰值落在两个采样点之间,抓到的最大值只有 0.7022 @ s=0.25,峰值唯一 失败:

图 3
屏幕截图 2026-11-11 164300

把锁死附着的上限从 85% 收到 20%,实测 23.7% 超限,锁死衰减 失败:

图 4
屏幕截图 2026-11-11 164330

参数确实经由 launch 传进节点(0.12 / 0.85 / dry_asphalt):

图 5
屏幕截图 2026-11-11 164412

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

# Conflicts:
#	docs/index.md
#	mkdocs.yml

@xingwunian xingwunian left a comment

Copy link
Copy Markdown
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

本地按贡献指南第 8 节核对过(fetch pull/1246/head 到本地、逐文件看改动、跑测试),没有阻断问题。

  • 把 master(69cf47b)合进本分支,冲突只在 mkdocs.yml / docs/index.md;处理方式是保留 master 已有的「VRU 冲突风险图」「里程计健康监视」两条入口,再把「轮胎滑移率-附着曲线」补进导航和首页
  • 顺带修正首页那条 * 轮胎附着曲线与 ABS 目标带: './ground/tire_slip_curve.md' —— 单引号 + 没有链接语法,在 mkdocs 里渲染不出来,已改成 * [轮胎滑移率-附着曲线](./ground/tire_slip_curve.md) —— ...
  • tests/test_tire_slip_curve_local.py 本地跑:通过 161 项,失败 0 项
  • 相对 master 的净变化 1573 行新增、0 行删除;catkin_install_python 三个脚本都在,package.xml 用不到 numpy(只依赖 math/json)

改动只动了作者分支的合并与导航,代码逻辑没动。按贡献指南用 Squash and merge 合并。

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

3 participants