质量块导纳控制Simulink程序：模型搭建、参数整定与常见问题排查

简介：面向单质量块导纳控制仿真验证的Simulink程序包，适用于学习阻抗/导纳控制基础原理的机器人或自动化方向学生与工程师。程序基于MATLAB 2019b搭建，共含5个文件，包括1个slx模型和4个m脚本，分别对应导纳控制算法实现、被控对象动力学建模以及期望输入生成等模块，压缩包整体仅27KB，结构精简清晰，代码与模型便于快速载入运行和按需修改。已有3979人学习下载，常作为从控制理论过渡到仿真的入门范例，尤其适合课程设计与毕业设计参考。程序思路可对照Ott等人在2010年ICRA论文中给出的统一阻抗与导纳控制框架，通过调节期望输入、质量参数与控制增益观察单质量块响应，帮助理解导纳控制与阻抗控制的联系和区别，也便于后续扩展到多自由度机械臂力位控制场景；还可替换对象模型的阻尼、刚度等参数，开展不同工况下的验证实验。

1. 质量块导纳控制simulink程序：先搞清楚这个仿真到底在解决什么问题

质量块导纳控制simulink程序，说白了就是把“外力”换算成“参考位移”的一套虚拟质量块动力学模型。你给控制系统一个接触力，它输出一台位置指令，让机械臂或运动平台表现得像一块有质量、有阻尼、拉着弹簧的物体。没有力时它不动，有力时它被“推开”，推开的快慢和幅度由目标惯量、目标阻尼、目标刚度三个参数决定。做机器人装配、打磨、人机共融的人，几乎都会碰到这个东西：力控效果调得不顺，问题往往不在后面的位置环PID，而在这个质量块导纳环节没搭对。本文适合三类读者：正在Simulink里搭力控仿真的人，被接触力振荡折磨的设备调试工程师，以及想把导纳理论真正转成可运行模型的同学。我会从数学模型讲到两种落地写法，再给出参数整定和排错清单，照着搭就能出结果。

2. 质量块导纳控制的模型基础：怎么在Simulink里把力变成位移

2.1 导纳控制与阻抗控制：作用方向相反，但经常被混为一谈

导纳控制解决的是“系统对外力如何响应”的问题，它接收力传感器读到的接触力，输出一个期望运动量，也就是让机构“顺着力的方向走”。阻抗控制正好反过来，它接收位置偏差或速度偏差，输出一个反作用力，让机构表现出抵抗运动的效果。两类控制器在数学上互为对偶，但在Simulink模型里的信号流方向完全不同：导纳外环把力传感器信号直接接到质量块模型上，产生位置参考指令；阻抗外环则是把位置误差送进弹簧阻尼模型，产生力矩补偿量。

工程上选哪一个，取决于你的执行层能控制什么。大多数工业机器人底层是位置控制模式，只能接收位置指令，所以上层交互控制都做成导纳形式：外环负责生成柔顺的参考位置，内环位置伺服负责跟踪。反过来，如果你的驱动器支持力矩模式且带宽足够高，才有可能做阻抗控制。这也是为什么“质量块导纳控制Simulink程序”在实际项目里出现频率远高于阻抗控制的原因——它和现有的位置伺服体系兼容性最好。

有一点容易踩坑：很多人把导纳控制和“柔顺控制”画等号，但柔顺控制的柔顺程度并不是随便设的。目标刚度决定了在恒定外力下机构退让的多少，目标阻尼决定了退让过程中振不振荡，目标惯量决定了力的突变会不会引起加速度冲击。这三个参数之间互相牵制，只有一个单独调的模型在简单阶跃仿真里看着不错，一旦接到位置内环上就会出现延迟和共振问题。

2.2 质量块受力方程与Simulink信号流的一一对应

质量块导纳模型的标准时域方程是：

F_ext = M_d · a + B_d · v + K_d · x

其中F_ext是外力，M_d是目标惯量（等效质量），B_d是目标阻尼，K_d是目标刚度，a是加速度，v是速度，x是位移。这个方程的真实含义是：外力的一部分用来给虚拟质量块加速，一部分被阻尼消耗掉，剩下的一部分压在虚拟弹簧上。把它改写成加速度表达：

a = (F_ext - B_d · v - K_d · x) / M_d

这个式子就是Simulink模型的基本骨架。你可以直接用两个积分器串联完成“加速度→速度→位移”的变换，再把速度和位移反馈回来参与计算，形成闭环。对应到信号流里，就是下面这张最小结构：

