CN112506232A - Space semi-stable scanning control method based on angle feedback of rotary transformer - Google Patents
Space semi-stable scanning control method based on angle feedback of rotary transformer Download PDFInfo
- Publication number
- CN112506232A CN112506232A CN202011235116.5A CN202011235116A CN112506232A CN 112506232 A CN112506232 A CN 112506232A CN 202011235116 A CN202011235116 A CN 202011235116A CN 112506232 A CN112506232 A CN 112506232A
- Authority
- CN
- China
- Prior art keywords
- scanning
- zero
- singama
- sinbeta
- cosgama
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000009466 transformation Effects 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 abstract description 2
- 238000001514 detection method Methods 0.000 abstract description 2
- 230000005622 photoelectricity Effects 0.000 abstract description 2
- 238000012795 verification Methods 0.000 abstract 1
- 238000005457 optimization Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
The invention relates to a space semi-stable scanning control method based on angle feedback of a rotary transformer, and belongs to the technical field of photoelectricity. The method utilizes the angle values fed back by the rotary transformers of the azimuth and pitch shafting and combines the attitude angle of the airplane, plans the scanning path after the processing of the coordinate system conversion algorithm, has the advantages of simple realization, no need of hardware change of products, small software change and the like, completely meets the scanning requirement of airborne photoelectric detection equipment on the specified control through experimental verification, is already applied to products, is also suitable for control platforms of various closed-loop motor driving platforms, and has strong practicability.
Description
Technical Field
The invention belongs to the technical field of photoelectricity, relates to a space semi-stable scanning control technology based on angle feedback of a rotary transformer, and particularly relates to a method for calculating and planning spatial step scanning of a scanning mirror to an appointed geographic system by utilizing a scanning mirror angle value fed back by the rotary transformer and combining an aircraft attitude angle.
Background
At present, in the field of airborne aviation, in order to scan and track a space target of a designated geographic coordinate system, a classical control method needs to be externally connected with a gyro sensor, so that the product cost is increased, and meanwhile, a gyroscope is additionally arranged on a visual axis, so that the weight and the volume of a product are increased, and the optimization of product performance is not facilitated. Therefore, the problem of implementing step scanning on a designated geographic coordinate system space under the condition that a gyro sensor is not added to a product is urgently needed to be solved.
Disclosure of Invention
Technical problem to be solved
The detection equipment is required to scan the designated geographic system space, a gyro sensor needs to be externally connected in a classical control method, the product cost is increased, the software is greatly changed, and meanwhile, a gyroscope is additionally arranged on a visual axis, so that the weight and the volume of the product are increased, and the product performance optimization is not facilitated. The invention provides a space semi-stable scanning control method based on angle feedback of a rotary transformer, aiming at solving the problem of realizing step scanning of a designated geographic coordinate system space under the condition of no gyro sensor.
Technical scheme
A space semi-stable scanning control method based on angle feedback of a rotary transformer is characterized by comprising the following steps:
step 1: obtaining a ZERO position FW _ ZERO, an initial scanning position FW _ CanKao, a scanning range FW _ WORKMAX, FW _ WORKMIN, FY _ WORKMAX, FY _ MIN, XX _ MAX and XX _ MIN of a scanning mirror according to a system working instruction;
step 2: calculating deviation amount FW _ jisean which is FW _ ZERO-FW _ CanKao according to the ZERO position FW _ ZERO of the scanning mirror and the initial scanning position FW _ CanKao;
and step 3: calculating an intermediate variable 1 converted by a coordinate system according to the deviation value and by combining the attitude angle of the airplane;
x＝cos(El)*cos(-Az)；
y＝cos(El)*sin(-Az)；
z＝sin(El)；
calculating intermediate variables of coordinate system transformation 2
x_＝(cosbeta*cosalpha)*x+(cosbeta*sinalpha)*y-sinbeta*z；
y_＝(singama*sinbeta*cosalpha-cosgama*sinalpha)*x+(singama*sinbeta*sinalpha+cosgama*cosalpha)*y+singama*cosbeta*z；
z_＝(cosgama*sinbeta*cosalpha+singama*sinalpha)*x+(cosgama*sinbeta*sinalpha-singama*cosalpha)*y+cosgama*cosbeta*z；
Azz＝atan2(y_,x_)；
And 4, step 4: calculating the position and the pitching position values of the scanning mirror in the position and the pitching direction and under the geographic system coordinate, judging whether the position and the pitching position values exceed the working range, and limiting the position and the pitching position values to the working limit if the position and the pitching position values exceed the working range;
ELL＝-(float)(atan2(z_,(sqrt(pow(x_,2.0)+pow(y_,2.0)))))*28.65；
FW_Mubiao＝FW_ZERO-Azz*83428.8；
FY_Mubiao＝FY_ZERO-ELL*728；
and 5: and (5) repeating the step (2) after the program execution of the current scanning period is finished.
The technical scheme of the invention is further that: the scanning mode is axial stepping scanning.
Advantageous effects
The invention provides a space semi-stable scanning control method based on angle feedback of a rotary transformer, and relates to a control method for scanning a designated geographic system space by a scanning swing mirror in a non-gyro control system.
Drawings
FIG. 1 is a flow chart of the method of the present invention
Detailed Description
The invention will now be further described with reference to the following examples and drawings:
as shown in fig. 1, the spatial semi-stable scanning control method based on the angular feedback of the resolver provided by the present invention specifically includes the following steps:
step 1: obtaining a ZERO position FW _ ZERO, an initial scanning position FW _ CanKao, a scanning range FW _ WORKMAX, FW _ WORKMIN, FY _ WORKMAX, FY _ MIN, XX _ MAX and XX _ MIN of a scanning mirror according to a system working instruction;
step 2: calculating deviation amount FW _ jisean which is FW _ ZERO-FW _ CanKao according to the ZERO position FW _ ZERO of the scanning mirror and the initial scanning position FW _ CanKao;
and step 3: calculating an intermediate variable 1 converted by a coordinate system according to the deviation value and by combining the attitude angle of the airplane;
x＝cos(El)*cos(-Az)；
y＝cos(El)*sin(-Az)；
z＝sin(El)；
calculating intermediate variables of coordinate system transformation 2
x_＝(cosbeta*cosalpha)*x+(cosbeta*sinalpha)*y-sinbeta*z；
y_＝(singama*sinbeta*cosalpha-cosgama*sinalpha)*x+(singama*sinbeta*sinalpha+cosgama*cosalpha)*y+singama*cosbeta*z；
z_＝(cosgama*sinbeta*cosalpha+singama*sinalpha)*x+(cosgama*sinbeta*sinalpha-singama*cosalpha)*y+cosgama*cosbeta*z；
Azz＝atan2(y_,x_)；
And 4, step 4: calculating the position and the pitching position values of the scanning mirror in the position and the pitching direction and under the geographic system coordinate, judging whether the position and the pitching position values exceed the working range, and limiting the position and the pitching position values to the working limit if the position and the pitching position values exceed the working range;
ELL＝-(float)(atan2(z_,(sqrt(pow(x_,2.0)+pow(y_,2.0)))))*28.65；
FW_Mubiao＝FW_ZERO-Azz*83428.8；
FY_Mubiao＝FY_ZERO-ELL*728；
and 5: and (5) repeating the step (2) after the program execution of the current scanning period is finished.
Using the feedback angle values of the rotation transformation of the azimuth and pitch shafting, wherein the unit is degree; combining the attitude angle of the airplane, wherein the unit is degree; the azimuth angle value of the scanning mirror under the product coordinate system is measured in degrees; and the pitch angle value of the scanning mirror under the product coordinate system is measured in degrees.
The space semi-stable scanning control method based on the angle feedback of the rotary transformer utilizes the angle value fed back by the system angle measurement rotary transformer as a reference, combines information such as the attitude angle of an airplane, coordinate system conversion algorithm processing of a product system-geographic system, the position of a scanning mirror and the like, plans the scanning paths of the azimuth channel and the pitching channel, dynamically adjusts the position of the scanning angle, realizes that the scanning mirror is controlled to continuously scan the space of the specified geographic coordinate system, and has the advantages of simple realization, good reliability and the like.
Claims (2)
1. A space semi-stable scanning control method based on angle feedback of a rotary transformer is characterized by comprising the following steps:
step 1: obtaining a ZERO position FW _ ZERO, an initial scanning position FW _ CanKao, a scanning range FW _ WORKMAX, FW _ WORKMIN, FY _ WORKMAX, FY _ MIN, XX _ MAX and XX _ MIN of a scanning mirror according to a system working instruction;
step 2: calculating deviation amount FW _ jisean which is FW _ ZERO-FW _ CanKao according to the ZERO position FW _ ZERO of the scanning mirror and the initial scanning position FW _ CanKao;
and step 3: calculating an intermediate variable 1 converted by a coordinate system according to the deviation value and by combining the attitude angle of the airplane;
x＝cos(El)*cos(-Az)；
y＝cos(El)*sin(-Az)；
z＝sin(El)；
calculating intermediate variables of coordinate system transformation 2
x_＝(cosbeta*cosalpha)*x+(cosbeta*sinalpha)*y-sinbeta*z；
y_＝(singama*sinbeta*cosalpha-cosgama*sinalpha)*x+(singama*sinbeta*sinalpha+cosgama*cosalpha)*y+singama*cosbeta*z；
z_＝(cosgama*sinbeta*cosalpha+singama*sinalpha)*x+(cosgama*sinbeta*sinalpha-singama*cosalpha)*y+cosgama*cosbeta*z；
Azz＝atan2(y_,x_)；
And 4, step 4: calculating the position and the pitching position values of the scanning mirror in the position and the pitching direction and under the geographic system coordinate, judging whether the position and the pitching position values exceed the working range, and limiting the position and the pitching position values to the working limit if the position and the pitching position values exceed the working range;
ELL＝-(float)(atan2(z_,(sqrt(pow(x_,2.0)+pow(y_,2.0)))))*28.65；
FW_Mubiao＝FW_ZERO-Azz*83428.8；
FY_Mubiao＝FY_ZERO-ELL*728；
and 5: and (5) repeating the step (2) after the program execution of the current scanning period is finished.
2. The method according to claim 1, wherein the scanning mode is step scanning around an axis.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011235116.5A CN112506232A (en) | 2020-11-08 | 2020-11-08 | Space semi-stable scanning control method based on angle feedback of rotary transformer |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202011235116.5A CN112506232A (en) | 2020-11-08 | 2020-11-08 | Space semi-stable scanning control method based on angle feedback of rotary transformer |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN112506232A true CN112506232A (en) | 2021-03-16 |
Family
ID=74955526
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202011235116.5A Pending CN112506232A (en) | 2020-11-08 | 2020-11-08 | Space semi-stable scanning control method based on angle feedback of rotary transformer |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN112506232A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113739773A (en) * | 2021-09-08 | 2021-12-03 | 西安应用光学研究所 | Efficient scanning method suitable for photoelectric system of small aircraft |
-
2020
- 2020-11-08 CN CN202011235116.5A patent/CN112506232A/en active Pending
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113739773A (en) * | 2021-09-08 | 2021-12-03 | 西安应用光学研究所 | Efficient scanning method suitable for photoelectric system of small aircraft |
| CN113739773B (en) * | 2021-09-08 | 2024-06-07 | 西安应用光学研究所 | Efficient scanning method suitable for photoelectric system of small aircraft |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Shim et al. | Autonomous exploration in unknown urban environments for unmanned aerial vehicles | |
| Xie et al. | Highly constrained entry trajectory generation | |
| CN106681344B (en) | A kind of height control method and control system for aircraft | |
| Curry et al. | L+ 2, an improved line of sight guidance law for UAVs | |
| Oh et al. | Coordinated standoff tracking using path shaping for multiple UAVs | |
| CN109708639B (en) | Method for generating lateral guidance instruction of aircraft for tracking straight line and circular arc path in flat flight | |
| CN102393630B (en) | Carrier aircraft landing guidance and control system and method for suppressing ship tail airflow disturbance | |
| CN108511908B (en) | A spaceborne antenna automatic tracking control system and method with phase suppression function | |
| CN104483977A (en) | No-speed feedback dynamic surface control method for steering engine pan-tilt | |
| CN106444822A (en) | Space vector field guidance based stratospheric airship's trajectory tracking control method | |
| Perhinschi et al. | Simulation environment for UAV fault tolerant autonomous control laws development | |
| Trenev et al. | Movement stabilization of the parrot mambo quadcopter along a given trajectory based on PID controllers | |
| CN112506232A (en) | Space semi-stable scanning control method based on angle feedback of rotary transformer | |
| KR102307079B1 (en) | System for detecting and tracking target of unmanned aerial vehicle | |
| Ryu et al. | Vision-based wind and position estimation with fixed-wing unmanned aerial vehicle | |
| Stephan et al. | Spline trajectory planning and guidance for fixed-wing drones | |
| Hong et al. | Applications of adaptive neural network control to an unmanned airship | |
| Tirado et al. | An interface based on QgroundControl for the rapid parameterization of flights from an embedded system for the control of an inspection drone | |
| Xiao et al. | Coning motion instability of spinning missiles induced by the delay of strap-down seeker | |
| Kus | Autonomous carrier landing of a fixed-wing UAV with airborne deck motion estimation | |
| Schuchardt et al. | Mission management and landing assistance for an unmanned rotorcraft for maritime operations | |
| Saini et al. | Air-to-air tracking of a maneuvering target with gimbaled radar | |
| CN112162570A (en) | Small-range dynamic tracking method for four-rotor helicopter | |
| RU110069U1 (en) | DEVICE FORMING SIGNALS FOR CONTROLLING STEERING BOARDS OF A SYMMETRIC CONTROLLED ROCKET WITH A VERTICAL START AT AN AUTONOMOUS AREA OF ITS FLIGHT | |
| KR101725649B1 (en) | Unmanned aerial vehicle and remote controller for the unmanned aerial vehicle |
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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210316 |
|
| RJ01 | Rejection of invention patent application after publication |