Method and system for controlling antenna of mobile communication application system based on double quaternions in MEMS inertial navigation

Abstract

A method for controlling an antenna of a mobile communication application system based on double quaternions in MEMS inertial navigation. The method comprises: introducing an antenna control quaternion based on a navigation attitude quaternion; in each interrupt cycle of a navigation computer, updating the two quaternions respectively using a carrier system measured by a gyroscope relative to a rotation vector of an ideal platform coordinate system; in each filter cycle, correcting the error of the navigation attitude quaternion respectively using a Kalman filter; according to the relationship between the attitudes determined by the two attitude quaternions, determining the angular speed in an antenna control instruction; and finally, driving a servo system to rotate at an antenna servo control angle converted by an antenna control quaternion attitude.

Claims

1. A method for controlling a bi-quaternion satellite communication in motion antenna based on MEMS inertial navigation, comprising: (1) mounting an MEMS inertial navigation, a GPS and a satellite communication in motion on a carrier, wherein the MEMS inertial navigation and the GPS compose an integrated navigation system; (2) setting an antenna control quaternion, wherein the antenna control quaternion is in a form of [q.sub.0 q.sub.1 q.sub.2 q.sub.3], meanings of parameters of the antenna control quaternion coincide with those of a navigation attitude quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] obtained from a strapdown inertial navigation solving, and initial values of the antenna control quaternion are equal to those of the navigation attitude quaternion; (3) in each interrupt cycle of a strapdown inertial navigation computer, updating the navigation attitude quaternion and the antenna control quaternion by using a rotation vector .sub.Tb.sup.b of a carrier coordinate system with respect to an ideal platform coordinate system; (4) in each filtering cycle of the integrated navigation system, correcting a horizontal attitude error in a navigation attribute of the MEMS inertial navigation by using a Kalman filtering and integrated navigation algorithm, to correct the navigation attitude quaternion; (5) in each interrupt cycle of the strapdown inertial navigation computer, obtaining an attitude angle difference by performing subtraction between a carrier attitude angle determined from the navigation attitude quaternion and a carrier attitude angle determined from the antenna control quaternion; and generating, based on the attitude angle difference, a tri-axis instruction angular velocity rotation vector for correcting the antenna control quaternion, wherein a. a positive correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is greater than a heading angle determined from the navigation attitude quaternion; b. a negative correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is less than a heading angle determined from the navigation attitude quaternion; c. a positive correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is greater than a pitching angle determined from the navigation attitude quaternion; d. a negative correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is less than a pitching angle determined from the navigation attitude quaternion; e. a positive correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is greater than a roll angle determined from the navigation attitude quaternion; f. a negative correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is less than a roll angle determined from the navigation attitude quaternion; and (6) correcting the antenna control quaternion by using the tri-axis instruction angular velocity rotation vector; and in a next interrupt cycle of the strapdown inertial navigation computer after the correction, solving out a servo azimuth angle, a servo altitude angle and a servo polarizing angle of the satellite communication in motion antenna by using the corrected antenna control quaternion, and obtaining control quantities corresponding to the three attitude directions to control rotation of the satellite communication in motion antenna.

2. The method for controlling the bi-quaternion satellite communication in motion antenna based on MEMS inertial navigation according to claim 1, wherein in the cases a and b, a value of the correction instruction angular velocity in step (5) is not less than a value determined by dividing a difference between the heading angle determined from the antenna control quaternion and the heading angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than a maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna; in the cases c and d, the value of the correction instruction angular velocity in step (5) is not less than a value determined by dividing a difference between the pitching angle determined form the antenna control quaternion and the pitching angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than the maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna; and in the cases e and f, the value of the correction instruction angular velocity in step (5) is not less than a value determined by dividing a difference between the roll angle determined from the antenna control quaternion and the roll angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than the maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna.

