طراحي و تست تجربي الگوريتم توجيه اوليه با استفاده ازخروجي سنسورهاي ناوبري اينرسي

Design and Experimental Test of Alignment Algorithm based on Inertial Measurement Unit Outputs

مقاله حاضر به مساله ترازيابي و توجيه با استفاده از حسگرهاي اينرسي مي پردازد. يكي از گام هاي مهم براي افزايش دقت ناوبري اينرسي وسايل متحرك، تعيين دقيق مقادير اوليه براي زواياي قرارگيري در دستگاه ناوبري، از جمله وضعيت قرارگيري وسيله نسبت به شمال جغرافيايي يا آزيموت است. در اين مقاله يك الگوريتم توجيه و ترازيابي دو مرحله اي شامل ترازيابي اوليه و ترازيابي دقيق به منظور تعيين زواياي اوليه وسيله با دقت چند دقيقه قوسي پيشنهاد شده است. بر اين اساس ابتدا در ترازيابي اوليه، با استفاده از مولفه هاي بردار جاذبه و سرعت زاويه اي چرخش زمين كه توسط سنسور هاي اينرسي اندازه گيري مي شوند، زواياي تراز و آزيموت اوليه با دقت محدودي محاسبه مي شوند. سپس با استخراج مدل خطا براي يك سيستم ناوبري اينرسي و استفاده از مزيت ساكن بودن حسگرهاي اينرسي (صفر بودن سرعت واقعي حسگرها) خطاي زواياي تراز و آزيموت با بكارگيري يك فيلتر كالمن تخمين زده شده و محاسبات اوليه تنظيم مي شود. به منظور ارزيابي دقت اين الگوريتم، بلوك ناوبري اينرسي بر روي يك ميز سه درجه آزادي كه قابليت تنظيم زواياي تراز و آزيموت را با دقت حدود پنج ثانيه قوسي دارد، قرارداده شده و سپس الگوريتم ارائه شده با استفاده از خروجي سنسورهاي اينرسي در آزيموت هاي مختلف مورد ارزيابي قرار گرفته است. نتايج نشان دهنده دقت مناسب تعيين آزيموت با استفاده از الگوريتم ارائه شده مي باشد.

In this paper, an alignment algorithm is proposed based on using the outputs of inertial measurement unit (IMU). Accurate initialization of attitude angles containing the azimuth angle is an important step to increase the accuracy of inertial navigation system output of a moving vehicle. Two step alignment algorithm including course and fine calculation is proposed in this paper which derives the Euler attitude angles including azimuth of vehicle with accuracy of a few arc minutes. First a course alignment is performed based on the components of gravity acceleration and angular velocity of the earth in body coordinate which are measured by inertial measurement unit sensors. Then the fine alignment is performed by constructing an error model of navigation system and estimation of the attitude angles error using a Kalman filter. The observations which are feed to the Kalman filter are the velocity components of vehicle in navigation frame and the eastern angular velocity component of the earth which are zero. To evaluate the accuracy of the proposed alignment algorithm, the IMU is mounted on a 3DOF table which can be aligned with 5 arc second precision as reference attitude. Then the alignment algorithm is executed in several azimuths. The results show the acceptable accuracy of azimuth angle.