归档 170

UE C++深入笔记 24 算法 24 数据结构笔记 20 Dart学习笔记 17 C#学习笔记 13 C++深入笔记 11 RC上位机 11 操作系统笔记 10 算法笔记 10 图形学笔记 9 计算机网络笔记 8 设计模式笔记 7 游戏引擎笔记 6

1503 字

8 分钟

现场调参与参数热加载

2026-07-26

RC上位机

参数

yaml

ros2

调参

教程

前面几章的代码里到处是 magic number——Pure Pursuit 的前瞻距离写死 0.8，速度上限写死 1.5，PID 增益写死 1.2。这些数字在赛场上是要反复调的，如果每次改一个数字都要改代码、重新编译、重新部署，那赛前调试的时间全浪费在等编译上了。

为什么需要参数管理#

赛场上调参是这样的：

“速度太快了过弯打滑，降到 1.2 试试。” “前瞻距离太小了走蛇形，改大一点。” “PID 的 D 项太大了有高频抖动，去掉。”

每一句都是在改一个数字。如果这个数字写死在代码里，流程就是：改代码 → 编译 → 部署 → 跑一遍 → 不行再改 → 编译 → 部署……一轮下来 5 分钟没了，一天调不了几轮。

如果这个数字在配置文件里，流程就是：改配置文件 → 重启程序（甚至不重启）→ 跑一遍 → 不行再改。一轮 30 秒。

赛场上一天能跑的次数是有限的，每多编译一次就少跑一次。参数管理不是锦上添花，是直接决定赛前能调多少轮。

YAML 配置文件#

把所有可调参数抽到 YAML 文件里，程序启动时读取。

1
pure_pursuit:
2
  lookahead_min: 0.3      # 最小前瞻距离 m
3
  lookahead_k: 1.0        # 前瞻距离 = max(min, k * v)
4
  max_speed: 2.0          # 最大速度 m/s
5
  min_speed: 0.3          # 最小速度 m/s
6

7
pid:
8
  linear_kp: 1.2
9
  linear_ki: 0.01
10
  linear_kd: 0.3
11
  angular_kp: 2.0
12
  angular_ki: 0.0
13
  angular_kd: 0.5
14

15
chassis:
16
  wheel_base: 0.3         # 轮距 m
17
  max_angular_vel: 2.0    # 最大角速度 rad/s
18

19
paths:
20
  zone1:
21
    - [0.0, 0.0]
22
    - [1.0, 0.0]
23
    - [2.0, 0.5]
24
    - [3.0, 1.5]

Python 读取用 pyyaml：

1
pip install pyyaml

1
import yaml
2

3
def load_config(path="config/params.yaml"):
4
    with open(path) as f:
5
        return yaml.safe_load(f)
6

7
cfg = load_config()
8

9
# 用的时候
10
v_max = cfg["pure_pursuit"]["max_speed"]
11
Ld_min = cfg["pure_pursuit"]["lookahead_min"]
12
kp = cfg["pid"]["angular_kp"]

C++ 读取用 yaml-cpp：

1
#include <yaml-cpp/yaml.h>
2

3
YAML::Node cfg = YAML::LoadFile("config/params.yaml");
4

5
double v_max = cfg["pure_pursuit"]["max_speed"].as<double>();
6
double Ld_min = cfg["pure_pursuit"]["lookahead_min"].as<double>();
7
double kp = cfg["pid"]["angular_kp"].as<double>();

把路径点也写在 YAML 里，改流程就是改坐标，不用动代码。我的 decision.py 里 zone1 的路线就是从 ROS2 参数读的，改一个数字就行。

ROS2 Parameter#

如果你的系统已经在用 ROS2，那它自带一套参数系统，不用白不用。

声明参数#

在节点里声明参数，带默认值：

1
class ControlNode(Node):
2
    def __init__(self):
3
        super().__init__('control_node')
4

5
        # 声明参数，默认值在括号里
6
        self.declare_parameter('lookahead_min', 0.3)
7
        self.declare_parameter('lookahead_k', 1.0)
8
        self.declare_parameter('max_speed', 2.0)
9
        self.declare_parameter('pid_kp', 1.2)
10

11
    def get_params(self):
12
        return {
13
            'Ld_min': self.get_parameter('lookahead_min').value,
14
            'Ld_k': self.get_parameter('lookahead_k').value,
15
            'v_max': self.get_parameter('max_speed').value,
16
            'kp': self.get_parameter('pid_kp').value,
17
        }

从 launch 文件传参#

1
from launch import LaunchDescription
2
from launch_ros.actions import Node
3
from launch.actions import DeclareLaunchArgument
4
from launch.substitutions import LaunchConfiguration
5

6
def generate_launch_description():
7
    return LaunchDescription([
8
        DeclareLaunchArgument('max_speed', default_value='2.0'),
9
        Node(
10
            package='r2_control',
11
            executable='control_node',
12
            parameters=[{
13
                'max_speed': LaunchConfiguration('max_speed'),
14
                'lookahead_min': 0.3,
15
                'pid_kp': 1.2,
16
            }]
17
        )
18
    ])