3. A system for controlling a bi-quaternion satellite communication in motion antenna based on MEMS inertial navigation, comprising a satellite communication in motion antenna controller, a GPS, an MEMS gyroscope, an MEMS accelerometer and a satellite communication in motion antenna servo mechanism, wherein the GPS is configured to measure velocity and position information of a carrier and send the velocity and position information of the carrier to a filter unit in the satellite communication in motion antenna controller; the MEMS gyroscope is configured to measure angular velocity information of the carrier in a three-dimensional space and send the angular velocity information of the carrier in the three-dimensional space to an inertial navigation solving unit and an antenna control quaternion calculation unit in the satellite communication in motion antenna controller; the MEMS accelerometer is configured to measure specific force information of the carrier in the three-dimensional space and send the specific force information of the carrier in the three-dimensional space to the inertial navigation solving unit in the satellite communication in motion antenna controller; the satellite communication in motion antenna controller comprises the inertial navigation solving unit, the filter unit, the antenna control quaternion calculation unit, an antenna control instruction generation unit and an antenna control quaternion correction instruction angular velocity generation unit, wherein the inertial navigation solving unit is configured to remove angular velocities due to earth rotation and motion of the carrier along earth surface from the angular velocity information of the carrier in the three-dimensional space measured by the MEMS gyroscope, to obtain a tri-axis rotation vector .sub.Tb.sup.b of a carrier coordinate system with respect to the geographic coordinate system; remove a gravity acceleration and a Coriolis acceleration from the specific force information of the carrier in the three-dimensional space measured by the MEMS accelerometer, to obtain an acceleration of the carrier with respect to ground; obtain attitude, position and velocity information of the carrier via an inertial navigation solving based on the tri-axis rotation angular velocity of the carrier coordinate system with respect to the geographic coordinate system and the acceleration of the carrier with respect to the ground, and send the attitude, position and velocity information of the carrier to the filter unit; send, to the antenna control quaternion calculation unit, the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system and an attitude quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] corresponding to a carrier attitude directly obtained from first inertial navigation solving; and obtain corrected carrier attitude information from the filter unit, update the attitude quaternion corresponding to the corrected carrier attitude information by using the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system, take the updated attitude quaternion as a navigation attitude quaternion, and send the navigation attitude quaternion to the antenna control quaternion correction instruction angular velocity generation unit; the filter unit is configured to correct, at a fixed filter cycle, a horizontal attitude error in the carrier attitude output from the inertial navigation solving unit by using the Kalman filtering and integrated navigation algorithm based on the velocity and position information of the carrier output from the GPS and the velocity and position information of the carrier output from the inertial navigation solving unit; and send the corrected result to the inertial navigation solving unit; the antenna control quaternion calculation unit is configured to generate an antenna control quaternion, wherein the antenna control quaternion is in a form of [q.sub.0 q.sub.1 q.sub.2 q.sub.3], meanings of parameters of the antenna control quaternion coincide with those of the attitude quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] obtained by the inertial navigation solving unit, and initial values of [q.sub.0 q.sub.1 q.sub.2 q.sub.3] are [q.sub.0 q.sub.1 q.sub.2 q.sub.3]; update the antenna control quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] by using the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system and send the updated antenna control quaternion to the antenna control quaternion correction instruction angular velocity generation unit, every time the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system is received from the inertial navigation solving unit; and obtain a tri-axis instruction angular velocity rotation vector from the antenna control quaternion correction instruction angular velocity generation unit, update the antenna control quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] by using the tri-axis instruction angular velocity rotation vector again and send the updated antenna control quaternion to the antenna control instruction generation unit; the antenna control quaternion correction instruction angular velocity generation unit is configured to obtain the navigation attitude quaternion and the antenna control quaternion from the inertial navigation solving unit and the antenna control quaternion calculation unit respectively; obtain an attitude angle difference by performing subtraction between a carrier attitude angle determined from the navigation attitude quaternion and a carrier attitude angle determined from the antenna control quaternion; and generate, based on the attitude angle difference, a tri-axis instruction angular velocity rotation vector for correcting the antenna control quaternion, and send the tri-axis instruction angular velocity rotation vector to the antenna control quaternion calculation unit, wherein values of elements in the tri-axis instruction angular velocity rotation vector are as follows: a. a positive correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is greater than a heading angle determined from the navigation attitude quaternion; b. a negative correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is less than a heading angle determined from the navigation attitude quaternion; c. a positive correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is greater than a pitching angle determined from the navigation attitude quaternion; d. a negative correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is less than a pitching angle determined from the navigation attitude quaternion; e. a positive correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is greater than a roll angle determined from the navigation attitude quaternion; f. a negative correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is less than a roll angle determined from the navigation attitude quaternion; the antenna control instruction generation unit is configured to receive a newest antenna control quaternion from the antenna control quaternion calculation unit; and solve out a servo azimuth angle, a servo altitude angle and a servo polarizing angle of the satellite communication in motion antenna by using the antenna control quaternion, and send the servo azimuth angle, the servo altitude angle and the servo polarizing angle of the satellite communication in motion antenna to the satellite communication in motion antenna servo mechanism; the satellite communication in motion antenna servo mechanism comprises an azimuth-oriented motor driver and a corresponding motor, a pitch-oriented motor driver and a corresponding motor and a polarization-oriented motor driver and a corresponding motor, wherein the motor drivers in the three orientations drive the corresponding motors based on the servo azimuth angle, the servo altitude angle and the servo polarizing angle sent from the antenna control instruction generation unit respectively, to control rotation of three axis of the satellite communication in motion antenna.

