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

我的大三的机器人控制原理课程设计及，利用机器人工具箱，进行六自由度的机械臂的直线轨迹规划和圆弧轨迹规划，完全可用，参数可改，有注释说明