CN115359095A - Universal motion platform tracking and guiding calculation method - Google Patents

Universal motion platform tracking and guiding calculation method Download PDF

Info

Publication number
CN115359095A
CN115359095A CN202211277344.8A CN202211277344A CN115359095A CN 115359095 A CN115359095 A CN 115359095A CN 202211277344 A CN202211277344 A CN 202211277344A CN 115359095 A CN115359095 A CN 115359095A
Authority
CN
China
Prior art keywords
motion platform
coordinate
target
angle
coordinates
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
Application number
CN202211277344.8A
Other languages
Chinese (zh)
Other versions
CN115359095B (en
Inventor
游安清
孙会
王智涌
田俊林
罗俊
赵平
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Institute of Applied Electronics of CAEP
Original Assignee
Institute of Applied Electronics of CAEP
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Institute of Applied Electronics of CAEP filed Critical Institute of Applied Electronics of CAEP
Priority to CN202211277344.8A priority Critical patent/CN115359095B/en
Publication of CN115359095A publication Critical patent/CN115359095A/en
Application granted granted Critical
Publication of CN115359095B publication Critical patent/CN115359095B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/20Analysis of motion
    • G06T7/246Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06TIMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00Image analysis
    • G06T7/70Determining position or orientation of objects or cameras
    • G06T7/73Determining position or orientation of objects or cameras using feature-based methods

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Navigation (AREA)

Abstract

The invention relates to a general tracking, guiding and calculating method for a moving platform, which belongs to the technical field of photoelectric tracking, and is used for acquiring the ground-fixed coordinates of a target and the geodetic coordinates of the moving platform in real time or acquiring the azimuth pitching coordinates of the target relative to a horizontal coordinate system of the moving platform in real time and calculating the horizontal coordinates of the target at the moving platform; the method comprises the steps of acquiring the three-axis attitude of the motion platform in real time, calibrating the three-axis installation attitude angle of an observation system coordinate system relative to the motion platform coordinate system, and resolving the spherical coordinates of the target in the observation system coordinate system based on the horizontal coordinates of the target at the motion platform to obtain tracking guide data.

Description

Universal motion platform tracking and guiding calculation method
Technical Field
The invention belongs to the technical field of photoelectric tracking, and particularly relates to a general tracking guidance calculation method for a motion platform.
Background
In a photoelectric observation system on a motion platform such as a vehicle, a ship, a machine and the like, operations such as tracking guidance, capturing, tracking closed loop, target identification and the like are often required to be carried out on an observation object, wherein the tracking guidance is a starting point of the whole link, and a guidance method and precision are crucial to the target capturing efficiency. Because the platform is moving, the position and the posture of the platform change in real time, and therefore a calculation model needs to be established to complete tracking and guiding calculation. Due to the fact that the photoelectric observation systems are mounted in various modes, such as vertical type, horizontal type and nacelle type, calculation models are different and lack of universality.
Disclosure of Invention
In order to solve the above problems, a general motion platform tracking and guiding calculation method is proposed.
In order to achieve the purpose, the invention provides the following technical scheme:
a general motion platform tracking and guiding calculation method comprises the following steps:
s100, acquiring the ground-fixed coordinate of a target and the geodetic coordinate of a moving platform in real time, or acquiring the azimuth pitching coordinate of the target relative to a ground coordinate system of the moving platform in real time, and calculating the ground coordinate of the target at the moving platform;
s200, acquiring the three-axis attitude of the motion platform in real time, calibrating the three-axis installation attitude angle of an observation system coordinate system relative to the motion platform coordinate system, and resolving the spherical coordinates of the target in the observation system coordinate system based on the horizontal coordinates of the target at the motion platform to obtain tracking guidance data.
The invention is further configured that in step S100, when the target is an unnatural celestial body, the method for calculating the horizon coordinate of the target at the motion platform comprises the following steps:
s101, acquiring geodetic coordinates of a motion platform in real time, and resolving the geodetic coordinates of the motion platform based on the geodetic coordinates of the motion platform;
s102, acquiring the earth-fixed coordinates of a target in real time, and calculating the station center earth-fixed coordinates of the target at the motion platform based on the earth-fixed coordinates of the motion platform;
s103, calculating the horizon coordinate of the target at the motion platform based on the station center earth-fixed coordinate of the target and the geodetic coordinate of the motion platform.
The invention is further arranged that in step S101, the geodetic coordinates of the motion platform obtained in real time are
Figure 852072DEST_PATH_IMAGE001
Resolving the geodetic coordinates of the motion platform into
Figure 93698DEST_PATH_IMAGE002
The method specifically comprises the following steps:
Figure 899980DEST_PATH_IMAGE003
wherein the content of the first and second substances,
Figure 277871DEST_PATH_IMAGE004
a represents the equatorial radius of the earth, and
Figure 144196DEST_PATH_IMAGE005
f represents the oblateness of the earth, an
Figure 873118DEST_PATH_IMAGE006
L denotes longitude, B denotes latitude, and H denotes altitude.
The invention is further configured that, in step S102, the real-time acquired ground-fixed coordinates of the target are
Figure 217511DEST_PATH_IMAGE007
Based on the ground fixed coordinates of the motion platform
Figure 981068DEST_PATH_IMAGE002
Resolving the station center earth-fixed coordinates of the target at the motion platform
Figure 487136DEST_PATH_IMAGE008
The method specifically comprises the following steps:
Figure 968933DEST_PATH_IMAGE009
the invention is further arranged that, in step S103, the station center earth-fixed coordinates based on the object are determined
Figure 851438DEST_PATH_IMAGE008
And geodetic coordinates of said motion platform
Figure 469501DEST_PATH_IMAGE001
Calculating the horizon coordinate of the target at the motion platform
Figure 146470DEST_PATH_IMAGE010
The method specifically comprises the following steps:
Figure 849984DEST_PATH_IMAGE011
wherein the content of the first and second substances,
Figure 801759DEST_PATH_IMAGE012
a coordinate transformation matrix representing a rotation by an angle θ about an x-axis or a y-axis or a z-axis, axis = x or y or z, representing an axis about which the coordinates are rotated;
depending on the axis about which the coordinates are rotated,
Figure 8750DEST_PATH_IMAGE013
the specific expressions of (a) are respectively:
Figure 387779DEST_PATH_IMAGE014
Figure 313009DEST_PATH_IMAGE015
Figure 802896DEST_PATH_IMAGE016
the invention further provides that, in step S100, when the target is a planet, the horizon coordinate of the target at the motion platform is calculated, specifically:
acquiring azimuth and elevation coordinates (A, E) of a target relative to a horizon coordinate system at a moving platform in real time, wherein the horizon coordinate of the target at the moving platform is
Figure 395552DEST_PATH_IMAGE017
And is made of
Figure 679903DEST_PATH_IMAGE018
Where A denotes the azimuth and E denotes the pitch.
The invention is further arranged that step S200 comprises the steps of:
s201, acquiring a three-axis attitude of the motion platform in real time, and resolving a rectangular coordinate of the target in a coordinate of the motion platform based on a horizontal coordinate of the target at the motion platform;
s202, calibrating a three-axis installation attitude angle of a coordinate system of an observation system relative to a coordinate system of a motion platform, and resolving a rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the coordinate of the motion platform;
s203, resolving the spherical coordinates of the target in the coordinate system of the observation system based on the rectangular coordinates of the target in the observation system to obtain tracking guidance data.
The invention is further configured that, in step S201, the three-axis posture of the motion platform is obtained in real time as
Figure 92429DEST_PATH_IMAGE019
Calculating the rectangular coordinate of the target in the motion platform coordinate based on the horizontal coordinate of the target at the motion platform
Figure 120428DEST_PATH_IMAGE020
Is concretely provided with:
Figure 567590DEST_PATH_IMAGE021
Figure 22842DEST_PATH_IMAGE022
A coordinate transformation matrix representing a rotation of a gamma angle around the y-axis,
Figure 188244DEST_PATH_IMAGE023
a coordinate transformation matrix representing a rotation by an angle beta about the x-axis,
Figure 19934DEST_PATH_IMAGE024
and a coordinate transformation matrix representing a negative angle alpha of rotation around the z axis, wherein alpha represents a course angle, beta represents a pitch angle, and gamma represents a roll angle.
The invention is further arranged that in step S202, the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform is calibrated
Figure 56023DEST_PATH_IMAGE025
Solving the rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the coordinates of the motion platform
Figure 682177DEST_PATH_IMAGE026
The method specifically comprises the following steps:
Figure 69296DEST_PATH_IMAGE027
wherein, in the process,
Figure 439097DEST_PATH_IMAGE028
representing a three-axis installation attitude angle matrix.
The present invention is further configured that, in step S203, the spherical coordinate (a, e, R) of the target in the observation system coordinate system is calculated based on the rectangular coordinate of the target in the observation system, specifically:
in the case of a vertical type observation system,
Figure 860851DEST_PATH_IMAGE029
for a horizontal-type observation system, the observation angle is set to be zero,
Figure 923485DEST_PATH_IMAGE030
in the case of a pod-type observation system,
Figure 532321DEST_PATH_IMAGE031
where α represents an azimuth angle, e represents a pitch angle, and R represents a pitch distance.
The invention is further arranged that in step S200, the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform
Figure 705813DEST_PATH_IMAGE032
The calibration method specifically comprises the following steps:
fixedly mounting an observation system on a motion platform, and acquiring geodetic coordinates and three-dimensional postures of the motion platform in real time
Figure 982074DEST_PATH_IMAGE033
Selecting more than three points with known positions in different directions of space as calibration points, and acquiring the ground-fixed coordinates of the calibration points;
obtaining the horizon coordinate of the target at the motion platform based on the step S100, and resolving the position of the calibration point relative to the horizon coordinate system of the observation system
Figure 950030DEST_PATH_IMAGE034
Adjusting the three-axis installation attitude angle of the observation system to observe the calibration points to obtain the observation positions of the calibration points
Figure 311741DEST_PATH_IMAGE035
Resolving three-axis installation attitude angle of coordinate system of observation system relative to coordinate system of motion platform
Figure 23345DEST_PATH_IMAGE032
The invention is further arranged that the horizon coordinate of the target at the motion platform is obtained based on the step S100
Figure 419692DEST_PATH_IMAGE017
And resolving the position of the calibration point relative to the horizon coordinate system of the observation system
Figure 558549DEST_PATH_IMAGE034
The method specifically comprises the following steps:
Figure 141977DEST_PATH_IMAGE036
a represents an azimuth angle, and E represents a pitch angle.
The invention is further arranged that the observation position of each calibration point is obtained
Figure 922851DEST_PATH_IMAGE035
Resolving the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform
Figure 908125DEST_PATH_IMAGE032
The method specifically comprises the following steps:
Figure 483462DEST_PATH_IMAGE037
the method comprises the following steps that theta represents a course angle of a motion platform, beta represents an attitude elevation angle of the motion platform, gamma represents a roll angle of the motion platform, alpha represents an azimuth angle, and e represents a pitch angle.
The invention has the beneficial effects that:
1. by adopting a coordinate system transformation method, a general motion platform tracking guidance calculation method is established, real-time calculation of target tracking guidance data is realized, and the method has a good application prospect in the field of motion platform photoelectric observation.
2. And aiming at observation systems with different installation modes such as vertical type, horizontal type and nacelle type, a corresponding difference calculation method is provided.
3. And aiming at different types of targets, a calculation method of the difference corresponding to the targets is given.
4. The coordinate system of the observation system is an abstract concept relative to the three-axis installation attitude angle of the coordinate system of the motion platform, the abstract concept is invisible in physical space and cannot be obtained through tool measurement, accurate data can be obtained through a calibration method of the coordinate system of the observation system relative to the three-axis installation attitude angle of the coordinate system of the motion platform, and accuracy of target tracking guide data is improved.
Drawings
FIG. 1 is a flow diagram of a general motion platform tracking guidance calculation method;
FIG. 2 is a schematic diagram of an observation system coordinate system, a motion platform coordinate system, and a horizon coordinate system;
FIG. 3 is a schematic view of a vision system in a different installation;
fig. 3 (a) is a schematic view of a vertical observation system, fig. 3 (b) is a schematic view of a horizontal observation system, and fig. 3 (c) is a schematic view of a pod-type observation system.
Detailed Description
In order to make the technical solutions of the present invention better understood, the following description of the technical solutions of the present invention with reference to the accompanying drawings of the present invention is made clearly and completely, and other similar embodiments obtained by a person of ordinary skill in the art without any creative effort based on the embodiments in the present application shall fall within the protection scope of the present application. In addition, directional terms such as "upper", "lower", "left", "right", etc. in the following embodiments are directions with reference to the drawings only, and thus, the directional terms are used for illustrating the present invention and not for limiting the present invention.
The first embodiment is as follows:
as shown in fig. 1, a general motion platform tracking guidance calculation method includes the following steps:
s100, acquiring the earth-fixed coordinates of the target and the geodetic coordinates of the moving platform in real time, or acquiring the azimuth pitching coordinates of the target relative to the horizon coordinate system of the moving platform in real time, and resolving the horizon coordinates of the target at the moving platform.
The earth-fixed coordinate system relates to an earth-fixed coordinate system, and the earth-fixed coordinate system is a coordinate system fixed on the earth and rotating together with the earth. The geodetic coordinates refer to a geodetic coordinate system which is established in geodetic surveying with reference to an ellipsoid as a reference surface, and the positions of ground points are expressed in terms of longitude, latitude, and height (altitude). The horizontal coordinate system at the position of the motion platform takes the position of the motion platform as a central point, and the horizontal line of the position of the motion platform is taken as a base plane.
Preferably, when the target is an unnatural celestial body, including a ground fixed point target, an aerial rotor unmanned aerial vehicle target, a floating balloon, an airplane, a missile, a satellite and the like, the method for calculating the horizon coordinate of the target at the moving platform comprises the following steps:
s101, acquiring the geodetic coordinates of the motion platform in real time, and resolving the geodetic coordinates of the motion platform based on the geodetic coordinates of the motion platform.
Preferably, the geodetic coordinates of the motion platform acquired in real time are
Figure 288607DEST_PATH_IMAGE001
Resolving the geodetic coordinates of the motion platform into
Figure 607593DEST_PATH_IMAGE002
The method specifically comprises the following steps:
Figure 447373DEST_PATH_IMAGE003
wherein, the first and the second end of the pipe are connected with each other,
Figure 193612DEST_PATH_IMAGE004
a represents the equatorial radius of the earth, and
Figure 751633DEST_PATH_IMAGE005
f represents the oblateness of the earth, and
Figure 608730DEST_PATH_IMAGE006
l represents longitude, B represents latitude, and H represents altitude.
S102, acquiring the earth-fixed coordinates of the target in real time, and calculating the station center earth-fixed coordinates of the target at the motion platform based on the earth-fixed coordinates of the motion platform.
Preferably, the real-time acquired earth-fixed coordinate of the target is
Figure 568596DEST_PATH_IMAGE007
Based on the ground fixed coordinates of the motion platform
Figure 485736DEST_PATH_IMAGE002
Resolving the station center earth-fixed coordinates of the target at the motion platform
Figure 531053DEST_PATH_IMAGE008
The method specifically comprises the following steps:
Figure 926262DEST_PATH_IMAGE009
s103, calculating the horizon coordinate of the target at the motion platform based on the station center earth-fixed coordinate of the target and the geodetic coordinate of the motion platform.
Preferably, the station center earth-fixed coordinate based on the target
Figure 6214DEST_PATH_IMAGE008
And geodetic coordinates of the motion platform
Figure 828676DEST_PATH_IMAGE001
Calculating the horizon coordinate of the target at the moving platform
Figure 361289DEST_PATH_IMAGE010
The method specifically comprises the following steps:
Figure 560189DEST_PATH_IMAGE011
wherein the content of the first and second substances,
Figure 494647DEST_PATH_IMAGE012
a coordinate transformation matrix representing a rotation of θ degrees around an x-axis or a y-axis or a z-axis, axis = x or y or z, representing an axis around which the coordinates are rotated;
depending on the axis about which the coordinates are rotated,
Figure 488011DEST_PATH_IMAGE013
the specific expressions of (a) are respectively:
Figure 507919DEST_PATH_IMAGE014
Figure 776089DEST_PATH_IMAGE015
Figure 299475DEST_PATH_IMAGE016
preferably, when the target is a planet, the method includes resolving a horizon coordinate of the target at the motion platform, specifically:
acquiring azimuth and elevation coordinates (A, E) of a target relative to a horizon coordinate system at a moving platform in real time, wherein the horizon coordinate of the target at the moving platform is
Figure 729319DEST_PATH_IMAGE017
And is and
Figure 970944DEST_PATH_IMAGE018
a represents an azimuth angle, and E represents a pitch angle.
The planets mainly refer to natural celestial bodies such as the stars, the days, the months and the stars, and generally cannot obtain the earth-center earth-fixed coordinates of the objects
Figure 511647DEST_PATH_IMAGE007
And only the azimuth and elevation data (A, E) of the horizon coordinate system of the target relative to the moving platform can be obtained, the target distance R =1 is implied, and R is reduced in the process of calculating the tracking guide angleThe setting of R has little effect and this processing skill is often used in the tracking guidance calculation of remote targets.
S200, acquiring the three-axis attitude of the motion platform in real time, calibrating the three-axis installation attitude angle of an observation system coordinate system relative to the motion platform coordinate system, and resolving the spherical coordinates of the target in the observation system coordinate system based on the horizontal coordinates of the target at the motion platform to obtain tracking guidance data.
Preferably, the platform coordinate system refers to a coordinate system defined on a moving platform, such as an airplane, a vehicle, a ship, a satellite, etc. Taking an airplane as an example, the coordinate origin may be defined at any position on the airplane, where the x-axis points to the right wing direction, the y-axis points to the nose direction, and the z-axis points to the sky direction. In the tracking and guiding calculation process of the motion platform, the real-time position and the attitude of the motion platform need to be introduced, the position of the motion platform can be measured by instruments such as a GPS (global positioning system) and the like or can be obtained by astronomical calculation, and the attitude can be measured by angle sensors (a gyroscope, inertial navigation and the like) and comprises a course angle alpha, a pitch angle beta and a roll angle gamma. In view of the fact that the pose change of the motion platform coordinate system needs to be reflected in real time by means of measurement equipment such as inertial navigation equipment, the motion platform coordinate system is generally represented by an installed inertial navigation coordinate system, the origin of the motion platform coordinate system is located at the inertial navigation center, and the three-axis direction is the three edge directions of an inertial navigation product.
The attitude angle has definite definition and value range: the heading angle can be defined as the included angle between the heading angle and the true north direction, the true north is 0 DEG, the heading angle is counted clockwise and takes the value
Figure 155118DEST_PATH_IMAGE038
(ii) a The pitch angle is defined as the included angle between the head direction and the horizontal plane, the included angle is 0 degree in the horizontal plane, the included angle is positive on the plane and negative under the plane, and the value is taken
Figure 21443DEST_PATH_IMAGE039
(ii) a The roll angle is defined as the angle between the lateral direction and the horizontal plane, the downward pressure is positive, the upward pressure is negative, and the value is taken
Figure 484785DEST_PATH_IMAGE039
. Three forThe attitude angles are the rotation angles around the z, x, y axes of the motion platform coordinate system, respectively.
The observation system coordinate system refers to a coordinate system defined on the observation system, and is generally characterized by two angles, such as an observation azimuth angle and an observation pitch angle. The definition depends on the rotary joint of the observation system, and is marked by the appointed angle zero position and the angle increasing and decreasing direction. The zero position includes an equipment zero position and a space zero position, the equipment zero position is a zero scale mark on an angle sensor carried by the observation system, the space zero position refers to a defined zero position in a specific occasion, for example, the north direction is generally defined as an azimuth angle zero position, and the horizontal plane is defined as a pitch angle zero position.
For a static and flat ground observation platform, the unification of the zero position of equipment and the zero position of space is a work which is often done, and the work is called orientation and pitching zero position calibration and is generally determined by observing the Polaris. For observation systems on motion platforms such as vehicles, ships and machines, generally, the zero position is not uniformly worked, but the pose relationship of the coordinate system of the observation system relative to the coordinate system of the motion platform is calibrated, as shown in fig. 2. Under the condition of not considering the relative offset of the two coordinate systems, the relative relationship of the two coordinate systems can be characterized by three attitude angles, namely a heading angle u, a pitch angle v and a rolling angle w of the coordinate system of the observation system relative to the coordinate system of the motion platform, and the three angles are calibrated or an attitude rotation matrix of the joint action of the three angles is calibrated
Figure 94758DEST_PATH_IMAGE040
. Since these three angles function in the form of three attitude rotation matrices, they are generally used together as a composite attitude matrix, namely:
Figure 327156DEST_PATH_IMAGE041
specifically, step S200 includes the following steps:
s201, acquiring a three-axis attitude of the motion platform in real time, and resolving a rectangular coordinate of the target in the motion platform coordinate based on a horizontal coordinate of the target at the motion platform.
Preferably, the three-axis posture of the motion platform is acquired in real time as
Figure 364383DEST_PATH_IMAGE019
Calculating rectangular coordinates of the object within the motion platform coordinates based on the horizon coordinates of the object at the motion platform
Figure 315021DEST_PATH_IMAGE020
The method specifically comprises the following steps:
Figure 463106DEST_PATH_IMAGE021
Figure 815590DEST_PATH_IMAGE022
a coordinate transformation matrix representing a rotation of a gamma angle around the y-axis,
Figure 23717DEST_PATH_IMAGE023
a coordinate transformation matrix representing a rotation by an angle beta about the x-axis,
Figure 461652DEST_PATH_IMAGE024
and a coordinate transformation matrix representing a negative angle alpha of rotation around the z axis, wherein alpha represents a course angle, beta represents a pitch angle, and gamma represents a roll angle.
S202, calibrating a triaxial installation attitude angle of a coordinate system of the observation system relative to a coordinate system of a motion platform, and resolving a rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the coordinate system of the motion platform.
Preferably, the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform is calibrated
Figure 413427DEST_PATH_IMAGE025
Solving the rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the coordinates of the motion platform
Figure 620418DEST_PATH_IMAGE026
The method specifically comprises the following steps:
Figure 999446DEST_PATH_IMAGE027
wherein, in the step (A),
Figure 207834DEST_PATH_IMAGE028
representing a three-axis installation attitude angle matrix.
S203, resolving the spherical coordinates of the target in the coordinate system of the observation system based on the rectangular coordinates of the target in the observation system to obtain tracking guidance data.
Preferably, as shown in fig. 3, the calculating the object spherical coordinate (a, e, R) in the observation system coordinate system based on the object rectangular coordinate in the observation system specifically includes:
in the case of a vertical observation system,
Figure 432142DEST_PATH_IMAGE029
for a horizontal-type observation system, the observation angle is set to be zero,
Figure 24798DEST_PATH_IMAGE030
in the case of a pod-type observation system,
Figure 43569DEST_PATH_IMAGE031
where α represents an azimuth angle, e represents a pitch angle, and R represents a pitch distance.
The vertical observation system, the horizontal observation system and the pod observation system are mature prior art and do not belong to the invention point of the invention, so the installation mode is explained by adopting the existing photos.
The above calculation formulas for the horizontal observation system and the pod observation system are not simple and depend on the coordinate definition of the actual system, including the zero position and the increasing and decreasing direction of the angle a and e. The definition of azimuth angle and pitch angle in a vertical observation system is basically defined in a common way: the true north is an azimuth zero line and is counted clockwise; the horizontal plane is a pitching zero-position plane and is positive and negative in the upper part.
In step S200, the coordinate system of the observation system is installed at the attitude angle of the three axes relative to the coordinate system of the motion platform
Figure 721675DEST_PATH_IMAGE025
The calibration method specifically comprises the following steps:
fixedly mounting an observation system on a motion platform, and acquiring geodetic coordinates and three-dimensional postures of the motion platform in real time
Figure 749674DEST_PATH_IMAGE042
Selecting more than three points with known positions in different directions of the space as calibration points, and acquiring the earth-fixed coordinates of the calibration points.
Obtaining the horizon coordinate of the target at the motion platform based on the step S100, and resolving the position of the calibration point relative to the horizon coordinate system of the observation system
Figure 196836DEST_PATH_IMAGE043
Specifically, the horizontal coordinate of the target at the motion platform is obtained based on step S100
Figure 652088DEST_PATH_IMAGE044
And resolving the position of the calibration point relative to the horizon coordinate system of the observation system
Figure 551911DEST_PATH_IMAGE043
The method specifically comprises the following steps:
Figure 118021DEST_PATH_IMAGE045
adjusting the three-axis installation attitude angle of the observation system to observe the calibration points to obtain the observation positions of the calibration points
Figure 685269DEST_PATH_IMAGE035
Resolving three-axis installation attitude angle of coordinate system of observation system relative to coordinate system of motion platform
Figure 577002DEST_PATH_IMAGE032
Preferably, the obtaining of the observation position of each calibration point
Figure 698541DEST_PATH_IMAGE035
Resolving three-axis installation attitude angle of coordinate system of observation system relative to coordinate system of motion platform
Figure 333922DEST_PATH_IMAGE032
The method specifically comprises the following steps:
Figure 490097DEST_PATH_IMAGE046
wherein, theta represents the course angle of the moving platform, beta represents the attitude elevation angle of the moving platform, and gamma represents the roll angle of the moving platform.
When the target is a star, the number is almost infinite, with millions or more. In most cases, the observation system does not predict which fixed star will be seen, which causes no pertinence in preparation of tracking guidance data, but real-time calculation of all fixed stars is impractical and unnecessary, and the invention does not describe the tracking guidance calculation of fixed stars in detail.
The present invention has been described in detail, and it should be understood that the detailed description and specific examples, while indicating the preferred embodiment of the invention, are intended for purposes of illustration only and are not intended to limit the scope of the invention.

Claims (10)

1. A general tracking and guiding calculation method for a motion platform is characterized by comprising the following steps:
acquiring the ground-fixed coordinate of a target and the geodetic coordinate of a moving platform in real time, or acquiring the azimuth pitching coordinate of the target relative to a ground coordinate system of the moving platform in real time, and calculating the ground coordinate of the target at the moving platform;
and acquiring the three-axis attitude of the motion platform in real time, calibrating the three-axis installation attitude angle of an observation system coordinate system relative to the motion platform coordinate system, and resolving the spherical coordinate of the target in the observation system coordinate system based on the horizontal coordinate of the target in the motion platform to obtain tracking guidance data.
2. The method of claim 1, wherein when the target is an unnatural celestial body, calculating the horizon coordinate of the target at the motion platform comprises the following steps:
acquiring the geodetic coordinates of a motion platform in real time, and resolving the geodetic coordinates of the motion platform based on the geodetic coordinates of the motion platform;
acquiring the earth-fixed coordinates of a target in real time, and resolving the station center earth-fixed coordinates of the target at the motion platform based on the earth-fixed coordinates of the motion platform;
and calculating the horizon coordinate of the target at the moving platform based on the station center earth-fixed coordinate of the target and the geodetic coordinate of the moving platform.
3. The method according to claim 1, wherein when the target is a planet, the method calculates the horizon coordinate of the target at the motion platform, specifically:
acquiring azimuth and elevation coordinates (A, E) of a target relative to a horizon coordinate system at a moving platform in real time, wherein the horizon coordinate of the target at the moving platform is
Figure 830328DEST_PATH_IMAGE001
And is made of
Figure 345623DEST_PATH_IMAGE002
A represents an azimuth angle, and E represents a pitch angle.
4. The method according to claim 1, wherein the method comprises the steps of obtaining three-axis postures of the motion platform in real time, calibrating three-axis installation posture angles of an observation system coordinate system relative to a motion platform coordinate system, and calculating a spherical coordinate of the target in the observation system coordinate system based on a horizon coordinate of the target at the motion platform to obtain tracking guidance data, and comprises the following steps:
acquiring the three-axis attitude of the motion platform in real time, and resolving the rectangular coordinate of the target in the motion platform coordinate based on the horizontal coordinate of the target at the motion platform;
calibrating a three-axis installation attitude angle of an observation system coordinate system relative to a motion platform coordinate system, and resolving a rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the motion platform coordinate;
and resolving the spherical coordinates of the target in the coordinate system of the observation system based on the rectangular coordinates of the target in the observation system to obtain tracking guidance data.
5. The method as claimed in claim 4, wherein the three-axis attitude of the motion platform is obtained in real time as
Figure 596475DEST_PATH_IMAGE003
Based on the horizon coordinates of the object at the motion platform
Figure 906234DEST_PATH_IMAGE004
Solving rectangular coordinates of the target in the coordinates of the motion platform
Figure 242537DEST_PATH_IMAGE005
The method specifically comprises the following steps:
Figure 295944DEST_PATH_IMAGE006
Figure 401303DEST_PATH_IMAGE007
a coordinate transformation matrix representing a rotation of the y-axis by an angle gamma,
Figure 147542DEST_PATH_IMAGE008
a coordinate transformation matrix representing a rotation by an angle beta about the x-axis,
Figure 439983DEST_PATH_IMAGE009
and the coordinate transformation matrix represents a negative angle of rotation around a z axis, alpha represents a course angle, beta represents a pitch angle, and gamma represents a roll angle.
6. The method as claimed in claim 5, wherein the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform is calibrated
Figure 562660DEST_PATH_IMAGE010
Solving the rectangular coordinate of the target in the observation system based on the rectangular coordinate of the target in the coordinates of the motion platform
Figure 522526DEST_PATH_IMAGE011
The method specifically comprises the following steps:
Figure 439666DEST_PATH_IMAGE012
wherein, in the step (A),
Figure 750562DEST_PATH_IMAGE013
representing a three-axis installation attitude angle matrix.
7. The method of claim 6, wherein the computing method is based on rectangular coordinates of the target in a viewing system
Figure 145771DEST_PATH_IMAGE014
Solving the ball seat of the target in the coordinate system of the observation systemStandard (α, e, R), specifically:
in the case of a vertical observation system,
Figure 960144DEST_PATH_IMAGE015
for a horizontal-type observation system, the observation system,
Figure 313764DEST_PATH_IMAGE016
in the case of a pod-type observation system,
Figure 580798DEST_PATH_IMAGE017
where α represents an azimuth angle, e represents a pitch angle, and R represents a pitch distance.
8. The universal tracking and guiding calculation method for the motion platform according to any one of claims 1 to 7, wherein the calibration method for the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform specifically comprises the following steps:
fixedly installing an observation system on a motion platform, and acquiring geodetic coordinates and three-dimensional postures of the motion platform in real time;
selecting more than three points with known positions in different directions of space as calibration points, and acquiring the ground-fixed coordinates of the calibration points;
based on the horizon coordinate of the target at the motion platform, calculating the position of a calibration point relative to the horizon coordinate system of the observation system;
and adjusting the three-axis installation attitude angle of the observation system to observe the calibration points, obtaining the observation position of each calibration point, and calculating the three-axis installation attitude angle of the coordinate system of the observation system relative to the coordinate system of the motion platform.
9. The method as claimed in claim 8, wherein the target has a horizon coordinate at the motion platform of
Figure 779698DEST_PATH_IMAGE018
And resolving the position of the calibration point relative to the horizon coordinate system of the observation system
Figure 714156DEST_PATH_IMAGE019
The method specifically comprises the following steps:
Figure 973099DEST_PATH_IMAGE020
a represents an azimuth angle, and E represents a pitch angle.
10. The method of claim 9, wherein the obtaining of the observed position of each calibration point is performed by a general tracking and guiding computing method for the motion platform
Figure 727428DEST_PATH_IMAGE021
Resolving three-axis installation attitude angle of coordinate system of observation system relative to coordinate system of motion platform
Figure 730019DEST_PATH_IMAGE022
The method specifically comprises the following steps:
Figure 518984DEST_PATH_IMAGE023
the method comprises the steps of obtaining a heading angle of a motion platform, obtaining an attitude elevation angle of the motion platform, obtaining a roll angle of the motion platform, obtaining an azimuth angle, obtaining a roll angle of the motion platform, and obtaining a pitch angle.
CN202211277344.8A 2022-10-19 2022-10-19 Universal motion platform tracking and guiding calculation method Active CN115359095B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211277344.8A CN115359095B (en) 2022-10-19 2022-10-19 Universal motion platform tracking and guiding calculation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211277344.8A CN115359095B (en) 2022-10-19 2022-10-19 Universal motion platform tracking and guiding calculation method

Publications (2)

Publication Number Publication Date
CN115359095A true CN115359095A (en) 2022-11-18
CN115359095B CN115359095B (en) 2023-01-24

Family

ID=84007703

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211277344.8A Active CN115359095B (en) 2022-10-19 2022-10-19 Universal motion platform tracking and guiding calculation method

Country Status (1)

Country Link
CN (1) CN115359095B (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8275544B1 (en) * 2005-11-21 2012-09-25 Miltec Missiles & Space Magnetically stabilized forward observation platform
CN104596503A (en) * 2015-01-26 2015-05-06 中国人民解放军国防科学技术大学 Tracking rotating table attitude determining and instruction compensating method based on differential satellite navigation measurement
CN109708667A (en) * 2018-12-26 2019-05-03 中国久远高新技术装备公司 A kind of double dynamic target tracking bootstrap techniques based on laser gyro
CN110858892A (en) * 2018-08-24 2020-03-03 中国电子科技集团公司第二十七研究所 Bank island observation system
CN112710303A (en) * 2020-12-14 2021-04-27 中国科学院光电技术研究所 Method for determining attitude angle theta change of target in field of view caused by motion of motion platform
CN114509066A (en) * 2022-01-29 2022-05-17 中国科学院光电技术研究所 High-speed target astronomical positioning method
CN114679541A (en) * 2022-03-11 2022-06-28 中国科学院长春光学精密机械与物理研究所 Method for tracking moving target on satellite
CN115200544A (en) * 2022-07-06 2022-10-18 中国电子科技集团公司第三十八研究所 Method and device for tracking target of maneuvering measurement and control station

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8275544B1 (en) * 2005-11-21 2012-09-25 Miltec Missiles & Space Magnetically stabilized forward observation platform
CN104596503A (en) * 2015-01-26 2015-05-06 中国人民解放军国防科学技术大学 Tracking rotating table attitude determining and instruction compensating method based on differential satellite navigation measurement
CN110858892A (en) * 2018-08-24 2020-03-03 中国电子科技集团公司第二十七研究所 Bank island observation system
CN109708667A (en) * 2018-12-26 2019-05-03 中国久远高新技术装备公司 A kind of double dynamic target tracking bootstrap techniques based on laser gyro
CN112710303A (en) * 2020-12-14 2021-04-27 中国科学院光电技术研究所 Method for determining attitude angle theta change of target in field of view caused by motion of motion platform
CN114509066A (en) * 2022-01-29 2022-05-17 中国科学院光电技术研究所 High-speed target astronomical positioning method
CN114679541A (en) * 2022-03-11 2022-06-28 中国科学院长春光学精密机械与物理研究所 Method for tracking moving target on satellite
CN115200544A (en) * 2022-07-06 2022-10-18 中国电子科技集团公司第三十八研究所 Method and device for tracking target of maneuvering measurement and control station

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
徐涛 等: "车载光电跟踪系统跟踪转台的初始标定", 《光学精密工程》 *
朱雷鸣 等: "直角坐标系的欧拉旋转变换及动力学方程", 《海洋测绘》 *
田俊林 等: "运动平台目标引导数据解算及误差分析", 《强激光与粒子束》 *
胡豪等: "空间运动目标实时引导数据解算探讨", 《科技传播》 *

Also Published As

Publication number Publication date
CN115359095B (en) 2023-01-24

Similar Documents

Publication Publication Date Title
CN106871927B (en) Unmanned aerial vehicle photoelectric pod installation error calibration method
CN109470265B (en) Inertial navigation prism height difference calibration method and system
CN104165640B (en) Near-space missile-borne strap-down inertial navigation system transfer alignment method based on star sensor
CN112197761B (en) High-precision multi-gyroplane co-location method and system
CN106595668A (en) Passive location algorithm for electro-optical pod
CN109460052A (en) A kind of control method for spelling group aircraft
CN105548976A (en) Shipborne radar offshore precision identification method
CN111366148B (en) Target positioning method suitable for multiple observations of airborne photoelectric observing and sighting system
CN105698762A (en) Rapid target positioning method based on observation points at different time on single airplane flight path
CN111102981B (en) High-precision satellite relative navigation method based on UKF
CN110926468A (en) Communication-in-motion antenna multi-platform navigation attitude determination method based on transfer alignment
CN106500731A (en) A kind of Calibration Method of the boat-carrying theodolite based on fixed star analog systemss
CN110631567B (en) Inversion and correction method for atmospheric refraction error of differential sky polarization compass
CN110134134B (en) Wind measuring method for unmanned aerial vehicle in hovering state
CN112461231A (en) Multi-star map fused astronomical positioning method
CN109506662B (en) Small celestial body landing initial alignment method and relative navigation reference determination method and device thereof
CN109708667B (en) Double-dynamic target tracking and guiding method based on laser gyro
CN114001756B (en) Small-field-of-view star sensor outfield ground star finding method
RU2723199C1 (en) Method and system for determining orientation of spacecraft in space with autonomous correction of light aberration effect
CN112833878A (en) Near-ground multi-source astronomical autonomous navigation method
CN110967021B (en) Active/passive ranging independent target geographic positioning method for airborne photoelectric system
EP1859295A1 (en) A calibration method and system for position measurements
CN115359095B (en) Universal motion platform tracking and guiding calculation method
Huang et al. Research on UAV flight performance test method based on dual antenna GPS/ins integrated system
CN114509071B (en) Attitude measurement method for wind tunnel test model

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
GR01 Patent grant
GR01 Patent grant