4. The system for controlling the bi-quaternion satellite communication in motion antenna based on MEMS inertial navigation according to claim 3, wherein in the cases a and b, a value of the correction instruction angular velocity generated by the antenna control quaternion correction instruction angular velocity generation unit is not less than a value determined by dividing a difference between the heading angle determined from the antenna control quaternion and the heading angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than a maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna; in the cases c and d, a value of the correction instruction angular velocity generated by the antenna control quaternion correction instruction angular velocity generation unit is not less than a value determined by dividing a difference between the pitching angle determined from the antenna control quaternion and the pitching angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than the maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna; and in the cases e and f, a value of the correction instruction angular velocity generated by the antenna control quaternion correction instruction angular velocity generation unit is not less than a value determined by dividing a difference between the roll angle determined from the antenna control quaternion and the roll angle determined from the navigation attitude quaternion by the filtering cycle of the integrated navigation, and is not greater than a maximum allowable satellite aiming angular error per second of the satellite communication in motion antenna.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a principle block diagram of a method according to the invention;

(2) FIG. 2 is a schematic graph of variation of antenna pointing deviation with respect to variation of time; and

(3) FIG. 3 is a principle block diagram of composing of a system according to the invention.

DETAILED DESCRIPTION OF EMBODIMENTS

(4) Reference is made to FIG. 1, which is a principle block diagram of a method according to the invention. In the method according to the invention, the navigation attitude quaternion and the antenna control quaternion are cooperated to control the antenna servo system of the satellite communication in motion on the carrier.

(5) In the method according to the invention, the concept of antenna control quaternion is introduced. The antenna control quaternion is in a form of [q.sub.0 q.sub.1 q.sub.2 q.sub.3]. Meanings of parameters of the antenna control quaternion coincide with those of the quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] obtained from the strapdown inertial navigation solving. At the beginning of the navigation, the antenna control quaternion is equal to the navigation attitude quaternion. The antenna control quaternion is updated for two times in each navigation cycle. The first updating is performed based on a rotation vector in a carrier coordinate system b with respect to an ideal platform coordinate system T, and the second updating is performed based on a constant tri-axis small instruction angular velocity. The first updating is used to track the variation in the carrier attitude, and the second updating is to cause a mathematic platform virtualized based on the antenna control quaternion to approximate to a mathematic platform virtualized based on the navigation attitude quaternion at a small angular velocity, without drastic variation of the antenna servo attitude angle due to the instant significant correction to the navigation attitude quaternion.

(6) Both the antenna control quaternion and the navigation attitude quaternion track the carrier attitude variation using the same rotation vector updating. The antenna control quaternion is different from the navigation attitude quaternion in that, the navigation attitude quaternion corrects the estimation error using the Kalman filtering for one time when the filtering time arrives (which will shock the antenna servo system), and the antenna control quaternion approximates the navigation attitude quaternion at a small instruction angular velocity slowly (which will not shock the servo system).

