空间七自由度机械臂动力学建模与仿真

针对空间机械臂动力学建模复杂、无法实时解算的困难,提出了基于铰接体惯量法的空间七自由度漂浮基机械臂正、逆动力学建模方法。为了实时地解算机械臂运动情况,推导了基于铰接体惯量法的正向动力学方程,实现了O(n)次高效率计算;利用空间矢量的牛顿-欧拉逆向动力学方程,结合动量守恒定理,建立了基于铰接体混合动力学理论的自由漂浮空间机械臂的逆向动力学方程,并基于逆动力学方程建立了机械臂位置控制系统。在MATLAB中建立了漂浮基七自由度机械臂动力学模型及其仿真系统,并在SimMechanics中搭建了机械臂物理模型与仿真系统,两个系统的仿真结果验证了所建动力学模型的准确性。