第3章贴装头运动学模型

第1章：贴装头运动学模型

各位工程师朋友，大家好。我是老张，在贴片机这个行当摸爬滚打了十几年。今天咱们开始聊贴装头的运动学模型，这是整个力位混合控制的基础。说白了，你连贴装头怎么动都搞不清楚，后面谈控制就是空中楼阁。

我个人习惯把运动学模型拆成三块来看：Z轴的上下运动、R轴的旋转运动、还有末端执行器的动力学特性。这三块搞明白了，雅可比矩阵和力映射自然就通了。

Z轴负责贴装头的升降。别小看这个上下运动，它直接决定了贴装精度和速度。我见过不少工程师，上来就调PID参数，结果怎么调都调不好。为什么？因为根本没搞清楚Z轴的数学模型。

Z轴的运动学模型其实很简单，就是一个质量-弹簧-阻尼系统。但实际工程中，我们得考虑几个关键因素：

嗯，这里要注意。很多人在建模仿真时把摩擦力忽略了，结果实际调试时发现低速爬行、高速震荡。我曾经在一个项目中，就因为没考虑静摩擦力，导致贴装头在接近PCB板时出现微小的抖动，吸嘴差点把元件弹飞了。

Z轴的运动学方程可以写成：

J * θ'' + B * θ' + K * θ = τ_m - τ_f - τ_g

其中：

实战技巧：我个人习惯在Z轴调试前，先做一次"空载惯量辨识"。用扫频法测出系统的谐振频率，然后反推等效惯量。这样后面调参数就有底了。

R轴控制的是吸嘴的旋转角度，用于调整元件的贴装方向。这个模型相对简单，但有个坑——旋转惯量会随着吸嘴上的元件变化而变化。

你想想看，贴一个0402的电阻和贴一个QFP封装的芯片，旋转惯量能差好几倍。如果还用同一套参数，肯定出问题。

R轴的模型可以简化为：

J_r * θ_r'' + B_r * θ_r' = τ_r - τ_rf

这里J_r是旋转惯量，B_r是旋转阻尼，τ_r是电机力矩，τ_rf是旋转摩擦力矩。

我记得有一次调试高速贴片机，R轴在高速旋转时出现了明显的过冲。查了半天，发现是旋转惯量辨识不准导致的。后来加了一个自适应惯量补偿算法，问题才解决。

避坑指南：我曾经在R轴设计中忽略了线缆的扭转刚度。结果机器跑起来后，线缆的弹性变形导致旋转角度误差达到了0.5度。对于细间距元件来说，这个误差足以导致贴装偏移。

末端执行器就是吸嘴和它抓取的元件。这部分动力学模型，说白了就是研究吸嘴在接触PCB板那一瞬间的力与位移关系。

为什么重要？因为贴装质量好不好，关键就看这一下。力太大，元件会碎；力太小，焊膏压不实。

末端执行器的动力学模型包括：

我建议用下面的简化模型来描述接触过程：

m_e * x'' + c_e * x' + k_e * x = F_contact

m_e是等效质量，c_e是接触阻尼，k_e是接触刚度，F_contact是接触力。

核心要点：末端执行器的动力学模型，是连接运动学与力控制的桥梁。没有这个模型，力位混合控制就是空谈。

终于到了这个部分。雅可比矩阵，听起来很高大上，其实它就是描述关节空间与操作空间之间速度/力映射关系的工具。

对于贴装头来说，雅可比矩阵J把Z轴和R轴的运动映射到吸嘴末端的运动：

[v_x, v_y, v_z, ω_z]^T = J * [θ_z', θ_r']^T

反过来，力映射就是：

[F_z, τ_r]^T = J^T * [F_x, F_y, F_z, M_z]^T

你想想看，有了这个映射关系，我们就可以在关节空间控制力，而实际效果体现在末端执行器上。这就是力位混合控制的核心思想。

我画了一张图，把整个运动学模型的关系梳理了一下：

从这张图可以看得很清楚：Z轴模型、R轴模型、末端执行器动力学，这三者通过雅可比矩阵耦合在一起，最终服务于力位混合控制。

在实际工程中，我建议按以下步骤来建立完整的运动学模型：

总结一下：运动学模型是贴装头控制的地基。地基打不牢，上面盖的房子再漂亮也是危房。我见过太多工程师跳过这一步直接调控制参数，结果项目周期拖了又拖。记住，花在模型上的时间，会在调试阶段加倍还给你。

个人经验：我习惯在项目初期就建立一个完整的Simulink仿真模型。把Z轴、R轴、末端执行器、雅可比矩阵全部放进去。这样在调试前就能预判很多问题。有一次，仿真发现某个频率点存在共振，实际测试果然如此。提前发现，省了不少事。

好了，这一章的内容就到这里。运动学模型是基础中的基础，希望大家能真正理解，而不是死记公式。下一章我们聊力位混合控制的原理，到时候会用到今天讲的内容。

公众号:蓝海资料掘金营，微信deep3321