(7) Reference is made to FIG. 2, which is a schematic graph of variation of antenna pointing deviation with respect to variation of time. The solid line AEBGCID represents the antenna pointing error graph in a case that the rotation of the antenna is controlled by the navigation attitude quaternion. The dotted line AEFGHI represents the antenna pointing error graph in a case that the rotation of the antenna is controlled by the antenna control quaternion. AB, BC and CD represent the error correction cycle of the navigation attitude quaternion by the integrated navigation algorithm. At the point A, both the antenna control quaternion and the navigation attitude quaternion are initialized. The overlapped solid line segment AE and dotted line segment AE represent both the navigation attitude quaternion and the antenna control quaternion are updated by using the same rotation vector .sub.Tb.sup.b. Since the initial value of the navigation attitude quaternion is equal to that of the antenna control quaternion, the navigation attitude quaternion is always equal to the antenna control quaternion on the line segment AB, and the solid line segment AE overlaps with the dotted line segment AE. The solid line segment EB (GC, ID) represents the navigation attitude quaternion is corrected using the integrated navigation algorithm, the navigation attitude error is returned to zero, and the antenna pointing error controlled by the navigation attitude quaternion becomes zero from a non-zero value instantly, thereby bringing vibration to the antenna servo system. The solid line segment BG (CI) represents that the antenna pointing deviation increases gradually with time and with inertial device error accumulation. The dotted line EF (GH) represents the process that the antenna control quaternion attitude approximates the navigation attitude quaternion at a small instruction angular velocity slowly. The dotted line FG (HI) represents development tendencies of the antenna pointing errors corresponding to the antenna control quaternion and the navigation attitude quaternion in a case that both the antenna control quaternion and the navigation attitude quaternion are updated using the same rotation vector after the antenna control quaternion attitude becomes equal to the navigation attitude quaternion.

(8) The method according to the invention includes steps as follows.

(9) (1) The initial value of the antenna control quaternion is set. The independent design of the antenna control quaternion aims to block mechanical and electrical shocks to the satellite communication in motion servo system in the carrier attitude error correction. The same as the navigation attitude quaternion, the antenna control quaternion describes the carrier attitude actually. Thus, in the startup time of the system, the antenna control quaternion is set to be equal to the navigation attitude quaternion obtained by the method of strapdown inertial navigation solving quaternion.

(10) (2) In each interrupt cycle of a strapdown inertial navigation computer, the navigation attitude quaternion and the antenna control quaternion are updated by using a rotation vector .sub.Tb.sup.b of a carrier coordinate system with respect to an ideal platform coordinate system.

(11) (3) In each filtering cycle, the navigation attitude quaternion, velocity and position of the MEMS inertial navigation are corrected using the Kalman filtering, to ensure the navigation accuracy of the MEMS inertial navigation for a long time.

(12) (4) In each interrupt cycle, a difference of attitude angle is obtained by performing subtraction between a carrier attitude angle determined from the navigation attitude quaternion and a carrier attitude angle determined from the antenna control quaternion.

(13) (5) In each interrupt cycle, the antenna control mode is determined based on the difference in the attitude angle. The basic principle is to cause the antenna control quaternion to approximate the navigation attitude quaternion. Here, a tri-axis instruction angular velocity rotation vector for correcting the antenna control quaternion is introduced. Specifically, there are following cases.

(14) a. A positive correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is greater than a heading angle determined from the navigation attitude quaternion.

(15) b. A negative correction instruction angular velocity is taken as a third element of the tri-axis instruction angular velocity rotation vector, in a case that a heading angle determined from the antenna control quaternion is less than a heading angle determined from the navigation attitude quaternion.

(16) The value of the correction instruction angular velocity is set as follows. To minimize the shock on the antenna servo system due to the correction of the antenna control quaternion, the correction instruction angular velocity of the third element of the tri-axis instruction angular velocity rotation vector is a value obtained by dividing the difference between the heading angle of the antenna control quaternion and the heading angle of the navigation attitude quaternion by the filtering cycle of the integrated navigation. In the case that the instruction angular velocity is a value obtained by dividing the difference between the heading angle of the antenna control quaternion and the heading angle of the navigation attitude quaternion by the filtering cycle of the integrated navigation, the maximum of the heading angle error of the antenna control quaternion is equal to the maximum of the heading angle error of the navigation attitude quaternion. Considering undetermined factors in the operation of the system, the instruction angular velocity should be greater than the value obtained by dividing the difference between the heading angle of the antenna control quaternion and the heading angle of the navigation attitude quaternion by the filtering cycle of the integrated navigation, and the maximum value of the instruction angular velocity should not be greater than a maximum allowable satellite aiming angular error of the satellite communication in motion antenna per second.

(17) c. A positive correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is greater than a pitching angle determined from the navigation attitude quaternion.

(18) d. A negative correction instruction angular velocity is taken as a first element of the tri-axis instruction angular velocity rotation vector, in a case that a pitching angle determined from the antenna control quaternion is less than a pitching angle determined from the navigation attitude quaternion.

(19) In the above two cases, the value of the correction instruction angular velocity is set using the same method as that in cases a and d, and the difference lies in that the two cases refer to the first element, which corresponds to the pitching angle, thus it only needs to calculate by replacing the heading angle in cases a and b with the pitching angle.

