更新DCM矩阵的快速算法
as = 1 - nt2/6 + nt2^2/120 - nt2^3/5040 + .....
nt2是theta的模的平方,分子按照-nt2,nt2^2,-nt2^3,nt2^4...变化,分母按照3!,5!,7!....变化
ac = 1/2 - nt2/24 +nt2^2/720 -nt2^3/40320 + .....
不同的是分母按照4!,6!,8!.....变化
似乎此方法对截断误差更加敏感,as、ac只取前两项时,精度很差。
而四元数法在只取前一项(r = [1 thetax/2 thetay/2 thetaz/2 ])时,精度已经能满足要求。
以上只是定性分析,稍后进行更详细的比较。