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

文件包括空间三自由度机械臂Solidworks模型，以及导出好的MATLAB Simulink模型xml文件。

车辆的三自由度非线性动力学模型，对智能车辆横向运动控制系统进行设计，先建立了车辆三自由度动力学模型并对车辆不确定参数的影响进行了分析，应用于车辆横向 控制系统设计，

并联机器人 用于控制4自由度并联机器人的软件包 启动实验 包pr_bringup负责管理机器人的启动文件。这是如何享用实验午餐的示例 ros2 launch pr_bringup pr_gus.launch.py

使用MATLAB simulink构建车辆二自由度模型，具有很强的实用性，包括程序源代码等。对初学者有一定的参考价值。

根据机械臂位姿输入DH参数（前置法），程序自动输出雅可比矩阵，可以自己做一个包，主程序调用。具体实现方法如下：1计算各连杆的变换矩阵；2、计算各连杆至机械臂末端的变换；3、计算雅可比矩阵各列元素。

针对一种四自由度工业串联机器人,为实现其在工作时的精确运动控制,对其进行运动学研究。建立空间坐标系,推导出运动学正解方程。根据正解方程使用Jacobian-迭代法,推导出机构的反解方程,用于运动控制的输入。通过ADAMS-MATLAB的联合仿真验证运动学方程的有效性。

七自由度机器人运动学分析 七自由度机器人运动学分析 七自由度机器人运动学分析

采用低成本传感器并借助卡尔曼滤波方法实现车辆运动状态的高精度估计。首先考虑车辆侧向运动、横摆运动以及侧倾运动，建立非线性三自由度的动力学车辆模型，通过对其线性化，实现扩展卡尔曼滤波设计，进一步针对线性化带来的截断误差问题，利用贝叶斯估计建立极大后验状态估计最小二乘表达式，通过进一步求解最终设计完成了迭代扩展卡尔曼滤波算法。 通过不同行驶条件下仿真，验证迭代扩展卡尔曼滤波过滤噪声和追踪实际值的能力。仿真结果表明: 在复杂的行驶条件下，迭代扩展卡尔曼滤波能大幅过滤噪声，并有效追踪车辆质心侧偏角和横摆角速度的实际状态。

有控弹道导弹六自由度的仿真与计算程序