首页 工业机器人空间曲线实时轨迹规划算法

工业机器人空间曲线实时轨迹规划算法

举报
开通vip

工业机器人空间曲线实时轨迹规划算法 工业机器人空间曲线实时轨迹规划算法 汪鎏,马国红,张华 (南昌大学机器人研究所,江西南昌 330031) 摘要:本文设计了一种六轴机械臂沿空间曲线行走的控制算法。算法使机器人对输入空间曲线 计算出各关节的电机控制命令使机器人沿曲线运动。算法中推导出机器人逆运动学各关节解析解, 使机械臂控制器计算过程由解方程组简化为代数运算。对类似结构的机械臂都可以使用,具有一定 的通用性。使用 Matlab 对算法进行编程实现,从而验证了文章所设计算法的正确性。 关键词:机器人;控制算法;轨迹规划;运动学 中图分...

工业机器人空间曲线实时轨迹规划算法
工业机器人空间曲线实时轨迹规划算法 汪鎏,马国红,张华 (南昌大学机器人研究所,江西南昌 330031) 摘要:本文设计了一种六轴机械臂沿空间曲线行走的控制算法。算法使机器人对输入空间曲线 计算出各关节的电机控制命令使机器人沿曲线运动。算法中推导出机器人逆运动学各关节解析解, 使机械臂控制器计算过程由解方程组简化为代数运算。对类似结构的机械臂都可以使用,具有一定 的通用性。使用 Matlab 对算法进行编程实现,从而验证了文章所设计算法的正确性。 关键词:机器人;控制算法;轨迹规划;运动学 中图分类号:TP242.2 文献标识码:A Industrial Robot Space Curve Real-time Path Planning Algorithm Wang Liu , Ma Guo-hong,Zhang Hua (Robot Institute, Nanchang University, Nanchang City, 330031, China) Abstract:This paper presents a path planning algorithms for six-axis manipulator. The algorithm guide the robot move along the space curves, and figure out joint command of the robot motor. Algorithm including analytical solution of inverse kinematics so similar structure type of the robot arm can be used. The algorithm is realized with Matlab, and the effectiveness of algorithm is verified with programme. Keyword: Robot; Control algorithm; path planning; kinematics 1 引言(Introduction) 机器人轨迹规划是使机器人在规定时间内,按一定的速度及加速度,从初始状态移动到目标状 态。本文首先用 D-H 法建立了运动学模型,并用酉矩阵法对其进行了求解,得出了机械臂逆运动学 解。使空间曲线转换到机器人关节空间的运动。在机器人关节空间使用多项式插值法使机械臂各关 节运动的速度和加速度连续,保证生成的各关节电机执行的角度增量指令符合物理规律。最后使用 Matlab 对算法进行编程实现,从而验证了文章所设计算法的正确性。 2 机器人模型(Robot kinematics model) 对一个六轴的串联机械臂,如图 1所示。 图 1 机器人连杆坐标系 Fig.1 Robot link coordinate system 根据D-H法得到机械臂位姿的变换矩阵[1]: 基金颁发部门:国家自然科学基金委;项目名称:焊接机器人柔性系统 petri 网建模;编号:50705041 基金申 请人: 马国红。 基金颁发部门:江西省教育厅项目基金;项目名称:基于机器人汽车薄板焊接的旋转电弧传感器研究;编号: No. [2007]8 基金申请人: 马国红。 0 6 1 1 2 2 3 3 4 4 5 5 6 6( ) ( ) ( ) ( ) ( ) ( ) 0 0 0 1 x x x x y y y y z z z z n o a p n o a p T A A A A A A n o a p θ θ θ θ θ θ ⎡ ⎤⎢ ⎥⎢ ⎥= = ⎢ ⎥⎢ ⎥⎣ ⎦ ( 1 ) 式中 nA 矩阵为根据D-H法建立的机械臂各个关节的变换矩阵。 为了使机械臂处于期望的位姿,需要求解其逆运动学解才能确定每个关节变量的值。我们可以 注意到,运动方程中有许多角度的耦合,这就使得无法从矩阵中取出足够的元素来求解单个的正弦 和余弦项以计算角度。逆解方程组是一个关于6个关节变量的由12个方程组成的非线性方程组,采 用酉矩阵法求解[2]: (1)求 1θ 。可用逆变换 11 1( )A θ− 左乘运动方程式两边: 1 0( ) ( ) ( ) ( ) ( ) ( )1 1 6 2 2 3 3 4 4 5 5 6 6A T A A A A Aθ θ θ θ θ θ− = (2 ) 解得: 1 arctan y y x x p da p da θ −= − 或 1 arctan y y x x p da p da θ π −= + − (3) (2)求 3θ 。 1 1 1( ) ( ) ( ) ( ) ( )3 3 2 2 1 1 4 4 5 5 6 6 0 0 0 1 n o a px x x x n o a py y y yA A A A A A n o a pz z z z θ θ θ θ θ θ ⎡ ⎤⎢ ⎥⎢ ⎥− − − =⎢ ⎥⎢ ⎥⎢ ⎥⎢ ⎥⎣ ⎦ ( ) (4) 解得: 3 1arcsin arctan 6 aθ = + 或 3 1arcsin arctan 6aθ π= − + (5) (3)求 2θ 23 1 1 23 4 5( )x y zc c a s a s a c s+ + = (6) 23 1 1 23 3 4 5( ) ( )x y zc c p s p s p cc dc s+ + − = (7) 解得: 23 23 23 sin( ) arcsin ; arcsin w B B w B w θ θ θ π + = ⇒ = − = − − (8) 其中: 1 1 1 1 2 2 3 1 1 1 1 ( ) tan ( ) ( ) ( ) x y x y z z x y x y z z c p s p d c a s a w p da B bc c p s p dc a ds a p pa + − +⎧ =⎪ −⎨⎪ = ÷ + − − + −⎩ (9) 2 23 3 3arcsin B wθ θ θ θ= − = − − 或 2 3arcsin B wθ π θ= − − − (10) (4)求 5θ 23 1 1 23 5 5 23 1 1 23 5 23 1 1 23 ( ) arccos[ ( ) ] 2 arccos[ ( ) ] x y z x y z x y z s c a s a c a c s c a s a c a s c a s a c aθ θ π + − = ⇒ = + − = − + − 或 (11) (5)求 4θ 由 1 1 4x ys a c a S S− = ,可以解得: 1 1 1 1 4 4 5 5 arcsin ;x y x y s a c a s a c a s s s θ− −= ⇒ = 或 1 14 5 arcsin x y s a c a s θ π −= − (12) (6)求 6θ 23 1 1 23 5 6 23 1 1 23 6 5 ( ) ( ) sin sin x y z x y z s c o s o c o s s s c o s o c oθ θ + − = ⇒ + −= (13) 23 1 1 23 6 5 ( ) arcsin sin x y zs c o s o c oθ θ + −= 或 23 1 1 236 5 ( ) arcsin sin x y zs c o s o c oθ π θ + −= − (14) 3 机器人运动控制(Robot Motion Control) 对于预先指定的路径曲线我们先要把它离散化,然后根据一定的路径约束和实际情况的约束给 出通过这些点时机械臂的姿态[3],代入逆运动学方程求出通过这些点时的 1 6, ,θ θL ,最后在关节空 间进行插补给出机器指令。 设在连续轨迹的起始点和终点机器人的姿态为 0 0 0( , , )ψ θ ϕ 和 1 1 1( , , )ψ θ ϕ ,机器人运动连续平 滑,姿态角度随时间做线性变化。在时刻 0( )i it t t t< < 手部姿态角为: 1 0 0i itT ψ ψψ ψ −= + , 1 0 0i itT θ θθ θ −= + , 1 0 0i itT ϕ ϕϕ ϕ −= + (15) 把姿态角和相映的位置值代入文章中求出的机械臂逆运动学方程,就可以得出关节空间下的 1 6, ,θ θL 值。同时注意这些 1 6, ,θ θL 值可能会有多解,由机构的奇异问题产生的无穷个解,或无解 (不可达)。对于多解在我们的程序中会自动选择离上一个解最近的解,保证机械臂各个旋转轴运 动连续。 在关节空间生成机器指令 1 2 3 4 5 6( , , , , , )θ θ θ θ θ θΔ Δ Δ Δ Δ Δ ΔΦ = 。考虑到机械臂运动的实际情况,要求运动, 速度和加速度都是连续的,否则就和物理规律违背不能精确运动到指定的空间点。如果长时间这样 操作,机械臂就容易损坏[4,5],所以我们要在关节空间中插值。采用三次多项式插值,其 关于同志近三年现实表现材料材料类招标技术评分表图表与交易pdf视力表打印pdf用图表说话 pdf 达式位: 1 2 3 0 1 3( )t a a t a t a tθ = + + + (16) 角度约束位: 0 (0) ( )f ft θ θ θ θ =⎧⎪⎨ =⎪⎩ , (17) 速度约束位: 0 (0) ( )f ft θ θ θ θ ⎧ =⎪⎨ =⎪⎩ & & && && (18) 解上面的方程可得多项式系数为: 0 0 1 0 2 0 02 3 0 03 3 2 1( ) 2 1( ) ( ) f f f f f f f f f a a a t t t a t t θ θ θ θ θ θ θ θ θ θ =⎧⎪ =⎪⎪⎪ = − − −⎨⎪⎪ = − − + +⎪⎪⎩ & & & & & (19) 然后等时间的取 t(0 ft t< < 这里设 1ft = )代入多项式: 1 2 3 0 1 3( )t a a t a t a tθ = + + + (20) 生成机器指令 1 2 3 4 5 6( , , , , , )θ θ θ θ θ θΔ Δ Δ Δ Δ Δ ΔΦ = 。其误差为 (3) 2 4 ( ) ( ) 8!x fR tξ ω= ,其中 ( )f x 为空间路径转换 到关节空间的函数, 4 0 1 2 3( ) ( )( )( )( )t t t t t t t t tω = − − − − 。 4 编程实现及结果 分析 定性数据统计分析pdf销售业绩分析模板建筑结构震害分析销售进度分析表京东商城竞争战略分析 (Programming and Analysis) 通过 matlab 软件编写了以上控制算法,程序对输入的目标点或空间曲线的参数方程就可以自动 生成机器人可以执行的各关节增量指令。设定机器人实际参数 b=255,c=255,d=65。给出一空间 圆的方程 L的参数方程为: 5210 cos 6 y α= + 0 017.5 87.5sin ( 180 180 )z α α= − + − ≤ ≤ (21) 35 175sinx α= − + 给出实际约束:Z 轴始终指向实体内部。代入逆运动学方程求出各个关节运动角度,各个关节的 角度变化如图 2 所示。 图 2 机械臂各关节运动角度变化曲线 Fig. 2 joint movement perspective curve 通过程序计算,可以得出机器人控制命令。图 2 显示了在沿空间曲线运动的时候各关节运动平 滑。从而说明了本文所用方法的正确性。 5 结论(Conclusion) 本文所设计的六轴机械臂的控制算法使机器人对输入空间曲线,计算出各关节的电机控制命令 使机器人沿曲线运动。同时 计算公式 六西格玛计算公式下载结构力学静力计算公式下载重复性计算公式下载六西格玛计算公式下载年假计算公式 中各参数用符号表示,能够运用到各种类似结构的机器人控制。 控制算法中多项式插值法使机械臂各关节运动的速度和加速度连续,避免运行生成的机器指令违背 物理规律使不能正确执行任务。本方法计算效率很高,100 个点能在 2s 内计算完成。计算公式是单 变量参数方程的形式,在运动的同时计算后面几点,能适应实时控制的要求。 本文作者创新点用酉矩阵法求解出机械臂逆运动学解析解,使机械臂控制器计算过程由解方程 组简化为代数运算。对于相同结构机械臂,只要代入实际机构参数变可使用本算法实时控制机械臂 运动。 参考文献 (Reference) [1]蔡自兴等编. 机器人学[M]. 北京:清华大学出版社,2003. [2] Murray R M, 李泽湘,Shankar S S. 机器人操作的数学导论[M]. 北京: 机械工业出版社,1995. [3]Tan Guanzheng, Wang Yuehao. Theoretical and experimental research on time-optimal trajectory planning and control of industrial robots[J]. Journal of Control Theory & Application, 2003,20(2). [4] 朱学军,泉照之.机器人机械手臂关节驱动控制系统设计[J].微计算机信息,2007,5-22:265-267. [5] Yamamoto M, Yanai N, Mohri A. Inverse dynamic and control of crane-type manipulator[A].Proceedings of IEEE/RSJ International Conference on Intelligence Robots and Systems[c]. Piscataway, NJ, USA: IEEE, 1999. 1228-1233 作者简介:汪鎏(1983-),男(汉族),江西南昌人。南昌大学机器人研究所在读硕士。主要从事机 器人控制,机器视觉研究。 Biography: Wang Liu (1983 -),male (Han),JiangXi. Robot Institute (Nanchang University), Major Research Area is robot control, machine vision.
本文档为【工业机器人空间曲线实时轨迹规划算法】,请使用软件OFFICE或WPS软件打开。作品中的文字与图均可以修改和编辑, 图片更改请在作品中右键图片并更换,文字修改请直接点击文字进行修改,也可以新增和删除文档中的内容。
该文档来自用户分享,如有侵权行为请发邮件ishare@vip.sina.com联系网站客服,我们会及时删除。
[版权声明] 本站所有资料为用户分享产生,若发现您的权利被侵害,请联系客服邮件isharekefu@iask.cn,我们尽快处理。
本作品所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用。
网站提供的党政主题相关内容(国旗、国徽、党徽..)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
下载需要: 免费 已有0 人下载
最新资料
资料动态
专题动态
is_906388
暂无简介~
格式:pdf
大小:144KB
软件:PDF阅读器
页数:5
分类:互联网
上传时间:2012-12-23
浏览量:59