Skip to content

feat(ground): 新增 drive_cycle_energy,把「工况能耗与续航」做成可离线复算的能量分解 - #1250

Merged
xingwunian merged 8 commits into
OpenHUTB:masterfrom
Wist-sutton:feat-drive-cycle-energy
Nov 11, 2026
Merged

xingwunian merged 8 commits into
OpenHUTB:masterfrom
Wist-sutton:feat-drive-cycle-energy

Conversation

@Wist-sutton

Copy link
Copy Markdown
Contributor

修改概述

新增 src/ground/drive_cycle_energy 模块:把一段行驶工况拆成滚阻、风阻、制动、动能四份能量,
给出百公里电耗与满电续航,并用「能量分解 / 回收上限 / 续航自洽 / 风阻上升」四条断言
把账算平。纯标准库实现,不需要 CARLA、不需要显示器,Ubuntu 18.04 + ROS Melodic 直接可跑。

配套新增 docs/ground/drive_cycle_energy.md 文档页。

修改的详细描述

1. 为什么需要这个包

src/ground/ 下的地面载具模块,纵向动力学已有 braking_distance_check(停车距离)、
ros_scenario_runner(场景断言),但没有一处把「跑完一段路到底用了多少电」算清楚:

模块 管什么 缺什么
braking_distance_check 反应距离 + 制动距离 只看刹车,不看行驶
ros_scenario_runner 场景时间轴与断言 只判「到没到」,不判「耗多少」
tire_slip_curve 轮胎附着 只管抓地,不管能耗
本模块 工况能耗分解与续航 —

电动车的续航焦虑本质上就是这笔账没算清:同一段路,风阻与滚阻的占比完全不同,
到底是「开太快风阻大」还是「刹车太多」造成的浪费,需要拆开看。本模块给的就是这个拆解。

2. 模型

行驶阻力     F(v, a) = m·a + m·g·c_rr + 0.5·ρ·Cd·A·v²
驱动能量     E_drive = ∫ max(F, 0) · v dt
制动能量     E_brake = ∫ max(−F, 0) · v dt
回收能量     E_regen = η · E_brake
净消耗       E_net   = E_drive − E_regen
百公里电耗   per_100km = E_net / 3.6e6 / (距离 / 100km)      (kWh/100km)
满电续航     range     = 电池容量 / per_100km × 100           (km)

关键恒等式(第 1 条断言查的就是它):

E_drive = E_roll + E_aero + E_brake + ΔKE

其中 E_roll = m·g·c_rr·s、E_aero = ∫0.5ρCdA v³dt、ΔKE = ½m(v_end² − v_start²)。
这条恒等式把「驱动力做过的功」拆成四份互不重叠的账,任何一项漏算都会立刻暴露。

3. 四条断言

断言 判据 默认实测
能量分解 四项之和与 E_drive 的相对偏差 ≤ 2% 偏差 0.0000
回收上限 E_regen / E_brake ≤ regen_limit(默认 1.0) 0.6000
续航自洽 range 与 battery / per_100km × 100 一致 0.0000
风阻上升 速度翻倍后风阻功率至少 ×6(理论 ×8) 通过

第 2 条的默认上限是 1.0,不是 0.6:回收能量超过制动能量违反能量守恒,
这是物理边界而不是标定值。第 4 条用「至少 ×6」而不是「恰好 ×8」,是因为工况里
速度并非瞬时翻倍,留了积分带来的余量。

4. 默认数字

工况 8 段、60 s、512.5 m、最高 50 km/h:

项 值
驱动 / 制动 / 回收 / 净 407321.39 / 159646.51 / 95787.91 / 311533.49 J
滚阻 / 风阻 / 制动 / 动能 108596.70 / 27967.07 / 159646.51 / 111111.11 J
占比 26.7% / 6.9% / 39.2% / 27.3%
百公里电耗 16.885 kWh
满电续航(60 kWh) 355.3 km

5. 参数与话题

12 个参数由 launch 逐个 <arg>(带 doc)+ <rosparam command="load"> + 同名 <param> 三层落地:
/vehicle/{mass,c_rr,cd,area,battery_kwh,regen_eff}、/check/{breakdown_tolerance,regen_limit}、
/rate/publish_hz、三个话题名。

