刚入坑 Simulink 的朋友，十有八九都绕不过倒立摆这道坎——但一上来就直接从 Simulink 基础库开始搭二阶倒立摆，确实容易劝退。今天分享一种更省心的玩法：用 Simscape 物理建模工具，基本不用手推复杂微分方程，就能把二阶倒立摆的机械本体“搭积木”一样搭出来，再配合简单控制器实现稳定控制。这篇内容会覆盖从模型架构、工具箱选择、刚体搭建、参数配置到控制闭环与常见报错排查的完整过程，适合刚接触 Simulink/Simscape、又想做二阶倒立摆仿真的小白直接参考复现，文末附整套可用的参数配置。

1. 为什么选 Simscape 搭倒立摆：先搞懂它和普通 Simulink 的区别

1.1 物理建模 vs 信号建模：选对工具少走一半弯路

很多新手第一次接触 Simulink 时，接触的都是信号流建模，也就是把微分方程拆成一堆积分、增益、求和模块，用信号线连起来。比如二阶倒立摆的状态方程里有 sin 和 cos 项，就把角度信号接入 Trigonometric Function 模块，再乘个系数，一路连下去。这套方式的好处是直观，但坏处也明显：一旦系统结构变化，比如从单摆改成双摆，或者从直线导轨改成旋转底座，整个信号流图基本要推翻重来。

Simscape 则完全不同。它走的是物理网络建模路线，模块之间的连线不代表信号，而代表能量流动。你用 Simscape Multibody 里的 Solid 模块定义摆杆的几何和质量，用 Revolute Joint 定义旋转关节，用 Prismatic Joint 定义小车的滑动导轨，系统会自动根据物理连接生成对应的运动方程。这就像搭积木一样，结构的修改成本远低于信号流建模。

我用一个实际体会来说明：之前我用纯 Simulink 搭过一个单级倒立摆，光是把运动学方程从拉格朗日方程推导到可编程的 Simulink 模块形式，就花了大半天。后来改用 Simscape Multibody 搭同样的模型，真正动手搭建时间不超过一小时，而且模型的可维护性和可读性明显更好。

1.2 二阶倒立摆为什么要用 Simscape

二阶倒立摆指的是在直线导轨上有一个小车，小车上方通过旋转关节连接第一个摆杆，第一个摆杆顶端再通过第二个旋转关节连接第二个摆杆。目标是让两级摆杆同时直立不倒。它比单级倒立摆难的地方在于：系统自由度从 2 个变为 3 个（小车位移、下摆角、上摆角），且存在严重的欠驱动特性和非线性耦合。纯 Simulink 信号流建模需要推导两组耦合微分方程，推导过程极其容易出错；而 Simscape 直接在三维物理空间里定义刚体和关节，系统会自动处理约束方程和耦合项。

另外，Simscape 模型天然带有物理单位，角度、质量、长度、转动惯量都可以按真实物理量填写。这意味着你可以把模型参数直接换成任何一套实际装置的参数，仿真结果与实验的对应关系非常紧密，后续如果要做硬件在环或者实际台架测试，Simscape 模型的迁移成本也低很多。

2. 模型整体架构与搭建顺序：先画好物理拓扑，再动手连线

2.1 明确系统组成的四个层级

在打开 MATLAB 之前，先把二阶倒立摆的物理结构在脑子里拆成四个层级。第一层是基座层，包括地面坐标系和导轨，小车在导轨上做一维直线运动；第二层是小车层，包括车体质量、驱动轮/丝杠传动的等效推力或位置输入；第三层是下摆层，通过旋转关节安装在小车上；第四层是上摆层，通过第二个旋转关节安装在下摆末端。

这四个层级对应到 Simscape Multibody 里，就是一条从 World Frame 开始的刚体链：导轨 → 小车刚体 → 下摆刚体 → 上摆刚体。搞清楚这条链的顺序非常重要，因为后续所有坐标系、关节、传感器都会挂在这条链上。搭模型时只要保持这个物理拓扑不变，中间某个刚体的具体尺寸、质量怎么改都不会破坏整体结构。

2.2 工具箱选择与模型库认知