启动时传参：

1
ros2 launch r2_control control.launch.py max_speed:=1.5

运行时改参数#

程序跑着的时候，一行命令改参数：

1
ros2 param set /control_node max_speed 1.2
2
ros2 param set /control_node lookahead_min 0.5

不用重启程序，改完立刻生效（如果代码里处理了参数更新的话）。

参数更新回调#

要让参数改了立刻生效，注册一个回调：

1
class ControlNode(Node):
2
    def __init__(self):
3
        super().__init__('control_node')
4
        self.declare_parameter('max_speed', 2.0)
5
        self.v_max = 2.0
6

7
        # 注册参数更新回调
8
        self.add_on_set_parameters_callback(self.on_param_change)
9

10
    def on_param_change(self, params):
11
        for param in params:
12
            if param.name == 'max_speed':
13
                self.v_max = param.value
14
                self.get_logger().info(f'v_max updated to {param.value}')
15
        return SetParametersResult(successful=True)

26赛季的决策节点参数全是通过 ROS2 Parameter 加载的，红蓝区两套参数、zone1 路径点、DT35 目标值全在 launch 文件里。切红蓝区就是换一套参数，不用改代码。

不用 ROS2 的热重载方案#

如果你没用 ROS2，自己实现一个文件监听也很简单。思路是：起一个后台线程，每隔几秒检查 YAML 文件的修改时间，变了就重新读取。

1
import os
2
import time
3
import yaml
4
import threading
5

6
class ConfigWatcher:
7
    def __init__(self, path, callback, interval=2.0):
8
        self.path = path
9
        self.callback = callback
10
        self.interval = interval
11
        self._last_mtime = 0
12
        self._running = False
13

14
    def start(self):
15
        self._running = True
16
        threading.Thread(target=self._loop, daemon=True).start()
17

18
    def stop(self):
19
        self._running = False
20

21
    def _loop(self):
22
        while self._running:
23
            try:
24
                mtime = os.path.getmtime(self.path)
25
                if mtime != self._last_mtime:
26
                    self._last_mtime = mtime
27
                    with open(self.path) as f:
28
                        cfg = yaml.safe_load(f)
29
                    self.callback(cfg)
30
            except Exception as e:
31
                print(f"Config reload failed: {e}")
32
            time.sleep(self.interval)
33

34
# 用法
35
def on_config_change(cfg):
36
    global v_max, Ld_min
37
    v_max = cfg["pure_pursuit"]["max_speed"]
38
    Ld_min = cfg["pure_pursuit"]["lookahead_min"]
39
    print(f"Config reloaded: v_max={v_max}, Ld_min={Ld_min}")
40

41
watcher = ConfigWatcher("config/params.yaml", on_config_change)
42
watcher.start()
43

44
# 之后改 params.yaml 文件，2 秒内自动生效

这个方案比 ROS2 Parameter 轻量得多，但要注意：修改 YAML 文件的时候不要有语法错误，否则 yaml.safe_load 会抛异常。用 try-except 包住，加载失败就用上一次的配置。

哪些参数值得抽出来#

不是所有变量都要写进 YAML。判断标准：赛场上会不会调这个值？

该抽出来的	不用抽的
前瞻距离、速度上限	帧头 0xAA
PID 增益	循环里的计数器
路径点坐标	数学常量（π）
红蓝区标志	内部状态变量
超时时间	数据结构字段

原则：和物理世界打交道的参数抽出来，纯逻辑的东西不用抽。速度、距离、增益、超时这些是和底盘、场地、硬件绑定的，换一辆车就要改。帧头、校验方式这些是协议层面的，定了就不动。

调参的顺序#

赛场上时间有限，不能瞎调。推荐的顺序：

1
1. 先调前瞻距离 Ld
2
   → 蛇形走位？Ld 调大
3
   → 过弯切太多？Ld 调小
4
   → 这一个参数影响最大
5

6
2. 再调速度上限
7
   → 过弯打滑？降速
8
   → 直道太慢？提速
9
   → 和 Ld 配合调
10

11
3. 最后调控制参数（PID / 其他控制器的增益）
12
   → 这部分取决于你用什么控制器，具体怎么调看你自己的方案

不要一次改三个参数。改一个，跑一遍，看效果，再改下一个。同时改多个参数出了问题你不知道是哪个改坏了。

小结#

参数管理就一件事：把会变的东西和不变的东西分开。会变的写配置文件，不变的，很少变的写代码里面。

用 ROS2 的话自带 Parameter 系统，ros2 param set 一行命令改参数。不用 ROS2 的话写个文件监听，改 YAML 自动重载。

赛场上每多编译一次就少跑一次。参数热加载不是锦上添花，是直接决定赛前能调多少轮。

文章分享

如果这篇文章对你有帮助，欢迎分享给更多人！

现场调参与参数热加载

https://firefly-7a0.pages.dev/posts/rc/9params/

作者

lumivers

发布于