基于旋转矩阵正交性的转向架6自由度平台位姿正解解算

利用齐次变换矩阵中旋转矩阵的正交特性及牛顿迭代实现了转向架空间姿态模拟平台的运动学正解解算。根据旋转矩阵元素之间的正交关系及各液压缸杆长约束条件,建立了以齐次变换矩阵各元素为未知量、方程数等于未知量数的非线性方程组的数学模型,并运用牛顿拉夫逊法进行近似求解,再根据齐次变换矩阵元素与位姿变量对应函数关系求解相应位姿,避免了牛顿拉夫逊法算法迭代求解过程中三角函数反复运算,提高了位姿正解解算速度。本文研究的转向架6自由度平台位姿正解解算方法为转向架空间姿态模拟的实现提供了依据,同时为其余形式的6自由度平台位姿解算提供了理论基础和技术支持。