西门子200SMART 5轴伺服控制程序 威纶屏 ST30+ST20 2个V90伺服+3个步进电机 该程序是实际项目中的。 。 有注释，有工程实际遇到的注意事项。 包括脉冲单量的换算，伺服步进马达与PLC的接线图。 屏的配方，I/O点等， 该程序可直接用于五轴往复喷涂。 也可用于初学者编程借鉴。
机械臂转1度要多少个脉冲？这个坑我踩过三次才搞明白。核心公式：
// 伺服电机每转脉冲数 = 编码器分辨率 * 电子齿轮比 // 机械减速比设为1:10时： #define GEAR_RATIO 10 REAL PulsesPerDegree := (131072 * 4) / (360.0 / GEAR_RATIO); //V90编码器17位注意这里用了4倍频计数，实际测试时发现威纶屏的数值输入控件要强制限制小数点后三位，否则累计误差会让机械臂跑偏2mm以上。建议用浮点数运算前先做取整处理，像这样：
LDP SM0.0 ROUND VD100, VD104 //VD100存原始计算值，VD104存整型脉冲数接线图必须单独拎出来说——特别是步进电机驱动器的共地问题。V90伺服的24V地线要和ST30的M端子直连，但42步进驱动器的信号地得串10Ω电阻再接入，否则上电瞬间必烧DI点。实际接线时最好用不同颜色的冷压端子区分，我习惯伺服用蓝线，步进用黄线，强电部分全用红色热缩管标记。
配方功能是威纶屏的亮点，但变量关联容易出错。在HMI变量表里建个"喷涂参数"结构体：
typedef struct { float speed; //地址VD2000 int thickness; //地址VW2004 uint cycle; //地址VW2006 } SprayParams;重点是把结构体首地址设为4000的倍数，这样掉电保存时不会和其他数据块冲突。调试时用趋势图监控发现，配方加载时如果直接写入V区会导致数据跳变，后来改成先用M区做缓冲中转才稳定。
运动控制程序架构要特别注意急停回路的嵌套：
NETWORK1: 急停连锁 LD I0.0 //急停按钮 O I0.1 //X轴限位 O I0.2 //Y轴限位 = M0.0 //总故障标志 NETWORK2: 伺服使能 LD M0.0 NOT = Q0.0 //V90伺服使能信号这里有个血泪教训——最初没加NOT指令直接输出，结果急停按下时伺服反而上使能，差点把限位开关撞碎。现在程序里所有安全信号都做双保险，PLC输出端并联硬件继电器，就算程序跑飞了硬件还能兜底。
五轴联动最吃性能的是圆弧插补算法，ST20的运算能力刚好够用。关键是用S7-200的POSx_CTRL指令库时，要手动补偿加减速段的脉冲丢失：
MOVW 500, SMB67 //设置PTO为500Hz MOVD 20000, SMW168 //总脉冲数 PLS 0 //启动Q0.0的脉冲输出 //补偿公式：实际位移 = 理论脉冲数 × (1 - 加速占比/2)调试时拿激光测距仪对比发现，当加速度超过300mm/s²时，末端会有0.5mm左右的滞后。后来在触摸屏上加了个加速度补偿系数输入框，根据不同涂料粘度动态调整，喷漆均匀度直接提升40%。
这程序里最值钱的其实是注释——比如某个子程序开头写着："//2019.3.12 老王调这里时炸过保险丝"。这些实战经验比教科书管用十倍。建议新手仿真时先断开驱动器供电，用LED灯模拟电机响应，等逻辑跑顺了再上真机。
