六轴机械臂避碰运动学算法研究

【摘要】： 本文的工作是围绕我们自行研发的蒸汽发生器检修用机械臂进行的，该机械臂用于蒸汽发生器堵管等各种检修工作，具有六个关节，同时末端安装偏心工具。本文主要针对机械臂的二个过程安装过程(抓顶过程)到工作过程，再到其过程所涉及到的算法进行分析，编程与调式，及其相应的仿真工作。主要完成了机械臂的运动学，运动学求解，碰撞检测和抓顶安装过程，安装工具等的算法设计及其对应仿真工作。 首先本文给出了蒸汽发生器检修机械臂算法的理论基础。 其后本文对机械臂的安装过程运动学，及其运动学求解进行分析。给出了简明实用，方便计算机编程的几何解法，同时给出了圆与球的交点数值法与几何解法。保证了算法的精确性与实时性。 然后由安装过程，转到了工作过程。并同样分析并计算了工作过程运动学与运动学的求解。在文中不安装偏心工具时，不考虑偏心时械臂非冗余，文中分别研究了代数解法和几何解法。接下来给出了新颖独到的机械臂的安装过程与工作过程的机械臂碰撞检测。给出了机械臂与人孔的碰撞和机械臂臂之间的互碰的程序流程图及其相应的算法设计。 最后对前面所要涉及到的重要算法进行了联合仿真测试来保证前面算法程序的准确性及实时。给出了机械臂抓顶安装范围的仿真，无工具运动范围的仿真，及按装简易工具仿真及其相应的分析。该仿真是基于VC++的系统软件，基于OpenGL的三维图形仿真系统。所有的算法同时考虑到实时行的问题，通过仿真与实际机械臂的联调测试，证明了算法的准确性与实时性。