搭建前先确认安装了 Simscape Multibody 工具箱。在命令行输入 ver 查找，或者在 MATLAB 的 Home 页面的 Add-Ons 里搜索“Simscape Multibody”安装即可。除了 Simscape Multibody，还需要基础 Simscape 工具箱和 Simulink Control Design（用于线性化分析和控制器设计）。这三件套基本是控制类仿真项目的标准配置。

启动 Simulink 后，在 Library Browser 左侧找到 Simscape 目录，展开后能看到 Multibody、Electrical、Fluids 等子库。我们只用 Multibody 子库中的几个模块：World Frame、Mechanism Configuration、Solid、Revolute Joint、Prismatic Joint、Rigid Transform、Bushing Joint、Transform Sensor、Joint Sensor 等。这些模块已经足够搭建完整的二阶倒立摆机械系统。

对于第一次接触 Multibody 的新手，我建议先花十分钟浏览一下 Multibody 子库的模块分类。Solid 模块负责定义刚体的几何、质量和惯性；Joint 模块定义刚体之间的约束关系；Rigid Transform 模块负责定义刚体内部的参考坐标系变换；World Frame 和 Mechanism Configuration 是每个模型必需的“锚点”和“全局配置”。理解这几类模块的作用，搭建过程就不会迷路。

3. 用 Simscape Multibody 搭建机械结构（纯实操）

3.1 新建模型并放置全局模块

首先在 MATLAB 命令行输入smnew或者手动新建 Simulink 模型，然后从 Simscape > Multibody > Frames 和 Utilities 中拖入两个必备模块：World Frame 和 Mechanism Configuration。前者是全局大地坐标系，所有机械链的起点；后者用来设置重力加速度等全局参数。双击 Mechanism Configuration，在 Gravity 向量里填[0 -9.81 0]。这里选择 Y 轴负方向为重力方向，是 Multibody 世界坐标系的常见约定，机械臂和移动机器人模型里也普遍采用这个方向。

接着在 Multibody > Bodies 中拖入两个 Solid 模块：一个作为小车，一个作为下摆杆，再复制出第二个 Solid 作为上摆杆。这里我习惯先把三个刚体的名称改成 Car、LowerPendulum、UpperPendulum，方便后续查找。改名的操作在模块属性窗口的 General 选项卡里修改 Name 字段即可，名称最好用英文且不要带空格，否则后续脚本和控制器引用容易出问题。

3.2 定义刚体几何、质量与惯性参数

双击 Solid 模块，进入 Geometry 选项卡。小车用默认的 Box 形状，长宽高分别设为 0.3m、0.15m、0.05m，这样看起来比较稳定，质量密度设为 2000 kg/m³，软件会自动计算质量，约 4.5kg。为了方便手动指定参数，我一般把 Type 从“By density”切换为“By mass”，直接填质量，这样后续调参更直观。你也可以保持密度方式，软件自动计算惯性张量，这通常是更物理准确的做法。

下摆杆选择 Cylinder 形状，半径 0.02m，长度 0.5m。这里要注意一个关键点：Solid 模块的几何中心默认在自身坐标系的零点。对于圆柱体，如果直接摆在小车上方，它的几何中心会出现在旋转关节位置，导致旋转轴其实穿过圆柱中心。这其实是符合物理直觉的——单摆的旋转轴确实在杆的中心？不对，倒立摆的旋转轴在杆的底部端点。所以需要做一次坐标系变换，让圆柱的一端对准旋转关节。

具体做法是在 Solid 模块的 Geometry 选项卡中，将 Cylinder 的 Length Direction 设置为 Z 轴，并在 Frame 选项卡中新增一个参考坐标系（Frame），位置设置为[0 0 -0.25]。这意味着 Solid 的质心在自身坐标系原点，而参考坐标系位于杆的底端，这样后续把这个参考坐标系与 Revolute Joint 连接时，旋转轴就落在杆的底端端点。这个操作是整个建模中最容易忽略的细节，很多新手搭出来的倒立摆看起来怪怪的，模型里杆绕着自己的质心旋转，根本不是绕底部转，大概率就是漏了这一步。

