1. 曲率约束基础：曲率的数学定义、曲率半径、曲率与路径平滑度的关系
各位工程师朋友，咱们今天聊聊曲率约束。说实话，这玩意儿在路径规划里是个绕不开的坎儿。我刚开始做AGV导航那会儿，就吃过曲率没算好的亏——车拐弯时直接蹭墙了。嗯，从那以后，我对曲率就格外上心。
1.1 曲率的数学定义
曲率，说白了就是描述曲线弯曲程度的量。你想想看，一条直线它弯不弯？肯定不弯，曲率就是0。那一个急转弯呢？弯得厉害，曲率就大。
数学上，曲率κ的定义是这样的：
κ = |dθ/ds|其中θ是切线与x轴的夹角，s是弧长。这个公式的意思是：单位弧长上，切线方向的变化率。
我个人习惯用另一种更直观的形式——对于参数曲线r(t) = (x(t), y(t))：
κ = |x'y'' - y'x''| / (x'² + y'²)^(3/2)看着复杂？其实你只要记住：曲率是曲线弯曲程度的量化指标。我在项目中遇到过不少同事，一看到这个公式就头大，但实际用起来，大部分时候我们只需要知道曲率不能超过某个阈值就够了。
核心要点：曲率κ的单位是1/米，表示每米弧长上切线方向转过的弧度。
1.2 曲率半径
曲率半径R，就是曲率的倒数：
R = 1/κ这个物理意义很直观：曲线在某点处，可以用一个圆来近似，这个圆的半径就是曲率半径。圆越大，曲率越小；圆越小，曲率越大。
| 曲线类型 | 曲率κ | 曲率半径R |
|---|---|---|
| 直线 | 0 | ∞ |
| 半径为r的圆 | 1/r | r |
| 急转弯 | 大 | 小 |
举个例子：你家小区门口那个转弯，如果半径是5米，那曲率就是0.2。换成高速公路的匝道，半径可能50米，曲率就只有0.02了。差别很大吧？
实用技巧：做路径规划时，我建议先把曲率半径换算成更直观的东西——比如车辆的最小转弯半径。如果路径的曲率半径小于车辆的最小转弯半径，那这条路就走不通。
1.3 曲率与路径平滑度的关系
这里有个关键概念：路径平滑度。它跟曲率直接相关，但不是一回事。
平滑度，我个人的理解是：曲率的变化率。你想想看，如果一段路径上曲率突然从0跳到0.5，那车开过去肯定猛打方向盘，乘客会很不舒服。这就是平滑度差的表现。
数学上，我们用曲率对弧长的导数dκ/ds来量化平滑度：
- dκ/ds = 0：曲率不变，比如直线或圆弧，最平滑
- dκ/ds 较小：曲率缓慢变化，比如回旋线，比较平滑
- dκ/ds 较大：曲率突变，不平滑，容易导致控制问题
我曾经在一个项目中，用三次样条插值生成路径，结果曲率在连接点处不连续。车跑起来一抖一抖的，像在跳探戈。后来改用五次样条，保证了曲率连续，问题就解决了。
避坑指南：我曾经以为只要路径连续就行，结果吃了大亏。记住：路径连续只是最低要求，曲率连续才是工程上的及格线。如果条件允许，尽量保证曲率变化率也连续。
1.4 知识体系总览
下面这张图，是我梳理的曲率约束知识框架。你可以把它当作本章的思维导图：
1.5 实际工程中的曲率约束
说了这么多理论，咱们聊聊实际怎么用。在路径规划中，曲率约束通常表现为两个层面：
- 硬约束：曲率不能超过车辆/机器人的最大允许曲率。这是底线，碰了就出问题。
- 软约束：曲率变化率要尽量小。这是优化目标，影响乘坐舒适度和跟踪精度。
我记得有一次做仓储机器人项目，路径规划算法跑出来的路径曲率都满足要求，但实际跑起来就是抖。查了半天，发现是曲率变化率太大，电机响应跟不上。后来在代价函数里加了曲率变化率的惩罚项，问题就解决了。
工程经验：做路径规划时，我建议把曲率约束放在优化问题的约束条件里，而不是事后检查。事后检查就像考试完才看答案——发现问题也晚了。
好了，曲率约束的基础就聊到这儿。记住三个关键词：曲率、曲率半径、平滑度。它们是路径规划里最基础也最重要的概念。下一节咱们会深入讨论曲率约束在具体路径规划算法中的应用。
可可精品资料库