三路 latched 话题:/energy/report(std_msgs/String)、/energy/breakdown(Float64MultiArray,
四份能量 + 四份占比)、/energy/range(Float64MultiArray,百公里与续航)。

6. 结构约定

与仓库里已有的 ground 模块保持一致:config/ + launch/main.launch + scripts/{main,*_core,*_node}.py

  • tests/test_*_local.py + docs/ground/*.md,*_core.py 不 import rospy(离线可测),
    *_node.py 里 _log() 把消息 encode 成 byte str(规避 Melodic 的 UnicodeEncodeError)。

7. 自查修掉的三处

  1. 恒等式不成立:最初用 inertia_pos(只累计加速时的正功),导致
    E_drive ≠ 四项之和。改成带符号的 ΔKE 后偏差归零。
  2. 零距离工况崩溃:距离为 0 时 per_100km 除零抛异常,检查器直接退出。
    改成 try/except,把「续航自洽」判成 FAIL 并写明原因。
  3. 测试列表比较:check() 只支持数字,遇到字符串列表(断言名)会抛 TypeError,补了分支。

8. 没改动什么

没有修改任何既有模块、mkdocs.yml 和 docs/index.md(索引与导航的改动单独提交)。
docs/ground/drive_cycle_energy.md 是本次新增的文件。

测试

在 Ubuntu 18.04 + ROS Melodic(Python 2.7.17)的虚拟机里执行:

python3 tests/test_drive_cycle_energy_local.py

通过 152 项,失败 0 项。覆盖 11 组:

组 内容
A 8 段工况解析(时长、距离、最高车速)
B 行驶阻力四项分解
C 能量积分与恒等式
D 回收与净消耗
E 百公里电耗与续航
F 四条断言的正反例
G 参数读取与非法值拒绝
H 报告排版
I 闭式核对(匀速工况手算对比)
J 三个脚本的工程约定
K 编码声明回归(shebang + coding)

运行效果

默认参数:

roslaunch drive_cycle_energy main.launch

输出 断言:4 通过 / 0 失败(共 4 条)、结论:PASSED。
关掉回收(vehicle_regen_eff:=0.0)续航从 355.3 km 掉到 271.8 km;把 regen_limit 收到 0.5
则只有「回收上限」翻红。

图 1 离线测试通过 152 项
屏幕截图 2026-11-11 171655

图 2 默认工况 结论:PASSED
屏幕截图 2026-11-11 172003

图 3 vehicle_regen_eff:=0.0:净消耗变大、续航 271.8 km,断言仍全过
屏幕截图 2026-11-11 172558

图 4 regen_limit:=0.5:翻「回收上限」
屏幕截图 2026-11-11 172709

图 5 终端 B 三条 rosparam get 回显
屏幕截图 2026-11-11 172753

所使用具体的大模型声明

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

# 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 节本地核对过(git fetch origin pull/1250/head → 逐文件看 → 跑离线测试),没有阻断问题,可以合。

  • 把 master(4c9b5e07,已含 #1246/#1249)合进本分支,冲突只在 mkdocs.yml / docs/index.md
  • 本 PR 原来的导航 hunk 有两个问题:一是把 master 已有的「VRU 冲突风险图」删掉了;二是新增的那一行指向 ./ground/ride_comfort_transmissibility.md(是 #1252 的模块,不是本 PR 的)。已改成保留 master 两条,本模块用 ./ground/drive_cycle_energy.md 单独加一行
  • 首页同样补上「工况能耗与续航核算」的链接
  • tests/test_drive_cycle_energy_local.py 本地跑:通过 152 项,失败 0 项
  • 相对 master 的净变化 1349 行新增、0 行删除;catkin_install_python 三个脚本齐全,包内只依赖 math

代码逻辑没动,只补了合并与导航。按贡献指南用 Squash and merge。

@xingwunian
xingwunian merged commit 2d9653a into OpenHUTB:master Nov 11, 2026
1 check passed
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.

2 participants