第三章：基础数学知识回顾——导数与积分、泰勒展开、插值与拟合、贝塞尔曲线基础
各位同学，欢迎来到实战课的基础篇。说实话，很多做运动控制的工程师，最后卡住的往往不是算法本身，而是数学。我见过太多人拿着PID调了半天，结果连加速度的导数关系都没理清。今天咱们就把这些基础工具过一遍，别怕，都是干货。
3.1 导数与积分：运动的语言
运动控制里，导数就是变化率。位置对时间求导是速度，速度对时间求导是加速度。反过来，加速度积分得到速度，速度积分得到位置。就这么简单。
我个人的习惯是，在写任何轨迹规划代码之前，先把这三个量的关系画出来。你想想看，如果加速度曲线不连续，那速度曲线就会出现拐点，电机就会抖。
核心公式：
- 速度：v(t) = ds/dt
- 加速度：a(t) = dv/dt = d²s/dt²
- 位移：s(t) = ∫v(t)dt
我在项目中遇到过一个问题：用梯形速度曲线做点焊机器人，结果焊点总是偏移。后来发现是加速度突变导致的振动。从那以后，我所有轨迹都要求加速度连续。
3.2 泰勒展开：用多项式逼近任意函数
泰勒展开说白了，就是用一堆多项式去拟合一个复杂函数。你不需要知道函数长什么样，只要知道它在某点的各阶导数，就能近似出来。
f(x) ≈ f(a) + f'(a)(x-a) + f''(a)(x-a)²/2! + ...为什么运动控制里要用它？因为我们的控制器只能处理多项式形式的轨迹。比如S型速度曲线，本质上就是分段的多项式。泰勒展开给了我们一个工具，把任意光滑曲线变成可执行的多项式。
实用技巧：实际工程中，取到二阶或三阶就够了。取太高阶反而容易过拟合，而且计算量大。我曾经试过取到五阶，结果在嵌入式芯片上跑不动，得不偿失。
3.3 插值与拟合：离散点的艺术
传感器采集到的数据都是离散的。插值就是让曲线精确穿过每个已知点，拟合则是找一条最接近所有点的曲线。
| 方法 | 特点 | 运动控制应用 |
|---|---|---|
| 线性插值 | 简单，但导数不连续 | 点位运动 |
| 三次样条插值 | 二阶导数连续，平滑 | 连续轨迹控制 |
| 最小二乘拟合 | 抗噪声，不强制过点 | 传感器数据滤波 |
嗯，这里要注意：插值不是越多点越好。我记得有一次做六轴机器人轨迹，用了100多个插值点，结果曲线振荡得厉害。后来改用三次样条，只用了20个关键点，反而更平滑。
避坑指南：我曾经在高速龙门架上用线性插值做路径，结果在拐角处电机剧烈抖动。原因是线性插值的一阶导数不连续，导致速度突变。后来换成三次样条，问题就解决了。
3.4 贝塞尔曲线基础
贝塞尔曲线是图形学和运动控制里的老朋友。它的核心思想是用控制点来定义曲线形状，而不是用方程。
二阶贝塞尔曲线的公式：
B(t) = (1-t)²P₀ + 2(1-t)tP₁ + t²P₂, t∈[0,1]三阶的就更常见了：
B(t) = (1-t)³P₀ + 3(1-t)²tP₁ + 3(1-t)t²P₂ + t³P₃为什么运动控制喜欢用贝塞尔？因为它的导数也是贝塞尔曲线，计算方便。而且曲线始终在控制点构成的凸包内，不会出现意外的振荡。
我的经验：在AGV路径规划中，我常用三阶贝塞尔曲线做转弯。只需要设置起点、终点和两个控制点，就能生成平滑的转弯路径。比圆弧路径更灵活，而且曲率连续。
你想想看，如果直接用圆弧转弯，曲率是突变的。但贝塞尔曲线可以做到曲率连续变化，这对高速运动的稳定性至关重要。
这张图把今天的内容串起来了。导数积分是基础工具，泰勒展开是理论支撑，插值拟合是实践手段，贝塞尔曲线是具体实现。四者缺一不可。
学习建议：别急着背公式。先理解每个工具解决什么问题。比如遇到速度不平滑，先想是不是导数不连续；遇到路径振荡，先想是不是插值点太多。带着问题去学，效率高得多。
好了，这一章的内容就到这里。数学是工具，不是目的。后面我们会把这些工具一个个用到实战中，到时候你会发现，原来这些公式这么有用。