CN119469210B - Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite - Google Patents
Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite Download PDFInfo
- Publication number
- CN119469210B CN119469210B CN202510065310.XA CN202510065310A CN119469210B CN 119469210 B CN119469210 B CN 119469210B CN 202510065310 A CN202510065310 A CN 202510065310A CN 119469210 B CN119469210 B CN 119469210B
- Authority
- CN
- China
- Prior art keywords
- mirror
- photoelectric theodolite
- encoder
- sensor photoelectric
- coordinate system
- 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.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
- G01C1/02—Theodolites
- G01C1/04—Theodolites combined with cameras
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D18/00—Testing or calibrating apparatus or arrangements provided for in groups G01D1/00 - G01D15/00
- G01D18/001—Calibrating encoders
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
The invention relates to a method for detecting encoder zero value errors by utilizing non-primary shooting of a multi-sensor photoelectric theodolite, which aims to solve the technical problem that the existing photoelectric theodolite zero value error correction method cannot be suitable for correcting the multi-sensor photoelectric theodolite zero value errors by utilizing a non-primary shooting optical system, and belongs to the technical field of photoelectric theodolites. The method comprises the following steps of establishing a non-main shooting imaging coordinate system, calculating coordinates of a non-main shooting central point position under the main shooting imaging coordinate system, shooting azimuth mark images under a positive mirror state, recording readings of a horizontal encoder and a pitching encoder, shooting azimuth mark images under a multi-sensor photoelectric theodolite reverse mirror state, and recording readings of the horizontal encoder and the pitching encoder under the reverse mirror state. According to the method, the multi-sensor photoelectric theodolite non-main shooting optical measurement system is utilized to shoot the target range azimuth standard positive and negative mirror image, zero value errors of encoders of the multi-sensor photoelectric theodolites are corrected, and meanwhile non-parallelism errors can be calculated.
Description
Technical Field
The invention relates to the technical field of photoelectric theodolites, in particular to a method for detecting encoder zero value errors by utilizing non-primary shooting of a multi-sensor photoelectric theodolite.
Background
The photoelectric theodolite is widely applied to the measurement of the external trajectory parameters of flying targets such as rockets, missiles, aviation bombs and the like, and can also measure the target attitude and the target miss distance parameters and record in real time. It is one of the primary optical measuring devices of the target range. A typical electro-optic theodolite tracking frame is a two-axis foundation structure, as shown in fig. 7, consisting of a vertical axis and a horizontal axis, with the main optical system mounted in the middle of the horizontal axis body and with its optical axis as the collimation axis (collimation axis) of the tracking frame and perpendicular to the horizontal axis.
The collimation axis of the electro-optic theodolite can rotate in both azimuth and elevation directions about a horizontal axis and a vertical axis under the control of a servo system to point to a target. As shown in fig. 8, the target point (x i,yi,zi) is ideally located on the axis of sight, and the azimuth a and pitch E angles of the target relative to the electro-optic theodolite can be described by the horizontal axis angle encoder and the pitch axis angle encoder of the electro-optic theodolite.
The centrifugal error of the code wheel generated by the encoder of the photoelectric theodolite can influence the angle measurement precision of the photoelectric theodolite, the horizontal code wheel and the pitch angle code wheel of the encoder of the photoelectric theodolite are arranged on the vertical axis and the horizontal axis of the photoelectric theodolite, and the error of installation and adjustment inconsistent with the optical axis generated after the encoder is arranged becomes the zero value error of the encoder.
The horizontal encoder zero value error refers to an angle value that the device horizontal code wheel zero value deviates from the earth north or the astronomical north. When the warp and weft are rotated so that the axis of collimation is aligned with the direction of the directional line (typically north-earth), the angular difference g between it and that direction can be read from the horizontal encoder. In actual measurement, the zero value error of the horizontal encoder can be solved according to a local position mark, an azimuth mark is set near the photoelectric theodolite, the main optical system of the photoelectric theodolite aims at the target under the assumption that the true azimuth angle of the azimuth mark relative to the station address of the photoelectric theodolite is alpha 0, and at the moment, the reading of the horizontal code wheel is the measured value A f of the photoelectric theodolite on the azimuth mark, and g=A f-α0 exists.
The zero value error of the pitching encoder refers to the angle value of zero position deviation of the pitching code disc of the equipment from the horizontal direction. When the photoelectric theodolite is in a positive mirror state, the collimation axis points to the horizontal direction, the angle value read by the pitching encoder at the moment is zero value error of the pitching encoder in the positive mirror state, the value is the included angle between the horizontal plane and the zero graduation of the pitching code disc, namely h=E-E f, wherein E is the collimation axis of the photoelectric theodolite points to the horizontal direction when the photoelectric theodolite is in the positive mirror state, and E f is the theoretical pitching value of the azimuth mark relative to the photoelectric theodolite.
At present, in order to improve the target detection capability, a multi-sensor photoelectric theodolite is formed by additionally arranging a plurality of sensors such as infrared sensors, visible light sensors, laser sensors, radar sensors, GPS sensors and the like besides a main optical system. The main photographing optical system is generally arranged at the center of the horizontal shaft body of the multi-sensor photoelectric theodolite, and other non-main photographing optical systems need to be fixed on the shaft body or the shaft head of the horizontal shaft. The collimation axis of the non-main shooting systems is difficult to be completely parallel to the main optical axis, so that non-parallelism errors exist, so that the current zero value error calculation method of the encoder of the photoelectric theodolite cannot be suitable for correcting the zero value error of the multi-sensor theodolite by using the non-main shooting optical systems, and a general encoder zero value error calculation method needs to be established. Meanwhile, even for a main camera system, the projection center of the main camera system is difficult to completely coincide with the rotation center of the multi-sensor photoelectric theodolite, so that the position of the projection center is dynamically changed in the rotation process of the multi-sensor photoelectric theodolite, and the influence of the movement on the precision of an optical imaging system cannot be ignored in high-precision measurement.
The commonly used correction method is generally aimed at a main shooting measurement system with an imaging optical axis at a rotation center, and a non-main shooting optical measurement system of the multi-sensor photoelectric theodolite is required to detect and correct the non-parallelism error due to the non-parallelism error, so that the non-main shooting measurement system can be used for correcting the shafting error and the system error of the multi-sensor photoelectric theodolite.
Chinese patent document CN115683157a discloses a multi-sensor photo theodolite optical axis parallel difference calibration method, in which a visible marker and an infrared marker are required to be used, the central geodetic height of a marker pattern is required to be the same as the position of the triaxial center of the photo theodolite, and two markers form a certain angle with the triaxial center of the photo theodolite, and the included angle between the infrared and visible light sensors is required to be known in advance. The method has strict limitation on the shape, the layout angle and the height of the marker, and is difficult to adapt to the requirements in a target range of a field environment.
Chinese patent document CN115388913a proposes a method for correcting angular relative error of a multi-sensor system, but the field to which the method relates is not the optical measurement field of an optoelectronic theodolite, but is directed to error correction of a shipborne fixed multi-sensor.
The chinese patent document CN103727961a proposes a dynamic error correction method for an electro-optic theodolite, which uses the forward and reverse mirror data, but mainly corrects errors caused by the time dyssynchrony of the encoder sampling time, exposure time and off-target amount.
Chinese patent document CN115406408a proposes a method for detecting and correcting vertical axis tilt error of an electro-optic theodolite, in which the axis error of the electro-optic theodolite is corrected, but the influence of parallelism error of a non-primary optical system is not considered.
The paper discloses a method for improving the off-target amount by using a coordinate transformation method in the aspect of dynamically correcting the off-target amount of a multi-sensor photoelectric theodolite by using coordinate transformation, and the method considers the influence of the non-parallelism between the optical axis of a non-main shooting system and the sight axis of the photoelectric theodolite on the off-target amount calculation, but does not relate to a specific method for measuring the non-parallelism in a target range environment.
Paper photoelectric theodolite axis parallelism detection applicable to a target range proposes a method for detecting the non-parallelism between the optical axis of an imaging system and an ideal collimation axis by using an azimuth standard positive and negative mirror image, only the non-parallelism error is considered, but a zero value error exists in a horizontal encoder and a pitching encoder of a common photoelectric theodolite, if the zero value error is not corrected, a larger error exists in encoder values read when the positive mirror and the negative mirror shoot the azimuth standard image, and the calculated non-parallelism error is inaccurate, so that the influence of the encoder zero value error is considered while the non-parallelism error is detected.
The paper 'study on three-difference detection method of T-shaped frame photoelectric theodolite' mentions a three-difference detection method of T-shaped photoelectric theodolite, but only aims at ideal conditions, namely, under strict conditions that a non-main shooting system is arranged at one end of a horizontal shaft and an optical axis is parallel to a main shooting system sighting shaft, the situation that the photoelectric theodolite under a multi-sensor has non-parallelism errors is not considered, and in practical cases, the multi-sensor photoelectric theodolite cannot be arranged at one end of the horizontal shaft and the non-parallelism errors also exist.
Disclosure of Invention
The invention provides a method for detecting encoder zero value errors by utilizing non-primary shooting of a multi-sensor photoelectric theodolite, which aims to solve the technical problem that the shafting errors and systematic errors of the multi-sensor photoelectric theodolite cannot be corrected correctly in the prior art.
In order to solve the technical problems, the technical scheme of the invention is as follows:
the method for detecting encoder zero value error by utilizing non-primary shooting of the multi-sensor photoelectric theodolite comprises the following steps of measuring equipment suitable for the method, namely the multi-sensor photoelectric theodolite, a azimuth mark, high-precision geodetic coordinate measuring equipment and image interpretation software;
the azimuth mark is a plane target with a characteristic point which is convenient to identify, and the plane target is placed on the ground somewhere in the visible range of the multi-sensor photoelectric theodolite, so that clear imaging can be carried out in the fields of view of all optical sensors of the multi-sensor photoelectric theodolite;
the multi-sensor photoelectric theodolite is used for shooting azimuth mark images;
The high-precision geodetic coordinate measuring equipment is used for measuring geodetic coordinates of a azimuth mark and a rotation center of the multi-sensor photoelectric theodolite;
The image interpretation software is used for interpreting the off-target quantity of the azimuth mark feature points in the azimuth mark image and calculating the angles of the azimuth mark feature points relative to the imaging center;
the method comprises the following steps:
Step S1, high-precision geodetic coordinate measuring equipment is placed at the position of the azimuth standard feature point, and geodetic coordinates of the azimuth standard feature point are measured to be (L MBMHM);
s2, measuring the geodetic coordinates of the three-axis intersection points of the multi-sensor photoelectric theodolite, calculating the coordinates of the geodetic coordinates under a geodetic space rectangular coordinate system, and establishing a measurement coordinate system and a main imaging coordinate system at the three-axis intersection points;
s3, calculating coordinates under a geodetic space rectangular coordinate system by using the geodetic coordinates of the azimuth mark feature points measured in the step S1;
Step S4, a non-main shooting imaging coordinate system is established in a projection center of a non-main shooting imaging system, and coordinates of a non-main shooting projection center point under the main shooting imaging coordinate system are calculated;
S5, shooting azimuth mark images under the state of a multi-sensor photoelectric theodolite positive mirror, and recording readings of a horizontal encoder and a pitching encoder under the state of the positive mirror;
S6, shooting azimuth mark images under the inverted mirror state of the multi-sensor photoelectric theodolite, and recording readings of a horizontal encoder and a pitching encoder under the inverted mirror state;
s7, interpreting the off-target quantity of the azimuth mark feature points in the azimuth mark positive mirror and the inverted mirror image by using image interpretation software, and calculating the angle of the azimuth mark feature points relative to an imaging center;
s8, calculating the distance between the non-main shooting projection center and the azimuth standard feature point when the front mirror and the back mirror images are shot;
And S9, calculating the comprehensive angle value of the azimuth mark characteristic points relative to the origin of the measuring coordinate system of the multi-sensor photoelectric theodolite when the multi-sensor photoelectric theodolite is shot by the positive mirror and the negative mirror, substituting the comprehensive angle value into a zero value error calculation formula, calculating zero value errors of a horizontal encoder and a pitching encoder of the multi-sensor photoelectric theodolite, and simultaneously calculating non-principal non-parallel degree.
In the above technical solution, step S2 includes the following steps:
S21, placing the multi-sensor photoelectric theodolite on the horizontal ground, leveling, placing high-precision geodetic coordinate measuring equipment under the three-axis intersection points of a vertical axis, a horizontal axis and a collimation axis, accurately measuring the geodetic coordinate of the point, and adding the height to the instrument height of the equipment to obtain the accurate geodetic coordinate of the three-axis intersection point, namely the origin of a measurement coordinate system (L CBCHC);
S22, when the azimuth mark characteristic point M is shot by the positive mirror and the negative mirror, converting the geodetic coordinates of the azimuth mark characteristic point M and the origin O C of the multi-sensor photoelectric theodolite measurement coordinate system into azimuth mark characteristic point coordinates under the geodetic space rectangular coordinate system according to the following formula And measuring the origin coordinates of the coordinate system
Wherein, N is the radius of the circle of the mortise, e is the first eccentricity of the earth, L is the longitude of the earth, B is the latitude of the earth, h is the altitude of the earth, a is the long half axis of the reference ellipsoid;
And S23, establishing a main shooting imaging coordinate system O LXLYLZL by taking the three-axis intersection point of the multi-sensor photoelectric theodolite as an origin, wherein an X L axis is coincident with a main shooting optical sensor collimation axis, and when the collimation axis of the multi-sensor photoelectric theodolite is parallel to a horizontal plane and points to the north, the coincidence of a Y L axis and a vertical axis of the multi-sensor photoelectric theodolite is positive upwards, and the coincidence of a Z L axis and a horizontal axis of the multi-sensor photoelectric theodolite is positive to the right.
In the above technical solution, step S3 includes the following steps:
step S31, converting the geodetic coordinates of the azimuth mark feature points into coordinates in a geodetic space rectangular coordinate system according to the formula in the step S2
Step S32, calculating the coordinates of the azimuth standard feature points under the measurement coordinate system according to the following formula
Wherein L is the geodetic longitude and B is the geodetic latitude; is the coordinate of the azimuth standard characteristic point M under the rectangular coordinate system of the geocentric space, For measuring the coordinates of the origin coordinates of the coordinate system in the geocentric rectangular coordinate system, R x、Ry、Rz is a coordinate transformation rotation matrix rotating around the X-axis, around the Y-axis, and around the Z-axis, respectively.
In the above technical solution, step S4 includes the following steps:
Step S41, a non-main shooting imaging coordinate system O FXFYFZF is established at a non-main shooting projection central point O F according to the relative positions of the non-main shooting projection central point O F and the main shooting projection central position measured by the multi-sensor photoelectric theodolite in the equipment assembling and adjusting process;
And step S42, obtaining the coordinate of the non-main shooting projection center point O F under a main shooting imaging coordinate system (x FO,yFO,zFO) by measuring the position relation on the structure during the adjustment of the multi-sensor photoelectric theodolite.
In the above technical solution, step S5 includes the following steps:
s51, turning the multi-sensor photoelectric theodolite to a positive mirror state to align with a azimuth mark;
S52, shooting azimuth standard mirror images by utilizing non-main shooting of the multi-sensor photoelectric theodolite, and recording readings of a horizontal encoder in a state of the standard mirror And pitch encoder readings
In the above technical solution, step S6 includes the following steps:
Step S61, turning the multi-sensor photoelectric theodolite to a reverse mirror state to align with the azimuth mark;
step S62, utilizing the multi-sensor photoelectric theodolite to photograph the azimuth mark reverse mirror image in a non-main shooting way, and recording the reading of a horizontal encoder in the reverse mirror state And pitch encoder readings
In the above technical solution, step S7 includes the following steps:
Step S71, leading in a multisensor photoelectric theodolite positive mirror image by image interpretation software, wherein the miss distance of the interpretation azimuth mark characteristic point M in the positive mirror image is (delta x z,Δyz);
Step S72, the image interpretation software is used for importing a multi-sensor photoelectric theodolite inverted mirror image, and the miss distance of the interpretation azimuth mark characteristic point M in the inverted mirror image is (delta x d,Δyd);
step S73, calculating the angles of the azimuth standard characteristic points relative to the imaging center when the positive mirror and the negative mirror are respectively according to the following formula And
Wherein Angle represents the azimuth and pitching imaging Angle of the target point relative to the imaging center, p is the size of a non-main shooting element of the multi-sensor photoelectric theodolite, f is the non-main shooting focal length of the multi-sensor photoelectric theodolite, and Δd is the off-target amount.
In the above technical solution, step S8 includes the following steps:
step S81, the non-main shooting projection center is expressed as (x FO,yFO,zFO) under a main shooting imaging coordinate system;
step S82, according to the encoder values recorded when shooting the azimuth standard positive mirror and the inverted mirror, the coordinates of the non-main shooting projection center point under the measurement coordinate system when the positive mirror and the inverted mirror are respectively obtained by the following formula And
Wherein, For measuring coordinates in a coordinate system, (A 0,E0) is readings of a horizontal encoder and a pitching encoder of the multi-sensor photoelectric theodolite, and R y、Rz is a coordinate transformation rotation matrix which rotates around a Y axis and rotates around a Z axis respectively;
Step S83, calculating distances L Z and L d between the azimuth standard feature point M and the non-main shooting projection center point in the front mirror and the back mirror according to the following formula:
wherein L is the distance of the three-dimensional space between the non-main shooting projection center point and the azimuth mark feature point, Is the coordinates of the azimuth characteristic points in the measurement coordinate system.
In the above technical solution, step S9 includes the following steps:
Step S91, calculating comprehensive angle values (A z,Ez) and (A d,Ed) of the multi-sensor photoelectric theodolite of the front mirror and the back mirror shooting azimuth marks according to the following formulas by bringing the multi-sensor photoelectric theodolite into the distances between the azimuth marks and non-main shooting projection centers of the multi-sensor photoelectric theodolites when the front mirror and the back mirror shooting azimuth marks, and simultaneously calculating non-main shooting non-parallelism errors (delta A 0,ΔE0):
wherein e is the first eccentricity of the earth, K z、Vz、Nz、Kd、Vd、Nd and P are nonsensical intermediate variables respectively, L z、Ld is the distance between the azimuth mark characteristic point and the non-primary shooting projection center when the mirror is positive and inverted respectively, Respectively the pitch angle and the azimuth angle of the azimuth mark characteristic point relative to the non-main imaging center when the positive mirror is used,The pitch angle and the azimuth angle of the azimuth mark characteristic point relative to the non-main shooting imaging center when the mirror is reversed are respectively shown as y FO、zFO, the y coordinate and z coordinate of the non-main shooting projection center point under the main shooting imaging coordinate system, deltax z、Δyz is respectively shown as the off-target quantity obtained by interpreting the azimuth mark positive mirror image, deltax d、Δyd is respectively shown as the off-target quantity obtained by interpreting the azimuth mark mirror image,Pitch and azimuth encoder readings for the positive mirror,Pitch and azimuth encoder readings when the mirror is inverted, respectively;
Step S92, calculating a zero value error G of the horizontal encoder and a zero value error H of the pitching encoder according to the following formula;
Wherein, Is the coordinates of the azimuth characteristic points in the measurement coordinate system.
In the above technical solution, in order to reduce the influence caused by the random error, the measurements of step S5 to step S9 are repeated a plurality of times, an average value is calculated, the average value is taken as the zero value error of the horizontal encoder and the zero value error of the pitch encoder of the multi-sensor electro-optic theodolite, and the correction amount is obtained according to the correction amount of the measured value and the error sign opposite to each other, so as to correct the zero value errors of the horizontal encoder and the pitch encoder.
The invention has the following beneficial effects:
The method for detecting the encoder zero value error by utilizing the non-primary shooting of the multi-sensor photoelectric theodolite utilizes the multi-sensor photoelectric theodolite non-primary shooting optical measurement system to shoot the target range azimuth mark positive and negative mirror image, corrects the encoder zero value error of the multi-sensor photoelectric theodolite, and can calculate the non-parallelism error. The method improves the efficiency of shooting marks and error correction of the multi-sensor photoelectric theodolite in the shooting range, and shortens the preparation time before the task.
Drawings
The invention is described in further detail below with reference to the drawings and the detailed description.
FIG. 1 is a schematic diagram of the steps of the method for detecting encoder zero value errors by non-primary shooting of a multi-sensor electro-optic theodolite according to the present invention.
FIG. 2 is a schematic diagram of a layout of an electro-optic theodolite and an azimuth mark.
Fig. 3 is a schematic diagram of a measurement coordinate system, a main imaging coordinate system, and a non-main imaging coordinate system.
Fig. 4 is a schematic diagram of the relative positions of the non-primary projection center and the origin of the primary imaging coordinate system.
Fig. 5 is a schematic diagram of a horizontal encoder zero value error.
FIG. 6 is a schematic diagram of pitch encoder zero value error.
Fig. 7 is a schematic three-axis view of a multi-sensor electro-optic theodolite of the prior art.
Fig. 8 is a schematic diagram of the measurement principle of the electro-optic theodolite in the prior art.
Detailed Description
The invention is characterized in that:
The method for detecting encoder zero value errors by utilizing the non-primary shooting of the multi-sensor photoelectric theodolite utilizes a non-primary shooting measurement system of the multi-sensor photoelectric theodolite to correct shafting errors and encoder errors of the multi-sensor photoelectric theodolite.
According to the method for detecting the encoder zero value error by utilizing the non-main shooting of the multi-sensor photoelectric theodolite, disclosed by the invention, the non-main shooting measurement system is utilized to shoot the image of the azimuth mark positive and negative mirror, and correction of the non-parallelism error is considered in the process of calculating the encoder error, so that the correction of the encoder error by utilizing the multi-sensor photoelectric theodolite non-main shooting measurement system is creatively enabled, and the error calculation process is simplified.
The present invention will be described in detail with reference to the accompanying drawings.
The method for detecting the encoder zero value error by utilizing the non-primary shooting of the multi-sensor photoelectric theodolite is realized based on measuring equipment comprising the multi-sensor photoelectric theodolite, an azimuth mark, high-precision geodetic coordinate measuring equipment and image interpretation software.
As shown in figure 2, the azimuth mark is a plane target with a characteristic point which is convenient to identify, the plane target is placed on the ground somewhere in the visual range of the multi-sensor photoelectric theodolite, and the azimuth mark can be clearly imaged in the visual fields of all optical sensors of the multi-sensor photoelectric theodolite.
The multi-sensor photoelectric theodolite is used for shooting azimuth mark images;
The high-precision geodetic coordinate measuring equipment is used for measuring geodetic coordinates of a azimuth mark and a rotation center of the multi-sensor photoelectric theodolite;
The image interpretation software is used for interpreting the off-target quantity of the azimuth mark feature points in the azimuth mark image and calculating the angles of the azimuth mark feature points relative to the imaging center;
A measurement coordinate system, a main imaging coordinate system, and a non-main imaging coordinate system are established as shown in fig. 3.
The measurement coordinate system O CXCYCZC takes the three-axis intersection point of the multi-sensor photoelectric theodolite as an origin, the positive direction of the X C axis points to the earth north, the positive direction of the Y C axis points to the sky perpendicular to the horizontal plane where the origin is located, and the Z C axis, the X C axis and the Y C axis form a right-hand coordinate system.
The main imaging coordinate system O LXLYLZL takes a multi-sensor photoelectric theodolite triaxial intersection point O L as an origin, wherein an X L axis coincides with a main imaging optical sensor collimation axis, when the collimation axis of the multi-sensor photoelectric theodolite is parallel to a horizontal plane and points to the north, the Y L axis coincides with a vertical axis of the multi-sensor photoelectric theodolite upwards to be positive, and the Z L axis coincides with a horizontal axis of the multi-sensor photoelectric theodolite to be positive to the right.
The non-main shooting imaging coordinate system O FXFYFZF takes the projection center of a non-main shooting imaging system of the multi-sensor photoelectric theodolite, the non-main shooting projection center point O F is taken as an original point, the X F axis is the optical axis of the non-main shooting imaging system, the Y F axis is parallel to the image plane of the non-main shooting imaging system, the positive direction points to the sky when in positive mirror, the Z F axis is parallel to the image plane of the non-main shooting imaging system, and the right is positive when in positive mirror.
The method for detecting encoder zero value errors by utilizing non-primary shooting by utilizing the photoelectric theodolite with multiple sensors, as shown in fig. 1, comprises the following steps:
And S1, placing high-precision geodetic coordinate measuring equipment at the position of the azimuth standard feature point M, and accurately measuring the geodetic coordinate of the azimuth standard feature point M to be (L MBMHM).
Step S2, measuring the geodetic coordinates of the three-axis intersection points of the multi-sensor photoelectric theodolite, calculating the coordinates of the geodetic coordinates in a geodetic space rectangular coordinate system, and establishing a measurement coordinate system and a main imaging coordinate system at the three-axis intersection points, wherein the method comprises the following steps:
S21, placing the multi-sensor photoelectric theodolite on the horizontal ground, leveling, placing high-precision geodetic coordinate measuring equipment under the three-axis intersection points of a vertical axis, a horizontal axis and a collimation axis, accurately measuring the geodetic coordinate of the point, and adding the height to the instrument height of the equipment to obtain the accurate geodetic coordinate of the three-axis intersection point, namely the origin of a measurement coordinate system (L CBCHC);
S22, when the azimuth mark characteristic point M is shot by the positive mirror and the negative mirror, converting the geodetic coordinates of the azimuth mark characteristic point M and the origin O C of the multi-sensor photoelectric theodolite measurement coordinate system into azimuth mark characteristic point coordinates under the geodetic space rectangular coordinate system according to the following formula And measuring the origin coordinates of the coordinate system
Wherein, N is the radius of the circle of the mortise, e is the first eccentricity of the earth, L is the longitude of the earth, B is the latitude of the earth, h is the altitude of the earth, a is the long half axis of the reference ellipsoid;
And S23, establishing a main shooting imaging coordinate system O LXLYLZL by taking the three-axis intersection point of the multi-sensor photoelectric theodolite as an origin, wherein an X L axis is coincident with a main shooting optical sensor collimation axis, and when the collimation axis of the multi-sensor photoelectric theodolite is parallel to a horizontal plane and points to the north, the coincidence of a Y L axis and a vertical axis of the multi-sensor photoelectric theodolite is positive upwards, and the coincidence of a Z L axis and a horizontal axis of the multi-sensor photoelectric theodolite is positive to the right.
Step S3, calculating coordinates under a geodetic space rectangular coordinate system by using the geodetic coordinates of the azimuth mark feature points M measured in the step S1, wherein the method comprises the following steps:
Step S31, converting the geodetic coordinates of the azimuth mark feature point M into coordinates in a geodetic space rectangular coordinate system according to the formula in the step S2
Step S32, calculating the coordinates of the azimuth standard feature point M under the measurement coordinate system according to the following formula
Wherein L is the geodetic longitude and B is the geodetic latitude; is the coordinate of the azimuth standard characteristic point M under the rectangular coordinate system of the geocentric space, For measuring the coordinates of the origin coordinates of the coordinate system in the geocentric rectangular coordinate system, R x、Ry、Rz is a coordinate transformation rotation matrix rotating around the X-axis, around the Y-axis, and around the Z-axis, respectively.
Step S4, a non-main shooting imaging coordinate system is established in a projection center of a non-main shooting imaging system, and coordinates of a non-main shooting projection center point under the main shooting imaging coordinate system are calculated, wherein the method comprises the following steps:
Step S41, a non-main shooting imaging coordinate system O FXFYFZF is established at a non-main shooting projection central point O F according to the relative positions of the non-main shooting projection central point O F and the main shooting projection central position measured by the multi-sensor photoelectric theodolite in the equipment assembling and adjusting process;
in step S42, as shown in FIG. 3, the coordinate of the non-primary projection center point O F under the primary imaging coordinate system is obtained by measuring the position relationship on the structure during the adjustment of the multi-sensor electro-optic theodolite (x FO,yFO,zFO).
S5, shooting azimuth mark images under the state of a multi-sensor photoelectric theodolite positive mirror, and recording readings of a horizontal encoder and a pitching encoder under the state of the positive mirror, wherein the method comprises the following steps of:
s51, turning the multi-sensor photoelectric theodolite to a positive mirror state to align with a azimuth mark;
S52, shooting azimuth standard mirror images by utilizing non-main shooting of the multi-sensor photoelectric theodolite, and recording readings of a horizontal encoder in a state of the standard mirror And pitch encoder readings
Step S6, shooting azimuth mark images under the inverted mirror state of the multi-sensor photoelectric theodolite, and recording readings of a horizontal encoder and a pitching encoder under the inverted mirror state, wherein the steps are as follows:
Step S61, turning the multi-sensor photoelectric theodolite to a reverse mirror state to align with the azimuth mark;
step S62, utilizing the multi-sensor photoelectric theodolite to photograph the azimuth mark reverse mirror image in a non-main shooting way, and recording the reading of a horizontal encoder in the reverse mirror state And pitch encoder readings
And S7, interpreting the miss distance of the azimuth mark feature point M in the azimuth mark positive mirror and the inverted mirror image by using image interpretation software, and calculating the angle of the azimuth mark feature point M relative to an imaging center, wherein the method comprises the following steps:
Step S71, leading in a multisensor photoelectric theodolite positive mirror image by image interpretation software, wherein the miss distance of the interpretation azimuth mark characteristic point M in the positive mirror image is (delta x z,Δyz);
Step S72, the image interpretation software is used for importing a multi-sensor photoelectric theodolite inverted mirror image, and the miss distance of the interpretation azimuth mark characteristic point M in the inverted mirror image is (delta x d,Δyd);
step S73, calculating the angles of the azimuth standard characteristic points relative to the imaging center when the positive mirror and the negative mirror are respectively according to the following formula And
Wherein Angle represents the azimuth and pitching imaging Angle of the target point relative to the imaging center, p is the size of a non-main shooting element of the multi-sensor photoelectric theodolite, f is the non-main shooting focal length of the multi-sensor photoelectric theodolite, and Δd is the off-target amount.
Step S8, calculating the distance between the non-main shooting projection center and the azimuth standard feature point when the front mirror and the back mirror images are shot, wherein the step comprises the following steps:
In step S81, FIG. 4 shows the relative relationship between the non-primary-shooting projection center and the origin of the measurement coordinate system, and the multi-sensor electro-optic theodolite can measure the distance between the non-primary-shooting projection center and the origin of the primary-shooting imaging coordinate system during the adjustment, and the non-primary-shooting projection center can be represented as (x FO,yFO,zFO) in the primary-shooting imaging coordinate system.
Step S82, the main imaging coordinate system can be regarded as obtained by performing horizontal rotation around the y axis and rotational transformation around the Z axis, and the coordinates of the non-main projection center point under the measuring coordinate system when the positive mirror and the negative mirror are respectively obtained by using the following formulas according to the encoder values recorded when the positive mirror and the negative mirror are shotAnd
Wherein, For measuring coordinates in a coordinate system, (A 0,E0) is readings of a horizontal encoder and a pitching encoder of the multi-sensor photoelectric theodolite, and R y、Rz is a coordinate transformation rotation matrix which rotates around a Y axis and rotates around a Z axis respectively;
Step S83, calculating distances L Z and L d between the azimuth standard feature point M and the non-main shooting projection center point in the front mirror and the back mirror according to the following formula:
wherein L is the distance of the three-dimensional space between the non-main shooting projection center point and the azimuth mark feature point, Is the coordinates of the azimuth characteristic points in the measurement coordinate system.
And S9, calculating the comprehensive angle value of the azimuth mark characteristic points relative to the origin of the measuring coordinate system of the multi-sensor photoelectric theodolite when the multi-sensor photoelectric theodolite is shot by the positive mirror and the negative mirror, substituting the comprehensive angle value into a zero value error calculation formula, and calculating the zero value errors of the horizontal encoder and the pitching encoder of the multi-sensor photoelectric theodolite. Meanwhile, the non-main shooting non-parallelism can be calculated, and the method comprises the following steps:
Step S91, when the multi-sensor photoelectric theodolite shoots azimuth marks on a positive mirror and a negative mirror, the distance between the azimuth marks and the non-main shooting projection center of the multi-sensor photoelectric theodolite is carried, the comprehensive angle values (A z,Ez) and (A d,Ed) of the multi-sensor photoelectric theodolite shooting the azimuth marks on the positive mirror and the negative mirror are calculated according to the following formula, and meanwhile, the non-main shooting non-parallelism error (delta A 0,ΔE0) can be calculated:
wherein e is the first eccentricity of the earth, K z、Vz、Nz、Kd、Vd、Nd and P are nonsensical intermediate variables respectively, L z、Ld is the distance between the azimuth mark characteristic point and the non-primary shooting projection center when the mirror is positive and inverted respectively, Respectively the pitch angle and the azimuth angle of the azimuth mark characteristic point relative to the non-main imaging center when the positive mirror is used,The pitch angle and the azimuth angle of the azimuth mark characteristic point relative to the non-main shooting imaging center when the mirror is reversed are respectively shown as y FO、zFO, the y coordinate and z coordinate of the non-main shooting projection center point under the main shooting imaging coordinate system, deltax z、Δyz is respectively shown as the off-target quantity obtained by interpreting the azimuth mark positive mirror image, deltax d、Δyd is respectively shown as the off-target quantity obtained by interpreting the azimuth mark mirror image,Pitch and azimuth encoder readings for the positive mirror,Pitch and azimuth encoder readings when the mirror is inverted, respectively;
Step S92, shown in FIG. 5 and FIG. 6, is a schematic diagram of encoder zero value errors of the multi-sensor photoelectric theodolite, wherein when the zero value errors of the horizontal encoder are calculated, the zero value errors need to be compared with azimuth true values, so that coordinates of azimuth standard feature points in a measurement coordinate system need to be brought into and judged;
Wherein, Is the coordinates of the azimuth characteristic points in the measurement coordinate system.
In order to reduce the influence caused by random errors, the measurement of the steps S5-S9 is repeated for a plurality of times, an average value is calculated, the average value is used as the zero value error of the horizontal encoder and the zero value error of the pitching encoder of the multi-sensor photoelectric theodolite, and the correction amount can be obtained according to the correction amount of the measured value and the error sign opposite to each other and is used for correcting the zero value errors of the horizontal encoder and the pitching encoder.
The method for detecting the encoder zero value error by utilizing the non-primary shooting of the multi-sensor photoelectric theodolite utilizes the multi-sensor photoelectric theodolite non-primary shooting optical measurement system to shoot the target range azimuth mark positive and negative mirror image, corrects the encoder zero value error of the multi-sensor photoelectric theodolite, and can calculate the non-parallelism error. The method improves the efficiency of shooting marks and error correction of the multi-sensor photoelectric theodolite in the shooting range, and shortens the preparation time before the task.
It is apparent that the above examples are given by way of illustration only and are not limiting of the embodiments. Other variations or modifications of the above teachings will be apparent to those of ordinary skill in the art. It is not necessary here nor is it exhaustive of all embodiments. While still being apparent from variations or modifications that may be made by those skilled in the art are within the scope of the invention.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202510065310.XA CN119469210B (en) | 2025-01-16 | 2025-01-16 | Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202510065310.XA CN119469210B (en) | 2025-01-16 | 2025-01-16 | Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN119469210A CN119469210A (en) | 2025-02-18 |
| CN119469210B true CN119469210B (en) | 2025-04-11 |
Family
ID=94573593
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202510065310.XA Active CN119469210B (en) | 2025-01-16 | 2025-01-16 | Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN119469210B (en) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111811538A (en) * | 2020-07-08 | 2020-10-23 | 中国人民解放军63660部队 | Photoelectric theodolite directional calibration method based on common stars |
| CN119309601A (en) * | 2024-12-17 | 2025-01-14 | 中国科学院长春光学精密机械与物理研究所 | Photoelectric theodolite shooting time calibration system and method |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH06331326A (en) * | 1993-05-21 | 1994-12-02 | Kobe Steel Ltd | Three-dimensional shape measuring apparatus |
-
2025
- 2025-01-16 CN CN202510065310.XA patent/CN119469210B/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111811538A (en) * | 2020-07-08 | 2020-10-23 | 中国人民解放军63660部队 | Photoelectric theodolite directional calibration method based on common stars |
| CN119309601A (en) * | 2024-12-17 | 2025-01-14 | 中国科学院长春光学精密机械与物理研究所 | Photoelectric theodolite shooting time calibration system and method |
Also Published As
| Publication number | Publication date |
|---|---|
| CN119469210A (en) | 2025-02-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103149558B (en) | Telescope based calibration of a three dimensional optical scanner | |
| CN111486868B (en) | Photoelectric telescope azimuth-free expansion calibration method based on ground feature | |
| CN102239421B (en) | Telescope based calibration of a three dimensional optical scanner | |
| CN111366902B (en) | Satellite thermal deformation test relative pointing change measurement system and method | |
| CN107589431B (en) | Target calibration method for improving target positioning accuracy of airborne photoelectric system | |
| CN110220533A (en) | A kind of onboard electro-optical pod misalignment scaling method based on Transfer Alignment | |
| CN110686571B (en) | Method for calibrating assembly error of full strapdown imaging seeker and projectile body | |
| CN109887041B (en) | Method for controlling position and posture of shooting center of digital camera by mechanical arm | |
| CN113281797B (en) | Maneuvering detection and correction radar system based on inertial navigation | |
| CN109186944A (en) | Airborne more optical axis optics load light axis consistency Calibration Methods | |
| CN119245694B (en) | Method for calibrating inertial navigation and optical axis zero position in optoelectronic platform | |
| CN106338286B (en) | A kind of moving base measurement method | |
| CN116242315B (en) | The installation and adjustment method of double-sided off-axis three-mirror mapping camera | |
| CN104535078A (en) | Measuring method for flying object through photoelectric equipment based on marking points | |
| CN113865432A (en) | Self-propelled artillery barrel orientation detection method | |
| CN115423884B (en) | Video camera attitude angle calibration method by utilizing river section water edge line | |
| CN109470274B (en) | A vehicle-mounted photoelectric theodolite vehicle-mounted platform deformation measurement system and method | |
| US7768631B1 (en) | Method and system for providing a known reference point for an airborne imaging platform | |
| CN112129263A (en) | Separated moving type stereo distance measuring camera and design method thereof | |
| CN113050108B (en) | Electronic world site vision measurement system and measurement method | |
| CN112135042B (en) | Adjusting and calibrating method for camera carried by ground mobile robot | |
| CN119469210B (en) | Method for detecting encoder zero value error by utilizing non-main shooting of multi-sensor photoelectric theodolite | |
| CN112945213A (en) | Angle-based heliostat space positioning system and method | |
| CN115406408B (en) | Detection and Correction Method of Vertical Axis Tilt Error of Photoelectric Theodolite | |
| CN114460619B (en) | A high-precision gun adjustment detection method based on optical differential GPS combination |
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 |