CN113849003A - Control method for motion isolation of communication-in-motion antenna - Google Patents
Control method for motion isolation of communication-in-motion antenna Download PDFInfo
- Publication number
- CN113849003A CN113849003A CN202111193228.3A CN202111193228A CN113849003A CN 113849003 A CN113849003 A CN 113849003A CN 202111193228 A CN202111193228 A CN 202111193228A CN 113849003 A CN113849003 A CN 113849003A
- Authority
- CN
- China
- Prior art keywords
- angle
- polarization
- error
- course
- pitch
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000002955 isolation Methods 0.000 title claims abstract description 20
- 230000010287 polarization Effects 0.000 claims abstract description 146
- 239000011159 matrix material Substances 0.000 claims description 58
- 239000013598 vector Substances 0.000 claims description 58
- 238000001914 filtration Methods 0.000 claims description 10
- 239000000126 substance Substances 0.000 claims description 9
- 238000010295 mobile communication Methods 0.000 claims description 8
- 238000004364 calculation method Methods 0.000 description 12
- 238000004891 communication Methods 0.000 description 7
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000001360 synchronised effect Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
Abstract
The invention discloses a control method for motion isolation of a communication-in-motion antenna, which does not need to install expensive main inertial navigation system equipment on a carrier, and does not need the antenna to perform two-dimensional/three-dimensional conical scanning motion; only the course axis of the antenna is controlled to perform single-dimensional sine swing, and the pitching axis and the polarization axis of the antenna do not have left-right scanning motion and directly and accurately point to the respective power maximum point. The invention enhances the intensity of the antenna receiving signal, enhances the anti-interference capability, increases the bandwidth and saves more energy.
Description
Technical Field
The invention belongs to the field of antennas, and particularly relates to a control method for motion isolation of a communication-in-motion antenna.
Background
When a moving carrier (such as an airplane or a ship) communicates with a geostationary satellite, no matter how the carrier moves, a satellite communication antenna (such as a parabolic antenna) on the carrier needs to be isolated from the motion of the carrier, and the axial direction of the control antenna points to the direction of the sky geostationary satellite in real time, which is the main purpose of controlling the communication-in-motion antenna. In order to achieve the purpose, the prior art adopts two technical schemes to control the communication-in-motion antenna, and the first scheme is as follows: when the carrier is provided with a main inertial navigation system, acquiring motion real-time information of the carrier from the main inertial navigation system of the carrier as a reference information source; the second scheme is as follows: when the main inertial navigation system is not in the carrier, a (combined) inertial navigation system is carried as a motion information reference source.
However, the main inertial navigation system in the first scheme is expensive, and the inertial navigation system in the second scheme is low in precision, and requires the antenna to continuously perform two-dimensional (or three-dimensional) conical scanning motion around the central axis thereof, so that the antenna axis always points to the multi-latitude space direction with the strongest communication signal power. The "strongest power" of the communication signal is not a true power maximum in a region where the average value of the signal power is actually the largest.
Disclosure of Invention
Aiming at the defects in the prior art, the control method for motion isolation of the communication-in-motion antenna provided by the invention solves the problems in the prior art.
In order to achieve the purpose of the invention, the invention adopts the technical scheme that: a control method for motion isolation of a communication-in-motion antenna is characterized in that a carrier provided with an antenna is provided with a GNSS receiver and an MEMS inertial navigation system, and comprises the following steps:
A. communicating with a satellite through a GNSS receiver to obtain the positions of the GNSS receiver and the satellite;
B. connecting the position of the GNSS receiver with the position of the satellite, and respectively taking the spatial included angles between the connecting line and the equator and the zero longitude line as a first pitch angle SPAnd a first course angle SHSetting a first polarization angle SRIs 0;
C. measuring a second pitch angle theta and a second course angle through the MEMS inertial navigation systemAnd a second polarization angle gamma, and solving a second pitch angle error, a second course angle error and a second polarization angle error;
D. according to the second pitch angle error, the second course angle error and the second polarization angle error, aligning the second pitch angle theta and the second course angleAnd updating the second polarization angle gamma to obtain a second updated pitch angle theta and a second updated course angleAnd a second angle of polarization gamma;
E. according to a first pitch angle SPFirst navigationTo angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle gamma, obtaining an angle error;
F. and controlling the antenna to rotate by a corresponding angle according to the angle error to finish the control of the motion isolation of the antenna.
Further, the obtaining a second pitch angle error, a second heading angle error and a second polarization angle error includes:
the vector function for constructing the inertial navigation error is as follows:
where δ represents the prefix sign of the error amount, δ VnRepresenting the three-dimensional velocity error on the geographical coordinate system n where the antenna is located,δVE、δVNand δ VURespectively representing three-dimensional velocity errors deltaVnComponents in the east, north, and sky directions; E. n and U represent east, north and sky directions, respectively; the direction of the sky represents a direction perpendicular to a horizontal plane where the antenna is located and away from the ground;is represented by δ VnA differential of (f)nRepresenting a three-dimensional vector of specific forces measured by an accelerometer in a MEMS inertial navigation system on a geographical navigation coordinate system,fE、fNand fURespectively represent threeDimension vector fnThe components in the east, north and sky directions,a three-dimensional vector representing the rotation speed of the earth with respect to the inertial space i on a geographical coordinate system n,a three-dimensional vector representing the geographical position at which the antenna is located relative to the rotational speed of the earth's sphere,a three-dimensional vector representing the rotation speed of the geographical position where the antenna is located with respect to the inertial space i,three-dimensional vector, epsilon, representing accelerometer null error in geographic coordinate system nnRepresents a three-dimensional vector of zero errors of a gyroscope in the MEMS inertial navigation system on a geographic coordinate system n,respectively representError vector of (phi)nA three-dimensional vector of three angular errors representing the heading attitude of the carrier on a geographical coordinate system n,φE、φNand phiURespectively representing three-dimensional vectors phinThe components in the east, north and sky directions,is indicative of phinDifferentiation of (1);
taking three-dimensional speed of GNSS receiver as observed quantityCombined pipeThe over-observed quantity acquisition observation function is:
wherein the content of the first and second substances,representing a three-dimensional velocity vector on a navigation coordinate system n, which is calculated and output by the MEMS inertial navigation system, wherein ins represents the MEMS inertial navigation system;
and acquiring a second pitch angle error, a second course angle error and a second polarization angle error by adopting a KALMAN filtering algorithm according to the vector function and the observation function of the inertial navigation error.
Further, according to the second pitch angle error, the second course angle error and the second polarization angle error, the second pitch angle theta and the second course angle theta are correctedAnd a second polarization angle γ update, comprising:
according to the second pitch angle theta and the second course angleAnd a second polarization angle gamma to obtain a first direction cosine matrixComprises the following steps:
obtaining a second direction cosine matrix according to the second pitch angle error, the second course angle error and the second polarization angle errorComprises the following steps:
wherein the content of the first and second substances,a second heading angle error is indicated that is,a second pitch angle error is indicated and,representing a second polarization angle error;
according to the second direction cosine matrixFor the cosine matrix of the first directionUpdating, specifically:
wherein the content of the first and second substances,representing the updated first direction cosine matrix
Cosine the first directionIs replaced byFrom a first direction cosine matrixTo a second pitch angle theta and a second course angleAnd the second polarization angle gamma is reversely calculated to obtain the updated second pitch angle theta and the updated second course angleAnd a second polarization angle gamma.
Further, according to a first pitch angle SPA first course angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle γ, obtaining an angle error, comprising:
according to a first pitch angle SPA first course angle SHAnd a first polarization angle SRObtaining a third directional cosine matrixComprises the following steps:
acquiring the longitude and latitude information of the geographic position where the carrier is located in the antenna through a GNSS receiver as lambda, L]And according to the longitude and latitude information [ lambda, L ] of the geographic position]Obtaining the cosine matrix of the fourth directionComprises the following steps:
wherein λ represents longitude and L represents latitude;
according to the updated second pitch angle theta and the second course angleAnd a second polarization angle gamma to obtain a first direction cosine matrix
According to the first direction cosine matrixThird direction cosine matrixAnd a fourth direction cosine matrixObtaining a fifth directional cosine matrixThe fifth direction cosine matrixAnd a first direction cosine matrixThe expansion forms are the same and are calculated by three spatial angle values;
from the fifth direction cosine matrixThe space angle value is reversely calculated to obtain the theoretical pitch angle P under the carrier coordinate system b of the MEMS inertial navigation systembTheoretical polarization angle RbAnd theoretical course angle Hb;
According to theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbAnd obtaining the angle error.
Furthermore, the antenna comprises a pitching shaft, a polarization shaft and a course shaft, wherein the pitching shaft, the polarization shaft and the course shaft are respectively provided with a motor, a power driver and an encoder;
the motor of the pitch shaft is used for rotating the pitch shaft so as to change the pitch angle; the power driver of the pitch axis is used for controlling the motor of the pitch axis to rotate; the encoder of the pitch shaft is used for measuring the angle of the pitch shaft to obtain the true pitch angle ax;
The motor of the polarization shaft is used for rotating the polarization shaft to change the polarization angle; the power driver of the polarization shaft is used for controlling the motor of the polarization shaft to rotate; the encoder of the polarization shaft is used for measuring the angle of the polarization shaft to obtain a real polarization angle ay;
The motor of the course shaft is used for rotating the course shaft so as to change a course angle; the power driver of the course shaft is used for controlling the motor of the course shaft to rotate; the encoder of the course shaft is used for measuring the angle of the course shaft to obtain a real course angle az。
Further, the angle errors comprise pitch angle errors, polarization angle errors and course angle errors;
according to the theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbObtaining an angle error, comprising:
according to theoretical pitch angle PbAnd true pitch angle axAcquiring a pitch angle error;
according to the theoretical angle of polarization RbAnd true polarization angle ayObtaining a polarization angle error;
according to the theoretical course angle HbAnd true heading angle azAnd acquiring course angle error.
Further, the pitch angle error δ θfsComprises the following steps:
δθfs=ax-Pb
the polarization angle error δ γfsComprises the following steps:
δγfs=ay-Rb
further, the controlling the antenna to rotate by a corresponding angle according to the angle error includes:
controlling the rotation of the pitch axis by a corresponding angle according to the pitch angle error;
controlling the rotation corresponding angle of the polarization axis according to the polarization angle error;
and controlling the corresponding rotation angle of the course shaft according to the course angle error.
The invention has the beneficial effects that:
(1) the invention provides a control method for motion isolation of a communication-in-motion antenna, which does not need to install expensive main inertial navigation system equipment on a carrier, nor does the antenna need to perform two-dimensional (three-dimensional) conical scanning motion; only the course axis of the antenna is controlled to perform single-dimensional sine swing, and the pitching axis and the polarization axis of the antenna do not have left-right scanning motion and directly and accurately point to the respective power maximum point.
(2) The invention enhances the intensity of the antenna receiving signal, enhances the anti-interference capability, increases the bandwidth and saves more energy.
(3) The invention has low implementation cost and can be widely applied to the communication between the antenna and the satellite in motion.
Drawings
Fig. 1 is a flowchart of a control method for motion isolation of a mobile communication antenna according to an embodiment of the present invention.
Fig. 2 is a schematic diagram of an antenna control system according to an embodiment of the present invention.
Detailed Description
The following description of the embodiments of the present invention is provided to facilitate the understanding of the present invention by those skilled in the art, but it should be understood that the present invention is not limited to the scope of the embodiments, and it will be apparent to those skilled in the art that various changes may be made without departing from the spirit and scope of the invention as defined and defined in the appended claims, and all matters produced by the invention using the inventive concept are protected.
Embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
As shown in fig. 1, a control method for motion isolation of a mobile communication antenna, in which a GNSS (Global Navigation Satellite System) receiver and an MEMS (Micro-Electro-Mechanical System) inertial Navigation System are disposed on a carrier on which the antenna is mounted, includes:
A. and communicating with the satellite through the GNSS receiver to acquire the positions of the GNSS receiver and the satellite.
B. Connecting the position of the GNSS receiver with the position of the satellite, and respectively taking the spatial included angles between the connecting line and the equator and the zero longitude line as a first pitch angle SPAnd a first course angle SHSetting a first polarization angle SR=0。
The polarization angle on a paraboloid antenna frame in the communication field is equivalent to the roll angle concept in the inertial navigation field.
The GNSS receiver is included in the self-contained integrated navigation system, so that the accurate position information of the antenna can be known (the error is generally only tens of meters); in addition, when a synchronous satellite which needs to be used for communication is specified, the accurate position of the synchronous satellite is known according to the satellite information, and thus the space included angle between the connecting line of the antenna and the satellite and the equator and the zero longitude line is calculated.
C. Measuring a second pitch angle theta and a second course angle through the MEMS inertial navigation systemAnd a second polarization angle gamma, and solving a second pitch angle error, a second course angle error and a second polarization angle error.
D. According to the second pitch angle error, the second course angle error and the second polarization angle error, aligning the second pitch angle theta and the second course angleAnd a second angle of polarization gammaObtaining a second pitch angle theta and a second course angle after updatingAnd a second polarization angle gamma.
E. According to a first pitch angle SPA first course angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle gamma, obtaining the angle error.
F. And controlling the antenna to rotate by a corresponding angle according to the angle error to finish the control of the motion isolation of the antenna.
Optionally, a geographic coordinate system (east-north-sky or E-N-U) where the carrier is located is a common coordinate system (and is denoted as N) of the GNSS receiver and the MEMS inertial navigation system, a carrier system (right-front-up) where the inertial navigation system is installed is denoted as b, an inertial space coordinate system is denoted as i, an earth coordinate system (X-Y-Z) is denoted as E, and a synchronous satellite position is denoted as s. The initial position and velocity of the inertial navigation system may be provided by the GNSS, the initial pitch and polarization angles may be substantially zero after the frame is zeroed and centered, and the initial heading may be provided by a built-in calibrated magnetic heading sensor.
In a possible embodiment, the determining the second pitch angle error, the second heading angle error and the second polarization angle error includes:
the vector function for constructing the inertial navigation error is as follows:
where δ represents the prefix sign of the error amount, δ VnRepresenting the three-dimensional velocity error on the geographical coordinate system n where the antenna is located,δVE、δVNand δ VURespectively representing three-dimensional velocity errors deltaVnComponents in the east, north, and sky directions; E. n and U represent east, north and sky directions, respectively; the direction of the sky represents a direction perpendicular to a horizontal plane where the antenna is located and away from the ground;is represented by δ VnA differential of (f)nRepresenting a three-dimensional vector of specific forces measured by an accelerometer in a MEMS inertial navigation system on a geographical navigation coordinate system,fE、fNand fURespectively representing three-dimensional vectors fnThe components in the east, north and sky directions,a three-dimensional vector representing the rotation speed of the earth with respect to the inertial space i on a geographical coordinate system n,a three-dimensional vector representing the geographical position at which the antenna is located relative to the rotational speed of the earth's sphere,a three-dimensional vector representing the rotation speed of the geographical position where the antenna is located with respect to the inertial space i,three-dimensional vector, epsilon, representing accelerometer null error in geographic coordinate system nnRepresents a three-dimensional vector of zero errors of a gyroscope in the MEMS inertial navigation system on a geographic coordinate system n,respectively representError vector of (phi)nA three-dimensional vector of three angular errors representing the heading attitude of the carrier on a geographical coordinate system n,φE、φNand phiURespectively representing three-dimensional vectors phinThe components in the east, north and sky directions,is indicative of phinDifferentiation of (2).
The difference or differential is obtained by dividing the parameter difference between the two successive calculation instants or by the interval time.And εnThree-dimensional vectors of accelerometer zero-position error and gyroscope zero-position error on a geographical navigation coordinate system respectively (generally, a device grade with accuracy meeting index requirements is selected, meanwhile, the calculation real-time performance is considered in the implementation, and only the filtering calculation phi is considerednError angle, neglectingAnd εnThe constant parameter of these two errors is zero, leaving only random noise errors).
Taking three-dimensional speed of GNSS receiver as observed quantityAnd obtaining an observation function by the observed quantity as follows:
wherein the content of the first and second substances,in-navigation coordinates representing the computational output of a MEMS inertial navigation systemIs a three-dimensional velocity vector on n, ins represents the MEMS inertial navigation system.
And acquiring a second pitch angle error, a second course angle error and a second polarization angle error by adopting a KALMAN filtering algorithm according to the vector function and the observation function of the inertial navigation error.
In the present embodiment, it is preferred that,the method specifically comprises the following steps:
wherein, ω isieRepresenting the rotational speed values of the earth relative to the inertial space, VEAnd VNIs the component of the vector velocity vector in east and north direction of the navigation system, L represents the vector latitude, h represents the vector height, R represents the vector velocity vectorMRepresenting the local value of the radius of curvature, R, along the earth's meridianNAnd (3) representing the local curvature radius value along the earth prime circle.
δVnAnd phinAll three-dimensional vectors, which can be combined and taken as:thus, two formulas in the vector function of the inertial navigation error can be combined by taking x (t) as a state variable, and the following functions are obtained after the two formulas are arranged:
wherein: w (t) zero-mean systematic random noise, referred to as 6 x 1 dimensions, i.e. process noise of 6 components in the state variable x (t). In the actual calculation: w (t) mean E { W (t) } ═ 0, W (t) variance E { W (t) } WT(t) } ═ q (t) · σ (t- τ); q (t) is a 6 x 6 dimensional diagonal matrix whose diagonal upper values are the respective random noise coefficients in the three acceleration plus three gyro product specifications in the inertial navigation system, respectively, and σ (t- τ) is the unit pulse function; the superscript T is the matrix transpose symbol.
F (t) is a 6 x 6 dimensional system matrix, expanded into:
wherein, each element in F (t) is specifically:
F15=-fU
F16=fN
F24=fU
F26=-fE
F34=-fN
F35=fE
the right parameter values in the above formula are all known parameters in the calculation of the inertial navigation system, wherein omegaieRepresenting the rotational speed values of the earth relative to the inertial space, VE、VNAnd VUIs the component of the vector velocity in the east, north and sky directions, L represents the latitude of the vector, h represents the height of the vector, and R represents the height of the vectorMRepresenting the local value of the radius of curvature, R, along the earth's meridianNRepresenting the local curvature radius value f along the global prime circleE、fNAnd fUAre respectively fnThree components in the geographical navigation coordinate system, and the values of other elements in the F (t) matrix, which are not illustrated here, are 0.
As described above, the observation function z (t) ═ δ V is takenn+ v (t), v (t) is the measured random noise with mean 0, taken in the actual calculation: v (t) mean E { V (t) } ═ 0, V (t) variance E { V (t) × VT(t) } ═ r (t) · σ (t- τ); r (t) is a 3 × 3 dimensional diagonal matrix, whose diagonal values are the three velocity random noise strength values of the GNSS receiver.
The observation function was unfolded and arranged into the form shown below:
h (t) is a 3 x 6 dimensional observation matrix, which is expanded to:
the KALMAN filtering algorithm is calculated according to a vector equation in a general form as shown below, and filters and estimates a state variable x (t), specifically:
Z(t)=H(t)*x(t)+V(t)
where x (t) is any state vector of n dimensions, Z (t) is any measurement vector of m dimensions, F (t) is the system matrix, and H (t) is the observation matrix.
W (t) and v (t) are incoherent zero-mean white noise processes, i.e. the noise statistics are:
E{W(t)}=0;
E{W(t)*WT(t)}=Q(t)*σ(t-τ);
E{V(t)}=0;
E{V(t)*VT(t)}=R(t)*σ(t-τ);
E{W(t)*VT(t)}=0;
wherein, the superscript T represents the transposition sign of the vector, E { W (T) } and E { V (T) } are the mean operation functions of the random noise process, E { W (T) × WT(t) and E { V (t) } VT(t) is a function of variance operation of the random noise process, E { W (t) } VT(t) is a covariance operation function of two random noise processes, Q (t) and R (t) are respectively a variance intensity array of system noise and a variance intensity array of measurement noise, wherein Q (t) is a non-negative array and R (t) is a positive array, sigma (t-tau) is a unit pulse function, tau represents delay time, and t represents time.
The error three-dimensional vector equations of the GNSS combined inertial navigation all meet the requirements of the KALMAN filtering algorithm, so that the parameters and variables in the upper vector function and the observation function are converted into corresponding forms of the KALMAN filtering algorithm, namely:
wherein:is the amount of location that can be estimated using the KALMAN filtering algorithm, three components of the three-dimensional speed calculated and output by the MEMS inertial navigation system on a navigation coordinate system n and three components of the three-dimensional speed calculated and output by the GNSS receiver on the navigation coordinate system n are respectively represented. In addition, the value of R (t) is consistent with the noise intensity of GNSS, and the value of Q (t) is consistent with the noise intensity of the sensor in the inertial navigation system.
Can substitute x (t) and Z (t) into KALMAN filtering algorithm, and obtain the estimated value of x (t) after one-step calculation of KALMAN filtering
Estimating parametersLast three estimated parameters ofI.e. representing a second heading angle error, a second pitch angle error and a second polarization angle error.To representAn estimate of (d).
In a possible embodiment, said second angle error is a function of a second pitch angle error, a second heading angle error and a second polarizationAngular error to second pitch angle theta, second course angleAnd a second polarization angle γ update, comprising:
according to the second pitch angle theta and the second course angleAnd a second polarization angle gamma to obtain a first direction cosine matrixComprises the following steps:
obtaining a second direction cosine matrix according to the second pitch angle error, the second course angle error and the second polarization angle errorComprises the following steps:
wherein the content of the first and second substances,a second heading angle error is indicated that is,a second pitch angle error is indicated and,representing a second polarization angle error.
According to the second direction cosine matrixFor the cosine matrix of the first directionUpdating, specifically:
wherein the content of the first and second substances,representing the updated first direction cosine matrix
Cosine the first directionIs replaced byFrom a first direction cosine matrixTo a second pitch angle theta and a second course angleAnd the second polarization angle gamma is reversely calculated to obtain the updated second pitch angle theta and the updated second course angleAnd a second polarization angle gamma.
In this embodiment, the reverse calculation process specifically includes:
from the expression of the elements in the matrix, the following relation can be directly obtained:
θ=arcsin(C23)
since the angle is periodic in the trigonometric function calculation, γ hereMaster and slaveAndthe value of the main value domain in the inverse trigonometric function calculation is obtained, and when the true value of the full value domain is obtained, the conversion is carried out according to the coincidence, as shown in table 1 and table 2:
table 1 true value conversion table for polarization angle γ:
γmaster and slavePositive and negative sign of | C33Positive and negative sign of | Truth value of gamma |
+ | + | γMaster and slave |
- | + | γMaster and slave |
+ | - | γMaster and slave-180° |
- | - | γMaster and slave+180° |
thus, the updated second pitch angle theta and second course angle can be obtainedAnd a second polarization angle gamma.
In a possible embodiment, said first pitch angle SPA first course angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle γ, obtaining an angle error, comprising:
according to a first pitch angle SPA first course angle SHAnd a first polarization angle SRObtaining a third directional cosine matrixComprises the following steps:
acquiring the longitude and latitude information of the geographic position where the carrier is located in the antenna through a GNSS receiver as lambda, L]And according to the longitude and latitude information [ lambda, L ] of the geographic position]Obtaining the cosine matrix of the fourth directionComprises the following steps:
where λ represents longitude and L represents latitude.
According to the updated second pitch angle theta and the second course angleAnd a second polarization angle gamma to obtain a first direction cosine matrix
According to the first direction cosine matrixThird direction cosine matrixAnd a fourth direction cosine matrixObtaining a fifth directional cosine matrixThe fifth direction cosine matrixAnd a first direction cosine matrixThe expansion forms are the same and are calculated by three spatial angle values.
From the fifth direction cosine matrixThe space angle value is reversely calculated to obtain the theoretical pitch angle P under the carrier coordinate system b of the MEMS inertial navigation systembTheoretical polarization angle RbAnd theoretical course angle Hb。
According to theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbAnd obtaining the angle error.
The reverse calculation process is the same as the principle of the reverse calculation, and is not described herein again.
In one possible implementation mode, the antenna comprises a pitching shaft, a polarization shaft and a heading shaft, and a motor, a power driver and an encoder are arranged on the pitching shaft, the polarization shaft and the heading shaft.
The motor of the pitch shaft is used for rotating the pitch shaft so as to change the pitch angle; the power driver of the pitch axis is used for controlling the motor of the pitch axis to rotate; the encoder of the pitch shaft is used for measuring the angle of the pitch shaft to obtain the true pitch angle ax。
The motor of the polarization shaft is used for rotating the polarization shaft to change the polarization angle; the power driver of the polarization shaft is used for controlling the motor of the polarization shaft to rotate; the encoder of the polarization shaft is used for measuring the angle of the polarization shaft to obtain a real polarization angle ay。
The motor of the course shaft is used for rotating the course shaft so as to change a course angle; the power driver of the course shaft is used for controlling the motor of the course shaft to rotate; the encoder of the course shaft is used for measuring the angle of the course shaft to obtain a real course angle az。
In one possible embodiment, the angular error includes a pitch angle error, a polarization angle error, and a heading angle error.
According to the theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbObtaining an angle error, comprising:
according to theoretical pitch angle PbAnd true pitch angle axAcquiring a pitch angle error;
according to the theoretical angle of polarization RbAnd true polarization angle ayObtaining a polarization angle error;
according to the theoretical course angle HbAnd true heading angle azAnd acquiring course angle error.
In a possible embodiment, the pitch angle error δ θfsComprises the following steps:
δθfs=ax-Pb
the polarization angle error δ γfsComprises the following steps:
δγfs=ay-Rb
in a possible embodiment, the controlling the antenna to rotate by a corresponding angle according to the angle error includes:
controlling the rotation of the pitch axis by a corresponding angle according to the pitch angle error;
controlling the rotation corresponding angle of the polarization axis according to the polarization angle error;
and controlling the corresponding rotation angle of the course shaft according to the course angle error.
The invention provides a control method for motion isolation of a communication-in-motion antenna, which does not need to install expensive main inertial navigation system equipment on a carrier, nor does the antenna need to perform two-dimensional (three-dimensional) conical scanning motion; only the course axis of the antenna is controlled to perform single-dimensional sine swing, and the pitching axis and the polarization axis of the antenna do not have left-right scanning motion and directly and accurately point to the respective power maximum point. The invention enhances the intensity of the antenna receiving signal, enhances the anti-interference capability, increases the bandwidth and saves more energy. The invention has low implementation cost and can be widely applied to the communication between the antenna and the satellite in motion.
As shown in fig. 2, an antenna control system provided in the embodiment of the present application includes a microcontroller, a pitch axis power driver, a polarization axis power driver, a heading axis power driver, a pitch axis motor, a polarization axis motor, a heading axis motor, a beacon, and a combined inertial navigation system, where the combined inertial navigation system includes a GNSS receiver and a MEMS inertial navigation system.
The micro-control is electrically connected with the pitching shaft power driver, the polarization shaft power driver, the course shaft power driver, the beacon machine and the combined inertial navigation system through RS232 buses respectively, and the pitching shaft power driver, the polarization shaft power driver and the course shaft power driver are electrically connected with the pitching shaft motor, the polarization shaft motor and the course shaft motor respectively. The pitching shaft motor, the polarization shaft motor and the course shaft motor are all provided with coaxial encoders and are respectively connected to the pitching shaft power driver, the polarization shaft power driver and the course shaft power driver through one encoder.
And calculating an angle error through a microcontroller, and respectively controlling the pitching axis motor, the polarization axis motor and the course axis motor to rotate by corresponding angles according to the angle error to complete antenna control. In the control process, the microcontroller sends rotation signals to the pitch axis power driver, the polarization axis power driver and the course axis power driver through the RS232 bus respectively, and then sends PWM driving signals to the pitch axis motor, the polarization axis motor and the course axis motor through the pitch axis power driver, the polarization axis power driver and the course axis power driver respectively, so that the pitch axis motor, the polarization axis motor and the course axis motor are controlled to rotate by corresponding angles. The angles of the pitch axis motor, the polarization axis motor and the course axis motor can be respectively measured through the three encoders, so that a real pitch angle, a real polarization angle and a real course angle can be obtained. The real pitch angle, the real polarization angle and the real heading angle can be fed back to the microcontroller through the pitch axis power driver, the polarization axis power driver and the heading axis power driver respectively.
The method provided by the application is applied to a small-sized communication-in-motion antenna control system with 420mm caliber on a certain vehicle, a beacon machine is used for actual measurement in an external field test, and the output voltage value of the signal detection power of the antenna beacon machine is at least 0.5V higher than that of the signal detection power of the antenna beacon machine under the same configuration by using a similar product in the prior art.
Claims (8)
1. A control method for motion isolation of a communication-in-motion antenna is characterized in that a carrier for assembling the antenna is provided with a GNSS receiver and an MEMS inertial navigation system, and the control method comprises the following steps:
A. communicating with a satellite through a GNSS receiver to obtain the positions of the GNSS receiver and the satellite;
B. connecting the position of the GNSS receiver with the position of the satellite, and respectively taking the spatial included angles between the connecting line and the equator and the zero longitude line as a first pitch angle SPAnd a first course angle SHSetting a first polarization angle SRIs 0;
C. measuring a second pitch angle theta and a second course angle through the MEMS inertial navigation systemAnd a second polarization angle gamma, and solving a second pitch angle error, a second course angle error and a second polarization angle error;
D. according to the second pitch angle error, the second course angle error and the second polarization angle error, aligning the second pitch angle theta and the second course angleAnd updating the second polarization angle gamma to obtain a second updated pitch angle theta and a second updated course angleAnd a second angle of polarization gamma;
E. according to a first pitch angle SPA first course angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle gamma, obtaining an angle error;
F. and controlling the antenna to rotate by a corresponding angle according to the angle error to finish the control of the motion isolation of the antenna.
2. The method for controlling motion isolation of a mobile communication antenna according to claim 1, wherein the determining a second pitch angle error, a second course angle error and a second polarization angle error comprises:
the vector function for constructing the inertial navigation error is as follows:
where δ represents the prefix sign of the error amount, δ VnRepresenting the three-dimensional velocity error on the geographical coordinate system n where the antenna is located,δVE、δVNand δ VURespectively representing three-dimensional velocity errors deltaVnComponents in the east, north, and sky directions; E. n and U represent east, north and sky directions, respectively; the direction of the sky represents a direction perpendicular to a horizontal plane where the antenna is located and away from the ground;is represented by δ VnA differential of (f)nRepresenting a three-dimensional vector of specific forces measured by an accelerometer in a MEMS inertial navigation system on a geographical navigation coordinate system,fE、fNand fURespectively representing three-dimensional vectors fnThe components in the east, north and sky directions,a three-dimensional vector representing the rotation speed of the earth with respect to the inertial space i on a geographical coordinate system n,a three-dimensional vector representing the geographical position at which the antenna is located relative to the rotational speed of the earth's sphere,a three-dimensional vector representing the rotation speed of the geographical position where the antenna is located with respect to the inertial space i,three-dimensional vector, epsilon, representing accelerometer null error in geographic coordinate system nnRepresents a three-dimensional vector of zero errors of a gyroscope in the MEMS inertial navigation system on a geographic coordinate system n,respectively representError vector of (phi)nA three-dimensional vector of three angular errors representing the heading attitude of the carrier on a geographical coordinate system n,φE、φNand phiURespectively representing three-dimensional vectors phinThe components in the east, north and sky directions,is indicative of phinDifferentiation of (1);
taking three-dimensional speed of GNSS receiver as observed quantityAnd obtaining an observation function by the observed quantity as follows:
wherein the content of the first and second substances,representing a three-dimensional velocity vector on a navigation coordinate system n, which is calculated and output by the MEMS inertial navigation system, wherein ins represents the MEMS inertial navigation system;
and acquiring a second pitch angle error, a second course angle error and a second polarization angle error by adopting a KALMAN filtering algorithm according to the vector function and the observation function of the inertial navigation error.
3. The method as claimed in claim 2, wherein the step of adjusting the tilt angle θ and the second heading angle θ is performed according to the second tilt angle error, the second heading angle error and the second polarization angle errorAnd a second polarization angle γ update, comprising:
according to the second pitch angle theta and the second course angleAnd a second angle of polarization gamma, toTaking a first direction cosine matrixComprises the following steps:
obtaining a second direction cosine matrix according to the second pitch angle error, the second course angle error and the second polarization angle errorComprises the following steps:
wherein the content of the first and second substances,a second heading angle error is indicated that is,a second pitch angle error is indicated and,representing a second polarization angle error;
according to the second direction cosine matrixFor the cosine matrix of the first directionUpdating, specifically:
wherein the content of the first and second substances,representing the updated first direction cosine matrix
Cosine the first directionIs replaced byFrom a first direction cosine matrixTo a second pitch angle theta and a second course angleAnd the second polarization angle gamma is reversely calculated to obtain the updated second pitch angle theta and the updated second course angleAnd a second polarization angle gamma.
4. Method for controlling motion isolation of a mobile communication antenna according to claim 3, wherein said first pitch angle S is defined as the first pitch anglePA first course angle SHFirst angle of polarization SRThe updated second pitch angle theta and the second course angleAnd a second polarization angle γ, obtaining an angle error, comprising:
according to a first pitch angle SPA first course angle SHAnd a first polarization angle SRObtaining a third directional cosine matrixComprises the following steps:
acquiring the longitude and latitude information of the geographic position where the carrier is located in the antenna through a GNSS receiver as lambda, L]And according to the longitude and latitude information [ lambda, L ] of the geographic position]Obtaining the cosine matrix of the fourth directionComprises the following steps:
wherein λ represents longitude and L represents latitude;
according to the updated second pitch angle theta and the second course angleAnd a second polarization angle gamma to obtain a first direction cosine matrix
According to the first direction cosine matrixThird direction cosine matrixAnd a fourth direction cosine matrixObtaining a fifth directional cosine matrixThe fifth direction cosine matrixAnd a first direction cosine matrixThe expansion forms are the same and are calculated by three spatial angle values;
from the fifth direction cosine matrixThe space angle value is reversely calculated to obtain the theoretical pitch angle P under the carrier coordinate system b of the MEMS inertial navigation systembTheoretical polarization angle RbAnd theoretical course angle Hb;
According to theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbAnd obtaining the angle error.
5. The method for controlling motion isolation of a mobile communication antenna according to claim 4, wherein the antenna comprises a pitch axis, a polarization axis and a heading axis, and the pitch axis, the polarization axis and the heading axis are respectively provided with a motor, a power driver and an encoder;
the motor of the pitch shaft is used for rotating the pitch shaft so as to change the pitch angle; the power driver of the pitch axis is used for controlling the motor of the pitch axis to rotate; the encoder of the pitch shaft is used for measuring the angle of the pitch shaft to obtain the true pitch angle ax;
The motor of the polarization shaft is used for rotating the polarization shaft to change the polarization angle; the power driver of the polarization shaft is used for controlling the motor of the polarization shaft to rotate; the encoder of the polarization shaft is used for measuring the angle of the polarization shaft to obtain a real polarization angle ay;
The motor of the course shaft is used for rotating the course shaft to change the course angle(ii) a The power driver of the course shaft is used for controlling the motor of the course shaft to rotate; the encoder of the course shaft is used for measuring the angle of the course shaft to obtain a real course angle az。
6. The method for controlling motion isolation of a mobile communication antenna according to claim 5, wherein the angle error includes a pitch angle error, a polarization angle error and a heading angle error;
according to the theoretical pitch angle PbTheoretical polarization angle RbAnd theoretical course angle HbObtaining an angle error, comprising:
according to theoretical pitch angle PbAnd true pitch angle axAcquiring a pitch angle error;
according to the theoretical angle of polarization RbAnd true polarization angle ayObtaining a polarization angle error;
according to the theoretical course angle HbAnd true heading angle azAnd acquiring course angle error.
7. The method for controlling motion isolation of a mobile communication antenna according to claim 6, wherein the pitch angle error δ θfsComprises the following steps:
δθfs=ax-Pb
the polarization angle error δ γfsComprises the following steps:
δγfs=ay-Rb
8. the method for controlling motion isolation of a mobile communication antenna according to claim 6, wherein the controlling the antenna to rotate by a corresponding angle according to the angle error comprises:
controlling the rotation of the pitch axis by a corresponding angle according to the pitch angle error;
controlling the rotation corresponding angle of the polarization axis according to the polarization angle error;
and controlling the corresponding rotation angle of the course shaft according to the course angle error.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111193228.3A CN113849003B (en) | 2021-10-13 | Control method for motion isolation of communication-in-motion antenna |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111193228.3A CN113849003B (en) | 2021-10-13 | Control method for motion isolation of communication-in-motion antenna |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113849003A true CN113849003A (en) | 2021-12-28 |
CN113849003B CN113849003B (en) | 2024-04-26 |
Family
ID=
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090295633A1 (en) * | 2008-06-02 | 2009-12-03 | Pinto Robert W | Attitude estimation using intentional translation of a global navigation satellite system (GNSS) antenna |
CN102662188A (en) * | 2012-04-11 | 2012-09-12 | 北京星网宇达科技股份有限公司 | Initializing method of mobile satellite communication antenna |
CN103792561A (en) * | 2014-02-21 | 2014-05-14 | 南京理工大学 | Tight integration dimensionality reduction filter method based on GNSS channel differences |
CN104124528A (en) * | 2014-05-05 | 2014-10-29 | 北京星网卫通科技开发有限公司 | Inertia/GNSS (Global Navigation Satellite System)/satellite beacon based integrated communication on the move antenna stabilization tracking method |
US20160349058A1 (en) * | 2014-06-13 | 2016-12-01 | Beijing Aerospace Wanda Hi-Tech Ltd. | Method and System for Controlling Antenna of Mobile Communication Application System Based on Double Quaternions in MEMS Inertial Navigation |
CN110926468A (en) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment |
CN111947653A (en) * | 2020-08-13 | 2020-11-17 | 北京航空航天大学 | Dual-mode inertial/visual/astronomical navigation method for lunar surface inspection tour detector |
US20210011175A1 (en) * | 2019-06-04 | 2021-01-14 | Atlantic Inertial Systems Limited | Direction finder |
CN112378400A (en) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | Dual-antenna GNSS assisted strapdown inertial navigation integrated navigation method |
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090295633A1 (en) * | 2008-06-02 | 2009-12-03 | Pinto Robert W | Attitude estimation using intentional translation of a global navigation satellite system (GNSS) antenna |
CN102662188A (en) * | 2012-04-11 | 2012-09-12 | 北京星网宇达科技股份有限公司 | Initializing method of mobile satellite communication antenna |
CN103792561A (en) * | 2014-02-21 | 2014-05-14 | 南京理工大学 | Tight integration dimensionality reduction filter method based on GNSS channel differences |
CN104124528A (en) * | 2014-05-05 | 2014-10-29 | 北京星网卫通科技开发有限公司 | Inertia/GNSS (Global Navigation Satellite System)/satellite beacon based integrated communication on the move antenna stabilization tracking method |
US20160349058A1 (en) * | 2014-06-13 | 2016-12-01 | Beijing Aerospace Wanda Hi-Tech Ltd. | Method and System for Controlling Antenna of Mobile Communication Application System Based on Double Quaternions in MEMS Inertial Navigation |
US20210011175A1 (en) * | 2019-06-04 | 2021-01-14 | Atlantic Inertial Systems Limited | Direction finder |
CN110926468A (en) * | 2019-12-05 | 2020-03-27 | 中国电子科技集团公司第五十四研究所 | Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment |
CN111947653A (en) * | 2020-08-13 | 2020-11-17 | 北京航空航天大学 | Dual-mode inertial/visual/astronomical navigation method for lunar surface inspection tour detector |
CN112378400A (en) * | 2020-10-30 | 2021-02-19 | 湖南航天机电设备与特种材料研究所 | Dual-antenna GNSS assisted strapdown inertial navigation integrated navigation method |
Non-Patent Citations (1)
Title |
---|
苗萍;杨洪勇;杨志群;曲晓云;韩泉城;石宝民;: "Ku频段车载"动中通"天线信号的遮挡检测及恢复方法", 鲁东大学学报(自然科学版), no. 03 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110780326A (en) | Vehicle-mounted integrated navigation system and positioning method | |
CN100587641C (en) | A kind of attitude determination system that is applicable to the arbitrary motion mini system | |
CN110779521A (en) | Multi-source fusion high-precision positioning method and device | |
CN113311436B (en) | Method for correcting wind measurement of motion attitude of laser wind measuring radar on mobile platform | |
CN110926468B (en) | Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment | |
CN108181630B (en) | Beidou double-antenna rotation rapid orientation method | |
CN104713555A (en) | Autonomous vehicle navigation method for assisting orientation by applying omnimax neutral point | |
CN108151737A (en) | A kind of unmanned plane bee colony collaborative navigation method under the conditions of the mutual observed relationships of dynamic | |
CN105371838A (en) | Combination navigation method and combination navigation system based on INS assisted GNSS single antenna attitude measurement | |
CN104697520A (en) | Combined navigation method based on integrated gyroscope free strapdown inertial navigation system and GPS | |
CN103604428A (en) | Star sensor positioning method based on high-precision horizon reference | |
CN102117952A (en) | Four-shaft stable framework for antenna and control method | |
CN107830873B (en) | High-precision vehicle positioning and orientation method based on combination of single-shaft horizontal rotation inertial navigation and odometer | |
CN106054185A (en) | Airborne double antenna InSAR base line calculating method based on distributed POS | |
CN108151765A (en) | Attitude positioning method is surveyed in a kind of positioning of online real-time estimation compensation magnetometer error | |
CN105928519B (en) | Navigation algorithm based on INS inertial navigation and GPS navigation and magnetometer | |
CN108205151B (en) | Low-cost GPS single-antenna attitude measurement method | |
CN113794497A (en) | Mobile satellite communication antenna terminal with anti-interference positioning function | |
CN109471102B (en) | Inertial measurement unit error correction method | |
CN112083425A (en) | SINS/LBL tight combination navigation method introducing radial velocity | |
CN113849003B (en) | Control method for motion isolation of communication-in-motion antenna | |
Huang et al. | Research on UAV flight performance test method based on dual antenna GPS/INS integrated system | |
CN113849003A (en) | Control method for motion isolation of communication-in-motion antenna | |
CN105739542A (en) | Interest point tracking control method based on two-shaft radar servo platform | |
Jia et al. | Self-calibration of INS/odometer integrated system via Kalman filter |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20231128 Address after: Room 327, Zone A, 3rd Floor, Building 5, No. 261 Sanbang Road, Songjiang District, Shanghai, 200000 Applicant after: Fuyuanxin (Shanghai) Technology Co.,Ltd. Address before: 710000 1303-a132, 13th floor, Kaiwei building, No. 2, Guangtai Road, high tech Zone, Xi'an, Shaanxi Applicant before: Xi'an yinnashu Intelligent Technology Co.,Ltd. |
|
GR01 | Patent grant |