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

轨迹规划是机器人设计的基础理论，是动力学和控制的基本条件，该6自由度轨迹规划代码，可用于多自由度轨迹规划的变化与修改，内附详细的说明；有问题可私信/留言沟通