该文件以6自由度puma560为例说明机器人的一种正逆运动学的编程方法（正运动学为DH法，逆运动学为解析解），以及机器人工具箱（matlab robotic toolbox）初步的运动学使用方法。

题主要开展了以下几个方面的工作： 首先，依据工作空间中机械臂抓持器要想达到任意位姿，至少需要六个自由 度的结论，采用了六自由度链式关节的结构。根据自平衡机器人的尺寸设计了一 套机械臂的结构方案，并通过各连杆的质量，采用静力学估算各个关节的力矩， 从而选择与之匹配的电机。采用了一种基于 CAN 总线分布式的控制方案。将工 控机和关节控制器挂在 CAN 总线上。工控机主要功能是对关节控制器进行监控， 同时也完成机械臂运动学、轨迹规划方面算法的实现。关节控制器采用 TI 公司 的 TMS320LF2

该文件以6自由度puma560为例说明机器人的一种正逆运动学的编程方法（正运动学为DH法，逆运动学为解析解），以及机器人工具箱（matlab robotic toolbox）初步的运动学使用方法。