(20) e. A positive correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is greater than a roll angle determined from the navigation attitude quaternion.

(21) f. A negative correction instruction angular velocity is taken as a second element of the tri-axis instruction angular velocity rotation vector, in a case that a roll angle determined from the antenna control quaternion is less than a roll angle determined from the navigation attitude quaternion.

(22) In the above two cases, the value of the correction instruction angular velocity is set using the same method as that in cases a and d, and the difference lies in that the two cases refer to the second element, which corresponds to the roll angle, thus it only needs to calculate by replacing the heading angle in cases a and b with the roll angle.

(23) (6) A servo azimuth angle, a servo altitude angle and a servo polarizing angle of the satellite communication in motion antenna are calculated based on the attitude angle corresponding to the antenna control quaternion, to drive the satellite communication in motion servo system to control the antenna.

(24) Reference is made to FIG. 3, which is a principle diagram of composing of a system for controlling a bi-quaternion satellite communication in motion antenna based on MEMS inertial navigation according to the invention. The system includes a satellite communication in motion antenna controller, a GPS, an MEMS gyroscope, an MEMS accelerometer and a satellite communication in motion antenna servo mechanism.

(25) The GPS is mainly configured to measure velocity and position information of a carrier and send the velocity and position information of the carrier to a filter unit in the satellite communication in motion antenna controller.

(26) The MEMS gyroscope is mainly configured to measure angular velocity information of the carrier in a three-dimensional space and send the angular velocity information of the carrier in the three-dimensional space to an inertial navigation solving unit and an antenna control quaternion calculation unit in the satellite communication in motion antenna controller.

(27) The MEMS accelerometer is mainly configured to measure specific force information of the carrier in the three-dimensional space and send the specific force information of the carrier in the three-dimensional space to the inertial navigation solving unit in the satellite communication in motion antenna controller.

(28) The satellite communication in motion antenna servo mechanism includes an azimuth-oriented motor driver and a corresponding motor, a pitch-oriented motor driver and a corresponding motor and a polarization-oriented motor driver and a corresponding motor, wherein the motor drivers in the three orientations drive the corresponding motors based on the servo azimuth angle, the servo altitude angle and the servo polarizing angle sent from the antenna control instruction generation unit respectively, to control rotation of three axis of the satellite communication in motion antenna.

(29) The satellite communication in motion antenna controller is the core of the system according to the invention, which mainly includes the inertial navigation solving unit, the filter unit, the antenna control quaternion calculation unit, an antenna control instruction generation unit and an antenna control quaternion correction instruction angular velocity generation unit.

(30) The inertial navigation solving unit is configured to remove angular velocities due to earth rotation and motion of the carrier along earth surface from the angular velocity information of the carrier in the three-dimensional space measured by the MEMS gyroscope, to obtain a tri-axis rotation vector .sub.Tb.sup.b of a carrier coordinate system with respect to the geographic coordinate system; remove a gravity acceleration and a Coriolis acceleration from the specific force information of the carrier in the three-dimensional space measured by the MEMS accelerometer, to obtain an acceleration of the carrier with respect to ground; obtain attitude, position and velocity information of the carrier via an inertial navigation solving based on the tri-axis rotation angular velocity of the carrier coordinate system with respect to the geographic coordinate system and the acceleration of the carrier with respect to the ground, and send the attitude, position and velocity information of the carrier to the filter unit; send, to the antenna control quaternion calculation unit, the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system and an attitude quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] corresponding to a carrier attitude directly obtained from first inertial navigation solving; and obtain corrected carrier attitude information from the filter unit, update the attitude quaternion corresponding to the corrected carrier attitude information by using the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system, take the updated attitude quaternion as a navigation attitude quaternion, and send the navigation attitude quaternion to the antenna control quaternion correction instruction angular velocity generation unit.

(31) The filter unit is configured to combine the velocity and position information of the carrier output from the GPS and the velocity and position information of the carrier output from the inertial navigation solving unit; calculate differences between the east velocity and the north velocity of the carrier obtained by the GPS and the east velocity and the north velocity of the carrier output from the inertial navigation solving unit respectively; take the two differences as a measurement quantity of the Kalman filtering; and correct, at a fixed filter cycle, the carrier attitude information output from the inertial navigation solving unit by using the Kalman filtering and integrated navigation algorithm and send the corrected result to the inertial navigation solving unit. For the Kalman filtering and integrated navigation algorithm, reference may be made to Kalman filtering and integrated navigation principle (second edition), Qin, Yongyuan, Zhang Hongyue and Wang Shuhua, Northwestern Polytechnical University Press, 2012. In the invention, eight quantities, including the east and north velocity errors, the east and north misalignment angles, the right and forward gyro-drifts and the right and forward accelerometer offsets, are selected as the state variables.