% 纯Simulink版本的最小模块结构 % 输入：外力信号 F_ext % 输出：参考位移 x_ref % % 模块排列顺序如下： % F_ext ---> [加减运算 Sum] ---> [增益 Gain 1/M_d] ---> [积分器 Integrator v] ---> [积分器 Integrator1 x_ref] % ^ | % |----)<---[增益 Gain B_d]<---- 速度信号 v <----------------------| % |----)<---[增益 Gain K_d]<---- 位置信号 x_ref <------------------|

这里每个模块都有明确物理含义，Gain 1/M_d模块算出加速度，它的输入是外力减去阻尼力和弹簧力后的合力，输出单位是m/s²。第一个积分器把加速度积分成速度，第二个积分器把速度积分成位移。Gain B_d模块让速度产生阻尼力，Gain K_d模块让位置产生弹簧力，两个反馈量都从合力中扣除，整个模型就是前面那个二阶微分方程的机械式展开。

在Simulink里，Sum模块的符号列表要填成“+|−|−”，意思是第一个输入加外力，第二个输入减阻尼力，第三个输入减弹簧力，顺序不要弄反。积分器Initial condition都必须设为0，否则初始时刻就已经有了速度和位置，模型一启动就是错的。单位也要统一，建议全程用SI单位，力给N，质量给kg，阻尼给N·s/m，刚度给N/m，这样位移就是米，不会出一堆数量级换算的毛病。

如果你用传递函数的方式实现，质量块导纳模型可以写成：

X(s) / F(s) = 1 / (M_d · s² + B_d · s + K_d)

这恰好对应MATLAB里的一个传递函数对象。我会在下一章给出具体搭建方式，先记住一点：分母二次项系数是M_d，一次项是B_d，常数项是K_d，顺序别颠倒了。

2.3 为什么用“质量块”二阶模型而不是简单的比例增益

有人会问这样一个问题：既然导纳控制最终输出的是参考位置，那干脆用F除以K_d直接算位移不就行了？理论上稳态确实是这样，但力是动态变化的，接触过程里力的突变非常常见。如果直接用比例关系，力一突变位移就突变，速度指令会瞬间跳变，位置内环根本跟踪不上，末端机构就会抖动甚至弹开。

加了质量块惯性项之后，情况完全不一样。外力突变时，加速度先突变，但速度和位置是通过积分得到的，连续变化不会跳变。这就像汽车撞到软垫：弹簧决定最后被推开多少，阻尼决定回弹是否振荡，而质量和加速度的关系决定了撞上瞬间的冲击感。二阶模型能表现这种“力先到、运动后到”的动态过程，一阶和比例模型都做不到。

还有一个实际原因是内环兼容性。位置内环是有限带宽的，通常只有几赫兹到几十赫兹。如果导纳外环输出的参考轨迹变化太陡，内环跟踪误差就会很大。质量块模型本质上是一个二阶低通滤波器，把高频的力信号滤掉一部分，输出的参考位移变得平滑，位置内环才能跟得上。这也是为什么我们说质量块中的M_d不能随便给个极小值——M_d太小意味着加速度很大，参考轨迹变化过快，内环更容易“甩飞”。

3. 搭建最小可跑通的质量块导纳控制simulink程序：两种写法都能复现

3.1 纯Simulink写法：两个积分器和三个增益搭出1/(M_d·s²+B_d·s+K_d)

我一般建议先把纯Simulink版本跑通，因为它简单、没有物理域转换器，很快就能看到阶跃响应长什么样。新建一个空模型，拖入Step信号模块作为外力输入，阶跃时间设为0.1s，阶跃值设为20N，Initial value设为0。再拖入两个Integrator，第一级用来输出速度，第二级用来输出位移。拖入三个Gain模块，分别设置成1/M_d、B_d、K_d，最后拖入一个Sum模块把反馈的量减掉。

模块之间的连线方式就是上一章那张结构图：Step输出接Sum第一个输入，Sum输出接1/M_d的Gain，再接速度积分器。速度积分器输出分三路：一路直接接第二个积分器生成位移，一路接B_d增益反馈回Sum减号端口，位移输出再接K_d增益反馈回Sum另一个减号端口。注意要把Sum模块的符号设置修改为“+|−|−”，否则默认的“+++”会变成不稳定的正反馈。第一个积分器输出是v，第二个是x_ref，连接到Scope模块观看。