上摆杆参数类似，半径为 0.018m，长度为 0.4m，同样在 Frame 选项卡中设置[0 0 -0.2]的参考坐标系偏移。上下摆的质量都不必太大，0.3kg 左右比较合适，后续控制器整定的工作量也小一些。

3.3 搭建运动链：导轨、关节与刚体连接

从 Multibody > Joints 中拖入一个 Prismatic Joint 作为小车的直线导轨，一个 Revolute Joint 作为下摆的旋转关节，另一个 Revolute Joint 作为上摆的旋转关节。

连接顺序为：World Frame → Prismatic Joint → Car Solid → Rigid Transform → Revolute Joint 1 → LowerPendulum Solid → Rigid Transform → Revolute Joint 2 → UpperPendulum Solid。

这里的 Rigid Transform 模块是用来调整连接点位置的。先想清楚：小车 Solid 的底面中心应该落在导轨上。小车 Solid 的默认坐标系在几何中心，也就是高度 0.025m 处，连接 Prismatic Joint 时要把旋转/平移轴放到小车底面。可以在 Car Solid 的 Frame 选项卡里设置[0 -0.025 0]的偏移，或者加一个 Rigid Transform 模块来对齐。我实际操作时更倾向于改 Solid 的 Frame 偏移，模块数量越少，模型越清爽。

连接好之后双击 Prismatic Joint，设置轴的方向为 X 轴。这意味着小车只能沿 X 轴平动。再双击第一个 Revolute Joint，设置旋转轴为 Z 轴，确保摆杆在 XY 平面内摆动。第二个 Revolute Joint 同样轴设为 Z 轴。这样整个系统就限制在二维平面内，符合典型二阶倒立摆的物理模型假设。

还有一个默认配置被很多人忽略：Revolute Joint 的模式默认是 Automatically computed，意思是软件会根据连接的刚体自动决定运动范围。建议把 Mode 改为 State Target，并在 Sensor 选项卡中勾选 Position 和 Velocity 的测量。这样后续控制器可以直接读取角度和角速度，无需额外加传感器。对倒立摆来说，下摆角和上摆角的实时测量是控制系统反馈的基础，省掉这个勾选后续会很麻烦。

3.4 添加驱动输入与外部接口

小车的直线运动需要一个力或速度输入。在 Simscape Multibody 中，最常用的做法是用一个 Velocity Source 或 Force Source 驱动 Prismatic Joint。更标准的做法是在 Prismatic Joint 的 Actuation 选项卡中，把 Actuation 设置为 Provided by Input，然后从 Simscape > Foundation Library > Mechanical > Translational > Sources 中拖入一个 Force Source 模块，连接到 Prismatic Joint 的物理输入端口。

这一步牵涉到一个 Multibody 新手经常困惑的点：Simscape Multibody 关节输入是物理端口，而控制器输出是普通 Simulink 数值信号，二者需要用 Simulink-PS Converter 进行转换。同样地，从关节传感器出来的物理信号要进入 Simulink 软件控制器，需要用 PS-Simulink Converter 转换。我把这些转换模块统一放在一个子系统里，方便管理。

在 Prismatic Joint 的属性窗口，把 Actuation 选项卡中的 Force 选为 Provided by Input，然后在 Simscape > Utilities 中拖入 Simulink-PS Converter，其物理端连到 Prismatic Joint 的 Force 物理端口，信号端连到控制器的输出。Simulink-PS Converter 的参数页里有输入输出单位设置，我这里统一设置为 N（牛）。最后用一个 Inport 模块作为整个模型的控制器输入接口，一个 Outport 作为状态输出接口，整个机械部分就算搭完了。

到此，二阶倒立摆的“本体模型”已经闭环。可以先用一个 Constant 模块给小车加一个固定的 0 力，设置好所有初值后运行一次，看模型能否正常初始化。如果初始化报错，多数情况是刚体连接顺序或坐标系变换有问题，先排除这些再往下走。

4. 参数配置与初始化：从物理装置到仿真模型的关键映射

4.1 机械参数的完整配置表