(32) The antenna control quaternion calculation unit is configured to generate an antenna control quaternion, wherein the antenna control quaternion is in a form of [q.sub.0 q.sub.1 q.sub.2 q.sub.3], meanings of parameters of the antenna control quaternion coincide with those of the attitude quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] obtained by the inertial navigation solving unit, and initial values of [q.sub.0 q.sub.1 q.sub.2 q.sub.3] are [q.sub.0 q.sub.1 q.sub.2 q.sub.3]; update the antenna control quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] by using the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system and send the updated antenna control quaternion to the antenna control quaternion correction instruction angular velocity generation unit, every time the tri-axis rotation vector .sub.Tb.sup.b of the carrier coordinate system with respect to the geographic coordinate system is received from the inertial navigation solving unit; and obtain a tri-axis instruction angular velocity rotation vector from the antenna control quaternion correction instruction angular velocity generation unit, update the antenna control quaternion [q.sub.0 q.sub.1 q.sub.2 q.sub.3] by using the tri-axis instruction angular velocity rotation vector again and send the updated antenna control quaternion to the antenna control instruction generation unit.

(33) The antenna control quaternion correction instruction angular velocity generation unit is configured to obtain the navigation attitude quaternion and the antenna control quaternion from the inertial navigation solving unit and the antenna control quaternion calculation unit respectively; obtain an attitude angle difference by performing subtraction between a carrier attitude angle determined from the navigation attitude quaternion and a carrier attitude angle determined from the antenna control quaternion; and generate, based on the attitude angle difference, a tri-axis instruction angular velocity rotation vector for correcting the antenna control quaternion, and send the tri-axis instruction angular velocity rotation vector to the antenna control quaternion calculation unit.

(34) The antenna control instruction generation unit is configured to receive a newest antenna control quaternion from the antenna control quaternion calculation unit; and calculate a servo azimuth angle, a servo altitude angle and a servo polarizing angle of the satellite communication in motion antenna by using the antenna control quaternion, and send the servo azimuth angle, the servo altitude angle and the servo polarizing angle of the satellite communication in motion antenna to the satellite communication in motion antenna servo mechanism.

(35) The inertial navigation solving unit operates by mainly using the strapdown inertial navigation algorithm. In the strapdown inertial navigation algorithm, attitude solving, velocity solving and position solving are performed. A mathematical carrier of the attitude information is the navigation attitude quaternion. The navigation attitude quaternion is a reference quantity for variation of the antenna control quaternion. The velocity information is used to consist, together with the velocity information obtained by the GPS, the filter measurement quantity of the filter unit. The servo azimuth angle, the servo altitude angle and the servo polarizing angle of the satellite communication in motion antenna are calculated based on the position information and the attitude information corresponding to the antenna control quaternion.

(36) The servo azimuth angle, the servo altitude angle and the servo polarizing angle are calculated as follows.

(37) The navigation coordinate system n, the carrier coordinate system b, the antenna coordinate system v and the earth coordinate system e are involved in the calculation. The geographic coordinate system (x-east, y-north, z-sky) is taken as the navigation coordinate system n. The x-axis, the y-axis and the z-axis of the carrier coordinate system direct to the right, the front and the top of the carrier respectively. In the antenna coordinate system v, the y-axis is consistent with the direction of the antenna, the z-axis directs upwards along the azimuth axis of the antenna, and the x-axis together with the other two axes form the right-handed system. In the earth coordinate system e, the origin is located at the core of the earth, the x-axis is across the intersection between the prime meridian and the equator, the z-axis is across the North Pole of the earth, and the y-axis is across the intersection between the meridian east longitude ninety degrees and the equator. The earth coordinate system e is earth-fixed.

