专利名称：多轴全闭环运动控制插补器的制作方法
技术领域：
多轴全闭环运动控制插补器。该项发明主要应用于机电一体化的运动控制器，数控系统，飞剪系统，追剪系统，同步运动控制，机器人控制系统等领域，尤其需要多轴高速高精的联动控制应用上。
背景技术：
目前实现多轴闭环控制的插补方法是运动控制插补器将目标位置投影到各轴，各运动轴单独形成闭环即各轴接收实际位置的回馈并且单独进行控制。这种方法的实现有很大的局限性1.无论各轴的闭环如何调整，实际运动位置和目标位置的偏差总是存在的，而且由于各轴的负载不一样以及实际运动中的各轴加速度不一样必将形成各轴偏差不一样，这样会导致实际的运动轨迹偏离目标轨迹。而且由于实际加工工件的负载和运动轨迹的不确定性，导致这种实际偏离不可控。2.很难实现高精度的多轴同步控制。
发明内容
本多轴全闭环运动控制插补器是将一段由多个运动轴合成的空间目标短直线，经过全闭环的PID调节，实现各个轴的实际位置插补。克服在实际加工过程中由于某轴的位置偏差而导致实际加工轨迹产生较大误差。本插补器由于采用各轴实际位置的全闭环反馈，插补过程中以以实际运动位置为基础进行全闭环的PID调节，从而避免了某个轴的偏差引起的整个轨迹的较大偏差，可以高精度的实现多轴的高速联动。其特征在于该多轴全闭环插补器由插补周期规划，运动规划，运动实际位置偏差反馈，各轴PID跟随调节四个个过程对实际位置和速度不断刷新控制，从而实现加工过程中的实际速度和位置的插补。。
图1多轴全闭环运动控制插补器流程具体实施例方式1.对于要进行插补的目标空间短直线(X，Y，Z…W)和速度V，确定插补周期T ；计算直线距离S ；插补次数N=S/ (VT)，计算各轴在1，2…..N段的速度和位置，如X轴，会有Vxl, Vx2, ....Vxn ；Sxl, Sx2, -.Sxn ；Y 轴会有 Vyl，Vy2......Vyn ；Syl, Sy2......Sxn ；如此类推。Vxl = X/ (NT)Sxl = Χ/ΝVyl = Y/ (NT)Syl = Υ/Ν2.对目标位置进行运动形态的规划；包括速度形态的确定如起始速度，目标速度，加速度；加速形态的确定如梯形加速，S形加速，指数形加速等；跟随参考轴的确定如X 轴，Y轴或Z轴等。假定X轴为跟随参考轴，需进行S开加速，则将X轴的位置和速重新按S形加速模式重新计算，作为单轴加速指令发送到驱动器；而Y轴，Z轴….W轴则按步骤1所计算结果发送到驱动器； 3.将运动各轴的实际位置或速度通过编码器或光栅将各运动轴的实际位置反馈到插补器，插补器将实际位置和插补周期规划数据进行比对，形成各轴的速度和位置偏差。 如各轴实际位置和速度分别为X 轴:FSxl, FVxl Y 轴:FSyl, FVyl......W 轴FSwl，FVwl 各轴的实际位置和速度偏差为 X 轴ASxl, AVxl Y 轴ASyl, AVyl ... W 轴ASwl, AVwl4.根根据反馈到的各轴实际偏差，结合插补规划的各轴第η次的插补数据，与跟随参考轴的偏差在各轴的投影值，形成新的目标数据，经过PID调节运算后形成各轴的该次运动控制数据发送到各运动轴。 通过检测到参考轴的偏差Δ Sxl和Δ Vxl，分别投影到其他各轴，则有 Y 轴=Tsyl = Y Δ Sxl/X ；Tvyl = Y Δ Vxl/X ； Y轴Tsy1=Y△Sx1/X；Tvy1=Y△Vx1/X；...W 轴=Tswl = WA Sxl/X ；Tvwl = WA Vxl/X ； 则修正后的各轴位置和速度为Zsy2 = ASyl+Tsyl+Sy2 ； Zvy2 = Δ Vyl+Tvyl+Vy2 ；...Zsw2 = Δ Swl+Tswl+Sw2 ； Zvw2 = AVwl+Tvwl+Vw2 ； 将以上各轴修正后的位置和速度代入到PID调节器，则得出新的目标位置和速
度，对于Y轴则有Nsy2 = PID(ASyl, Zsy2, Τ)Nvy2 = PID(ΔVyl，Zvy2,T...对于W轴则有Nvw2 = PID(ΔVwl, Zvw2, TNsw2 = PID(Δ Swl, Zsw2, Τ)将以上经过PID调节过后的数据发送到伺服驱动器。 如是类推，当第t个差补周期时则有 Nswt = PID ( Δ Swt-I，Zswt, Τ)
Nvwt = PID(ΔVwt-I, Zvwt, T
权利要求
1.多轴全闭环运动控制插补器。该插补器将一段由多个运动轴合成的空间目标短直线，经过全闭环的PID调节，实现各个轴的实际位置插补。其特征在于该多轴全闭环插补器由插补周期规划，运动规划，运动实际位置偏差反馈，各轴PID跟随调节四个个过程对实际位置和速度不断刷新控制，从而实现加工过程中的实际速度和位置的插补。
2.权利要求1中插补周期规划是对目标对象进行插补周期内的位置和速度进行细分； 包括确定插补周期T，插补次数N，各轴在1，2…..N段的速度和位置，如X轴，会有Vxl， Vx2, ....Vxn ；Sxl, Sx2, -.Sxn ；Y 轴会有 Vyl，Vy2......Vyn ；Syl, Sy2......Sxn ；如此类推。
3.权利要求1中的运动规划是指对目标位置进行运动形态的规划；包括速度形态的确定如起始速度，目标速度，加速度；加速形态的确定如梯形加速，S形加速，指数形加速等； 跟随参考轴的确定如X轴，Y轴或Z轴等。
4.权利要求1中的运动实际位置偏差反馈是将运动各轴的实际位置或速度通过编码器或光栅将各运动轴的实际位置反馈到插补器，插补器将实际位置和插补周期规划数据进行比对，形成各轴的速度和位置偏差。
5.权利要求1中的各轴PID跟随调节是指根据反馈到的各轴实际偏差，结合插补规划的各轴第η次的插补数据，与跟随参考轴的偏差在各轴的投影值，形成新的目标数据，经过 PID调节运算后形成各轴的该次运动控制数据发送到各运动轴。
全文摘要
多轴全闭环运动控制插补器。该项发明主要应用于机电一体化的运动控制器，数控系统，飞剪系统，追剪系统，同步运动控制，机器人控制系统等领域，尤其需要多轴高速高精的联动控制应用上。本多轴全闭环运动控制插补器是将一段由多个运动轴合成的空间目标短直线，经过全闭环的PID调节，实现各个轴的实际位置插补。
文档编号G05B19/414GK102279588SQ20101060017
公开日2011年12月14日 申请日期2010年12月15日 优先权日2010年12月15日
发明者曾逸 申请人:深圳众为兴技术股份有限公司