西门子 S7-200 SMART 二次多项式插值 + 伺服曲线定位完整程序（适配不规则曲线控制）

西门子S7-200SMART二次多项式插值+伺服曲线定位完整程序（适配不规则曲线控制）以工件10s内完成500mm直线运动的不规则速度曲线为需求（0s→0mm/s→2s→80mm/s→5s→150mm/s→8s→100mm/s→10s→0mm/s），适配西门子S7-200SMARTPLC+V90伺服电机，程序包含曲线离散化存储、二次多项式插值计算、伺服脉冲输出、回零/限位/急停保护，逻辑与三菱FX5U版本对应，指令为西门子STL（语句表）+LAD（梯形图）混合形式，可直接导入STEP7-Micro/WINSMART软件。一、核心参数与寄存器分配（西门子S7-200SMART专属）西门子S7-200SMART采用V寄存器存储数据，T定时器（10ms单位）、C计数器，高速脉冲输出口为Q0.0/Q0.1，本次选用Q0.0作为伺服脉冲输出口，Q0.1作为方向口。寄存器/地址功能说明输入I0.0~I0.5I0.0=启动、I0.1=停止、I0.2=急停（常闭）、I0.3=原点传感器、I0.4=正限位、I0.5=负限位输出Q0.0~Q0.1Q0.0=伺服脉冲输出、Q0.1=伺服方向输出V寄存器-坐标区V100.0~V104.0=X轴时间坐标（0/2/5/8/10s）、V200.0~V204.0=Y轴速度坐标（0/80/150/100/0mm/s）V寄存器-计算区V30.0~V32.0=3个拟合点X值、V33.0~V35.0=3个拟合点Y值、V40.0~V47.0=插值中间计算值V寄存器-系数区V50.0=二次项系数a、V51.0=一次项系数b、V52.0=常数项cV寄存器-控制区V0.0=总点数(5)、V1.0=当前点序号n、V2.0=目标点序号n+1、V10.0=T37当前值（时间）、V300.0=实时速度、V500.0=伺服脉冲频率定时器/计数器T37=时间基准（10ms单位，设定值1000=10s）、C0=定位脉冲计数二、程序1：二次多项式插值核心程序（STL语句表，可直接导入）stl//====================步骤1：坐标点初始化+运行标志自锁====================LDSM0.0//程序运行常ONMOVB5,VB0//V0.0=总点数5MOVB0,VB1//V1.0=当前点序号n初始0MOVW0,VW100//V100.0=X0=0sMOVW2,VW102//V101.0=X1=2sMOVW5,VW104//V102.0=X2=5sMOVW8,VW106//V103.0=X3=8sMOVW10,VW108//V104.0=X4=10sMOVW0,VW200//V200.0=Y0=0mm/sMOVW80,VW202//V201.0=Y1=80mm/sMOVW150,VW204//V202.0=Y2=150mm/sMOVW100,VW206//V203.0=Y3=100mm/sMOVW0,VW208//V204.0=Y4=0mm/sLDI0.0//I0.0=启动按钮ORM0.0//M0.0=运行总标志ANI0.1//I0.1=停止按钮ANI0.2//I0.2=急停按钮（常闭）=M0.0//运行标志自锁//====================步骤2：时间基准获取（T37，10ms单位）====================LDM0.0TONT37,1000//T37=10s（10ms×1000），覆盖曲线总时间MOVWT37,VW10//VW10=当前时间（10ms单位，如200=2s）//====================步骤3：查找当前点区间（确定3个拟合点）====================LDM0.0LBL0//循环标签0MOVBVB1,VB2//VB2=目标点序号n+1MOVW*&VW100[VB2],VW31//VW31=Xn+1（间接寻址取X坐标）LDB>=VW10,VW31//比较当前时间X与Xn+1JMP1//若X≥Xn+1，跳至标签1，n+1JMP2//若X<Xn+1，跳至标签2，开始插值计算LBL1INCBVB1//当前点序号n+1LDB<VB1,VB0//比较n与总点数JMP0//若n<总点数，继续循环MOVB0,VB1//若n≥总点数，复位n=0，曲线循环JMP0//====================步骤4：二次多项式系数求解（a/b/c）====================LBL2//提取3个拟合点坐标：(Xn,Yn)、(Xn+1,Yn+1)、(Xn+2,Yn+2)MOVW*&VW100[VB1],VW30//VW30=XnMOVW*&VW100[VB2],VW31//VW31=Xn+1INCBVB2MOVW*&VW100[VB2],VW32//VW32=Xn+2DECBVB2MOVW*&VW200[VB1],VW33//VW33=YnMOVW*&VW200[VB2],VW34//VW34=Yn+1INCBVB2MOVW*&VW200[VB2],VW35//VW35=Yn+2DECBVB2//计算中间值：ΔX1、ΔX2、ΔY1、ΔY2SUBWVW31,VW30,VW40//VW40=Xn+1-Xn=ΔX1SUBWVW32,VW31,VW41//VW41=Xn+2-Xn+1=ΔX2SUBWVW34,VW33,VW42//VW42=Yn+1-Yn=ΔY1SUBWVW35,VW34,VW43//VW43=Yn+2-Yn+1=ΔY2//计算二次项系数a=[(ΔY2/ΔX2)-(ΔY1/ΔX1)]/(Xn+2-Xn)DIVWVW42,VW40,VW44//VW44=ΔY1/ΔX1DIVWVW43,VW41,VW45//VW45=ΔY2/ΔX2SUBWVW45,VW44,VW46//VW46=ΔY2/ΔX2-ΔY1/ΔX1SUBWVW32,VW30,VW47//VW47=Xn+2-XnDIVWVW46,VW47,VW50//VW50=a（二次项系数）//计算一次项系数b=(ΔY1/ΔX1)-a×(Xn+Xn+1)ADDWVW30,VW31,VW48//VW48=Xn+Xn+1MULWVW50,VW48,VW49//VW49=a×(Xn+Xn+1)SUBWVW44,VW49,VW51//VW51=b（一次项系数）//计算常数项c=Yn-a×Xn²-b×XnMULWVW30,VW30,VW48//VW48=Xn²MULWVW50,VW48,VW49//VW49=a×Xn²MULWVW51,VW30,VW53//VW53=b×XnADDWVW49,VW53,VW54//VW54=a×Xn²+b×XnSUBWVW33,VW54,VW52//VW52=c（常数项）//====================步骤5：二次多项式计算实时速度（Y=aX²+bX+c）====================MULWVW10,VW10,VW55//VW55=X²（当前时间平方）MULWVW50,VW55,VW56//VW56=aX²MULWVW51,VW10,VW57//VW57=bXADDWVW56,VW57,VW58//VW58=aX²+bXADDWVW58,VW52,VW300//VW300=实时速度（mm/s）//====================步骤6：速度缩放+限幅（适配伺服脉冲频率）====================LDM0.0MULWVW300,10,VW500//VW500=实时速度×10（脉冲频率基准，0.01mm/脉冲）//限幅：频率0~15000Hz（伺服额定）LDB>=VW500,15000MOVW15000,VW500LDB<=VW500,0MOVW0,VW500//====================步骤7：停止/急停复位====================LDM0.1RSTT37RSTM0.0MOVB0,VB1MOVW0,VW10MOVW0,VW300MOVW0,VW500LD/M0.0=M0.1三、程序2：伺服曲线定位+回零控制（梯形图核心片段）ladder//【1.伺服脉冲输出：PLS指令（Q0.0脉冲，Q0.1方向）】LDM0.0ANI0.4ANI0.5MOVWVW500,SMW68//SMW68=PLS脉冲频率MOVW50000,SMW70//SMW70=总定位脉冲（500mm，0.01mm/脉冲）MOVB16#01,SMB67//SMB67=脉冲输出配置（脉冲+方向，高速输出0）PLS0//启动Q0.0脉冲输出=Q0.1//Q0.1=方向（正方向）//【2.定位完成检测】LDM0.0ANSM66.7//SM66.7=脉冲输出完成标志RSTC0LDSM66.7CTUC0,1//C0=1，定位完成LDC0RSTQ0.0MOVW0,VW500=Y0.0//Y0.0=定位完成指示灯//【3.回零控制】LDI0.3ANM0.0MOVW500,SMW68//回零速度50mm/s→脉冲频率500MOVW0,SMW70//回零至原点脉冲MOVB16#02,SMB67//方向反向PLS0LDI0.3=Q0.1//Q0.1=方向（反方向）//【4.限位/急停保护】LDI0.2LDI0.4LDI0.5OLDOLDRSTQ0.0RSTM0.0MOVW0,VW500=Y0.1//Y0.1=故障指示灯四、西门子V90伺服参数适配（关键设置）与S7-200SMART配套的西门子V90伺服驱动器，需在STARTER软件中设置以下核心参数，匹配PLC脉冲控制：参数号参数名称设置值功能说明P0700控制源选择2端子控制P1500位置控制模式1脉冲+方向控制P1070电子齿轮比分子1000适配0.01mm/脉冲的脉冲当量P1071电子齿轮比分母1电子齿轮比=P1070/P1071P29000快速调试完成1保存参数并生效五、程序调试关键步骤（西门子S7-200