基于旋量理论的六自由度机械臂逆解算法

Inverse kinematic solution algorithm of 6-DOF manipulator based on screw theory

  • 摘要: 机器人求逆解过程中主要采用D-H参数法和旋量法来建立机器人运动学模型。D-H参数法机器人运动学分析中应用较多,但由于D-H参数法需要在每个关节处建立坐标系,因此建模过程较为繁琐。旋量法中机器人各连杆坐标系相对于底座建立,建模较为方便并且几何意义更明确。基于旋量理论建立的机器人运动学模型,其逆解一般采用Paden-Kahan子问题方法进行求解。针对6R模块化机械臂,该机械臂后3个关节轴线相交于一点,基于旋量理论建立机械臂的运动学模型,利用几何关系与Paden-Kahan子问题,对该机械臂进行了逆运动学求解,得到了该机械臂的解析解。利用Matlab编制运动学算法程序,验证了逆解算法的正确性。

     

    Abstract: D-H notation method and screw theory method are used to set up the kinematics model of robots when its inverse kinematics is to be solved. D-H notation method is widely used in kinematics analysis of robots, but, because D-H parameter method needs to establish coordinate system at each joint, it is more complicated to establish model. In screw method, the coordinate system of each link is established relative to the base, establish model is more convenient and the geometric meaning is clearer. The inverse solution of the kinematics model based on screw theory is usually solved by Paden-Kahan sub-problem method. Aiming at the 6R modular manipulator, the last three joint axes of the manipulator intersect at one point, this paper set up the kinematics model of the manipulator based on the screw theory. The inverse kinematics of the manipulator is solved by using the geometric relationship and Paden-Kahan sub-problem, and the analytical solution of the manipulator was acquired. The kinematics algorithm program was programmed by Matlab which verifies the correctness of the inverse solution algorithm.

     

/

返回文章
返回