论文部分内容阅读
机械臂作为机器人最主要的执行机构,对于它的研究有着重要的意义。机械臂系统包括机械、硬件、软件、算法这四个部分。各个部分都是紧密相联,需要互相协调来设计的。课题主要开展了以下几个方面的工作:首先,依据工作空间中机械臂抓持器要想达到任意位姿,至少需要六个自由度的结论,采用了六自由度链式关节的结构。根据自平衡机器人的尺寸设计了一套机械臂的结构方案,并通过各连杆的质量,采用静力学估算各个关节的力矩,从而选择与之匹配的电机。采用了一种基于CAN总线分布式的控制方案。将工控机和关节控制器挂在CAN总线上。工控机主要功能是对关节控制器进行监控,同时也完成机械臂运动学、轨迹规划方面算法的实现。关节控制器采用TI公司的TMS320LF2407 DSP,主要实现位置,速度和力矩伺服控制算法的实现。其次,采用标准的D-H建模方法,建立了机械臂的数学模型。对机械臂的正运动学进行了分析,采用解析法对关节角进行解耦运算,推导出了逆运动学的封闭解析解,并采用功率最省做为性能指标,确定了唯一解。使用基于Matlab平台下的Robotics Toolbox机器人工具箱对推导过程的正确性进行了验证与仿真。再次,重点分析了机械臂在关节空间中轨迹规划的两种实现方法:三次多项式和五次多项式轨迹规划方法。仿真结果表明三次多项式轨迹规划方法计算量较小,但是不能保证角加速度连续;五次多项式轨迹规划方法计算量较大些,但能够保证角加速度的连续性,从而使电机平稳地运行。然后又在笛卡儿空间中对机械臂进行了轨迹规划,采用了空间直线和空间圆弧插补算法,详细地介绍了这两种轨迹计划的实现算法,并且对种插补算法进行了仿真实验。最后,根据六自由度机械臂的构型,基于MFC框架类和OpenGL图形库,在VC++6.0开发平台上专门开发了一套适用于这种构型的三维仿真工具。仿真工具把运动学和轨迹规划算法融入了其中,有效地验证了机械臂数学模型以及正、逆运动学求解过程的正确性,并且对四种轨迹规划方法的效果做了直观的比较。有效地解决了运动学和轨迹规划分析结果不易验证以及在实际本体上试验成本较高的问题。