基于关节位置约束的冗余机械臂协调控制误差仿真研究

简介

针对冗余机械臂关节位置约束问题,设计了冗余机械臂关节位置控制策略,在不同条件下对机械臂运动效果进行仿真验证。建立冗余机械臂简图模型,通过雅可比矩阵推导机械臂运动方程式。分析机械臂优先级任务体系构造,比较冗余机械臂在不同优先级条件下的极限状态,引入了机械臂监控系统。设置机械臂仿真环境,采用MATLAB软件对机械臂运动进行仿真。结果表明:机械臂2个关节都违背了极限限制;监控系统在保证关节位置规避限制的同时,会导致路径跟踪误差较大。但是,路径跟随误差不会影响所需的相对末端效应器运动,能够保持末端执行器的相对运动,保证抓取对象的稳定性;证明了冗余机械臂控制器的有效性。采用该策略避免了运动过程中的机械臂关节的限制,能够实现机械臂抓取物体的路径跟踪功能。