经常有读者问“倒立摆模型到底要用什么参数？”我的建议是：先用一组稳妥的初始参数跑通，再逐步调节到对应实际装置。下面这组参数是我基于实验室常见的直线一级/二级倒立摆装置适配后的典型值，完全适合仿真验证：

4.2 转动惯量的两种配置方式

在 Solid 模块中，转动惯量的填写有两种方式。如果你选择了“By mass”模式，则软件会根据几何形状自动计算惯性张量，你只需要填质量。对标准圆柱体，自动计算的惯性张量一般准确可用。如果你需要手动指定，则在 Solid 的 Inertia 选项卡中，取消勾选“Automatically compute”，然后手动输入惯性矩阵。

一个比较隐蔽的坑是：惯性张量矩阵必须相对于 Solid 的质心坐标系输入。如果你的参考坐标系经过了偏移，手动填写的惯性张量却仍然以参考坐标系为基准，那动力学就会出错。稳妥的办法是先用自动计算模式，在仿真结果正常后再考虑是否手动微调。我建模时几乎总是用自动计算，只在需要建模“配重块”“偏心块”等特殊刚体时才手动指定。

4.3 关节阻尼与摩擦参数的设定

很多人会把模型里的关节阻尼全部设为零，结果仿真出来的系统很难收敛，控制器要输出很大的力才能稳住。这不符合真实物理系统。我在 Prismatic Joint 的属性窗口中，将 Internal Mechanics 选项卡里的 Viscous Friction 设为 0.1 N·s/m；在两个 Revolute Joint 中，将 Viscous Friction 设为 0.01 N·m·s/rad。阻尼的作用相当于在运动方程中加入线性的能量耗散项，数值不大但对数值稳定性和后续控制器的增益整定都有帮助。

这里原理上补充一句：倒立摆是一个典型的非最小相位系统，阻尼项的存在不会改变系统的本质不稳定性，但可以减小仿真过程中高频振荡的幅度。对 Simulink 求解器来说，这能有效避免不必要的步长缩减和收敛失败。

4.4 初始条件设定

在 Simscape Multibody 中，关节的初始角度不能通过给 Solid 模块改初始位置实现，而是必须在关节模块的 State Target 选项卡中设定。双击第一个 Revolute Joint（下摆），展开 State Targets 选项卡，把 Position 的 Value 设置为-0.1 rad（注意，正负号取决于你的坐标轴方向定义），Velocity 设置为 0。这里如果你之前把 x、y、z 轴的定义搞反了，初始角度的正负号也会跟着反，仿真结果会表现为摆锤直接倒下——这是很常见的“模型看着对但一仿真就塌”的原因之一。

第二个 Revolute Joint 同理，初始位置设置为0.1 rad。初始速度都为 0。小车初始位置设置 0，速度 0。设置完之后，整个机械系统就有了一个微小的初始偏移，这比完全直立（0 度）更有验证意义——如果控制器能在有初始偏差的情况下把摆拉回平衡点，那说明控制算法真正有效。如果完全从 0 度开始，即使控制器失效，模型也可能在数值误差的驱动下过一段时间才倒下，反而不利于调试。

5. 控制系统搭建：从 PID 到状态反馈控制的取舍

5.1 为什么纯 PID 容易让二阶倒立摆失控

很多初学者的第一反应是用 PID 控制器稳住倒立摆。但二阶倒立摆是一个四阶系统（状态量包括小车位移、下摆角、上摆角以及对应速度），两个输出角度，一个输入力。用一个 PID 控制器同时控制两个角度，本质上是把一个多输入多输出（MIMO）系统强行当作单输入单输出（SISO）系统来处理。这样做不是完全不行，但增益调节极其困难：一个通道的反馈会影响另一个通道的稳定性，很容易出现“下摆稳住了、上摆开始抖”的尴尬局面。

我个人的经验是：如果只是仿真验证，先用一个简化方案——状态反馈控制（极点配置或 LQR），把两个角度和小车位移都引入反馈，最简单的模型就能稳定。后面如果想要更贴近工程实际，再在状态反馈基础上加积分项来消除稳态误差。

5.2 LQR 控制器的 Simulink 实现

