【Simscape】三维物理仿真实战：PID控制器在倒立摆系统中的调参与优化

1. 从零开始：在Simscape中搭建你的第一个倒立摆

大家好，我是ReadAir。今天我们来聊聊一个经典的控制问题——倒立摆，并且用Matlab的Simscape工具箱，在三维物理仿真环境里把它“驯服”。如果你之前觉得物理仿真和控制理论高深莫测，那这篇文章就是为你准备的。我会手把手带你，从一个空白的Simulink模型开始，一步步搭建出一个能真实反映物理规律的三维倒立摆，然后给它装上“大脑”——PID控制器，最后再一起调参，让它稳稳立住。

为什么是倒立摆？因为它太经典了。小到我们玩的平衡车，大到火箭发射时的姿态控制，其核心的物理模型都和倒立摆有千丝万缕的联系。可以说，搞懂了倒立摆的控制，你就摸到了机器人、航空航天等领域控制问题的门道。而Simscape这个工具，能让我们摆脱繁琐的数学公式推导，直接在视觉上“搭建”出一个物理系统，传感器、执行器、连接关系一目了然，仿真结果还自带三维动画，非常直观。

那么，在Simscape里搭建一个倒立摆，我们需要哪些“零件”呢？核心就两个：一个能在轨道上自由滑动的小车（滑块），和一根与小车顶部铰接的摆杆。在Simscape的“多体”（Multibody）库中，我们可以找到这些基本元素：刚体（Rigid Body）用来定义小车和摆杆的质量、尺寸和外形；关节（Joint）用来定义它们之间的连接和运动关系。对于小车，我们使用 “三轴平动关节” （Prismatic Joint），它允许小车沿着轨道（比如Y轴方向）滑动。对于摆杆，我们使用 “旋转关节” （Revolute Joint），将它铰接在小车上，使其能在垂直于轨道的平面内自由旋转。

搭建过程就像搭积木。首先，你需要从Simulink库浏览器中找到Simscape -> Multibody -> Bodies，拖出两个“刚体”模块，分别代表小车和摆杆。接着，从Joints库里拖出上述两种关节模块。然后，用“机械参考系”（Mechanism Configuration）模块设置好重力等环境参数，并用“世界坐标系”（World Frame）和“刚体变换”（Rigid Transform）模块来定位和组装这些部件。关键的一步是正确连接这些模块的“端口”（Frame Port）：关节的一端（基础端Base）连接到上一个刚体或世界坐标系，另一端（跟随端Follower）连接到下一个刚体。这样，一个物理连接关系就建立起来了。我建议你一开始不要追求复杂的造型，先用简单的长方体（小车）和细长圆柱体（摆杆）来构建模型，把重心放在理解物理连接和控制逻辑上。

2. 让系统“活”起来：添加传感器与执行器

模型搭好了，但它还是个“植物人”，既感觉不到自己的状态，也无法对外界做出反应。要让这个倒立摆系统成为一个能被控制的闭环系统，我们必须给它装上“眼睛”（传感器）和“手脚”（执行器）。这对应着控制理论中“能观”与“能控”两个基本概念。

首先，我们来添加“眼睛”。我们需要知道摆杆当前的角度和角速度，这是控制它立起来的关键状态信息。幸运的是，Simscape的关节模块内置了传感器选项，我们无需额外建模。具体操作是：双击连接摆杆的 “旋转关节” 模块，在属性对话框中找到 “传感器” （Sensing）一栏。你会看到里面有很多可测量的物理量，对于我们这个案例，勾选 “位置” （Position）和 “速度” （Velocity）即可。这里的“位置”对于旋转关节来说就是旋转角度（通常用q表示），“速度”就是角速度（用w表示）。点击应用（Apply）后，你会发现这个关节模块上多出了两个物理信号（Physical Signal）输出端口，这就是我们实时获取的摆杆角度和角速度。你看，Simscape把复杂的传感器建模简化成了勾勾选选，非常方便。

接下来，是添加“手脚”——也就是执行器。我们的控制目标是让摆杆倒立，而直接的控制手段是让小车在轨道上来回移动，通过加速度来“扶住”摆杆。因此，执行器的作用就是给小车施加一个水平方向（Y轴）的力。操作对象是控制小车运动的 “三轴平动关节” 。双击它，在属性中找到 “驱动” （Actuation）一栏。对于“受力”（Force）选项，我们选择 “由输入提供” （Provided by Input）；对于“运动”（Motion），选