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

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