这里推荐用 LQR 控制器，因为它的参数配置有明确的物理含义，不需要凭直觉调增益。LQR 的目标是设计状态反馈增益矩阵 K，使得二次型性能指标达到最小。在 MATLAB 命令行中，先运行模型生成了状态空间矩阵 A、B，再调用lqr函数计算 K。

二阶倒立摆的线性化状态方程可以写为：

dx/dt = A x + B u

其中状态向量 x = [X dX θ1 dθ1 θ2 dθ2]，θ1 是下摆角，θ2 是上摆角。

在我的仿真中取 Q 矩阵为对角阵，对角线对应各个状态变量的权重：小车位移权重 100，小车速度权重 10，下摆角权重 1000，下摆角速度权重 50，上摆角权重 1000，上摆角速度权重 50。R 取 1。调用的命令为：

Q = diag([100 10 1000 50 1000 50]); R = 1; K = lqr(A, B, Q, R);

计算出的 K 就是一个 1x6 的矩阵，对应六个状态量的反馈增益。在 Simulink 中搭建一个增益矩阵模块（Gain），把 K 填进去，输入为六个状态量，输出为控制量 u。这里需要特别注意：从 Simscape 传感器出来的物理信号（角度、角速度、位移、速度）需要通过 PS-Simulink Converter 转换为纯数值信号，然后借助 Demux 或 Bus Selector 按状态向量顺序排列，再进入 Gain 模块。

5.3 控制量限幅与执行器饱和

任何实际执行器都有输出上限。我设置控制力限幅为 ±50N，这在实际小型倒立摆装置上已经算是比较大的驱动力。实现方式很简答：在 Gain 模块输出后串联一个 Saturation 模块，上下限分别设为 50 和 -50。这一步看似简单，但如果没有限幅，LQR 在初始偏差较大时可能输出上百牛的力，仿真曲线看起来非常“理想”，但对应到实际台架上根本无法实现，等于白做。

5.4 仿真求解器配置

双击模型空白处打开 Model Settings，在 Solver 选项卡中，将求解器类型设为 Variable-step，求解器选 ode45（Dormand-Prince）。Max Step Size 设置为 0.001s，仿真时间先设 10s。Simscape 模型默认使用自动步长，但 max step 设得太大时，关节碰撞和高速摆动的数值会出现明显不连续，导致结果震荡。0.001s 是一个安全而有效的默认选择，兼顾仿真速度和精度。

另外一个必须注意的选项是 Simscape 模型的“Local Solver”配置。双击 Mechanism Configuration 模块，或者进入 Model Settings > Simscape Multibody，把“Do not use local solver”保持默认。新手往往会在求解器报错后试图开启 Local Solver，但本地求解器主要用于大型多体动力学系统的加速，对倒立摆这种规模不大的模型反而可能引入额外的数值误差。

6. 搭建过程中最常踩的坑：报错排查与仿真调优

6.1 Simscape 初值一致性检查失败

这是新手遇到频率最高的问题。模型搭建完成后，点击运行，直接弹出类似“Initial conditions are not consistent”的报错。原因通常有几种：刚体之间互相穿透未检测到、关节初始位置和机械约束矛盾、或者两个刚体重合导致自由度约束重叠。排查方法分三步：

先检查是否有两个 Solid 模块的位置几何关系有重叠。双击每个 Solid 查看几何尺寸，特别关注同一位置的上下摆连接处。比如下摆长 0.5m，上摆长 0.4m，两级之间的 Rigid Transform 偏移必须和杆长匹配，否则会出现“杆已经插入小车内”这种几何冲突。

再检查关节方向是否和实际物理运动匹配。如果 Revolute Joint 的旋转轴设成 X 轴，而摆杆的设置沿 Z 轴伸展，那么初始时刻关节角为 0 时摆杆“横着”而不是“竖着”，系统为了满足约束会给出不一致初值。这里我的经验是：先不管运动学细节，把摆杆的初始几何设置为与重力方向一致（竖直），再在关节里设一个小角度偏移，这样模型初始化最稳定。

