基于阻尼最小范数法的四轴转台逆运动学算法分析

由于三轴转台在仿真过程中会产生运动学奇异,因此无法模拟大角度全姿态的飞行运动。四轴转台通过在三轴转台的基础上增加一个冗余轴,利用冗余自由度的特点可以有效规避三轴转台的奇异性。针对四轴转台中冗余自由度的逆运动学求解,采用加权最小范数法构建了等式的约束优化条件,并通过引入阻尼因子增强了求解的鲁棒性。最后,为了降低由消除闭环迭代引起的误差,在算法中进一步引入了二次计算,从而最大程度地提高了框架角解算的准确性。通过仿真分析,所提出的方法可以进行四轴转台的框架角解算且角度变化平稳,满足仿真周期为1ms的测试需求,理论解算精度可以达到10^-11量级。