为了快速验证模型的传递函数是否正确，我通常会在工作区里先跑一段MATLAB代码确认极点位置和阶跃响应形状，代码如下：

% 设置质量块导纳控制参数 Md = 2.0; % 目标惯量/等效质量，单位 kg Bd = 20.0; % 目标阻尼，单位 N*s/m Kd = 50.0; % 目标刚度，单位 N/m % 导纳模型传递函数：X(s)/F(s) = 1/(Md*s^2 + Bd*s + Kd) G_adm = tf(1, [Md, Bd, Kd]); % 查看1N阶跃力下的位移响应，2秒窗口 step(G_adm, 2); grid on; title('质量块导纳模型 1N 阶跃响应'); % 查看系统极点，判断阻尼状态 damp(G_adm);

这段代码里，damp函数会列出极点实部、虚部、阻尼比和无阻尼自然频率。对于Md=2、Bd=20、Kd=50这套参数，临界阻尼比的计算公式是B_d除以两倍根号下M_d·K_d，算出来大约是1.0，也就是刚好处于临界阻尼状态，阶跃响应没有超调且收敛很快。这个速度在后面的工程整定里很重要，Bd太小会看到明显的超调振荡，Bd太大又会让位移响应变慢，看起来像一条爬行曲线。

纯Simulink版本的好处是状态量全部可见，中间速度信号还能顺便拿来当地速前馈。如果你打算做嵌入式代码生成或者快速原型验证，这种结构也可以直接作为模型参考，不需要额外的Simscape License。缺点就是它只反映导纳模型本身，没有质量块、弹簧、阻尼器这些物理元件的真实位移和约束关系，遇到复杂机构要另外再建动力学模型。

3.2 Simscape物理写法：质量块加弹簧阻尼器加力源的真实物理连接

如果你希望在模型里看到真实的物理质量块和弹簧阻尼器，那就要用Simscape来搭。这种方法更适合做系统级动力学仿真，比如把一个导纳质量块和机械臂关节连同起来看整机响应。它的模块清单包括：Solver Configuration、Ideal Force Source、Mass、Spring-Damper、Mechanical Translational Reference、Translational Motion Sensor、Simulink-PS Converter和PS-Simulink Converter。

连接顺序要特别注意。Simulink里的Step力信号先经过Simulink-PS Converter转成物理信号，接到Ideal Force Source的S端口，力源输出端接到Mass的C端口。Mass的R端口再串联一个Spring-Damper，弹簧阻尼器另一端接到Mechanical Translational Reference（相当于地面参考）。Translational Motion Sensor的一端接在Mass的R端口处，另一端接在参考地上，这样测出来的就是质量块相对地面的绝对位移，再经过PS-Simulink Converter转回Simulink信号输出。

% 在模型初始化脚本中定义Simscape物理域参数 mdl = 'adm_mass_simscape'; % 导纳物理模型参数 Md = 2.0; % 质量块质量，kg Bd = 20.0; % 弹簧阻尼器阻尼系数，N*s/m Kd = 50.0; % 弹簧阻尼器刚度，N/m F_step = 20.0; % 阶跃力幅值，N % 将参数写入基础工作区，供Simulink模块参数使用 assignin('base', 'Md', Md); assignin('base', 'Bd', Bd); assignin('base', 'Kd', Kd); assignin('base', 'F_step', F_step); % 打开模型（假设模型文件已经创建好） open_system(mdl);

这里要特别说明Simscape和纯Simulink的本质区别：纯Simulink的积分器是理想的数学积分器，而Simscape里Mass块是物理运动方程求解，两者之间带跨域转换器。跨域转换器本身有离散时间效应，在高速力控仿真里会引入微小延迟。如果在Solver Configuration里把步长设得太大，位置响应会和纯数学版本有差别，这是物理建模的正常现象，并不是模型写错了。

物理版的好处是你可以直接在这个基础上扩展，比如给弹簧并联一个限位模块模拟机械限位，或者在质量块旁边加一个摩擦力源模拟导轨摩擦力。物理元的参数和真实设备一一对应，调完之后可以比较有把握地映射到实际硬件参数上。缺点是Simscape求解和转换器配置会麻烦一些，而且模型初始化比纯Simulink慢，调试循环周期会长不少。

3.3 求解器、采样时间与初始条件：模型打开第一步就要设对

我见过很多质量块导纳模型刚跑就能看到位移输出异常，问题根源之一就是求解器设置不对。纯Simulink数学版本如果只用默认Variable-Step和ode45，一般能跑，但当地面刚度很大时容易算得慢；Simscape物理版本则建议在Solver Configuration里启用Local Solver，并选择合适的Backward Euler或ODE23t方式。

