运动控制算法轨迹规划.ppt

运动控制系统中的算法运动控制系统中的算法??运动控制设计两个基本问题:一是运动规划;二是运动控制设计两个基本问题:一是运动规划;二是控制算法,运动规划是在给定的路径端点之间插入控制算法,运动规划是在给定的路径端点之间插入用于控制的中间点序列从而实现沿给定的平稳运动。用于控制的中间点序列从而实现沿给定的平稳运动。运动控制则是主要解决如何控制目标系统准确跟踪运动控制则是主要解决如何控制目标系统准确跟踪指令轨迹的问题。即对于给定的指令轨迹,选择适指令轨迹的问题。即对于给定的指令轨迹,选择适合的控制算法和参数,产生输出,控制目标实时,合的控制算法和参数,产生输出,控制目标实时,准确地跟踪给定的指令轨迹。准确地跟踪给定的指令轨迹。??运动规划通常又称运动插补。插补就是按给定曲线生成相运动规划通常又称运动插补。插补就是按给定曲线生成相应逼近轨迹的方法,其实质是对给定曲线进行应逼近轨迹的方法,其实质是对给定曲线进行““数据点的数据点的密化密化””。数控加工零件的刀具路径一般由直线、圆弧、椭。数控加工零件的刀具路径一般由直线、圆弧、椭圆等简单曲线或圆等简单曲线或BB样条、样条、NURBSNURBS等复杂曲线组成。对于由等复杂曲线组成。对于由简单曲线组成的刀具路径,可以由相应的简单插补算法进简单曲线组成的刀具路径,可以由相应的简单插补算法进行插补。如对于直线路径有直线插补算法,对于圆弧路径行插补。如对于直线路径有直线插补算法,对于圆弧路径则有缘故插补算法。而对于复杂曲线组成的刀具路径目前则有缘故插补算法。而对于复杂曲线组成的刀具路径目前一般有两种做法:第一种做法是预先将这些复杂曲线按照一般有两种做法:第一种做法是预先将这些复杂曲线按照给定的精度要求分成大量的直线或圆弧段,再由数控系统给定的精度要求分成大量的直线或圆弧段,再由数控系统对这些直线或圆弧段进行插补运算;另外一种做法是直接对这些直线或圆弧段进行插补运算;另外一种做法是直接讲这些复杂曲线的参数传递到数控系统中,由数控系统对讲这些复杂曲线的参数传递到数控系统中,由数控系统对这些复杂曲线进行实时插补运算这些复杂曲线进行实时插补运算数控系统中用到的运动规划算法数控系统中用到的运动规划算法??逐点比较插补法:从给定的轨迹点出发,每进给一步都要与逐点比较插补法:从给定的轨迹点出发,每进给一步都要与给定轨迹上的坐标值进行比较,决定下一步的进给朝着减少给定轨迹上的坐标值进行比较,决定下一步的进给朝着减少偏差的方向运动,直至到达轨迹的终点。偏差的方向运动,直至到达轨迹的终点。??数字积分法(数字积分法(DDADDA法):利用对速度分量的积分的方法来分法):利用对速度分量的积分的方法来分配脉冲,控制目标沿给定的路径平稳移动。其插补速度较配脉冲,控制目标沿给定的路径平稳移动。其插补速度较快,输出脉冲均匀,易于实现多坐标联动。快,输出脉冲均匀,易于实现多坐标联动。??时间分割法:又叫数据采样插补法。是把加工一段直线或圆时间分割法:又叫数据采样插补法。是把加工一段直线或圆弧的整段时间细分为许多相等的时间间隔,称为单位时间间弧的整段时间细分为许多相等的时间间隔,称为单位时间间隔(或插补周期),每经过一个单位时间间隔就进行一次插隔(或插补周期),每经过一个单位时间间隔就进行一次插补计算,算出在这段时间间隔内各坐标轴的进给量,边计补计算,算出在这段时间间隔内各坐标轴的进给量,边计算,边加工,直至加工结束。其插补速度更快,对于复杂多算,边加工,直至加工结束。其插补速度更快,对于复杂多维曲线的运动规划尤其有利。维曲线的运动规划尤其有利。??运动控制的控制对象在启动和停止阶段分别运动控制的控制对象在启动和停止阶段分别会出现加速和减速的过度过程。这既是伺服会出现加速和减速的过度过程。这既是伺服电机对速度指令的时域响应而产生的自然现电机对速度指令的时域响应而产生的自然现象,又是为了保证进给运动的平稳而经人为象,又是为了保证进给运动的平稳而经人为顺势设计的。为了保证伺服系统运动的平稳顺势设计的。为了保证伺服系统运动的平稳性,要避免冲击和振荡,做到启动时不失步、性,要避免冲击和振荡,做到启动时不失步、停止时不超程,就必须对过渡过程进行专门停止时不超程,就必须对过渡过程进行专门而有效的加速控制,使加减速过程按照所采而有效的加速控制,使加减速过程按照所采用的控制算法进行。用的控制算法进行。运动控制算法运动控制算法??传统的交流伺服系统只能实现对速度的闭环控制,还不能传统的交流伺服系统只能实现对速度的闭环控制,还不能直接实现对位置的闭环控制。要实现对位置的闭环控制,必直接实现对位置的闭环控制。要实现对位置的闭环控制,必须在伺服电机和控制系统之间构成一个位置环。这个位置环须在伺服电机和控制系统之间构成一个位置环。这个位置环是由数字伺服控制