(38) Based on the above definitions of the coordinate systems, conversion matrixes between respective coordinate systems can be calculated conveniently. The conversion matrix for converting the antenna coordinate system to the carrier coordinate system is C.sub.v.sup.b. The conversion matrix for converting the carrier coordinate system to the navigation coordinate system is C.sub.b.sup.n. The conversion matrix for converting the navigation coordinate system to the carrier coordinate system is C.sub.n.sup.b. The conversion matrix for converting the antenna coordinate system to the navigation coordinate system is C.sub.v.sup.n. The conversion matrix for converting the earth coordinate system to the navigation coordinate system is C.sub.e.sup.n.

(39) For the antenna servo azimuth angle and servo altitude angle, the coordinates (X.sub.s.sup.e Y.sub.s.sup.e Z.sub.s.sup.e) of the satellite in the earth rectangular coordinate system may be obtained based on the satellite longitude .sub.s, and the coordinates (X.sub.b.sup.e Y.sub.b.sup.e Y.sub.b.sup.e) of the carrier in the earth rectangular coordinate system may also be easily obtained, then the vector from the carrier to the satellite is:

(40) $R_{bs}^{e} = [\begin{matrix} X_{s}^{e} \\ Y_{s}^{e} \\ Z_{s}^{e} \end{matrix}] - [\begin{matrix} X_{b}^{e} \\ Y_{b}^{e} \\ Z_{b}^{e} \end{matrix}],$
where

(41) $[\begin{matrix} X_{s}^{e} \\ Y_{s}^{e} \\ Z_{s}^{e} \end{matrix}] = [\begin{matrix} R .Math. \cos_{s} \\ R .Math. \sin_{s} \\ 0 \end{matrix}], [\begin{matrix} X_{b}^{e} \\ Y_{b}^{e} \\ Z_{b}^{e} \end{matrix}] = [\begin{matrix} R_{e} .Math. \cos L .Math. \sin \\ R_{e} .Math. \cos L .Math. \cos \\ R_{e} .Math. \sin L \end{matrix}],$
R is a geosynchronous orbit radius, L is a latitude where the carrier is located, is a longitude where the carrier is located, and R.sub.e is a radius of the earth.

(42) Coordinates of the vector R.sub.bs.sup.e is converted into the carrier coordinate system b, that is,
R.sub.bs.sup.b=C.sub.n.sup.b.Math.C.sub.e.sup.n.Math.R.sub.bs.sup.e.
From the above equation, the antenna servo altitude angle is

(43) $_{pit} = \tan^{- 1} (\frac{Z_{R_{bs}^{b}}}{\sqrt{X_{R_{bs}^{b}}^{2} + Y_{R_{bs}^{b}}^{2}}}) .$

(44) The principal value of the antenna servo azimuth angle is

(45) $_{cour} = \tan^{- 1} (\frac{X_{R_{bs}^{b}}}{Y_{R_{bs}^{b}}}),$
where X.sub.R.sub.bs.sub.b, Y.sub.R.sub.bs.sub.b, and Z.sub.R.sub.bs.sub.b are three components of the vector R.sub.bs.sup.b.

(46) The antenna servo polarizing angle is

(47) $_{roll} = \tan^{- 1} (\frac{\sin (_{sat} -_{loca})}{\tan (L_{loca})}),$
where .sub.loca is the longitude where the carrier is located, .sub.sat is the longitude where the satellite is located, and L.sub.loca is the latitude where the carrier is located

(48) The content that is not described in detail in the specification of the invention is known technology of those skilled in the art.

Method and system for controlling antenna of mobile communication application system based on double quaternions in MEMS inertial navigation

Assignee

Inventors

Cpc classification

Classification Explorer

G01C21/18

PHYSICS

Classification Explorer

H01Q1/125

ELECTRICITY

Classification Explorer

B64G1/244

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B64G1/1014

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G01C21/188

PHYSICS

Classification Explorer

H01Q1/247

ELECTRICITY

Classification Explorer

H01Q3/08

ELECTRICITY

Classification Explorer

H01Q3/02

ELECTRICITY

International classification

Classification Explorer

B64G1/36

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

G01C21/18

PHYSICS

Classification Explorer

G06F7/00

PHYSICS

Classification Explorer

H01Q3/02

ELECTRICITY

Classification Explorer

B64G1/10

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

B64G1/24

PERFORMING OPERATIONS; TRANSPORTING

Classification Explorer

H01Q1/24

ELECTRICITY

Classification Explorer

G05D1/00

PHYSICS

Classification Explorer

G05D3/00

PHYSICS

Classification Explorer

G06F17/00

PHYSICS

Abstract

Claims

Description