说明：  捷联算法的公用函数，是进行捷联航姿算法的必备的公用函数也是组合导航的公用函数
(Strapdown algorithm common function is to carry out AHRS algorithms essential public functions are common functions Navigation)