• Optics and Precision Engineering
  • Vol. 32, Issue 22, 3277 (2024)
Rencheng JIN, Sen PEI, Zijian ZHOU, Chen LIU, and Ran ZHANG*
Author Affiliations
  • Key Laboratory for Micro/Nano Technology and System of Liaoning Province ofDalian University of Technology, Dalian116024, China
  • show less
    DOI: 10.37188/OPE.20243222.3277 Cite this Article
    Rencheng JIN, Sen PEI, Zijian ZHOU, Chen LIU, Ran ZHANG. Polarized light/MIMU integrated navigation SHKF attitude solving algorithm for motion acceleration suppression[J]. Optics and Precision Engineering, 2024, 32(22): 3277 Copy Citation Text show less

    Abstract

    The study examines the accurate establishment of an attitude angle calculation model for UAVs influenced by large motion accelerations. Accelerometer output shows a decreased proportion of effective gravity acceleration information, while polarization sensors exhibit jitter. First, polarization sensor integrated navigation was introduced, along with the orientation principle of polarization navigation. Then, a cascaded attitude solution algorithm was built using the double-vector Gauss-Newton method and the SHKF (Sage-Husa Kalman) algorithm. This algorithm observed UAV attitude information based on multiple sensors. Next, based on analyzing the accuracy of accelerometer measurements under motion acceleration, a trust factor was proposed to mitigate the impact of motion acceleration on attitude calculation. This algorithm could suppress the effects of motion acceleration generated by high-speed UAV bodies. To verify this algorithm's feasibility, experiments were conducted on a polarization/MIMU (Micro Inertial Measurement Unit) integrated navigation platform. Results indicate a 30% improvement over PI and EKF algorithms in static and dynamic environments. The algorithm suppressed attitude deviation caused by non-gravity acceleration under motion acceleration influence. It improved the accuracy of attitude calculation under motion acceleration, ensuring normal UAV flight.
    γ=arctan2q0q1+q2q31-2(q12+q22)θ=arcsin(2(q0q2-q3q1))ψ=arctan2q0q3+q1q21-2(q22+q32)(1)

    View in Article

    hs=arcsin(sinφsinδ+cosφcosδcosτ)αs=arccossinδ-sinhssinφcoshscosφ(2)

    View in Article

    asn=[coshssinαscoshscosαssinhs]T(3)

    View in Article

    apm=[alm×]CbmCnbqasn(4)

    View in Article

    apm=[cosφsinφ0]T(5)

    View in Article

    gb=QnbgnQnb*(6)

    View in Article

    f(Qnb,ab)=gb-ab=2(q1q3-q0q2)-axb2(q2q3+q0q1)-ayb2(0.5-q12-q22)-azb(7)

    View in Article

    Epb=[alb×][QnbEsnQnb*](8)

    View in Article

    f(Qnb,Pb)=Epb-Pb=2Esxn(q1q2-q0q3)-Esyn(1-2(q32+q12))+2Eszn(q2q3+q0q1)-PxbEsxn(1-2(q32+q22))+2Esyn(q1q2+q0q3)+2Eszn(q1q3-q0q2)-Pyb0(9)

    View in Article

    F(Q)=12f(Q)Tf(Q)(10)

    View in Article

    FQF(Qk)+F(Qk)T(Q-Qk)+12(Q-Qk)TH(Qk)(Q-Qk),(11)

    View in Article

    F(Qk)=2J(Qk)Tf(Qk)(12)

    View in Article

    H(Qk)=2J(Qk)TJ(Qk)(13)

    View in Article

    F(Qk)+H(Qk)(Q-Qk)=0(14)

    View in Article

    Qk+1=Qk-μ[J(Qk)TJ(Qk)]-1J(Qk)Tf(Qk)(15)

    View in Article

    Xk=Φk,k-1Xk-1+Wk-1Zk=HkXk+Vk(16)

    View in Article

    Φk,k-1=1-Tωx2-Tωy2-Tωz2Tωx21Tωz2-Tωy2Tωy2-Tωz21Tωx2Tωz2Tωy2-Tωx21(17)

    View in Article

    Zk=1000010000100001Xk+Vk(18)

    View in Article

    X^k,k-1=Φk,k-1X^k-1+q^k(19)

    View in Article

    Z˜k=Zk-HkXk,k-1-r^k(20)

    View in Article

    Pk,k-1=Φk,k-1Pk-1Φk,k-1T+Q^k-1(21)

    View in Article

    Kk=Pk,k-1HkTHkPk,k-1HkT+R^k-1(22)

    View in Article

    X^k=X^k,k-1+KkZ˜k(23)

    View in Article

    Pk=Ι-KkHkPk,k-1(24)

    View in Article

    r^k=1-1kr^k-1+1kZk-HkX^k,k-1(25)

    View in Article

    R^k=1-1kR^k-1+1kZ˜kZ˜kT-HkPk,k-1HkT(26)

    View in Article

    a¯k=i=k-Nk-1(ai-g)N(27)

    View in Article

    λk=εε+a¯k2(28)

    View in Article

    Qk+1=Qk-μλk[J(Qk)TJ(Qk)]-1J(Qk)Tf(Qk).(29)

    View in Article

    Rencheng JIN, Sen PEI, Zijian ZHOU, Chen LIU, Ran ZHANG. Polarized light/MIMU integrated navigation SHKF attitude solving algorithm for motion acceleration suppression[J]. Optics and Precision Engineering, 2024, 32(22): 3277
    Download Citation