一种基于几何力学的机械臂末端规划算法

在几何力学框架下提出了开链机械臂末端实时追踪避障算法.首先,将回转力引入机械臂末端的自然运动方程,可以在工作空间获得光滑的避障轨迹;其次,利用阻尼最小二乘法求解相应的逆运动学问题,得到关节空间的平滑运动轨迹;最后,通过6自由度机械臂的仿真,并与经典的RRT算法作对比,验证了所提算法的有效性.

An algorithm of path planning for manipulator end-effector based on geometric mechanics

An online algorithm of real time collision avoidance and trajectory tracking for the manipulator end effector is proposed in the framework of geometric mechanics in this paper. First, the gyroscopic force is introduced in the motion of end effector to generate its collision free smooth trajectory in work space. Next, the corresponding smooth trajectories in the joint space are obtained by solving the inverse kinematics problem with the damped least square method. Finally, through the comparison with the classical RRT algorithm, the effectiveness of the proposed algorithm is illustrated by numerical simulations of a 6 DOF manipulator.