求解器选型有个简单原则：如果你的参数组合里K_d和M_d的比值很大，比如刚度几千、质量零点几，系统自然频率就会很高，刚性也变强，必须把求解器换到ode15s或ode23t这类刚性求解器。否则普通ode45会自动把步长缩到很小，仿真时间会拉得很长。采样时间方面，我习惯在模型配置里把Max step size设为0.001秒，这样在大多数低速接触力场景下精度足够，又不至于让仿真速度太慢。

初始条件的坑常在积分器里。纯Simulink版本中，第二个积分器如果Initial condition给了一个非零值，模型的位移输出一开始就会偏掉，整个阶跃响应基线就错了。Simscape物理版也要注意检查Spring-Damper的初始形变设置，如果初始形变默认是0，而质量块又不在平衡位置，仿真启动瞬间就会产生一个很大的弹簧力冲击，造成速度跳变。每次打开新模型先做三件事：确认积分器初值是0，确认力源初始值为0，确认位移传感器初始输出为0，然后再开始调导纳参数，这套检查习惯能省掉很多冤枉时间。

4. 质量块导纳控制参数整定与仿真验证：M_d、B_d、K_d到底怎么给

4.1 目标惯量、目标阻尼、目标刚度的物理含义与初值选取表

这三个参数不是随便填的，每个参数控制性能的一个侧面。目标刚度K_d决定稳态柔顺量，目标阻尼B_d决定振荡衰减速度，目标惯量M_d决定动态冲击感。三个参数合在一起，还决定了导纳模型自己的固有频率和阻尼比，所以在整定时不能孤立地调某一个量。

给出一套能用的参考步骤：先定K_d。如果你希望系统在20N接触力下退让不超过0.4m，那么K_d就是20除以0.4等于50N/m；如果接触环境很硬，希望退让很小，K_d就要给到几百甚至上千。然后定B_d，取临界阻尼值，即B_d等于两倍根号下M_d乘K_d。最后微调M_d，M_d越小响应越快但越容易抖，M_d越大越平稳但越迟钝，一般是从机构自身质量的0.5倍开始试验，仿真稳定后再根据需要往小调。

这里有个常见误区：有人把K_d设得特别大，以为“硬度大就是精度高”，结果外力下位移几乎为零，导纳控制只相当于一个位置保持逻辑，这完全背离了柔顺控制的本意。真正合理的K_d应该结合工艺要求来定，压装工艺要求大的退让余量，K_d适当小；打磨要求保持接触压力稳定，K_d又需要相对大一些。参数整定永远是为工艺服务的，不是为了凑波形好看。

4.2 阶跃力和正弦力输入下的响应验证方法

搭好模型之后，第一件事是用阶跃力验证稳态位移是否等于F/K_d。给模型输入一个20N的阶跃力，观察输出位移最终应该稳定在0.4m附近（20除以50）。如果偏差很大，说明模型里有初始位移偏差或者反馈增益错误；如果位移持续上升不停，说明刚度反馈漏接了，模型变成了纯积分环节；如果位移在稳定之前反复振荡，说明B_d太小。

一种更完整的验证方式是用MATLAB脚本统一跑仿真并绘制位移时间曲线，这样每次调整参数后能快速对比波形。示例代码如下：

% 向基础工作区写入阶跃力时间序列 t_step = [0, 0, 0.01, 2]; % 时间点：0s和0.01s发生跳变 u_step = [0, 20, 20, 20]; % 力值：跳变后保持20N % 赋值到工作区，供Simulink中From Workspace模块读取 assignin('base', 't_step', t_step); assignin('base', 'u_step', u_step); % 运行纯Simulink导纳模型，仿真时长2秒 simOut = sim('adm_mass_min', 'StopTime', '2'); % 提取位移输出数据 t = simOut.x_ref.Time; x = simOut.x_ref.Data; % 绘制并添加参考线 figure; plot(t, x, 'b-', 'LineWidth', 1.3); hold on; yline(0.4, 'r--', '理论稳态位移 0.4m'); xlabel('时间 (s)'); ylabel('位移 (m)'); title('导纳质量块 20N 阶跃响应'); grid on;

