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
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 |
|---|---|---|
| CN106681344B (en) | A kind of height control method and control system for aircraft | |
| US6529821B2 (en) | Route planner with area avoidance capability | |
| Curry et al. | L+ 2, an improved line of sight guidance law for UAVs | |
| CN109708639B (en) | Method for generating lateral guidance instruction of aircraft for tracking straight line and circular arc path in flat flight | |
| Oh et al. | Coordinated standoff tracking using path shaping for multiple UAVs | |
| CN104483977B (en) | The dynamic surface control method without velocity feedback of a kind of steering wheel The Cloud Terrace and controller | |
| CN108511908B (en) | A spaceborne antenna automatic tracking control system and method with phase suppression function | |
| CN102393630A (en) | Carrier aircraft landing guide and control system for inhibiting airflow disturbance of stern and control method for system | |
| CN105891821A (en) | Automatic tracking method of airborne downward-looking measurement target | |
| 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 | |
| CN113900448B (en) | Aircraft prediction correction composite guidance method based on sliding mode interference observer | |
| US5951607A (en) | Autonomous craft controller system for landing craft air cushioned vehicle | |
| Manjunath et al. | Application of virtual target based guidance laws to path following of a quadrotor UAV | |
| US20090069962A1 (en) | Guidance of marine vessels | |
| CN112506232A (en) | Space semi-stable scanning control method based on angle feedback of rotary transformer | |
| CN108544491B (en) | Mobile robot obstacle avoidance method comprehensively considering two factors of distance and direction | |
| CN111881514B (en) | Guidance reconstruction method under engine fault state | |
| 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 | |
| Hong et al. | Applications of adaptive neural network control to an unmanned airship | |
| Gonçalves et al. | Homography-based visual servoing of an aircraft for automatic approach and landing | |
| Stephan et al. | Spline trajectory planning and guidance for fixed-wing drones | |
| CN112162570B (en) | A small-range dynamic tracking method for a quadrotor helicopter | |
| Xiao et al. | Coning motion instability of spinning missiles induced by the delay of strap-down seeker |
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 |