Optoelectronic equipment optical axis stability control system for unmanned ship
By adopting an optical axis stability control system with two-axis structures in unmanned boat optoelectronic equipment, combined with a high-precision encoder and a permanent magnet torque servo motor, the problem of low steady direction longitude of the dual-axis photoelectric rotary stage is solved. It realizes high precision and stability of the optical axis and improves the autonomous navigation capabilities of unmanned boats.
Patent Information
- Application Number
- CN202411197606.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-29
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The two-axis photoelectric rotary stages of existing unmanned boat optoelectronic equipment are not stable in a high direction, making it difficult to maintain the optical axis under the influence of various environmental factors, affecting the accuracy of autonomous navigation.
An optical axis stability control system for unmanned boats including optical axis stabilization system and controller is designed, and a two-axis rotary table system with an outer pitch and inner azimuth structure is adopted, combining high-precision encoder and permanent magnet torque servo. The motor realizes the stability of the optical axis direction through real-time acquisition and closed-loop control.
Through simulation analysis and boat load test verification, high-precision and steady-direction measurement of the dual-axis photoelectric rotary table is achieved, solid obstacle avoidance support is provided, and the autonomous navigation capability of the unmanned boat is improved.
Smart Images

Figure CN118915595A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of optical axis stabilization control systems, and in particular to an optical axis stabilization control system for optoelectronic equipment used in unmanned boats. Background Art
[0002] Unmanned surface boats are a type of surface sports platform that can autonomously navigate in the ocean environment and complete various tasks. Unmanned boats can generally be used in many fields such as meteorology, water quality sampling, hydrological detection, and maritime rescue. Nowadays, unmanned boats have become an important direction for the development of unmanned equipment at sea.
[0003] During the autonomous navigation process, the unmanned boat needs to sense and detect the surrounding operating environment to determine whether there are obstacles around it. Optoelectronic equipment can detect the surroundings of the unmanned boat and accurately provide the longitude and latitude information of obstacles. Therefore, optoelectronic equipment plays a very important role in the autonomous operation of the unmanned boat.
[0004] Photoelectric equipment uses optical devices such as cameras to detect surrounding environment information and laser devices to relatively locate detected obstacles. The measurement accuracy of photoelectric equipment is affected by a variety of environmental factors, among which optical axis stability is one of the most critical factors. Summary of the invention
[0005] The technical problem to be solved by the present invention is to overcome the problem of low stabilization longitude of the dual-axis optoelectronic turntable in the prior art and to provide an optical axis stabilization control system for optoelectronic equipment for unmanned boats.
[0006] The technical solution adopted by the present invention to solve its technical problem is an optical axis stabilization control system for optoelectronic equipment for unmanned boats, including an optical axis stabilization system and a controller. The optical axis stabilization system includes a turntable system and an optical axis pointing turntable.
[0007] Furthermore, the optical axis pointing turntable includes two axis systems, namely, pitch and azimuth, and adopts an external pitch and internal azimuth two-axis structure. The pitch axis and the azimuth axis intersect vertically and couple the motions to cope with the angular pointing of the turntable in all directions.
[0008] Furthermore, the azimuth component and the elevation component form two frame structures.
[0009] Furthermore, the pitch axis adopts a structural form of a driving assembly on one side and a secondary shaft assembly on the other side.
[0010] Furthermore, the turntable system collects parameters and information of the optical axis pointing to the turntable in real time, and performs loop control according to different working modes of the turntable system to drive the azimuth and pitch motors to move.
[0011] Furthermore, the controller includes a power module, an ARM processor module, an FPGA, a data conversion module, an encoder interface module, a serial communication module, an input and output interface module In summary, the present invention has the following beneficial technical effects: Through simulation analysis and boat-borne tests, the effectiveness of the optical axis stabilization system of the above-mentioned unmanned boat optoelectronic equipment has been verified. It can realize the stable measurement of the dual-axis optoelectronic turntable and provide solid support for the obstacle avoidance of the unmanned boat. BRIEF DESCRIPTION OF THE DRAWINGS
[0012] Figure 1 This is a working principle diagram of an optical axis stabilization system of an embodiment of an optical axis stabilization control system for an optoelectronic device for an unmanned boat of the present invention; Figure 2 It is an azimuth and pitch stabilization mode loop of an embodiment of an optical axis stabilization control system of an optoelectronic device for an unmanned boat of the present invention; Figure 3 It is an azimuth and pitch pointing control loop of an embodiment of an optical axis stabilization control system of an optoelectronic device for an unmanned boat of the present invention; Figure 4 It is a general design block diagram of a controller of an embodiment of an optical axis stabilization control system of an optoelectronic device for an unmanned boat of the present invention; Figure 5 It is the position loop open-loop frequency characteristic of an embodiment of an optical axis stabilization control system for an optoelectronic device for an unmanned boat of the present invention; Figure 6 It is the position loop closed loop frequency characteristic of an embodiment of an optical axis stabilization control system for an optoelectronic device for an unmanned boat of the present invention; Figure 7 This is a screenshot of the display and control of the optoelectronic equipment during the sea trial of an optoelectronic equipment optical axis stabilization control system for an unmanned boat according to the present invention. DETAILED DESCRIPTION
[0013] The present invention is further described in detail below in conjunction with the accompanying drawings and embodiments.
[0014] This embodiment includes an optical axis stabilization system and a controller. The optical axis stabilization system includes a turntable system and an optical axis pointing turntable.
[0015] Reference Figure 1The optical axis pointing turntable is a dual-axis turntable, including an azimuth axis and a pitch axis. The optoelectronic platform achieves the stability of the optical axis of the optoelectronic payload through the coordinated control of the azimuth axis and the pitch axis. The optoelectronic equipment uses a gyroscope to measure the posture of the optoelectronic payload, and then uses the control motors of the azimuth axis and the pitch axis to rotate to control the azimuth and pitch angles to reach the specified position. The optical axis pointing turntable corresponds to the pitch and azimuth axis systems, and is an external pitch and internal azimuth axis structure. The pitch axis intersects the azimuth axis vertically and couples the motion to cope with the angle pointing of the turntable in all directions. The azimuth component and the pitch component form a two-frame structure. The two-axis transmission mechanism uses permanent magnet torque servo motors to shorten the transmission chain and reduce the transmission error. A high-precision encoder is used as the speed and position detection device of the system, and a slip ring is used as the internal electrical signal transmission to achieve 360-degree rotation in azimuth; the pitch axis of the turntable adopts a structure with a drive component on one side and a secondary axis component on the other side to ensure the rigidity and precision of the turntable transmission structure. Under the premise of ensuring the turntable's range of motion, the inner and outer frames and the base dimensions should be compressed as much as possible to increase the turntable's rigidity and reduce its mass.
[0016] Reference Figure 1 The turntable system collects motor current information, encoder angle information, tracking miss distance information, and gyro inertial angular velocity information in real time, and performs closed-loop control of tracking loops, position loops, gyro velocity loops, current loops and other control loops according to different system working modes, implements motor vector control algorithms, drives azimuth and pitch motors to move rapidly, and realizes high-precision search stabilization, pointing guidance, tracking and aiming of optoelectronic payload line of sight and other functions.
[0017] The control loops of the azimuth and elevation axes of the optoelectronic device are as follows: Figure 2 As shown in the figure, the control command information of the optoelectronic turntable to the execution motor is generated according to the attitude information collected by the inertial navigation and the target orientation issued by the mission system. The execution loop of the azimuth axis and pitch axis of the optoelectronic equipment platform is as follows: Figure 3 As shown, it is a double-loop circuit, which controls the motor to rotate to the desired position according to the motor control command generated by the control system.
[0018] Reference Figure 2 , Figure 3 The controller controls the azimuth and elevation of the optical axis to point to the desired azimuth. The photoelectric payload frame is equipped with a high-precision inertial navigation system, and each frame is equipped with a high-precision encoder that is sensitive to the angular position of the turntable to achieve accurate axial pointing of the optical axis of the payload.
[0019] Reference Figure 4The controller includes a power module, an ARM processor module, an FPGA, a data conversion module, an encoder interface module, a serial communication module, and an input / output interface module. The core of the entire controller is the ARM processor. All communications and controls are ultimately centralized to the ARM for unified processing. It has a rich peripheral interface, and can receive given command signals through network communication interfaces, CAN communication interfaces, 422 ports, SPI ports, and IO ports, or collect status information of various peripherals (encoders, gyroscopes, inertial navigation, etc.) and perform related controls. Finally, the ARM processor will solve and process the collected information, and finally output the command signal (communication port or DA output) to the driver's command input, achieving precise control of the motor servo system.
[0020] The controller uses a high-performance ARM processor, supplemented by the "dual-core" design of FPGA. It can quickly and easily access other peripherals through various types of communication interfaces and has very good compatibility. At the same time, this "dual-core" design processes complex vector control algorithms in FPGA, which can also greatly improve the efficiency of the ARM processor, so as to realize more complex algorithms. By collecting relevant digital quantities such as feedback current, speed encoder, position encoder, gyroscope, etc., high-precision and high-reliability closed-loop control of the motor can be achieved.
[0021] The open-loop frequency characteristics of the position loop and the closed-loop frequency characteristics of the position loop are as follows: Figure 5 and Figure 6 As shown, its open-loop cut-off frequency is about 21.4 rad / s and its closed-loop bandwidth is 5.6 Hz, which can meet the system stability requirements.
[0022] Reference for the actual detection effect of optoelectronic equipment at sea Figure 7 As shown, the optical axis of the optoelectronic device can stably point to the target, can quickly detect the target and stably track the target, which proves the effectiveness and reliability of the optoelectronic stabilization system of the invention.
[0023] The above are all preferred embodiments of the present invention, and the protection scope of the present invention is not limited thereby. Among them, the same parts are represented by the same figure numerals. It should be noted that the words "front", "rear", "left", "right", "up" and "down" used in the following description refer to the directions in the drawings, and the words "inside" and "outside" refer to the directions toward or away from the geometric center of a specific component, respectively. Therefore: All equivalent changes made according to the structure, shape, and principle of the present invention should be covered within the protection scope of the present invention.
Claims
1. An optical axis stabilization control system for optoelectronic equipment for unmanned boats, characterized in that: The invention comprises an optical axis stabilization system and a controller, wherein the optical axis stabilization system comprises a turntable system and an optical axis pointing turntable.
2. The optical axis stabilization control system of optoelectronic equipment for unmanned boat according to claim 1, characterized in that: The optical axis pointing turntable includes two axis systems, namely, pitch and azimuth, and adopts an external pitch and internal azimuth two-axis structure. The pitch axis and the azimuth axis intersect vertically and couple the motions to cope with the angular pointing of the turntable in all directions.
3. The optical axis stabilization control system of optoelectronic equipment for unmanned boat according to claim 1, characterized in that: The azimuth component and the elevation component form two frame structures.
4. The optical axis stabilization control system for optoelectronic equipment for unmanned boats according to claim 1, characterized in that: The pitch axis adopts a structural form with a drive assembly on one side and a secondary shaft assembly on the other side.
5. The optical axis stabilization control system for optoelectronic equipment for unmanned boat according to claim 1, characterized in that: The turntable system collects parameters and information of the optical axis pointing to the turntable in real time, and performs loop control according to different working modes of the turntable system to drive the azimuth and pitch motors to move.
6. The optical axis stabilization control system for optoelectronic equipment for unmanned boats according to claim 1, characterized in that: The controller includes a power supply module, an ARM processor module, a FPGA, a data conversion module, an encoder interface module, a serial communication module, and an input and output interface module.
Citation Information
Patent Citations
Two-dimensional photoelectric tracking rotary table driving control system and control method thereof
CN106647826A
Photoelectric theodolite intersection measurement system and method based on airship
CN106959097A
Two-axis four-frame photoelectric turntable control system
CN111338391A
Photoelectric turntable servo control system
CN115903923A
Gyroscope stabilized platform control method and gyro stabilized platform
CN117891176A
