Submersible for underwater soft landing and magnetic field orientation control method thereof
Through magnetic field directional control and data fusion technology, the problem of insufficient control accuracy of AUV thrusters is solved, and precise control and soft landing stability are achieved at low speeds. It is suitable for soft landing and hovering under cables, reducing equipment cost.
Patent Information
- Application Number
- CN202411122273.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-15
- Publication Date
- 2024-11-26
AI Technical Summary
The existing small autonomous underwater vehicle (AUV) thruster control methods have problems such as dead zone, delay and insufficient thrust accuracy. It is difficult to achieve accurate closed-loop control at low speeds, and it is impossible to achieve accurate speed control without speed feedback.
The magnetic field directional control method is used to combine four vector distribution thrusters and inertial navigation system, and data fusion and Kalman filtering are carried out through STM32H750VBT6, STM32G474CET6 and RK3566 chips to achieve fine control of the thruster speed and posture stability, and a peristaltic pump and water storage device are used. Adjust buoyancy to achieve cable-free underwater soft landing and hovering.
It realizes precise control of the thruster at low speeds, improves the stability and accuracy of soft landing, reduces equipment costs, can hover and contactless operations at any depth, and improves the redundancy of the overall electronic control system. and stability.
Smart Images

Figure CN119024870A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of marine robots, and in particular to a submersible for underwater soft landing and a magnetic field oriented control method thereof. Background Art
[0002] The resources in the ocean account for 97% of the world's total water resources, and the surface area of the ocean accounts for 71% of the earth's surface area, but more than 80% of the ocean is still undeveloped. The ocean contains a large amount of resources and development potential, among which the exploration, observation and development of the seabed are crucial to our development.
[0003] Patent document CN103061722A discloses a method for soft landing installation equipment using submarine cables, which achieves soft landing without using delivery tools. The disadvantage of this patent is that it needs to rely on submarine cables. Therefore, it is particularly important to design an autonomous underwater vehicle (AUV) with efficient and reliable soft landing performance. AUV can undertake various marine operation tasks, such as submarine environmental sampling and monitoring, submarine data collection and submarine resource exploration. The large-scale use of autonomous underwater vehicles is conducive to reducing the cost of submarine observation and development and improving operational efficiency.
[0004] Thruster control is an indispensable part of AUV motion control and achieving soft landing on the seabed. As an important research field of autonomous ocean vehicles, it has received more and more attention, and many methods have been developed to improve the control performance of AUV thrusters. As the last link of AUV motion control, the performance of thruster control significantly affects the motion performance of AUV. The existing mainstream small AUV thruster control method is the six-step commutation method, which has problems such as dead zone, delay, and saturation. Especially at low speeds, the relative error between the expected speed and the actual speed is large, and the dead zone phenomenon is obvious. The biggest defect is that without installing an encoder or Hall sensor, it is impossible to form an accurate closed-loop control of the speed, and the thrust accuracy generated is limited and the error is large. The magnetic field orientation method can estimate the speed by observing the phase current without speed feedback, and accurately control the speed. Even if the observed speed cannot converge at low speeds, a more accurate speed can be obtained through open-loop magnetic field orientation control. Summary of the invention
[0005] In view of the defects in the prior art, an object of the present invention is to provide a submersible for underwater soft landing and a magnetic field oriented control method thereof.
[0006] The submersible for underwater soft landing provided by the present invention comprises: a thruster, a thruster bracket, a posture sensor, a control drive circuit, a battery, a landing bracket, a sealing end cover, a sealed cabin bracket, a water storage device bracket, a peristaltic pump bracket, a control circuit bracket, a supporting copper column, a sealed cabin, a buoyancy adjustment device, an inertial navigation system, an acoustic Doppler velocity meter and a depth sensor;
[0007] The propeller is mounted on a propeller bracket, and the propeller bracket is mounted outside the sealed cabin;
[0008] The attitude sensor, control drive circuit, battery, water storage device bracket, peristaltic pump bracket, control circuit bracket, supporting copper column, buoyancy adjustment device and inertial navigation system are installed in the sealed cabin;
[0009] The buoyancy adjustment device is used to adjust the center of gravity, and the inertial navigation system is used to measure the attitude and acceleration of the submersible;
[0010] The landing support is used to support the soft landing of the submersible;
[0011] Two sealing end covers and a sealing cabin support are respectively installed at the front and rear of the sealing cabin, and the sealing end covers are connected to the sealing cabin support;
[0012] The thruster bracket and the landing bracket are both connected to the sealed cabin bracket;
[0013] The acoustic Doppler velocity meter and the depth sensor are both installed on the sealed end cover behind the sealed cabin; the acoustic Doppler velocity meter is used to measure the speed and displacement of the submersible, and the depth sensor is used to obtain the depth information of the submersible.
[0014] Preferably, the attitude sensor is installed at the buoyancy center of the submersible.
[0015] Preferably, the buoyancy regulating device comprises a peristaltic pump and a water storage device, the water storage device is connected to the peristaltic pump and connected to the outside through the peristaltic pump, and the peristaltic pump draws or discharges seawater into the water storage device;
[0016] Multiple water storage units are installed at the same height.
[0017] Preferably, the propeller adopts a brushless DC motor;
[0018] The control driving circuit comprises: a three-phase inverter bridge circuit, a current isolation sampling circuit and a micro control unit;
[0019] The three-phase inverter bridge circuit is used to drive the brushless DC motor, and the current isolation sampling circuit is used to collect the three-phase current of the brushless DC motor;
[0020] The microcontroller unit includes an STM32H750VBT6 chip, an STM32G474CET6 chip and an RK3566 chip. The STM32H750VBT6 chip is used to collect sensor signals and send control instructions; the STM32G474CET6 chip is used to control the three-phase inverter bridge circuit and receive the current isolation sampling circuit and the three-phase back electromotive force information of the motor; the RK3566 chip is used to integrate the acoustic Doppler speedometer and the inertial navigation system signals, realize Kalman filtering, and realize remote communication.
[0021] Preferably, each thruster bracket is used for one thruster, and four thrusters are mounted on the thruster bracket, and the angle between the thruster and the axial direction of the sealed cabin is 45°.
[0022] Preferably, the tail end parts inside the sealed cabin are installed in a vertical stack, and the head end parts inside the sealed cabin are installed in a cylindrical symmetrical manner;
[0023] The battery is installed at the bottom end of the rear of the sealed cabin, and water storage devices are located on the left and right sides of the battery; and a control drive circuit is located above the battery.
[0024] Preferably, the head end component is four peristaltic pumps installed symmetrically in a cylindrical manner and two water storage devices installed symmetrically in a vertical plane.
[0025] The magnetic field oriented control method for a submersible for underwater soft landing provided by the present invention comprises the following steps:
[0026] Step S1, the submersible receives a signal from the mother ship, and the peristaltic pump injects seawater into the water storage device, causing the submersible to start diving;
[0027] Step S2, when the submersible is close to the seabed, the peristaltic pump discharges seawater from the water storage device to offset the buoyancy of the submersible and the gravity;
[0028] Step S3, the four thrusters installed on the submersible maintain control accuracy and torque control at a preset low speed under magnetic field oriented control, the submersible starts to decelerate and maintain a stable attitude, and finally touches the seabed at a preset micro speed or suspends at a preset depth;
[0029] Step S4, after the submersible completes the task or receives a signal from the mother ship, the peristaltic pump discharges seawater from the water storage device, causing the submersible to begin to float up until it surfaces.
[0030] Preferably, in step S3, the attitude stability of the submersible is controlled jointly by the peristaltic pump and the four thrusters.
[0031] Preferably, the submersible performs remote communication underwater through an acoustic module, and the submersible is brought above the working area by a mother ship, and the mother ship obtains information about the submersible after diving through acoustic communication and sends a control signal;
[0032] After reaching the surface above the working waters, the submersible uses the buoyancy adjustment device to adjust the submersible to a zero buoyancy state, and then uses the thruster to generate thrust to dive. During the dive, the STM32H750VBT6 chip refers to the attitude information of the inertial navigation system and the horizontal position information of the acoustic Doppler speedometer, and uses the STM32G474CET6 chip to control the speed of the thruster motor in real time, balance the thrust, and maintain a stable attitude and position.
[0033] The submersible uses the RK3566 chip to perform Kalman filtering, integrating the height information from the depth sensor, acoustic Doppler velocimeter, and acceleration information from the inertial navigation system to obtain more accurate depth information.
[0034] Compared with the prior art, the present invention has the following beneficial effects:
[0035] (1) The present invention uses four vector distributed thrusters to provide thrust to control three-dimensional space movement, which can achieve soft landing of unmanned and cable-free underwater equipment and autonomous anti-interference during the diving process, thereby reducing the equipment cost of soft landing;
[0036] (2) The present invention adopts a thruster magnetic field oriented control method to control the thruster motor, thereby achieving fine control of the thruster speed, thereby achieving fine control of the thrust of each thruster, enabling the thrust output accuracy of the thruster to meet the requirements of soft landing, thereby improving the stability of soft landing;
[0037] (3) The present invention integrates the attitude and acceleration data of the IMU, the frequency-changing height data of the DVL and the position data based on integration, and the depth data of the depth sensor through Kalman filtering to perform data fusion, thereby being able to obtain its own attitude and position information, actively resist disturbances, and maintain the stability of attitude and position;
[0038] (4) In addition to achieving soft landing, the present invention can also enable the submersible to hover at any depth, such as hovering at a depth near the seabed, to achieve non-contact operation with the seabed;
[0039] (5) The software architecture of the present invention assigns a dedicated task to each sensor and adopts a sensor scheduling event group, which can enable the sensors to start receiving data at the same time. The control module is divided into three parts: STM32H750VBT6 chip, STM32G474CET6 chip and RK3566 chip, which respectively realize different functions, thereby improving the redundancy and stability of the overall electronic control system. BRIEF DESCRIPTION OF THE DRAWINGS
[0040] Other features, objects and advantages of the present invention will become more apparent from the detailed description of non-limiting embodiments made with reference to the following drawings:
[0041] Figure 1 This is a schematic diagram of the front view of the submersible;
[0042] Figure 2 It is a schematic diagram of the right side view of the submersible;
[0043] Figure 3 This is a top view of the submersible;
[0044] Figure 4 is a schematic side view of a submersible;
[0045] Figure 5 This is a schematic diagram of the front view of the interior of the sealed cabin;
[0046] Figure 6 It is a top view schematic diagram of the interior of the sealed cabin;
[0047] Figure 7 It is a schematic diagram of the side view of the interior of the sealed cabin;
[0048] Figure 8 Schematic diagram of the control system software architecture.
[0049] As shown in the figure: thruster 1, thruster bracket 2, attitude sensor 3, peristaltic pump 4, water storage device 5, control drive circuit 6, battery 7, landing bracket 8, sealing end cover 9, sealed cabin bracket 10, water storage device bracket 11, peristaltic pump bracket 12, control circuit bracket 13, supporting copper column 14, and sealed cabin 15. DETAILED DESCRIPTION
[0050] The present invention is described in detail below in conjunction with specific embodiments. The following embodiments will help those skilled in the art to further understand the present invention, but are not intended to limit the present invention in any form. It should be noted that, for those of ordinary skill in the art, several changes and improvements can also be made without departing from the concept of the present invention. These all belong to the protection scope of the present invention.
[0051] Example 1
[0052] like Figures 1 to 7As shown, this embodiment includes: a sealed cabin 15, a sealed cabin bracket 10, a thruster bracket 2, a landing bracket 8 and a thruster 1. The sealed cabin 15 includes two front and rear sealed end covers 9, one sealed cabin bracket 10 is installed at the front and rear, and the sealed cabin bracket 10 is fixedly connected to the front and rear sealed end covers 9 by bolts. The sealed cabin bracket 10 connects the left and right landing brackets 8 and four thruster brackets 2. Each thruster bracket 2 is used for one thruster 1. The rear sealed end cover 9 is installed with a depth sensor and a DVL.
[0053] like Figure 5 As shown, the sealed cabin 15 includes: a water storage device bracket 11, a control drive circuit 6, a control circuit bracket 13, a peristaltic pump bracket 12, a peristaltic pump 4, a posture sensor 3, a battery 7, a support copper column 14, and a water storage device 5. The tail end parts inside the sealed cabin 15 are vertically stacked and installed, and the head end parts are cylindrically symmetrically installed. The posture sensor 3 coincides with the buoyancy center of the submersible. The battery 7 is installed at the bottom of the tail, and the water storage device 5 is on the left and right sides of the battery. Above the battery is the control drive circuit 6. At the head end are four cylindrically symmetrically installed peristaltic pumps 4 and two vertically symmetrically installed water storage devices 5. The peristaltic pump 4 can pump water into the water storage device 5 to change the overall buoyancy of the submersible.
[0054] like Figure 8 As shown, the software architecture design of the control drive circuit 6 is divided into three parts: STM32G474CET6 chip software design, STM32H750VBT6 chip software design and RK3566 chip software design.
[0055] The STM32G474CET6 chip is responsible for realizing the magnetic field oriented control of the thruster. The STM32G474CET6 chip receives the speed command sent by the STM32H750VBT6 chip, obtains the three-phase current of the thruster through the current isolation sampling circuit, and directly controls the three-phase inverter bridge circuit based on this. The three-phase inverter bridge circuit provides three-phase voltage for the thruster to drive the thruster to rotate; the STM32H750VBT6 chip uses the FreeRTOS real-time operating system to send the thruster speed command to the STM32G474CET6 chip, send sensor information to the RK3566 chip, implement the navigation control algorithm, and parse the instructions sent by the RK3566 chip. The STM32H750VBT6 chip and the RK3566 chip use the JSON format to transmit data. The STM32H750VBT6 chip wakes up the corresponding task through the task scheduling time group according to the received instructions. All sensors connected to the STM32H750VBT6 chip have their data stored in a circular buffer, and the data is read from the buffer through the sensor task scheduling time group. The RK3566 chip is used to run the Kalman filter to fuse various sensor data. The RK3566 chip uses Python to implement multi-threading and multi-process, and implements data reception and storage, command sending, DVL data processing, and Kalman filtering in 4 threads.
[0056] This embodiment also provides a working method of the submersible of this embodiment, comprising the following steps:
[0057] Step 1: The submersible is dropped from the mother ship to the top of the working waters. At this time, the submersible is in a micro-buoyancy state and floats on the water surface.
[0058] Step 2: The submersible receives a signal from the mother ship, and the peristaltic pump 4 starts to work, injecting seawater into the water storage device 5, thereby increasing the weight of the submersible until the buoyancy of the submersible is less than the gravity, causing the submersible to start diving.
[0059] Step three, when the submersible is close to the seabed, the peristaltic pump 4 starts to work and discharges seawater from the water storage device 5 to reduce the weight of the submersible until the submersible is in a zero buoyancy state.
[0060] Step 4: The four thrusters 1 installed on the submersible start working. The thrusters under magnetic field directional control can maintain high control accuracy at low speeds and achieve fine torque control. Under the action of the thrusters 1, the submersible starts to decelerate and maintain a stable attitude. Finally, the submersible touches the seabed at a slow speed.
[0061] Step five, after the submersible contacts the seabed, the peristaltic pump 4 starts to work and injects seawater into the water storage device 5, so that the weight of the submersible increases until the buoyancy of the submersible is less than the gravity, so that the submersible is not disturbed by the ocean current when working on the seabed.
[0062] Step 6: After the submersible completes the seabed operation or receives a signal from the mother ship, the peristaltic pump 4 starts to work and discharges seawater from the water storage device 5, so that the weight of the submersible is reduced until the submersible is in a positive buoyancy state. At this time, the submersible starts to float up until it surfaces.
[0063] This embodiment achieves fine control of the thrust and torque of the submersible through four vector-distributed thrusters and a magnetic field oriented control method, and achieves stable soft landing on the seabed by analyzing sensor data, which has great application prospects.
[0064] Example 2
[0065] Example 2 is a preferred example of Example 1.
[0066] like Figure 4 As shown, this embodiment includes: a sealed cabin 15, a sealed cabin bracket 10, a thruster bracket 2, a landing bracket 8 and a thruster 1.
[0067] Specifically, the structure inside the sealed cabin 15 is the same as that in Example 1, including a water storage device bracket 11, a control drive circuit 6, a control circuit bracket 13, a peristaltic pump bracket 12, a peristaltic pump 4, a posture sensor 3, a battery 7, a supporting copper column 14, and a water storage device 5. At the same time, a depth sensor and a DVL are installed outside the tail sealing end cover 9.
[0068] In this embodiment, the landing bracket 8 can be used as a mounting bracket, and other equipment or sensors can be fixed to the landing bracket 8. The function of the submersible is to transport the equipment mounted on the landing bracket 8 to the seabed or a specified depth.
[0069] like Figure 8 As shown, the software framework for controlling the driving circuit is the same as that in the first embodiment, and the entire software architecture is implemented using the STM32G474CET6 chip, the STM32H750VBT6 chip, and the RK3566 chip.
[0070] Working principle:
[0071] In this embodiment, the submersible carries the marine equipment mounted on the landing bracket 8, brings the marine equipment to the designated working area, and after arriving at the designated working area, the submersible actively resists external interference through the thruster.
[0072] Step 1: The submersible receives a signal from the mother ship. The mother ship signal first reaches the RK3588 chip, and then the RK3588 chip sends it to the STM32H750VBT6 chip through the serial port in JSON format. The STM32H750VBT6 chip obtains data from the serial port receiving buffer, parses the data, and starts the diving task through the task scheduling event group. The peristaltic pump 4 pumps seawater into the water storage device 5, and the submersible starts to dive.
[0073] Step 2: The STM32H750VBT6 chip determines that the submersible has reached the designated working area based on the depth sensor information, closes the diving task through the task scheduling event group, and starts the suspension task. In the suspension task, the STM32H750VBT6 chip obtains the depth sensor data and IMU data in the ring buffer, sends them to the RK3588 chip for Kalman filtering together with the DVL data, and the RK3588 chip sends the filtered data back to the STM32H750VBT6 chip to obtain more accurate attitude, position, speed, and acceleration information.
[0074] Step 3: The STM32H750VBT6 chip calculates the rotation speed of each thruster 1 required to maintain the stability of the attitude and position based on the attitude, position, speed, and acceleration information, and then actively resists disturbances and maintains stability.
[0075] Step 4: The submersible receives a signal from the mother ship through the acoustic communication module, and the STM32H750VBT6 chip closes the suspension task and starts the floating task through the task scheduling event group. The peristaltic pump 4 discharges seawater from the water storage device 5, and the submersible begins to float.
[0076] This embodiment achieves fine control of the thrust and torque of the submersible through four vector-distributed thrusters and a magnetic field oriented control method. By analyzing sensor data, it actively resists underwater environmental interference and achieves stable suspension. This embodiment can be used for delivery and suspension tasks of any marine equipment and has great application prospects.
[0077] Those skilled in the art know that, in addition to implementing the system, device and its various modules provided by the present invention in a purely computer-readable program code, it is entirely possible to implement the same program in the form of logic gates, switches, application-specific integrated circuits, programmable logic controllers and embedded microcontrollers by logically programming the method steps. Therefore, the system, device and its various modules provided by the present invention can be considered as a hardware component, and the modules included therein for implementing various programs can also be considered as structures within the hardware component; the modules for implementing various functions can also be considered as both software programs for implementing the method and structures within the hardware component.
[0078] The above describes the specific embodiments of the present invention. It should be understood that the present invention is not limited to the above specific embodiments, and those skilled in the art can make various changes or modifications within the scope of the claims, which does not affect the essence of the present invention. In the absence of conflict, the embodiments of the present application and the features in the embodiments can be combined with each other arbitrarily.
Claims
1. A submersible for underwater soft landing, characterized in that: include: Propeller (1), propeller bracket (2), attitude sensor (3), control drive circuit (6), battery (7), landing bracket (8), sealing end cover (9), sealed cabin bracket (10), water storage device bracket (11), peristaltic pump bracket (12), control circuit bracket (13), supporting copper column (14), sealed cabin (15), buoyancy adjustment device, inertial navigation system, acoustic Doppler velocity meter and depth sensor; The thruster (1) is mounted on a thruster bracket (2), and the thruster bracket (2) is mounted outside the sealed cabin (15); The attitude sensor (3), control drive circuit (6), battery (7), water storage device bracket (11), peristaltic pump bracket (12), control circuit bracket (13), supporting copper column (14), buoyancy adjustment device and inertial navigation system are installed in a sealed cabin (15); The buoyancy adjustment device is used to adjust the center of gravity, and the inertial navigation system is used to measure the attitude and acceleration of the submersible; The landing support (8) is used to support the soft landing of the submersible; Two sealing end covers (9) and a sealing cabin support (10) are respectively installed at the front and rear of the sealing cabin (15), and the sealing end covers (9) are connected to the sealing cabin support (10); The thruster support (2) and the landing support (8) are both connected to the sealed cabin support (10); The acoustic Doppler velocity meter and the depth sensor are both mounted on the sealed end cover (9) behind the sealed cabin (15); the acoustic Doppler velocity meter is used to measure the speed and displacement of the submersible, and the depth sensor is used to obtain the depth information of the submersible.
2. The submersible for underwater soft landing according to claim 1, characterized in that: The attitude sensor (3) is installed at the buoyancy center of the submersible.
3. The submersible for underwater soft landing according to claim 1, characterized in that: The buoyancy regulating device comprises a peristaltic pump (4) and a water storage device (5), wherein the water storage device (5) is connected to the peristaltic pump (4) and is connected to the outside through the peristaltic pump (4), and the peristaltic pump (4) draws or discharges seawater into the water storage device (5); A plurality of water storage devices (5) are installed at the same height.
4. The submersible for underwater soft landing according to claim 1, characterized in that: The propeller (1) adopts a brushless DC motor; The control drive circuit (6) comprises: a three-phase inverter bridge circuit, a current isolation sampling circuit and a micro control unit; The three-phase inverter bridge circuit is used to drive the brushless DC motor, and the current isolation sampling circuit is used to collect the three-phase current of the brushless DC motor; The microcontroller unit includes an STM32H750VBT6 chip, an STM32G474CET6 chip and an RK3566 chip. The STM32H750VBT6 chip is used to collect sensor signals and send control instructions; the STM32G474CET6 chip is used to control the three-phase inverter bridge circuit and receive the current isolation sampling circuit and the three-phase back electromotive force information of the motor; the RK3566 chip is used to integrate the acoustic Doppler speedometer and the inertial navigation system signals, realize Kalman filtering, and realize remote communication.
5. The submersible for underwater soft landing according to claim 1, characterized in that: Each thruster bracket (1) is used for a thruster (1), four thrusters (1) are installed on the thruster bracket (2), and the axial angle between the thruster (1) and the sealed cabin (15) is 45°.
6. The submersible for underwater soft landing according to claim 1, characterized in that: The tail end parts inside the sealed cabin (15) are installed in a vertically stacked manner, and the head end parts inside the sealed cabin (15) are installed in a cylindrically symmetrical manner; The battery (7) is installed at the bottom end of the rear portion of the sealed cabin (15), and water storage devices (5) are located on the left and right sides of the battery (7); and a control drive circuit (6) is located above the battery (7).
7. The submersible for underwater soft landing according to claim 6, characterized in that: The head end components are four cylindrically symmetrically mounted peristaltic pumps (4) and two vertically symmetrically mounted water storage devices (5).
8. A magnetic field oriented control method for a submersible for underwater soft landing using any one of claims 1 to 7, characterized in that: The following steps are involved: Step S1, the submersible receives a signal from the mother ship, and the peristaltic pump injects seawater into the water storage device, causing the submersible to start diving; Step S2, when the submersible is close to the seabed, the peristaltic pump discharges seawater from the water storage device to offset the buoyancy of the submersible and the gravity; Step S3, the four thrusters installed on the submersible maintain control accuracy and torque control at a preset low speed under magnetic field oriented control, the submersible starts to decelerate and maintain a stable attitude, and finally touches the seabed at a preset micro speed or suspends at a preset depth; Step S4, after the submersible completes the task or receives a signal from the mother ship, the peristaltic pump discharges seawater from the water storage device, causing the submersible to begin to float up until it surfaces.
9. The magnetic field oriented control method for a submersible for underwater soft landing according to claim 8, characterized in that: In step S3, the attitude stability of the submersible is controlled by the peristaltic pump and the four thrusters.
10. The magnetic field oriented control method for a submersible for underwater soft landing according to claim 8, characterized in that: The submersible communicates remotely underwater through an acoustic module. The submersible is brought above the working area by the mother ship, which obtains information about the submersible after diving through acoustic communication and sends control signals. After reaching the surface above the working waters, the submersible uses the buoyancy adjustment device to adjust the submersible to a zero buoyancy state, and then uses the thruster to generate thrust to dive. During the dive, the STM32H750VBT6 chip refers to the attitude information of the inertial navigation system and the horizontal position information of the acoustic Doppler speedometer, and uses the STM32G474CET6 chip to control the speed of the thruster motor in real time, balance the thrust, and maintain a stable attitude and position. The submersible uses the RK3566 chip to perform Kalman filtering, integrating the height information from the depth sensor, acoustic Doppler velocimeter, and acceleration information from the inertial navigation system to obtain more accurate depth information.
