基于齐次变换矩阵的盾构机掘进位姿建模与求解研究

Abstract

为了更加精确快速地求解盾构机在掘进过程中的姿态变化，采用基于空间齐次变换矩阵元素的位姿正解求解方法建立盾构机位姿正解解算模型，并利用牛顿拉夫逊算法对得到的以齐次变换矩阵元素为未知量的非线性方程组进行逐次迭代求解，得到齐次变换矩阵各元素数值解；然后，根据齐次变换矩阵各元素与位姿映射关系求解对应位姿。并根据各个液压缸杆长约束条件建立位姿反解数学模型，在Matlab中对位姿正反解进行求解，并分析比较正反解结果的吻合度。结果表明，其误差在0.018%左右，在误差允许范围内，证明了所建立的盾构掘进位姿正反解数学模型的正确性