评价网 > 科教论文 > 理学毕业论文 > 理工论文 > 正文

机械手终端运动轨迹规划

2017-09-10 04:34 1引言对于多关节机械手,轨迹规划是有约束非线性的复杂题目,在非线性系统的轨迹规划中,对逆系统方法进行了很多研究,aspinwall提出脉冲构造方法,将机械臂的点位运动控制和振动抑制回结为非线性两点边值题目求解［1］，jankowski引进逆系统方法,利用状态反馈和动态预补偿得到解耦线性系统［2］,这些方法还比较复杂,要应用于多杆系统的轨迹规划存在一定困难。文献［3］用旋量法描述机器人(机械手)未端夹持器在直角坐标空间的位置和姿态对时间函数所显示的运动轨迹,并利用速度矢量是雅可比矩阵列向量的线性组合关系,对广义坐标的运动量进行线性规划,避免了求解逆运动学方程,取得期看的关节位移和关节速度。为了保证机械手终端运动的连续性和平滑性,本文作为文献［3］研究的继续,对求得在区间［0，t］各关节m＋1次的关节变量值和速度值,用一多项式拟合在子区间［ti－1，ti］内关节的运动,各轨迹段的拟合多项式系数采用递推方式求得,免往计算所有中间点,减少了计算量,并便于实时计算和实际应用。2关节空间轨迹规划规划的主要任务是选择公道的多项式函数或其它线性函数进行插补运算,使关节运动平滑、稳定,始终保持在关节运动容许的范围内。3关节轨迹m段的选取关节插补按一定采样周期ts定时进行,对于空间插补,还应考虑插补间隔对轨迹精度的影响,插补间隔大,轨迹误差大,插补间隔过小加大计算机的运算量,应根据答应的最大轨迹误差δs,来决定插补间隔。在一个采样周期内各关节同步运动,每个周期末各关节有一加速度冲击,使机械手受到一固定频率fs＝1／ts的振动,于此最大采样周期受到共振频率的限制,要求fs＞10fstructure［4］,使此振动阔别机械手结构的谐振频率fstructure。轨迹m段的选取步骤:(1)取采样固定频率fs＞10fstructure［4］(2)根据采样周期ts的大小ts＝1／fs,将时间区间［0，t］分成m段,依照手部运动的位置及姿态轨迹方程［3］： （科教论文网 lw.nSeAc.com编辑发布）
xpi＝f1［λ（t）］ypi＝f2［λ（t）］zpi＝f3［λ（t）］（10）ωxi＝ζ1［λ（t）］ωyi＝ζ2［λ（t）］ωzi＝ζ3［λ（t）］（11）得到m＋1个路径点的位置和姿态矢量。(3)由传感器测得实际位置及姿态轨迹与期看作业的偏差(4)假如δr＞r，δφ＞g则在路径点pi－1与pi之间增加一中间点,r、g为给定位置和姿态误差的概率。［5］轨迹分段m的选择,还可从节省能量消耗的角度选择最佳的运行速度,这个最佳运行速度的选择应避免加速度的急剧变化,也就是使执行器和机械臂机构本身的变形减至最小,在此最佳的速度运行曲线段,存在一个执行的时间区域,区域内能量消耗实际上是恒定的,缩短或延长执行时间都有可能使能量消耗增加,实验表明m＜10是相当满足于得到最佳运行速度。利用速度矢量是雅可比矩阵列向量的线性组合关系,求出m＋1个路径点各关节的位移和速度qi在区间［0，t］内便可选择插值函数,对关节进行轨迹规划。4实例设斯坦福机械手［4］在拟定轨迹中通过3个已知点p1（50，0，118），p2（110．5，50，84），p3（50．2，100，50）,并在三点保持姿态为ω1（0，0，1．57）t，ω2（0，－0．045，0）t，ω3（0，0，1．57）t。p1，ω1状态相对应的关节坐标及其相应的正弦和余弦值参阅文献［3］,试规划终端运动轨迹。解:设机械手终端以圆弧轨迹规划,其位置坐标函数及姿态坐标函数为:
xp＝f1［λ（t）］＝60．5sin（2．9966