还要检查 Rigid Transform 的位移单位是不是填错了。Simscape 默认单位是米，如果有人在 Transform 里把 0.5 写成了 5，那整个模型会放大十倍，初值检查大概率失败。

6.2 仿真发散（NaN）的排查顺序

模型初始化正常，但仿真跑到一秒钟左右数值直接发散，曲线变成一条竖线。这个问题多数和三个因素有关：初值过大、控制增益过大、求解器最大步长过大。先把初始角度从 0.1 rad 减到 0.05 rad，如果模型能稳住，说明控制器在较大初始偏移下饱和了，可以适当增大控制力限幅，或者重新调节 LQR 权重。

把 Max Step Size 从 0.001 改为 0.0005，观察发散时间点是否明显延后。如果是，说明原步长下的数值积分误差已经影响了系统稳定性，减少步长即可。

检查 Saturation 限幅是否合理。如果 LQR 算出的控制量常常顶在限幅值上，说明系统已经饱和，需要重新设计控制器或者放宽限幅。

6.3 角度传感器输出一直抖

传感器输出极其毛糙、充满高频噪声，这个在 Simscape 仿真里往往和被控对象的阻尼设置有关。查看关节模块的 Viscous Friction 是否为 0，如果是，给两个旋转关节各加 0.01 的阻尼。物理意义上，任何真实转动副多少都有阻尼，零阻尼模型等同于理想刚体转动，数值求解时更容易激发高频模态。

另外检查传感器转换模块 PS-Simulink Converter 输出端口的数据类型和采样时间设置。把 Sample Time 设为 0 或 -1（继承），避免因信号采样时间不匹配产生人为的阶梯状波形。如果输出信号仍有高频毛刺，可以在控制器前加一个低通滤波器，截止频率设为 50Hz 左右，这在实际嵌入式系统中也常见。

6.4 如何快速判断模型动力学是否正确

这一步很关键。在搭好模型、还没接入控制器之前，先做一个“自由落体测试”：把两个关节初始角度设为 45°，Simulink-PS Converter 输入力设为 0，运行 2 秒，观察两个摆杆角度曲线。如果模型动力学正确，摆杆会自然倒下并在导轨上来回滑动，曲线平滑、符合能量守恒，且有因摩擦阻尼导致的轻微衰减。如果曲线出现剧烈跳动或者明显不连续，说明刚体连接、坐标系方向或关节方向存在错误，先修这步再谈控制。

这个“先本体、后控制”的思路适用于所有 Simscape 机械模型。很多新手把机械模型和控制器一次性搭好，出问题时很难分清是物理建模错误还是控制参数问题。分开验证，定位效率高得多。

7. 调参经验和后续扩展：几点个人体会

第一次跑通模型时，不要急着上复杂算法。先把 LQR 的权重 Q、R 按照“角度权重 > 位置权重 > 速度权重”的经验设置，仿真时间 5 秒足够看出趋势。如果下摆稳了但上摆还在小幅震荡，就增大上摆角对应的 Q 权重；如果小车一直漂移回不到原点，就增大小车位移的 Q 权重。LQR 的优势在于：Q 矩阵对角元素每次只动一个，增益矩阵变化可控，调试过程远比手动调 PID 直观。

另外，在 Simscape Multibody 模型基础上，可以继续做很多扩展：把直线导轨换成圆弧导轨、把刚性杆换成柔性杆、加入弹簧阻尼器模拟实际关节间隙、甚至导成 FMU 模型用于联合仿真。这也是我为什么强调一定要用 Simscape 建模——它的模型天然支持这些扩展，而纯信号流模型每改一次结构都要重新推导并重搭一大片模块。

最后再提醒一句：做这类控制仿真，最重要的不是模型本身，而是你对系统物理特性的理解。Simscape 帮你省下了推导微分方程的时间，但也意味着你更要清楚每个参数在自己的真实装置上对应什么零部件。模型跑通之后，试着把初始角度调到 0.2 rad，看看控制器能不能拉回来；再把阻尼调到接近零，看看模型会不会发散。多折腾几次，你会对这个系统真正建立起直觉。这台模型是可以玩很久的试验台，祝各位都能顺利把两级摆“立”起来。