A rotating dual-prism line-of-sight stabilization system and control method based on MEMS gyroscope
By using MEMS gyroscope and Hall sensor in a rotating double prism visual axis stabilization system, combining differential processing and control methods, the problem of angle encoder susceptibility is solved, and high-precision visual axis stabilization and spatial orientation are achieved. Strong anti-interference ability and the advantages of miniaturization and lightweighting.
Patent Information
- Application Number
- CN202410249629.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-03-05
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2044-03-05
AI Technical Summary
The angle encoder of the existing rotating double prism visual axis stabilization system is susceptible to vibration shock, oil and dust, high ambient humidity and electromagnetic interference, resulting in inaccurate prism rotation angle information.
The rotating double-prism visual axis stabilization system based on MEMS gyroscope is adopted to measure the angular velocity and position of the rotation axis through the MEMS gyroscope and Hall sensor, and combine differential processing and control methods to achieve high-precision visual axis stabilization control.
In the disturbed environment, the high-precision spatial orientation and stable visual axis of the rotating double prism visual axis are achieved, and the advantages of miniaturization, lightweight and strong anti-interference ability are achieved.
Smart Images

Figure CN118113072B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of line of sight stabilization, and in particular relates to a rotating dual-prism line of sight stabilization system based on a MEMS gyroscope and a control method. Background Art
[0002] Line of sight stabilization means that the direction of the tracker's line of sight in inertial space is not affected by the motion of the carrier, and can maintain a stable direction to the tracked target. The rotating biprism is a type of beam deflection mechanism. Based on the principle of light refraction, the rotating biprism can realize arbitrary pointing of the light beam in the two-dimensional field of view by rotating the wedge-shaped prism. Compared with the coarse pointing mechanism universal turntable and the fine pointing mechanism deflection mirror of the laser communication terminal tracking and aiming system, the rotating biprism has the advantages of large scanning range, high beam deflection resolution, and good dynamic performance. It can be used as a coarse and fine pointing mechanism for spatial beams to achieve high-precision spatial pointing of the beam. On the basis of high-precision spatial pointing, the rotating biprism combined with the control method can realize line of sight stabilization control. In order to achieve high-precision spatial pointing, the composition structure of the rotating dual prism mechanism is mentioned in the prior art (application number: CN03129234.8, application date June 2003), the prior art (application number: CN201310655695.2, application date December 2013), and the prior art (application number: CN201910020626.1, application date January 2019). In the prior art, the angle encoders of the rotating dual prisms mostly use photoelectric encoders, magnetic encoders, capacitive encoders, inductive encoders, etc. The encoders are not enough in that the obtained prism rotation angle information is susceptible to interference such as vibration, shock, oil, dust, humidity, and electromagnetics, or the encoder reading head and the code disc must maintain a certain gap. Summary of the invention
[0003] In view of the problem that the angle encoder of the existing rotating dual-prism line of sight stabilization system obtains prism rotation angle information and is easily affected by interferences such as vibration and shock, oil and dust, high ambient humidity, and electromagnetic interference, or that the encoder reading head and the code disk need to maintain a certain gap, the present invention proposes a rotating dual-prism line of sight stabilization system and a control method based on a MEMS gyroscope, which can achieve high-precision spatial pointing and line of sight stabilization of the rotating dual-prism line of sight stabilization system under the influence of vibration and shock, oil and dust, high ambient humidity, and electromagnetic interference.
[0004] In order to achieve the above object, the present invention adopts the following technical scheme:
[0005] A rotating dual prism sight axis stabilization system based on a MEMS gyroscope, the rotating dual prism sight axis stabilization system comprising: a base, a first rotating shaft and a second rotating shaft, a first motor and a second motor, a first magnetic wheel and a second magnetic wheel, a first Hall sensor and a second Hall sensor, a first MEMS gyroscope, a second MEMS gyroscope and a third MEMS gyroscope, a first wedge prism and a second wedge prism, a first bearing, a second bearing, a third bearing, and a fourth bearing. The first rotating shaft and the second rotating shaft are installed in the base through bearings, the first wedge prism and the second wedge prism are installed in the first rotating shaft and the second rotating shaft respectively, and are driven to rotate by the first motor and the second motor; the first motor and the second motor, the first magnetic wheel and the second magnetic wheel, the first Hall sensor and the second Hall sensor, the first MEMS gyroscope and the second MEMS gyroscope are installed on the first rotating shaft and the second rotating shaft; the magnetic wheel and the motor rotor rotate synchronously, the first Hall sensor and the second Hall sensor measure the positions of the first magnetic wheel and the second magnetic wheel respectively, and the MEMS gyroscopes on the first rotating shaft and the second rotating shaft and the MEMS gyroscope on the base differentially measure the rotating shaft speed. The first MEMS gyroscope and the second MEMS gyroscope are mounted on the first rotating shaft and the second rotating shaft, and the third MEMS gyroscope is mounted on the base.
[0006] In one embodiment, the first rotating shaft is installed in the base through the first bearing and the second bearing, the first wedge-shaped prism is installed in the first rotating shaft, and the first bearing and the second bearing, the first motor, the first magnetic wheel, the first Hall sensor, and the first MEMS gyroscope are arranged on the first rotating shaft from left to right. The second rotating shaft is installed in the base through the third bearing and the fourth bearing, and the components on it are mirror-symmetrical with the components on the first rotating shaft.
[0007] In one embodiment, the first motor and the second motor are brushless DC servo motors or permanent magnet synchronous motors. The rotors of the first motor and the second motor are mounted on the rotating shaft, and the stators of the first motor and the second motor are mounted on the inner side of the base.
[0008] In one embodiment, the first magnetic wheel, the second magnetic wheel and the rotors of the first motor and the second motor have the same magnetic pole distribution, are arranged adjacent to the rotors of the first motor and the second motor, and rotate synchronously with the rotors of the first motor and the second motor.
[0009] In one embodiment, the first Hall sensor and the second Hall sensor respectively include three Hall elements, which are evenly distributed at 120° and integrated on a PCB board. The PCB board is in a circular shape and is installed on the inner side of the base, directly above the first magnetic wheel and the second magnetic wheel.
[0010] In one embodiment, the first MEMS gyroscope, the second MEMS gyroscope, and the third MEMS gyroscope include a MEMS gyroscope component and a Bluetooth module, which are integrated on a PCB board, and the PCB board is in a circular ring shape.
[0011] The present invention also provides a control method for a rotating dual-prism visual axis stabilization system based on a MEMS gyroscope, comprising the following steps:
[0012] S1, inputting a desired beam angle signal as a system input to a controller, the controller maps the desired beam angle into the prism angle, the prism angle is output as a control signal to a motor driver, and the motor driver outputs a current signal to drive the motor to rotate;
[0013] S2, the first Hall sensor and the second Hall sensor detect the polarity change of the magnetic wheel and output a pulse signal to the controller;
[0014] S3, the first MEMS gyroscope, the second MEMS gyroscope and the third MEMS gyroscope output the measurement data to the controller;
[0015] S4, the controller performs differential processing on the measurement signals of the first MEMS gyroscope and the third MEMS gyroscope, and the second MEMS gyroscope and the third MEMS gyroscope to obtain the angular velocities of the first rotating shaft and the second rotating shaft relative to the base, and the controller integrates the angular velocities of the first rotating shaft and the second rotating shaft to obtain the angle increments of the first rotating shaft and the second rotating shaft;
[0016] S5, the controller combines the pulse signal of the Hall sensor and the angle increment of the first rotating shaft and the second rotating shaft to calculate the angle of the first rotating shaft and the second rotating shaft;
[0017] S6. Use the angles of the first rotating shaft and the second rotating shaft as negative feedback to calculate the angle control error of the first rotating shaft and the second rotating shaft, and reduce or eliminate the error through a control method so that the actual beam rotation angle output by the system is close to the expected beam rotation angle input by the system.
[0018] In one embodiment, the mapping relationship in S1 is the correspondence between the output beam angle and the prism angle. The input is a set of output beam angles, a set of output beam angles corresponds to two sets of prism angles, and a set of prism angles that minimizes the total rotation angle is selected as the output. The theoretical basis of the mapping relationship is the law of vector refraction.
[0019] In one embodiment, in S1, the first motor and the second motor drive the first rotating shaft and the second rotating shaft to rotate respectively, and the first wedge-shaped prism and the second wedge-shaped prism are installed inside the first rotating shaft and the second rotating shaft. Therefore, the rotation angle of the rotors of the first motor and the second motor is the rotation angle of the first rotating shaft and the second rotating shaft, that is, the rotation angle of the first wedge-shaped prism and the second wedge-shaped prism.
[0020] In one embodiment, in S4, the differential processing of the gyroscope signal is to respectively subtract the three-dimensional measurement signals of the first MEMS gyroscope and the second MEMS gyroscope and the three-dimensional measurement signal of the third MEMS gyroscope, and the angular velocity signal obtained by the difference is a vector, and its modulus is taken as the angular velocity of the first rotation axis and the second rotation axis.
[0021] In one embodiment, in S6, the control method may include but is not limited to PID control, adaptive control, robust control, neural network and fuzzy control, sliding film control and other control methods.
[0022] The beneficial effects of the present invention are:
[0023] (1) Miniaturization, lightness, and simple structure. MEMS gyroscopes and Hall sensors as measuring components can achieve miniaturization and lightness of the present invention; the mirror-symmetrical component arrangement is conducive to installation and debugging, and the structure is simple.
[0024] (2) Strong anti-interference ability. The present invention uses a MEMS gyroscope to measure speed. Compared with other common angle encoders on the market, the advantage of the MEMS gyroscope combined with a Hall sensor for speed measurement is that it has a strong anti-interference ability.
[0025] (3) Can be used for visual axis stabilization control. The present invention can be further combined with a control method to achieve visual axis stabilization control based on high-precision pointing. BRIEF DESCRIPTION OF THE DRAWINGS
[0026] Figure 1 It is a structural cross-sectional view of a rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope of the present invention;
[0027] Figure 2 is a schematic diagram of the control method of the present invention;
[0028] In the figure:
[0029] 101——first motor 102——second motor
[0030] 103——first bearing 104——second bearing
[0031] 105——third bearing 106——fourth bearing
[0032] 201——first wedge-shaped prism 202——second wedge-shaped prism
[0033] 301——first magnetic wheel 302——second magnetic wheel
[0034] 303——first Hall sensor 304——second Hall sensor
[0035] 305——first MEMS gyroscope 306——second MEMS gyroscope
[0036] 307——third MEMS gyroscope 401——first rotation axis
[0037] 402——Second rotating shaft 403——Base DETAILED DESCRIPTION
[0038] In order to enable those skilled in the art to better understand the objectives, technical solutions and advantages of the present invention, the present invention is further described in detail below with reference to the accompanying drawings and examples.
[0039] like Figure 1 As shown, a rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope of the present invention comprises: a first rotating shaft 401, a second rotating shaft 402, a base 403, a first motor 101, a second motor 102, a first magnetic wheel 301, a second magnetic wheel 302, a first Hall sensor 303, a second Hall sensor 304, a first MEMS gyroscope 305, a second MEMS gyroscope 306, a third MEMS gyroscope 307, a first wedge prism 201, a second wedge prism 202, a first bearing 103, a second bearing 104, a third bearing 105, and a fourth bearing 106.
[0040] In one embodiment, the first rotating shaft 401 is installed in the base 403 through the first bearing 103 and the second bearing 104, the first wedge prism 201 is installed in the first rotating shaft 401, the first rotating shaft 401 is driven to rotate by the first motor 101, and the first motor 101, the first magnetic wheel 301, the first Hall sensor 303, and the first MEMS gyroscope 305 are installed on the first rotating shaft 401; the first magnetic wheel 301 and the rotor of the first motor 101 rotate synchronously, the first Hall sensor 303 measures the position of the first magnetic wheel 301, and the first MEMS gyroscope 305 on the first rotating shaft 401 and the third MEMS gyroscope 307 on the base 403 differentially measure the rotating shaft speed. The arrangement of the components on the first rotating shaft 401 is relatively space-saving, which is conducive to the miniaturization and lightweight of the rotating dual-prism visual axis stabilization system. The distribution of the second rotating shaft 402 and its components is mirror-symmetrical to the distribution of the first rotating shaft 401 and its components. The use of a mirror-symmetrical component arrangement is conducive to the installation and debugging of components.
[0041] Since the first rotating shaft 401 and its upper parts are distributed in mirror symmetry with the second rotating shaft 402 and its upper parts, the first rotating shaft 401 and its upper parts are used as an example for structural description. It should be known that the layout and connection method of the second rotating shaft 402 and its upper parts can refer to the layout and connection method of the first rotating shaft 401 and its upper parts.
[0042] In one embodiment, the first motor 101 and the second motor 102 are brushless DC servo motors or permanent magnet synchronous motors. The rotors of the first motor 101 and the second motor 102 are mounted on the first rotating shaft 401 and the second rotating shaft 402, and the mounting method can be selected by gluing or screw connection according to the volume of the motor. The stators of the first motor 101 and the second motor 102 are mounted on the inner side of the base 403. Preferably, the stators of the first motor 101 and the second motor 102 are equipped with stator sleeves, and the stator sleeves are glued to the stator, and the stator sleeves are connected to the first end cover by screws. The first end cover provides radial positioning and axial connection for the stator. The advantages of direct drive over indirect drive are high driving efficiency, simple structure and small size. The advantages of brushless DC servo motors or permanent magnet synchronous motors over stepper motors are small angular resolution and high control accuracy.
[0043] In one embodiment, the first magnetic wheel 301 has the same magnetic pole distribution as the rotor of the first motor 101, is arranged adjacent to the rotor of the first motor 101, and rotates synchronously with the rotor of the first motor 101. The first magnetic wheel 301 and the first rotating shaft 401 are connected by gluing.
[0044] In one embodiment, the first Hall sensor 303 includes three Hall elements, which are evenly distributed at 120° and integrated on a PCB board. The PCB board is annular and installed on the inner side of the base 403, just above the first magnetic wheel 301. The first Hall sensor 303 and the base 403 are axially limited by positioning steps, connected by adhesive, and positioned by positioning pins. The first Hall sensor 303 can detect the magnetic transformation that occurs when the first magnetic wheel 301 rotates, and thus plays a role in angular positioning of the first rotating shaft 401.
[0045] In one embodiment, the first MEMS gyroscope 305, the second MEMS gyroscope 306, and the third MEMS gyroscope 307 each include a MEMS gyroscope component and a Bluetooth module, which are integrated on a PCB board. The PCB board is in a circular ring shape. The first MEMS gyroscope 305 is mounted on the first rotating shaft 401, the second MEMS gyroscope 306 is mounted on the second rotating shaft 402, and the third MEMS gyroscope 307 is mounted on the base 403. The first MEMS gyroscope 305 and the second MEMS gyroscope 306 transmit the measurement data to the third MEMS gyroscope 307 through the Bluetooth module. The third MEMS gyroscope 307 receives data through the Bluetooth module, and the data of the third MEMS gyroscope 307 is transmitted to the controller through the data line. The first MEMS gyroscope 305, the second MEMS gyroscope 306 and the first rotating shaft 401 and the second rotating shaft 402 are axially limited by positioning steps, connected by adhesive, and positioned by positioning pins. The third MEMS gyroscope 307 is connected to the base 403 by a mounting plate, the mounting plate is connected to the base 403 by screws, the mounting plate is connected to the third MEMS gyroscope 307 by gluing, and is positioned by a positioning pin. The MEMS gyroscope has the characteristics of small size and high speed measurement accuracy. The shaft angle measurement method of the MEMS gyroscope combined with the Hall sensor has strong anti-interference ability and high measurement accuracy.
[0046] Preferably, the first wedge-shaped prism 201 is connected to the first rotating shaft 401 via a lens holder. The lens holder and the first rotating shaft 401 are processed as one piece. The first wedge-shaped prism 201 is connected to the lens holder by gluing.
[0047] Preferably, the mirror base can be designed with arc-shaped grooves to release the stress of the wedge prism to ensure the optical quality of the refracted light. The mirror base is made of titanium alloy TC4, which has low density and high strength, and can achieve light weight and excellent structural performance.
[0048] like Figure 2 As shown, in one embodiment, a control method of a rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope of the present invention comprises the following steps:
[0049] S1, inputting a desired beam angle signal as a system input to a controller, the controller maps the desired beam angle into the prism angle, the prism angle is output as a control signal to a motor driver, the motor driver outputs a current signal to drive the motor to rotate, and obtains an actual beam angle;
[0050] S2, the first Hall sensor 303 and the second Hall sensor 304 detect the polarity change of the first magnetic wheel 301 and the second magnetic wheel 302, and output a pulse signal to the controller after detecting the position of the magnetic wheel;
[0051] S3, the first MEMS gyroscope 305, the second MEMS gyroscope 306, and the third MEMS gyroscope 307 output the speed measurement data of the first motor 101, the second motor 102, and the base 403 relative to the inertial system to the controller;
[0052] S4, the controller performs differential processing on the measurement signals of the first MEMS gyroscope 305 and the third MEMS gyroscope 307, the second MEMS gyroscope 306 and the third MEMS gyroscope 307 to obtain the angular velocities of the first rotating shaft 401 and the second rotating shaft 402 relative to the base 403, and the controller integrates the angular velocities of the first rotating shaft 401 and the second rotating shaft 402 to obtain the angle increments of the first rotating shaft 401 and the second rotating shaft 402;
[0053] S5. The controller combines the pulse signals of the first Hall sensor 303 and the second Hall sensor 304 and the angle increments of the first rotating shaft 401 and the second rotating shaft 402 to calculate the angles of the first rotating shaft 401 and the second rotating shaft 402.
[0054] S6. Use the angles of the first rotating shaft 401 and the second rotating shaft 402 as negative feedback to obtain the angle control error of the first rotating shaft and the second rotating shaft, and reduce or eliminate the error through a control method so that the actual beam angle output by the system is close to the expected beam angle input by the system.
[0055] In one embodiment, the mapping relationship in S1 is the correspondence between the output beam angle and the prism angle. The input is a set of output beam angles, a set of output beam angles corresponds to two sets of prism angles, and the output is a set of prism angles with the smallest total rotation angle. The theoretical basis of the mapping relationship is the law of vector refraction.
[0056] In one embodiment, in S1, the first motor 101 and the second motor 102 drive the first rotating shaft 401 and the second rotating shaft 402 to rotate, and the first wedge-shaped prism 201 and the second wedge-shaped prism 202 are installed inside the first rotating shaft 401 and the second rotating shaft 402, so the rotation angle of the rotor of the first motor 101 and the second motor 102 is the rotation angle of the first rotating shaft 401 and the second rotating shaft 402, that is, the rotation angle of the first wedge-shaped prism 201 and the second wedge-shaped prism 202.
[0057] In one embodiment, in S4, the differential processing of the signals of the first MEMS gyroscope 305, the second MEMS gyroscope 306, and the third MEMS gyroscope 307 is to subtract the three-dimensional measurement signals of the first MEMS gyroscope 305, the second MEMS gyroscope 306 and the three-dimensional measurement signals of the third MEMS gyroscope 307, respectively. The angular velocity signal obtained by the difference is a vector, and its modulus is taken as the angular velocity of the first rotating shaft 401 and the second rotating shaft 402.
[0058] In one embodiment, in S6, the control method may adopt control methods including but not limited to PID control, adaptive control, robust control, neural network and fuzzy control, sliding film control, etc.
[0059] It will be easily understood by those skilled in the art that the above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. Any modifications, equivalent substitutions and improvements made within the spirit and principles of the present invention should be included in the protection scope of the present invention.
Claims
1. A rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope, characterized in that: The invention comprises a base, a first rotating shaft, a second rotating shaft, a first motor, a second motor, a first magnetic wheel, a second magnetic wheel, a first Hall sensor, a second Hall sensor, a first MEMS gyroscope, a second MEMS gyroscope, a third MEMS gyroscope, a first wedge prism, a second wedge prism, a first bearing, a second bearing, a third bearing and a fourth bearing; the first rotating shaft and the second rotating shaft are installed in the base through bearings, the first wedge prism and the second wedge prism are installed in the first rotating shaft and the second rotating shaft respectively, and are driven to rotate by the first motor and the second motor respectively; the first rotating shaft and the second rotating shaft are respectively installed with the first motor, the first magnetic wheel, the first Hall sensor, the first MEMS gyroscope and the second motor, the second magnetic wheel, the second Hall sensor and the second MEMS gyroscope The first magnetic wheel and the second magnetic wheel rotate synchronously with the rotors of the first motor and the second motor respectively, the first Hall sensor and the second Hall sensor measure the positions of the first magnetic wheel and the second magnetic wheel respectively, the first MEMS gyroscope and the second MEMS gyroscope on the first rotating shaft and the second rotating shaft and the third MEMS gyroscope on the base differentially measure the rotation speeds of the first rotating shaft and the second rotating shaft; the first rotating shaft is installed in the base through the first bearing and the second bearing, the first wedge-shaped prism is installed in the first rotating shaft, and the first bearing, the second bearing, the first motor, the first magnetic wheel, the first Hall sensor, and the first MEMS gyroscope are arranged on the first rotating shaft from left to right in sequence; the second rotating shaft is installed in the base through the third bearing and the fourth bearing, and the components thereon are mirror-symmetrical with the components thereon of the first rotating shaft.
2. The rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope according to claim 1, characterized in that: The first motor and the second motor are brushless DC servo motors or permanent magnet synchronous motors; the rotors of the first motor and the second motor are respectively mounted on the first rotating shaft and the second rotating shaft, and the stators of the first motor and the second motor are mounted on the inner side of the base.
3. The rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope according to claim 1, characterized in that: The first magnetic wheel and the second magnetic wheel have the same magnetic pole distribution as the rotors of the first motor and the second motor, are arranged adjacent to the rotors of the first motor and the second motor, and rotate synchronously with the rotors of the first motor and the second motor.
4. The rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope according to claim 1, characterized in that: The first Hall sensor and the second Hall sensor respectively include three Hall components, which are evenly distributed at 120° and integrated on a PCB board. The PCB board is in a circular shape and is installed on the inner side of the base, respectively, directly above the first magnetic wheel and the second magnetic wheel.
5. The rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope according to claim 1, characterized in that The MEMS gyroscope includes a MEMS gyroscope component and a Bluetooth module, which are integrated on a PCB board. The PCB board is in a circular ring shape. The first MEMS gyroscope and the second MEMS gyroscope are installed on the first rotating shaft and the second rotating shaft. The third MEMS gyroscope is installed on the base.
6. A control method for a rotating dual-prism line-of-sight stabilization system based on a MEMS gyroscope according to any one of claims 1 to 5, characterized in that: The following steps are involved: S1, inputting a desired beam angle signal as a system input to a controller, the controller mapping the desired beam angle into the first wedge prism and the second wedge prism angles, the first wedge prism and the second wedge prism angles are output as control signals to the first motor and the second motor driver, the first motor and the second motor driver output current signals to drive the first motor and the second motor to rotate; S2, the first Hall sensor and the second Hall sensor respectively detect the polarity changes of the first magnetic wheel and the second magnetic wheel, and output a pulse signal to the controller; S3, the first MEMS gyroscope, the second MEMS gyroscope, and the third MEMS gyroscope output the measurement data to the controller; S4, the controller performs differential processing on the measurement signals of the first MEMS gyroscope and the third MEMS gyroscope and performs differential processing on the measurement signals of the second MEMS gyroscope and the third MEMS gyroscope to obtain the angular velocities of the first rotating shaft and the second rotating shaft relative to the base, and the controller integrates the angular velocities of the first rotating shaft and the second rotating shaft to obtain the angle increments of the first rotating shaft and the second rotating shaft; S5, the controller combines the pulse signals of the first Hall sensor and the second Hall sensor and the angle increments of the first rotating shaft and the second rotating shaft to calculate the angles of the first rotating shaft and the second rotating shaft; S6. Use the angles of the first rotating shaft and the second rotating shaft as negative feedback to obtain the control error of the angles of the first rotating shaft and the second rotating shaft, and reduce or eliminate the error through a control method so that the actual beam angle output by the system is close to the desired beam angle input by the system.
7. The control method according to claim 6, characterized in that: The mapping relationship in S1 is the correspondence between the output beam angle and the prism angle. The input is a set of output beam angles, and a set of output beam angles corresponds to two sets of prism angles. The set of prism angles that minimizes the total rotation angle is selected as the output.
8. The control method according to claim 6, characterized in that: In S1, the first wedge-shaped prism and the second wedge-shaped prism are installed inside the first rotating shaft and the second rotating shaft, so the rotation angle of the first motor and the second motor rotor is the rotation angle of the first rotating shaft and the second rotating shaft, that is, the rotation angle of the first wedge-shaped prism and the second wedge-shaped prism.
9. The control method according to claim 6, characterized in that: In S4, the differential processing of the MEMS gyroscope signal is to subtract the three-dimensional measurement signals of the first MEMS gyroscope, the second MEMS gyroscope and the third MEMS gyroscope. The angular velocity signal obtained by the difference is a vector, and its modulus is taken as the angular velocity of the first rotation axis and the second rotation axis.
10. The control method according to claim 6, characterized in that: In S6, the control method adopts PID control, adaptive control, robust control, neural network and fuzzy control or sliding film control.
Citation Information
Patent Citations
Tracking device based on rotational double prisms and control method thereof
CN103631276A
High-precision target pointing device
CN109884769A
Optical device for simulating satellite trail
CN1463087A
Synchronous belt drive rotary prism device
CN103149686A
Stable holder based on MEMS gyroscope combination and control method
CN107817821A