这段代码里yline(0.4)画了一条红色虚线，用来对比仿真稳态位移和理论值。如果曲线最终没有贴到这条线上，优先检查K_d参数和反馈增益，确认Sum模块的减号端口数量没少。正弦力验证则换一种输入：给幅值10N、频率0.5Hz的正弦力，观察位移幅值和相位滞后是否合理，位移幅值应接近F幅值除以K_d（10除以50等于0.2m），如果频率再提高，由于惯量和阻尼作用，实际位移幅值会下降，这是二阶系统的正常低通特性。

如果你发现正弦响应幅值比理论值大很多，那说明模型里出现了谐振，也就是工作频率接近导纳模型的固有频率。这时需要提高B_d，把谐振峰压下来。如果幅值比理论值小很多，说明M_d和B_d组合起来把高频衰减得太厉害，导纳响应跟不上实际力的变化，在真实力控中会表现为接触力波动大，需要适当降低M_d。

4.3 把导纳输出接到位置控制环：柔顺装配的标准结构

质量块导纳模型的实际用法不是单独输出一个位移信号，而是要接到位置内环上去，形成一个嵌套控制结构。常见做法是：力传感器读取实际接触力，进入导纳质量块模型后生成参考位置x_ref；位置内环控制器跟踪x_ref，驱动真实机构运动；真实机构接触环境后产生的接触力反过来又通过力传感器影响导纳模型，形成闭环。

这种结构最大的坑在于内环延迟。位置内环带宽有限，导纳输出的参考轨迹变化快了，内环跟踪误差就会变大。更直接的影响是，导纳外环采样周期和内环控制周期如果不一致，力信号经过传感器滤波后已经产生了相位延迟，会让系统等效阻尼下降。因此工程上通常会故意把B_d调大一些来补偿延迟，而不是一味追求理论临界阻尼值。

我给这个串联结构配参数时，会先用下面的方法估算安全范围：位置内环带宽假设是f_p，导纳环路的等效固有频率最好控制在f_p的一半以下，这样外环不会激励内环的共振峰。如果位置内环是2Hz，导纳模型固有频率最好控制在1Hz以内，对应的K_d和M_d就要满足根号(K_d/M_d)除以2π小于1Hz。通过这个约束倒推参数取值范围，比直接乱试参数要可靠得多。

5. 质量块导纳控制simulink常见问题排查与避坑实践

5.1 质量块受力后往反方向跑：极性接反是头号原因

现象：给模型加一个正向阶跃力，质量块却向着负方向运动，位移曲线一开始就往负方向拉，速度也出现负值。

原因：纯Simulink版本里Sum模块的正负号配置错了，常见的是把减号端口放在了外力输入这一路，导致合力符号反转。Simscape版本里则是Ideal Force Source的输出方向设置反了，或者质量块和弹簧阻尼器的相对位置接反。

解决：先给模型输入一个固定的1N小力，观察位移方向是否与力的正向一致。如果是负向，纯Simulink版本双击Sum模块检查符号列表“+|−|−”，把第一个加号对应外力输入；Simscape版本则双击Ideal Force Source，查看参数里有没有Force direction选项，把它从Negative切到Positive，或者调换力源输出端与质量块端口的连接顺序。调整后再跑一次1N阶跃，确认方向正确了再加大力值。

5.2 位置输出缓慢漂移：积分器初始条件和直流偏置在作怪

现象：外力明明一直是0，但位移输出随时间缓慢增长，或者阶跃响应结束后位移不回到0，曲线整体漂移。

原因：积分器Initial condition不是0，模型一开始就带了一个初始位置或初始速度。更隐蔽的原因是力信号本身有直流偏置，比如Simulink-PS Converter前的信号源有微小常值，长期积分后累积成明显漂移。还有一种情况是Simscape物理版本中弹簧初始形变不为0，致使模型一开始就处于非平衡状态。

解决：把所有积分器Initial condition设为0，把Step模块的Initial value和Final value确认清楚，确保零输入时力源输出为0。如果信号源经过滤波后仍有微小偏置，可以在导纳模型前加一个截止频率很低的High-Pass Filter或Baseline修正模块，抑制直流漂移。调试时在Simulink模型里加一个Display模块直接看积分器输出，如果初始时刻显示非零，基本就是初值问题，不用继续怀疑后面的控制器。

5.3 小质量块配大刚度出现数值震荡：刚性方程要用对求解器

现象：参数设置成M_d等于0.2、K_d等于10000时，仿真波形出现高频抖动，甚至模型直接发散溢出。而且这个现象和B_d大小无关，怎么调阻尼都压不住。

原因：系统的无阻尼自然频率是根号下K_d/M_d，也就是根号50000约等于224 rad/s，对应约35Hz的自然频率。普通ode45求解器在这种刚性系统上会把最大步长自动缩得非常小，导致仿真极慢，同时在步长边缘容易产生数值振荡。

解决：切换到刚性求解器，最简单的方法是打开模型配置参数，把Solver选项从ode45改成ode15s，它专门处理这种刚性方程。如果模型里包含Simscape物理域，还需要在Solver Configuration里启用Local Solver并选择Backward Euler，同时把最大步长手动限制在0.001秒以内。改完之后重新仿真，高频抖动通常会消失。如果仿真时间仍然很长，就要重新审视参数本身，看看K_d和M_d的比值是否符合实际机构的物理极限。

5.4 Simscape代数量环报错：拓扑顺序和求解器配置先行

现象：Simscape模型仿真时直接报错，提示检测到代数环，或者提示无法求解速度约束，模型根本启动不起来。

原因：力源、质量块和弹簧阻尼器的连接顺序形成了一个没有积分状态的瞬时直通回路。最常见的是把Ideal Force Source和Spring-Damper并联连接，或者力源两端直接跨接在质量块和地面之间，形成了刚性反馈结构，Simscape求解器无法在初始时刻解出全部变量。

解决：先看拓扑连接是否正确，正确的顺序是力源串联质量块，质量块再串联弹簧阻尼器，弹簧阻尼器末端接机械参考。不要把力源并联在弹簧阻尼器两端。连接正确后，在Solver Configuration模块里勾选使用Local Solver，并将求解方式切换为Backward Euler，这样会引入数值阻尼，打断部分代数环。如果还报错，把PS-Simulink转换器的采样时间从-1改成明确的值（比如0.001秒），让转换关口有确定的时间语义。实在解决不了，可以退回到纯Simulink数学版本先把控制逻辑验证完，Simscape物理版本只用于后期整机验证，这条退路能保住项目进度。

6. 进阶：把导纳控制封装成子系统，并保留每版必跑的单位力阶跃验证

做成熟一点的项目时，我不会把质量块导纳控制模型直接摊在主图里，而是封装成一个独立的子系统，输入是外力F_ext，输出是参考位移x_ref，内部只保留导纳模型相关模块。这样做的直接好处是：整个主图里只看到“力进、位移出”两个信号，换参数只需要在模型回调或初始化脚本里改Md、Bd、Kd三个变量。更重要的是，把导纳当做独立子系统后，我可以在不同项目中反复复用这个子系统，也可以把它单独导出成模型引用或S-Function，方便后续做代码生成。

子系统封装好后，我会在项目根目录留一个叫导纳响应验证的初始化脚本，内容非常简单：先给子系统输入一个1N的阶跃力，仿真2秒，绘制位移曲线，并把理论稳态位移F/K_d用一条红虚线叠加在图上。每次改完导纳参数甚至改完整个上层控制器，我都会先跑一遍这个脚本，确认位移最终落在红虚线上，再去做复杂的接触仿真。如果在某个版本里这条曲线明显偏离，那一定是参数传递被覆盖了或反馈连接被碰断了，能第一时间发现问题。

我个人还有一个从血泪经验里总结出来的习惯：在子系统输入端之前，保留一个带宽可调的力信号滤波模块。因为导纳模型对高频力噪声很敏感，刚调好的参数往往一接真实力传感器信号就翻车，很多振荡不是来自模型本身，而是来自传感器噪声激励了质量块的固有频率。我在某次调试力控抓取时，仿真里波形完美，一连硬件就高频抖动，排查到最后发现是力传感器信号带了一个4kHz的尖峰，导纳模型里的M_d又取得太小，加速度被噪声放大成剧烈抖动。后来我在导纳模型前面加了截止频率为50Hz的二阶低通，抖动立刻消失。这套“先单位阶跃验证、再滤波接入”的流程，比我以前一遍遍调B_d高效得多。

如果你沿着这个方向继续深入，下一步可以试试在质量块导纳模型里加入速度前馈项，让参考速度在接触瞬间有一个平滑过渡，避免位置内环初始阶段的大误差；或者把M_d做成随接触状态切换的自适应参数，让自由空间响应快、接触空间响应稳。这些都是质量块导纳控制的正向扩展方向，前提是你已经能把基础模型稳定跑起来。希望今天这套从模型到参数再到排错的完整流程，能帮你在自己的项目里少走几趟弯路。

本文还有配套的精品资源，点击获取