High-maneuverability manta ray type bionic fish based on buoyancy and gravity center combined adjustment and snorkeling and obstacle avoidance control method of high-maneuverability manta ray type bionic fish
Through the flexible pectoral fins of buoyancy and center of gravity control and CPG control, the problem of inaccurate buoyancy adjustment and high energy consumption in depth adjustment and obstacle avoidance steering is solved, and the depth of high maneuverability and low energy consumption is achieved Adjustment and obstacle avoidance steering improve the safety and stability of underwater operations.
Patent Information
- Application Number
- CN202411305399.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-19
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2044-09-19
AI Technical Summary
The existing manta ray-type bionic fish have problems such as inaccurate buoyancy adjustment, high energy consumption, poor mobility and easy structure damage in terms of depth adjustment and obstacle avoidance steering.
Using a method based on the joint adjustment of buoyancy and center of gravity, the buoyancy center of gravity adjustment device of the left and right power supply chamber and the center of gravity adjustment auxiliary device of the center of gravity adjustment device of the center of gravity, combined with the CPG-controlled flexible pectoral fin, realize the coordinated adjustment of buoyancy and pitch attitude, and achieve fast and accurate depth. Adjustment and high maneuverability to avoid obstacle steering.
It improves the maneuverability and endurance of bionic fish, achieves fast and accurate depth adjustment and safe bottom operation at low energy consumption, avoids structural damage, and improves the safety and stability of underwater operations.
Smart Images

Figure CN119018319A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of bionic robots, and in particular to a highly maneuverable manta ray-type bionic fish based on combined regulation of buoyancy and center of gravity and a diving, floating and obstacle avoidance control method thereof. Background Art
[0002] Compared with conventional underwater robots, bionic robot fish have the advantages of high efficiency, high maneuverability, high concealment, etc., and are suitable for a variety of complex scenes. At present, the industry has invented a variety of manta ray-style bionic robot fish. For example, Chinese invention CN202210995754.X discloses a manta ray-style bionic fish and its buoyancy adjustment method, which includes a base component and pectoral fins. The pectoral fins are symmetrically arranged on both sides of the base component through a transition component with variable volume. The transition component is a closed cavity structure composed of a transition plate and a flexible skin. The cavity is filled with oil and is provided with a driving mechanism for controlling the movement of the pectoral fins; a control system and a buoyancy adjustment mechanism are installed on the middle partition of the base component. The buoyancy adjustment mechanism changes the volume of the flexible skin in the transition component by controlling the amount of oil in the transition component, thereby changing the buoyancy of the bionic fish. Chinese invention CN202311227974.9 discloses a manta ray-like soft underwater vehicle with pectoral and caudal fin flapping, weight buoyancy gliding, and propeller propulsion. It refers to the appearance and function of the manta ray, and has additional weight buoyancy adjustment and propeller propulsion devices while having the function of pectoral and caudal fin flapping. The vehicle uses the flapping of the left and right pectoral fins to achieve forward swimming, turning and other movements; uses weight buoyancy adjustment to achieve gliding movement, and during flapping and gliding movements, uses the interaction between the caudal fin and the water flow to achieve pitch adjustment. Chinese invention CN202310513000.0 discloses a composite buoyancy adjustment device, an autonomous underwater vehicle and a control method thereof. The composite buoyancy adjustment device installs the buoyancy adjustment mechanism and the pitch adjustment mechanism in a sealed cabin, uses piston movement to adjust the overall buoyancy, and adjusts the additional counterweight to achieve pitch adjustment. However, the above inventions have the following shortcomings: Although the first invention achieves the buoyancy and diving of the bionic fish by adjusting the oil on both sides, there is a problem that the balance of the oil on both sides cannot be accurately controlled, resulting in the displacement of the center of gravity of the bionic fish during the buoyancy adjustment process. The pectoral fins of the second invention use a flapping method that combines spanwise waves and chordwise waves, which has a small thrust. Although the propulsion efficiency is improved by adding a propeller propulsion device, it has the same high noise problem as traditional underwater robots. The third invention uses a piston-type buoyancy adjustment mechanism to adjust the buoyancy while requiring additional counterweights to achieve pitch adjustment, which has the problem of occupying a large space.
[0003] Compared with the highly maneuverable tail fin propulsion bionic fish, the manta ray bionic fish proposed in the existing invention patent mainly uses the pectoral fin as a propulsion mechanism. It has strong stability when swimming but poor maneuverability. In addition, the manta ray bionic fish is relatively large in size. It is difficult to avoid obstacles by relying solely on the pectoral fin flapping to turn in place, especially when performing a straight-line cruise mission at a high speed and requiring emergency obstacle avoidance. In addition, for the depth adjustment of the manta ray bionic fish, although the depth adjustment can be adjusted with lower energy consumption by controlling the buoyancy alone, when adjusting the depth over a large span, the adjustment speed is slow, and the operation of the buoyancy adjustment device will cause the overall center of gravity to shift, and the depth cannot be adjusted in a specified pitch posture. When the manta ray bionic fish is adjusted in depth by using the pectoral fin flapping combined with the up and down swinging of the tail fin, although the depth adjustment speed is fast, it is difficult to stably control the manta ray bionic fish at a fixed depth, and this adjustment method has high energy consumption. Not only that, when the manta ray-like bionic fish is needed to perform underwater operations, it is prone to colliding with the surrounding environment during the flapping of the pectoral fins and caudal fins, causing structural damage when relying on the pectoral fins or caudal fins for underwater landing or safe underwater starting. Summary of the invention
[0004] Purpose of the invention: The present invention aims to provide a highly maneuverable manta ray-like bionic fish that can jointly adjust buoyancy, center of gravity and pectoral fins; the second purpose of the present invention is to provide a method for controlling the diving and floating of a manta ray-like bionic fish, which can achieve fast and accurate depth adjustment while reducing energy consumption in depth adjustment tasks, and can achieve soft landing on the bottom of the water and safe starting on the bottom of the water, thereby effectively improving the safety of the manta ray-like bionic fish in underwater operations and recovery; the third purpose of the present invention is to provide a highly maneuverable obstacle avoidance and steering control method when encountering obstacles and emergency obstacle avoidance is required.
[0005] Technical solution: The highly maneuverable manta ray-like bionic fish based on the combined regulation of buoyancy and center of gravity described in the present invention comprises a base body and pectoral fins, wherein the base body comprises a bionic shell, a central cabin and power supply cabins symmetrically arranged on both sides of the central cabin, wherein the central cabin is a sealed structure, and a center of gravity adjustment auxiliary device of the central cabin is slidably arranged near the head of the bionic fish to change the center of gravity position of the central cabin for controlling the pitch angle of the head; the power supply cabin comprises a sealing flange, a cabin body, a buoyancy center of gravity adjustment device and an inlet / water discharge flange, wherein the sealing flange, the cabin body and the buoyancy center of gravity adjustment device form a sealing structure, and the buoyancy center of gravity adjustment device is slidably arranged near the tail of the bionic fish to change the displacement on one side of the buoyancy center of gravity adjustment device and the inlet / water discharge flange for controlling the buoyancy and center of gravity position of the power supply cabin; the bionic shell is provided with an inlet / water discharge port.
[0006] Furthermore, the center of gravity adjustment auxiliary device includes a sealed cabin flange, a linear servo and a counterweight unit. The counterweight unit is located inside the sealed cabin flange. The linear servo is installed on the outside of the sealed cabin flange through a connecting plate and a bracket. The telescopic rod of the linear servo is connected to the counterweight unit to control the position of the counterweight unit.
[0007] Furthermore, the counterweight unit includes a first lithium battery pack, a fixed support and a mounting plate, the fixed support and the mounting plate are connected by a connecting rod, and the first lithium battery pack is mounted on the fixed support.
[0008] Furthermore, the central cabin also includes a control system, a central cabin intermediate cabin body, a central cabin rear sealing flange and a central cabin rear end cover.
[0009] Furthermore, the buoyancy center of gravity adjustment device includes a linear servo, a second lithium battery pack, a piston and a piston sealing ring.
[0010] Furthermore, digital servos are provided at both ends of the power supply cabin, and the pectoral fins are connected to the digital servos through fin rays and connecting brackets; each digital servo is equipped with a CPG control unit.
[0011] The method for controlling the diving and floating of a highly maneuverable manta ray-like bionic fish based on the combined regulation of buoyancy and center of gravity of the present invention comprises the following steps:
[0012] The initial state of the manta ray bionic fish is preset to be a suspended state. In this state, the piston positions of the buoyancy center of gravity adjustment devices of the left power supply cabin and the right power supply cabin are x l0 and x r0 , corresponding to the middle position of the piston stroke, the piston is defined as pushing outward as the positive direction, and the maximum stroke position is x l0 +x max and x r0 +x max , the minimum travel position is x l0 -x max and x r0 -x max , the lithium battery pack of the gravity center adjustment auxiliary device is located at x a0 , x a0 Corresponding to the middle position of the first lithium battery pack travel, the lithium battery pack is defined as being pushed forward in the positive direction, and the maximum travel position is x a0 +x amax , the minimum stroke position is x a0 -x amax , the flexible pectoral fin is in the initial horizontal position, and the current buoyancy of the manta ray bionic fish is f 浮 Equal to the current gravity G;
[0013] The pectoral fins are controlled by two CPG control units; the CPG model is
[0014]
[0015] Among them, a i 、b i and x i is the amplitude, offset and phase of the i-th oscillator; i=1, 2, 3, 4 are the phase oscillators corresponding to the left rear, left front, right rear and right front servos of the manta ray bionic fish respectively; A i With B i are the expected amplitude and expected offset of the i-th oscillator respectively; α i With β i are the convergence coefficients of amplitude and offset respectively; f i is the oscillation frequency; μ ij is the coupling coefficient between the i-th oscillator and the j-th oscillator; x j is the current phase of the jth oscillator; is the phase difference between the i-th oscillator and the j-th oscillator; θ i is the servo angle output by the i-th phase oscillator;
[0016] The target depth thresholds ε1, ε2, and ε3 are defined, wherein ε1 is the target depth threshold when the manta ray bionic fish switches from the fast diving stage to the slow gliding diving stage or from the fast floating stage to the slow gliding floating stage when performing a diving task or an ascent task; ε2 is the target depth threshold when the manta ray bionic fish switches from the slow gliding diving stage to the fine-tuning diving stage close to the target or from the slow gliding floating stage to the fine-tuning floating stage close to the target; ε3 is the target depth threshold when the manta ray bionic fish switches from the fine-tuning diving stage close to the target or the fine-tuning floating stage close to the target to reach the target depth;
[0017] Through the target depth d tar With the current depth d t The difference in size |d tar -d t |Compare with the target depth thresholds ε1, ε2, ε3, and then switch to different ascent or descent stages.
[0018] Furthermore, when (d tar -d t )>0, perform the diving mission;
[0019] When |d tar -d t When |≥ε1, it enters the rapid diving stage, the piston moves linearly from the initial middle position to the minimum stroke position, the displacement decreases to the minimum value, and the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to minimum buoyancy. At this time, the buoyancy f 浮Less than the gravity G, the center of gravity moves forward, the manta ray-like bionic fish adjusts from a horizontal posture to a posture with its head pointing to the bottom of the water, and dives toward the bottom of the water in this posture, with the pectoral fins moving forward and backward with a fixed phase difference Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically downward, so that the manta ray-like bionic fish can dive quickly until ε1>|d tar -d t |≥ε2;
[0020] When ε1>|d tar -d t When |≥ε2, it enters the slow gliding dive stage, the CPG controller controls the pectoral fin to adjust to the initial position, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the center cabin is x adown for
[0021]
[0022] The center of gravity of the manta ray bionic fish gradually moves backwards, and when |d tar -d t |=ε2, the position of the lithium battery pack of the center of gravity adjustment auxiliary device is adjusted to the minimum stroke position x a0 -x amax , the center of gravity of the manta ray bionic fish returns to the central position in the initial state; in this process, the pitch posture of the manta ray bionic fish deflects from vertical downward to upward and finally reaches a horizontal posture; while the manta ray bionic fish maintains the minimum buoyancy and continues to dive. In the slow gliding diving stage, the manta ray bionic fish glides downward with a decelerated and gradually horizontal posture until ε2>|d tar -d t |≥ε1;
[0023] When ε2>|d tar -d t When |≥ε3, the dive begins in the fine-tuning phase close to the target. The pectoral fins maintain their initial horizontal position, and the piston moves linearly from the minimum stroke position to a position close to the minimum stroke position. At the same time, the position of the lithium battery pack of the gravity center adjustment auxiliary device is linearly moved to a position close to the minimum stroke position. The manta ray bionic fish maintains the center of gravity at the initial state, and the manta ray bionic fish slowly dives in a horizontal posture until |d tar -d t |<ε3;
[0024] When |d tar -d tWhen |<ε3, it enters the stage of reaching the target depth, the piston moves to the middle position, the position of the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position, the manta ray bionic fish hovers at the target depth in a horizontal posture or achieves a soft landing on the bottom of the water, and the mission is completed.
[0025] Furthermore, immediately (d tar -d t )<0, determine the current distance D between the manta ray bionic fish and the bottom of the water t Whether it exceeds the safe distance from the bottom of the water;
[0026] If D t <ξ, the manta ray bionic fish maintains the initial position of the pectoral fin, and the piston moves linearly to a position close to the maximum stroke position. The stroke position is to move the lithium battery pack of the gravity center adjustment auxiliary device linearly to the position close to the maximum stroke position. At the stroke position, the manta ray-like bionic fish slowly floats up in a horizontal position until D t >ξ;
[0027] When D t >ξ, the manta ray-like bionic fish has exceeded the safe distance from the bottom of the water and is performing the task of floating up;
[0028] When |d tar -d t |≥ε1, it enters the rapid floating stage, the piston moves linearly from the middle position to the maximum stroke position, and the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to maximum buoyancy. At this time, the buoyancy f 浮 When the G is greater than the gravity, the center of gravity moves backward, and the manta ray bionic fish adjusts from a horizontal posture to a posture with its head pointing upward to the water surface, and floats toward the water surface in this posture. At this time, the manta ray bionic fish uses the designed CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fin. Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically upward, so that the manta ray-like bionic fish can float up quickly until ε1>|d tar -d t |≥ε2;
[0029] When ε1>|d tar -d t |≥ε2, enter the slow gliding and floating stage, the pectoral fins are adjusted to the initial position, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the center cabin is x aup for
[0030]
[0031] During this process, the center of gravity of the manta ray bionic fish gradually moves forward, and when |d tar -d t |=ε2, the position of the lithium battery pack of the center of gravity adjustment auxiliary device is adjusted to the maximum stroke position x a0 +x amax , the center of gravity of the manta ray bionic fish returns to the central position in the initial state; in this process, the pitch posture of the manta ray bionic fish gradually deflects from vertical upward and downward and finally reaches a horizontal posture; while the manta ray bionic fish maintains the maximum buoyancy and continues to float up, decelerating and gliding upward and gradually floating up in a horizontal posture until ε2>|d tar -d t |≥ε1;
[0032] When ε2>|d tar -d t When |≥ε1, the target is approached and the fine-tuning floating phase begins. The pectoral fins maintain their initial horizontal position, and the piston moves linearly from the maximum stroke position to a position close to the maximum stroke position. At the same time, the position of the lithium battery pack of the gravity center adjustment auxiliary device is linearly moved to a position close to the maximum stroke position. The center of gravity of the manta ray bionic fish remains at the center position in the initial state, and the manta ray bionic fish slowly floats up in a horizontal posture until |d tar -d t |<ε3;
[0033] When |d tar -d t When |<ε3, the target depth is reached, the piston moves linearly to the middle position, the position of the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position, the manta ray bionic fish hovers at the target depth in a horizontal posture, and the mission is completed.
[0034] The obstacle avoidance and steering control method of a highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity of the present invention comprises the following steps:
[0035] The preset current distances between the left and right front of the manta ray bionic fish and the obstacle are D lt and D rt , the current straight-line forward swimming speed of the manta ray bionic fish is v t , the speed threshold for the manta ray bionic fish to perform high-maneuverability obstacle avoidance and steering tasks is v1, the distance obstacle threshold for the manta ray bionic fish to enter the high-maneuverability large-angle steering mode is dis1, and the distance obstacle threshold for the manta ray bionic fish to enter the high-maneuverability small-angle steering mode is dis2;
[0036] The parameters of the CPG controller in the high maneuverability obstacle avoidance steering task are preset to a fixed phase difference. Fixed amplitude Ai2 , fixed frequency f i2 , dynamically adjust the amplitude bias B i , the preset maximum amplitude bias is B imax , amplitude bias B i >0;
[0037] When the swimming speed v t ≥v1 and the minimum distance to the obstacle min(D lt ,D rt )≤dis1, the manta ray bionic fish autonomously performs high-maneuverability obstacle avoidance and steering tasks;
[0038] When v t ≥v1 and dis1≥min(D lt ,D rt )≥dis2, if D lt >D rt , enter the high maneuverability small deflection left turn mode, the first piston of the left power supply cabin moves linearly from the middle position to the minimum stroke position, and the second piston of the right power supply cabin moves linearly from the middle position to the maximum stroke position. The center of gravity of the manta ray bionic fish is balanced in the front and rear directions, and the center of buoyancy in the left and right directions moves to the right. The manta ray bionic fish rolls 90° to the left, presenting a posture with the left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fins Fixed amplitude A i2 , fixed frequency f i2 The sum is The amplitude of the bias flapping motion provides the manta ray bionic fish with a torque to turn left, so that the manta ray bionic fish can turn left with a small deflection angle in three-dimensional space with high maneuverability to avoid the obstacle on the right. When the current distance from the manta ray bionic fish to the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D latt The lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe When the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues;
[0039] When v t ≥v1 and min(D lt ,D rt )<dis2, if D lt >D rtWhen the fish enters the high maneuverability large deflection left turn mode, the first piston moves linearly from the initial middle position to the minimum stroke position, and the second piston moves linearly from the initial middle position to the maximum stroke position. The center of gravity of the manta ray bionic fish in the front and rear directions remains balanced, and the center of buoyancy in the left and right directions moves to the right. The manta ray bionic fish rolls 90° to the left, presenting a posture with the left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the front and back fixed phase difference of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn left, so that the manta ray bionic fish can turn left with high maneuverability and large deflection angle in three-dimensional space to avoid obstacles on the right. obst >dis safe And D latt >dis latsafe When the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues;
[0040] When v t ≥v1 and dis1≥min(D lt ,D rt )≥dis2, if D lt <D rt When the fish enters the high maneuverability small deflection angle right turn mode, the first piston moves linearly from the initial middle position to the maximum stroke position, and the second piston moves linearly from the initial middle position to the minimum stroke position. The center of gravity of the manta ray bionic fish is balanced in the front and rear directions, and the center of buoyancy moves leftward in the left and right directions. The manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the flexible pectoral fin with a fixed phase difference between the front and the back. Fixed amplitude A i2 , fixed frequency f i2 The sum is The amplitude of the biased flapping motion provides a torque for the manta ray bionic fish to turn right, so that the manta ray bionic fish can turn right with a small angle and high maneuverability in three-dimensional space to avoid obstacles on the left. obst >dis safe And D latt >dis latsafeWhen the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues;
[0041] When v t ≥v1 and min(D lt ,D rt )<dis2, if D lt <D rt , enter the high maneuverability large deflection angle right turn mode, the first piston moves linearly from the initial middle position to the maximum stroke position, the second piston moves linearly from the initial middle position to the minimum stroke position, the manta ray bionic fish keeps the center of gravity balanced in the front and rear directions, the buoyancy center moves to the left in the left and right directions, the manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upwards, the buoyancy of the manta ray bionic fish is equal to the gravity, at this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the flexible pectoral fin with a fixed phase difference between the front and back Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn right, so that the manta ray bionic fish can turn right with a large deflection angle in three-dimensional space with high maneuverability and avoid obstacles on the left. obst >dis safe And D latt >dis latsafe When the manta ray fish is in the air, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
[0042] Beneficial effects: Compared with the prior art, the present invention has the following significant advantages: 1. The present invention effectively realizes the precise control of the overall buoyancy and center of gravity of the bionic fish by integrating the buoyancy center of gravity adjustment devices of the left and right power supply cabins and the center of gravity adjustment auxiliary device of the central cabin, and uses the lithium battery pack as the counterweight, without the need to add additional counterweight blocks, thereby improving the maneuverability and endurance of the bionic fish; 2. The diving and floating control method for the highly maneuverable manta ray-type bionic fish proposed by the present invention can realize the joint adjustment of buoyancy and pitch attitude during the process of floating and diving by coordinating the buoyancy center of gravity adjustment device and the center of gravity adjustment auxiliary device, and cooperating with the flexible pectoral fins controlled by CPG; so that the bionic fish can respond quickly In response to the needs of depth changes, it has the ability to achieve fast and accurate depth adjustment at low energy consumption, and can perform soft landing and safe start-up on the bottom of the water, effectively avoiding structural damage caused by the manta ray-like bionic fish colliding with the surrounding environment due to the complex underwater environment and directly flapping the flexible pectoral fins, significantly improving the safety and stability of underwater operations; 3. The high-maneuverability obstacle avoidance steering control method described in the present invention, combined with the left and right buoyancy center of gravity adjustment devices and the different amplitude offset flapping of the pectoral fins, enables the manta ray-like bionic fish to achieve flexible steering in three-dimensional space during high-speed swimming, quickly avoid obstacles, avoid structural damage, and effectively improve the survival ability of the manta ray-like bionic fish in complex environments. BRIEF DESCRIPTION OF THE DRAWINGS
[0043] Figure 1 This is a schematic diagram of the structure of a highly maneuverable manta ray-like bionic fish;
[0044] Figure 2 This is a schematic diagram of the structure of the center cabin;
[0045] Figure 3 It is a structural schematic diagram of the center of gravity adjustment auxiliary device;
[0046] Figure 4 It is the structural diagram of the control system;
[0047] Figure 5 This is a structural diagram of the left pectoral fin and the left power supply cabin;
[0048] Figure 6 is a structural schematic diagram of a first buoyancy center of gravity adjusting device;
[0049] Figure 7 It is a schematic diagram of the structure of the bionic shell;
[0050] Figure 8 It is a schematic diagram of the structure of the bottom of the bionic shell;
[0051] Fig. 9 It is a structural schematic diagram of the mounting plate;
[0052] Fig.10 It is a structural schematic diagram of the mounting plate bracket;
[0053] Fig.11 It is a structural schematic diagram of the heat dissipation module;
[0054] Fig.12 A schematic diagram of the process of receiving diving and surfacing instructions;
[0055] Fig.13 This is a schematic diagram of the process of performing a diving mission;
[0056] Fig.14 This is a flowchart for performing a floating mission;
[0057] Fig.15 It is a structural diagram of the CPG model;
[0058] Fig.16 Schematic diagram of the various stages of diving to the bottom of the water;
[0059] Fig.17 It is a schematic diagram of the various stages of surfacing from the bottom of the water to the target depth;
[0060] Fig.18 Flowchart for performing high-maneuverability obstacle avoidance and steering tasks. DETAILED DESCRIPTION
[0061] The present invention will be further described below in conjunction with the accompanying drawings.
[0062] like Figure 1 As shown, the high-maneuverability manta ray-like bionic fish based on the combined adjustment of buoyancy and center of gravity described in the present invention includes a central cabin 1, a left power supply cabin 4, a right power supply cabin 5, a left pectoral fin 2, a right pectoral fin 3 and a bionic shell 6; the central cabin 1 is the main control cabin of the entire manta ray-like bionic fish, and includes a center of gravity adjustment auxiliary device; the left power supply cabin 4 and the right power supply cabin 5 are fixed by the bionic shell 6 and are symmetrically distributed on both sides of the central cabin 1; the left pectoral fin 2 and the right pectoral fin 3 are fixed to the left power supply cabin 2 and the right power supply cabin 3 and are symmetrically distributed on both sides of the left power supply cabin 2 and the right power supply cabin 3.
[0063] like Figure 2 As shown, the central cabin 1 includes a center of gravity adjustment auxiliary device 11, a control system 12, a central cabin intermediate cabin body 13, a central cabin rear sealing flange 14 and a central cabin rear end cover 15.
[0064] like Figure 3As shown, the gravity center adjustment auxiliary device 11 comprises a gravity center adjustment auxiliary device sealed cabin flange 111, a first linear servo support 112, a first linear servo 113, a first linear servo support connecting plate 114, a first lithium battery pack fixing support 115, a first lithium battery pack mounting plate 116, a first lithium battery pack connecting rod 117 and a first lithium battery pack 118. The gravity center adjustment auxiliary device sealed cabin flange 111 is a cylindrical sealed cabin, which is dynamically sealed with the cylindrical central cabin intermediate cabin body 13 through two layers of O-rings, and is fixedly connected by six screws evenly distributed around the circumference. The gravity center adjustment auxiliary device 11 is located at the front end of the central cabin 1. The inner circular end surface edge of the gravity center adjustment auxiliary device sealed cabin flange 111 is provided with six threaded holes evenly distributed around the circumference. The first linear servo support connecting plate 114 is a circular metal plate with a circular hole in the middle, and the edge of the first linear servo support connecting plate 114 and the edge of the circular hole are both provided with six circular through holes evenly distributed around the circumference. The first linear servo support connecting plate 114 is fixed to the inner end surface of the flange 111 of the center of gravity adjustment auxiliary device sealing cabin by six screws evenly distributed around the circumference. The first linear servo 113 is placed in the square groove of the first linear servo support 112, and the first linear servo 113 is fixed to the first linear servo support 112 by bolts and nuts. The base of the first linear servo support 112 is a circular plate with a square hole, and six through holes evenly distributed around the circumference are provided on its edge. The first linear servo support 112 is connected to the first linear servo support connecting plate 114 by six bolts evenly distributed around the circumference. The first lithium battery pack fixing support 115 is composed of a circular plate with 12 grooves for placing the first lithium battery pack 118 and a cylindrical polished rod. The cylindrical polished rod is processed with an external thread near the outer end surface, which is used to be connected to the first linear servo 113 by thread and locked by a locking nut. The edge of the first lithium battery pack fixing support 115 is provided with six circular threaded holes, the edge of the first lithium battery pack mounting plate 116 is provided with six circular through holes, and the first lithium battery pack mounting plate 116 is provided with 12 grooves for fixing the first lithium battery pack. The first lithium battery pack 118 and six first lithium battery pack connecting rods 117 evenly distributed around the circumference are placed between the first lithium battery pack fixing support 115 and the first lithium battery pack mounting plate 116. One end of the first lithium battery pack connecting rod 117 is an external thread and one section is an internal thread. The first lithium battery pack connecting rod 117 is threadedly connected to the first lithium battery pack fixing support 115 through the external thread. The first lithium battery pack mounting plate 116 is fixed to one end of the internal thread of the six first lithium battery pack connecting rods 117 evenly distributed around the circumference by six screws evenly distributed around the circumference, and fixes the position of the first lithium battery pack 118.The center of gravity adjustment auxiliary device 11 uses the first lithium battery pack as a counterweight, and controls the first linear servo 113 to push and pull the first lithium battery pack 118 to adjust the front and rear center of gravity of the manta ray-like bionic fish. When the first linear servo 113 pushes the first lithium battery pack 118, the center of gravity of the manta ray-like bionic fish moves forward, its head tilts downward, and the pitch angle decreases. When the first linear servo 113 pulls the first lithium battery pack 118, the center of gravity of the manta ray-like bionic fish moves backward, its head tilts upward, and the pitch angle increases. The center of gravity adjustment auxiliary device 11 works in conjunction with the left and right buoyancy center of gravity adjustment devices. After the left and right buoyancy center of gravity adjustment devices adjust the buoyancy, the center of gravity adjustment auxiliary device 11 plays an auxiliary role, adjusting the center of gravity so that the manta ray-like bionic fish swims or glides in a desired pitch posture.
[0065] like Figure 2 As shown, the cylindrical ends of the central cabin intermediate cabin body 13 are processed with upper and lower symmetrical planes, and the central cabin intermediate cabin body 13 is fixed by contacting the bionic shell 6. The central cabin rear sealing flange 14 realizes dynamic sealing with the central cabin intermediate cabin body 13 through two O-rings. The edge of the central cabin rear sealing flange 14 is provided with six circular through holes evenly distributed around the circumference. A circular hole is opened in the middle of the outer end surface of the central cabin rear sealing flange 14, and a circle of sealing ring grooves is provided on the edge of the circular hole. The central cabin rear sealing flange 14 realizes static sealing with the central cabin rear end cover 15 through O-rings. The edge of the central cabin rear end cover 15 is provided with six circular through holes evenly distributed around the circumference. The central cabin intermediate cabin body 13 is fixedly connected with the central cabin rear sealing flange 14 and the central cabin rear end cover 15 by six screws evenly distributed around the circumference. The end surface of the central cabin rear end cover 15 is provided with twelve evenly distributed circular through holes for installing a waterproof switch 129, a depth sensor 128 and an aviation plug 1210.
[0066] like Figure 4As shown, the control system 12 includes a microcomputer 122, a heat sink 1211, a steering engine expansion board 123, a LORA module 124, a posture sensor 125, a GPS module 126, a depth sensor solution board 127, and a depth sensor 128, a waterproof switch 129 and an aviation plug 1210 fixed to the rear end cover by bolts, and further includes a first mounting plate bracket 1212, a second mounting plate bracket 1214 and a mounting plate bracket connecting rod 1213. One end of the heat sink 1211 is attached to the chip of the microcomputer 122, and the other end is attached to the first linear steering engine bracket connecting plate 114 of the buoyancy regulating device 11, thereby dissipating heat to the outside through the central cabin intermediate cabin 13. The mounting plate 121 is installed in the square grooves of the first mounting plate bracket 1212 and the second mounting plate bracket 1214, and connected by four mounting plate bracket connecting rods 1213. A square groove is provided at one end of the mounting plate 121 for placing the first linear servo support 112 of the center of gravity adjustment auxiliary device 11 to improve space utilization.
[0067] like Figure 5 As shown, the left pectoral fin 2 includes a front servo bracket 21, a rear servo bracket 22, a servo flange 212, a front digital servo 23, a rear digital servo 24, a front fin ray connecting support 25, a rear fin ray connecting support 26, a front lower fin ray 27, a front upper fin ray 29, a rear lower fin ray 28, a rear upper fin ray 210 and a flexible fin membrane 211. The front servo gear bracket 21 and the rear servo gear bracket 22 are installed on the outside of the front sealing flange 41 and the rear drainage flange 42 of the power supply cabin by screws, the front digital servo gear 23 is connected to the front fin connecting support 25 by screws and the servo gear flange 212, and the rear digital servo gear 24 is connected to the rear fin connecting support 26 by screws and the servo gear flange 212. The rotating axes of the front digital servo gear 23 and the rear digital servo gear 24 are on the same axis. The flexible fin membrane 211 is made of soft silicone and is fixed between the front lower fin ray 27 and the front upper fin ray 29 and the rear lower fin ray 28 and the rear upper fin ray 210 by screws. The front lower fin ray 27 and the rear lower fin ray 28 are respectively installed in the grooves of the front fin connecting support 25 and the rear fin connecting support 26, and are fixed by screws.
[0068] The left power supply cabin includes a first power supply cabin sealing flange 41, a first power supply cabin middle cabin body 42, a first power supply cabin rear drainage flange 43 and a first buoyancy center of gravity adjustment device 44. The outer side of the first power supply cabin sealing flange 41 is provided with four threaded holes, which is connected to the front servo gear bracket 21 by screws. The first power supply cabin sealing flange 41 is dynamically sealed with the first power supply cabin middle cabin body 42 by an O-ring. The edge of the first power supply cabin sealing flange 41 is provided with six circular through holes evenly distributed around the circumference. The first power supply cabin sealing flange 41 is connected to the first power supply cabin middle cabin body 42 by six screws evenly distributed around the circumference. The outer end face of the first power supply cabin sealing flange 41 is provided with a circular through hole for passing the power supply line and the signal line. The edge of the inner end face of the first power supply cabin sealing flange 41 is provided with six threaded holes evenly distributed around the circumference. The cylindrical ends of the intermediate cabin 42 are processed with upper and lower symmetrical planes, and the intermediate cabin 42 of the first power supply cabin is fixed by contacting the bionic shell 6. The outer end face of the rear drainage flange 43 of the first power supply cabin is provided with four threaded holes, which is connected to the rear servo bracket 22 by screws. The edge of the rear drainage flange 43 of the first power supply cabin is provided with six circular through holes evenly distributed around the circumference. The rear drainage flange 43 of the first power supply cabin is connected to the intermediate cabin 42 of the first power supply cabin by six screws evenly distributed around the circumference. A waist-shaped hole is provided in the middle of the rear drainage flange 43 of the first power supply cabin, which is used by the first buoyancy center of gravity adjustment device 45 to drain water from the intermediate cabin 42 of the first power supply cabin.
[0069] like Figure 6As shown, the first buoyancy center of gravity adjustment device 44 includes a second linear servo bracket 441, a second linear servo 442, a first piston 443, a first piston sealing ring 444, a second lithium battery pack fixing support 445, a second lithium battery pack mounting plate 446, a second lithium battery pack 447 and a second lithium battery pack connecting rod 448. The second linear servo gear bracket 441 is composed of a circular plate with a circular hole in the middle and an L-shaped fixed plate. The edge of the circular plate of the second linear servo gear bracket 441 is provided with six circular through holes evenly distributed around the circumference. The second linear servo gear bracket 441 is connected to the sealing flange 41 of the first power supply cabin by six screws evenly distributed around the circumference. The second linear servo gear 442 is placed on the L-shaped fixed plate of the second linear servo gear bracket 441, and the second linear servo gear 442 is connected to the second linear servo gear bracket 441 by screws and nuts. The first piston 443 is composed of a piston and a piston rod. The piston rod is processed with an external thread near the outer end, which is used to be connected to the second linear servo gear 442 by a thread and locked by a locking nut. The first piston 443 is dynamically sealed with the intermediate cabin body 42 of the first power supply cabin through the first piston sealing ring 444. The outer The first side is in contact with the external environment, and the inner side is a sealed space. The inner end face of the first piston 443 is provided with six circumferentially evenly distributed threaded holes, the center of the second lithium battery pack fixing support 445 is provided with a circular hole for passing the piston rod of the first piston 443, the second lithium battery pack fixing support 445 is provided with six circumferentially evenly distributed through holes and six circumferentially evenly distributed circular grooves for fixing the second lithium battery pack 447, the center of the second lithium battery pack mounting plate 446 is provided with a circular hole for passing the piston rod of the first piston 443, the second lithium battery pack mounting plate 446 is provided with six circumferentially evenly distributed through holes and six circumferentially evenly distributed circular grooves for fixing the second lithium battery pack 447, and the second lithium battery pack 447 and six circumferentially evenly distributed second lithium battery pack connecting rods 448 are placed between the second lithium battery pack fixing support 445 and the second lithium battery pack mounting plate 446. One end of the second battery pack connecting rod 448 is an external thread and the other end is an internal thread. The second lithium battery pack connecting rod 448 is connected to the second lithium battery pack fixing support 445 and the first piston 443 via the external thread. The second lithium battery pack mounting plate 446 is fixed to one end of the internal thread of six circumferentially evenly distributed second lithium battery pack connecting rods 446 via six circumferentially evenly distributed screws to fix the position of the second lithium battery pack 443.The first buoyancy center of gravity adjusting device 44 uses the second lithium battery pack 448 and the first piston 443 as counterweights, and changes the volume and center of gravity inside the left power supply cabin 4 by controlling the second linear servo 442 to push and pull the second lithium battery pack 447 and the first piston 443. When the second linear servo 442 pushes the second lithium battery pack 447 and the first piston 443, the internal volume of the left power supply cabin 4 increases, the displacement increases, and the buoyancy of the left power supply cabin 4 increases, and the center of gravity of the left power supply cabin 4 moves backward. When the second linear servo 442 pulls the second lithium battery pack 447 and the first piston 443, the internal volume of the left power supply cabin 4 decreases, the displacement decreases, and the buoyancy of the left power supply cabin 4 decreases, and the center of gravity of the left power supply cabin 4 moves forward.
[0070] The right power supply cabin 3 has the same structure as the left power supply cabin 4 and is symmetrically distributed. The buoyancy center of gravity adjustment device of the left power supply cabin 4 and the right power supply cabin 3 is jointly adjusted. When the pistons and lithium battery packs on both sides move forward, the overall displacement of the manta ray-type bionic fish decreases, the buoyancy decreases, and at the same time, due to the forward movement of the center of gravity, the head of the manta ray-type bionic fish tilts downward, and the pitch angle decreases. When the pistons and lithium battery packs on both sides move backward, the overall displacement of the manta ray-type bionic fish increases, the buoyancy increases, and at the same time, due to the backward movement of the center of gravity, the head of the manta ray-type bionic fish tilts upward, and the pitch angle increases. Jointly adjusting the buoyancy center of gravity adjustment device of the left power supply cabin 4 and the right power supply cabin 3 and the center adjustment auxiliary device 11 of the center cabin can adjust the pitch angle of the manta ray-type bionic fish while adjusting the buoyancy.
[0071] like Figure 7 As shown, the bionic shell 6 includes a lower bionic shell 61 and an upper bionic shell 62, which covers and supports the central cabin 1, the left power supply cabin 4 and the right power supply cabin 3. The bionic shell 6 is made of light and high-strength material to ensure durability and corrosion resistance. The upper bionic shell 62 and the lower bionic shell 61 are connected by screw sleeves and screws. The overall cross-section of the bionic shell 6 is a wing-shaped cross-section. A three-in-one antenna 63 is installed above the upper bionic shell 62, which is used to connect with the LORA module 124, the GPS module 126 and the microcomputer 122 of the central cabin to realize the transmission and reception of wireless signals.
[0072] like Figure 8As shown, the lower bionic housing 61 is equipped with a camera and infrared ranging sensor bracket 64, a waterproof camera 66, a first infrared ranging sensor 67, a second infrared ranging sensor 68, an ultrasonic ranging sensor bracket 65 and an ultrasonic ranging sensor 69. The waterproof camera 66, the first infrared ranging sensor 67 and the second infrared ranging sensor 68 are fixed to the camera and infrared ranging sensor bracket 64 using waterproof glue, and the camera and infrared ranging sensor bracket 64 is fixed to the front of the lower bionic housing 61 by screws. The ultrasonic ranging sensor 69 is fixed to the ultrasonic ranging sensor bracket 65 by bolts and nuts, and the ultrasonic ranging sensor bracket 65 is fixed to the middle of the lower bionic housing 61 by screws. The waterproof camera 66 is used to perform underwater monitoring tasks, the first infrared ranging sensor 67 and the second infrared ranging sensor 68 are used to measure the distance from the front to obstacles, and the ultrasonic ranging sensor 69 is used to measure the distance between the bionic fish and the bottom of the water.
[0073] The method for controlling the diving and floating of a highly maneuverable manta ray-like bionic fish based on the combined regulation of buoyancy and center of gravity of the present invention comprises the following steps:
[0074] By combining the buoyancy and center of gravity adjustment devices of the left and right power supply cabins, the center of gravity adjustment auxiliary device of the center cabin, and the left and right flexible pectoral fins, the floating and diving operations of the bionic fish are realized, thereby completing the adjustment of the specified depth, and achieving soft landing and safe starting on the bottom of the water.
[0075] The manta ray bionic fish uses a depth sensor and an ultrasonic ranging sensor to obtain the current depth d of the manta ray bionic fish in real time. t and the current distance D from the bottom of the water t ;
[0076] The initial state of the manta ray bionic fish is preset to be a suspended state, in which the positions of the first piston of the first buoyancy center of gravity adjustment device of the left power supply cabin and the second piston of the second buoyancy center of gravity adjustment device of the right power supply cabin are respectively x l0 and x r0 , corresponding to the middle positions of the first piston and the second piston stroke, respectively. It is defined that the first piston and the second piston push outward in the positive direction, and the maximum stroke positions are x l0 +x max and x r0 +x max , the minimum travel position is x l0 -x max and x r0 -x max , the lithium battery pack of the gravity center adjustment auxiliary device is located at x a0 , x a0Corresponding to the middle position of the first lithium battery pack travel, the lithium battery pack is defined as being pushed forward in the positive direction, and the maximum travel position is x a0 +x amax , the minimum stroke position is x a0 -x amax , the flexible pectoral fin is in the initial horizontal position, and the current buoyancy of the manta ray bionic fish is f 浮 Equal to the current gravity G;
[0077] The manta ray bionic fish uses a depth sensor and an ultrasonic ranging sensor to obtain the current depth d of the manta ray bionic fish in real time. t and the current distance D from the bottom of the water t , the preset target depth is d tar ;
[0078] like Fig.12 As shown, according to the difference d between the target depth and the current depth tar -d t Divided into surfacing tasks and diving tasks, (d tar -d t )<0, perform the floating task, (d tar -d t )>0, perform the diving mission;
[0079] The present invention divides a manta ray type bionic fish diving control method into a fast diving stage, a slow gliding diving stage, a target approaching fine-adjusting floating stage and a target depth arrival stage, and divides a floating control method into a fast floating stage, a slow gliding floating stage, a target approaching fine-adjusting floating stage and a target depth arrival stage; defines distance target depth thresholds ε1, ε2 and ε3, wherein ε1 is a distance target depth threshold when the manta ray type bionic fish switches from the fast diving stage to the slow gliding diving stage or from the fast floating stage to the slow gliding floating stage when performing a diving task or a floating task, ε2 is a distance target depth threshold when the manta ray type bionic fish switches from the slow gliding diving stage to the target approaching fine-adjusting diving stage or from the slow gliding floating stage to the target approaching fine-adjusting floating stage, and ε3 is a distance target depth threshold when the manta ray type bionic fish switches from the target approaching fine-adjusting diving stage or the target approaching fine-adjusting floating stage to the target reaching depth; the difference between the target depth and the current depth |d tar -d t | is compared with the target depth thresholds ε1, ε2, and ε3, and then switches to different floating or diving stages, which are |d tar -d t |≥ε1,ε1>|d tar -d t |≥ε2、ε2>|d tar -d t |≥ε3 and d tar -dt |<ε3.
[0080] like Fig.15 As shown, the CPG controller based on the phase oscillator of the present invention is used to control the movement of the left and right flexible pectoral fins of the manta ray-like bionic fish; the CPG controller includes 4 CPG control units, of which 2 CPG control units are located on the left pectoral fin, and the other two CPG control units are located on the right pectoral fin; the CPG model is:
[0081]
[0082] Among them, a i 、b i and x i is the amplitude, offset and phase of the i-th oscillator; i=1, 2, 3, 4 are the phase oscillators corresponding to the left rear, left front, right rear and right front servos of the manta ray bionic fish respectively; A i With B i are the expected amplitude and expected offset of the i-th oscillator respectively; α i With β i are the convergence coefficients of amplitude and offset, respectively, which determine the state quantity a i and b i Convergence speed; f i is the oscillation frequency; μ ij is the coupling coefficient between the i-th oscillator and the j-th oscillator, which determines the strength of the coupling between the corresponding oscillators; is the phase difference between the i-th oscillator and the j-th oscillator; θ i is the final output angle of the servo by the i-th phase oscillator. These phase oscillators of the CPG topology network are coupled with each other, which simplifies the coupling parameters of the model and reduces the difficulty of calculation. θ1, θ2, θ3, and θ4 are the outputs of the CPG network topology structure, which are converted into PWM signals by the pulse width modulation (PWM) generator, and the servo swings to the specified angle.
[0083] When the difference between the specified target depth and the current depth is d tar -d t When it is greater than zero, that is, (d tar -d t )>0, the diving task is performed; firstly, the distance from the current depth of the manta ray bionic fish to the target depth is determined |d tar -d t |Is it less than the distance D from the current depth to the bottom of the water? t , that is, to determine whether the target depth is within the maximum diveable depth. If the target depth exceeds the maximum diveable depth, that is, |d tar -d t |>D t, then the manta ray-like bionic fish dives to the bottom of the water and lands softly. At this time, the target depth is equal to the depth of the bottom of the water, that is, d tar =D t +d t , and then according to the difference between the target depth and the current depth d tar -d t |Compare with the target depth thresholds ε1, ε2, ε3 to switch to the corresponding diving stage. If the target depth does not exceed the maximum diving depth, that is, |d tar -d t |<D t , directly based on the difference between the target depth and the current depth d tar -d t |Comparison with the target depth thresholds ε1, ε2, ε3 switches to the corresponding diving stage.
[0084] When |d tar -d t |≥ε1, that is, the difference between the target depth and the current depth |d tar -d t |When the distance to the target depth threshold ε1 is greater than or equal to the target depth threshold, the manta ray bionic fish enters the rapid diving stage. In the rapid diving stage, the first piston and the second piston move linearly from the initial middle position to the minimum stroke position x l0 -x max and x r0 -x max As the overall displacement is reduced to the minimum, the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to minimum buoyancy. At this time, the buoyancy f 浮 The center of gravity moves forward, and the manta ray bionic fish adjusts from a horizontal posture to a posture with its head pointing to the bottom of the water, and dives toward the bottom of the water in this posture. At this time, the manta ray bionic fish uses the designed CPG controller based on the phase oscillator to realize the fixed phase difference of the flexible pectoral fins forward and backward. Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically downward, so that the manta ray-like bionic fish can dive quickly until ε1>|d tar -d t |≥ε2, the manta ray bionic fish enters the slow gliding dive stage.
[0085] When ε1>|d tar -d t|≥ε2, the manta ray bionic fish enters the slow gliding diving stage. In the slow gliding diving stage, the CPG controller controls the flexible pectoral fin to adjust to the initial position. At this time, the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the central cabin changes from the middle position x to the center of gravity adjustment auxiliary device as the diving depth increases. a0 Gradually move linearly to the minimum stroke position x a0 -x amax , this process is a dynamic adjustment, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device during the slow gliding dive stage is defined as x adown ,
[0086]
[0087] During this process, the center of gravity of the manta ray bionic fish gradually moves backwards due to the backward movement of the lithium battery pack of the center of gravity adjustment auxiliary device. tar -d t |=ε2, the position of the lithium battery pack of the center of gravity adjustment auxiliary device is adjusted to the minimum stroke position x a0 -x amax , the center of gravity of the manta ray bionic fish returns to the central position in the initial state; in this process, the pitch posture of the manta ray bionic fish gradually deflects from vertical downward to upward and finally reaches a horizontal posture; and the manta ray bionic fish maintains the minimum buoyancy and continues to dive. Combined with the pitch posture change of the manta ray bionic fish, the initial velocity provided in the fast diving stage and the water flow resistance, the manta ray bionic fish glides downward in a decelerated and gradually horizontal posture in the slow gliding diving stage until ε2>|d tar -d t |≥ε1, the manta ray bionic fish enters the stage of fine-tuning the dive to approach the target.
[0088] When ε2>|d tar -d t When |≥ε3, the manta ray bionic fish enters the stage of fine-tuning the dive close to the target. In the stage of fine-tuning the dive close to the target, the flexible pectoral fin maintains the initial horizontal position. At this time, the first piston and the second piston move from the minimum stroke position x l0 -x max and x r0 -x max Linear movement to the minimum stroke position Travel location and As the overall displacement increases from the minimum value, the buoyancy of the manta ray bionic fish also increases from the minimum buoyancy. At this time, the buoyancy f 浮 Slightly less than the gravity G, at the same time, the position of the lithium battery pack of the center of gravity adjustment auxiliary device is linearly moved to a position close to the minimum stroke position. Travel location The center of gravity of the manta ray bionic fish remains at the center position in the initial state, and the manta ray bionic fish slowly dives in a horizontal posture until |d tar -d t |<ε3, the manta ray bionic fish enters the stage of reaching the target depth.
[0089] When |d tar -d t When |<ε3, the manta ray bionic fish enters the stage of reaching the target depth. At this time, the first piston and the second piston move linearly to the middle position x l0 and x r0 , the position of the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position x a0 , the manta ray-like bionic fish hovers at the target depth in a horizontal posture or achieves a soft landing on the bottom of the water, and the mission is completed.
[0090] When the difference between the specified target depth and the current depth is d tar -d t When it is less than zero, that is, (d tar -d t )<0, perform the floating task; because the wide pectoral fins of the manta ray bionic fish may collide with the surrounding environment and cause structural damage when flapping at the bottom of the water, first determine the current distance D of the manta ray bionic fish from the bottom of the water t Whether it exceeds the safe distance from the bottom of the water, if D t <ξ, the manta ray bionic fish maintains the initial position of the pectoral fin, and the first piston and the second piston move linearly to the position close to the maximum stroke position. Travel location and Move the lithium battery pack of the gravity center adjustment auxiliary device linearly to a position close to the maximum travel position. Travel location The manta ray-like bionic fish slowly floats up in a horizontal position until D t >ξ;
[0091] When D t >ξ, the manta ray-like bionic fish has exceeded the safe distance from the bottom of the water, and then according to the difference between the target depth and the current depth |d tar -d t |Comparison with the target depth thresholds ε1, ε2, ε3 switches to the corresponding floating stage.
[0092] When |d tar -d t |≥ε1, that is, the difference between the target depth and the current depth |d tar -d t|When the distance to the target depth threshold ε1 is greater than or equal to the target depth threshold, the manta ray bionic fish enters the rapid ascent stage. In the rapid ascent stage, the first piston and the second piston move linearly from the initial middle position to the maximum stroke position x l0 +x max and x r0 +x max As the overall displacement increases to the maximum value, the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to maximum buoyancy. At this time, the buoyancy f 浮 When the G is greater than the gravity, the center of gravity moves backward, and the manta ray bionic fish adjusts from a horizontal posture to a posture with its head pointing upward to the water surface, and floats toward the water surface in this posture. At this time, the manta ray bionic fish uses the designed CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fin. Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically upward, so that the manta ray-like bionic fish can float up quickly until ε1>|d tar -d t |≥ε2, the manta ray-like bionic fish enters the slow gliding and floating stage.
[0093] When ε1>|d tar -d t |≥ε2, the manta ray bionic fish enters the slow gliding floating stage. In the slow gliding floating stage, the pectoral fins are adjusted to the initial position. At this time, the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the central cabin changes from the middle position x to the center of gravity auxiliary device as the floating depth decreases. a0 Gradually move linearly to the maximum stroke position x a0 +x amax , this process is a dynamic adjustment, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device in the slow gliding floating stage is defined as x aup ,
[0094]
[0095] During this process, as the lithium battery pack of the gravity center adjustment auxiliary device moves forward, the center of gravity of the manta ray bionic fish gradually moves forward, and when |d tar -d t |=ε2, the position of the lithium battery pack of the center of gravity adjustment auxiliary device is adjusted to the maximum stroke position x a0 +x amax, the center of gravity of the manta ray bionic fish returns to the central position in the initial state; in this process, the pitch posture of the manta ray bionic fish gradually deflects from vertical upward to downward and finally reaches a horizontal posture; and the manta ray bionic fish maintains the maximum buoyancy and continues to float up. Combined with the pitch posture change of the manta ray bionic fish, the initial velocity provided in the rapid floating stage and the water flow resistance, the manta ray bionic fish floats up in a slow gliding diving stage with an upward deceleration and gradually horizontal posture until ε2>|d tar -d t |≥ε3, the manta ray bionic fish enters the stage of fine-tuning and floating close to the target.
[0096] When ε2>|d tar -d t When |≥ε1, the manta ray bionic fish enters the stage of fine-tuning and floating close to the target. In the stage of fine-tuning and floating close to the target, the pectoral fins maintain the initial horizontal position. At this time, the first piston and the second piston move from the maximum stroke position x l0 +x max and x r0 +x max Linear movement to the maximum stroke position Travel location and As the overall displacement is reduced from the maximum value, the buoyancy of the manta ray bionic fish is also reduced from the maximum buoyancy. At this time, the buoyancy f 浮 Slightly greater than the gravity G, at the same time, the position of the lithium battery pack of the gravity center adjustment auxiliary device is linearly moved to a position close to the maximum stroke position. Travel location The center of gravity of the manta ray bionic fish remains at the center position in the initial state, and the manta ray bionic fish slowly floats up in a horizontal posture until |d tar -d t |<ε3, the manta ray bionic fish enters the stage of reaching the target depth.
[0097] When |d tar -d t When |<ε3, the manta ray bionic fish enters the stage of reaching the target depth. At this time, the first piston and the second piston move linearly to the middle position x l0 and x r0 , the position of the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position x a0 , the manta ray-like bionic fish hovered at the target depth in a horizontal posture, and the mission was accomplished.
[0098] The obstacle avoidance control method of the highly maneuverable manta ray-like bionic fish based on the combined regulation of buoyancy and center of gravity of the present invention comprises the following steps:
[0099] The obstacle avoidance steering control method of the high-maneuverability manta ray bionic fish is divided into a high-maneuverability large-angle steering mode and a high-maneuverability small-angle steering mode, specifically including a high-maneuverability large-angle left turn mode, a high-maneuverability small-angle left turn mode, a high-maneuverability large-angle right turn mode and a high-maneuverability small-angle right turn mode. The current obstacle distances output by the infrared ranging sensors in the left front and right front of the manta ray bionic fish are preset to be D lt and D rt , the current straight-line forward swimming speed of the manta ray bionic fish is v t , the speed threshold of the manta ray bionic fish to perform high maneuverability obstacle avoidance and steering task is v1, and the distance obstacle thresholds dis1 and dis2 are defined, where dis1 is the distance obstacle threshold for the manta ray bionic fish to enter the high maneuverability large deflection angle steering mode, and dis2 is the distance obstacle threshold for the manta ray bionic fish to enter the high maneuverability small deflection angle steering mode; the minimum distance to the obstacle min(D lt ,D rt ) is compared with the distance obstacle thresholds dis1 and dis2, and then switches to different high maneuverability steering modes. The parameters of the preset CPG controller in the high maneuverability obstacle avoidance steering task are fixed phase difference Fixed amplitude A i2 , fixed frequency f i2 , dynamically adjust the amplitude bias B i , the preset maximum amplitude bias is B imax , amplitude bias B i >0;
[0100] After entering the high maneuverability steering mode, the manta ray needs to use IMU data to calculate the forward distance, yaw angle, distance to obstacles, and lateral distance from the initial course to determine when to end the high maneuverability steering mode. The preset safety distance threshold from obstacles is safe , the lateral safety distance threshold that deviates from the initial heading is dis latsafe The initial speed of the bionic fish entering the high maneuverability turning mode is v0, and the initial distance from the obstacle is D obs0 , D obs0 =D lt or D obs0 =D rt , the current acceleration of the bionic fish is a t , the acceleration is provided by IMU, and the distance traveled by the bionic fish from the initial position of obstacle avoidance is dis t , the current heading angle relative to the initial heading is θ t The heading angle is provided by the IMU. The current distance between the bionic fish and the obstacle during the steering process is D obst , the lateral distance that the bionic fish currently deviates from the initial course is D latt ,
[0101] The current swimming speed v1 of the manta ray bionic fish is calculated by the following formula:
[0102]
[0103] The distance dis that the manta ray bionic fish travels from its initial position when avoiding obstacles t Calculated by the following formula:
[0104]
[0105] The current distance D between the manta ray bionic fish and the obstacle during the turning process obst Calculated by the following formula:
[0106]
[0107] The lateral distance D that the manta ray bionic fish currently deviates from the initial course latt Calculated by the following formula:
[0108] D latt =dis t ·sin(θ t )
[0109] When the swimming speed v t ≥v1 and the minimum distance to the obstacle min(D lt ,D rt )≤dis1, the manta ray bionic fish autonomously performs high-maneuverability obstacle avoidance and steering tasks;
[0110] When v t ≥v1 and dis1≥min(D lt ,D rt )≥dis2, if D lt >D rt , the manta ray bionic fish enters the high maneuverability small deflection angle left turn mode. In the high maneuverability small deflection angle left turn mode, the first piston on the left side moves linearly from the initial middle position to the minimum stroke position x l0 -x max The second piston on the right moves linearly from the initial middle position to the maximum stroke position x r0 +x max The manta ray bionic fish keeps its center of gravity balanced in the front and back directions, and its buoyancy center moves rightward in the left and right directions. The manta ray bionic fish rolls 90° to the left, presenting a posture with its left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses a CPG controller based on a phase oscillator to achieve a fixed phase difference between the front and back of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2The sum is The amplitude of the biased flapping motion provides the manta ray bionic fish with a torque to turn left, so that the manta ray bionic fish can turn left with a small deflection angle in three-dimensional space with high maneuverability, thereby avoiding obstacles on the right.
[0111] When the current distance between the manta ray bionic fish and the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D latt The lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe , that is, D obst >dis safe And D latt >dis latsafe When the manta ray fish is in the process of turning, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
[0112] When v t ≥v1 and min(D lt ,D rt )<dis2, if D lt >D rt , the manta ray bionic fish enters the high maneuverability large deflection angle left turn mode. In the high maneuverability large deflection angle left turn mode, the first piston on the left side moves linearly from the initial middle position to the minimum stroke position x l0 -x max The second piston on the right moves linearly from the initial middle position to the maximum stroke position x r0 +x max The manta ray bionic fish keeps its center of gravity balanced in the front and back directions, and its buoyancy center moves rightward in the left and right directions. The manta ray bionic fish rolls 90° to the left, presenting a posture with its left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses a CPG controller based on a phase oscillator to achieve a fixed phase difference between the front and back of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn left, so that the manta ray bionic fish can turn left with a large deflection angle in three-dimensional space with high maneuverability, thereby avoiding the obstacle on the right. When the current distance from the manta ray bionic fish to the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D lattThe lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe , that is, D obst >dis safe And D latt >dis latsafe When the manta ray fish is in the process of turning, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
[0113] When v t ≥v1 and dis1≥min(D lt ,D rt )≥dis2, if D lt <D rt , the manta ray bionic fish enters the high maneuverability small deflection angle right turn mode. In the high maneuverability small deflection angle right turn mode, the first piston on the left side moves linearly from the initial middle position to the maximum stroke position x l0 +x max The second piston on the right moves linearly from the initial middle position to the minimum stroke position x r0 -x max The manta ray bionic fish keeps its center of gravity balanced in the front and back directions, and its buoyancy center moves to the left in the left and right directions. The manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2 The sum is The amplitude of the biased flapping motion provides the manta ray bionic fish with a torque to turn right, so that the manta ray bionic fish can turn right with a small angle and high maneuverability in three-dimensional space, thereby avoiding the obstacle on the left. When the current distance from the manta ray bionic fish to the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D latt The lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe , that is, D obst >dis safe And D latt >dis latsafe When the manta ray fish is in the air, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
[0114] When v t ≥v1 and min(D lt ,D rt )<dis2, if D lt <D rt , the manta ray bionic fish enters the high maneuverability large deflection angle right turn mode. In the high maneuverability large deflection angle right turn mode, the first piston on the left side moves linearly from the initial middle position to the maximum stroke position x l0 +x max The second piston on the right moves linearly from the initial middle position to the minimum stroke position x r0 -x max The manta ray bionic fish keeps its center of gravity balanced in the front and back directions, and its buoyancy center moves to the left in the left and right directions. The manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn right, so that the manta ray bionic fish can turn right with a large deflection angle in three-dimensional space with high maneuverability, thereby avoiding the obstacle on the left. When the current distance from the manta ray bionic fish to the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D latt The lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe , that is, D obst >dis safe And D latt >dis latsafe When the manta ray fish is in the air, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
Claims
1. A highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity, comprising a base body and pectoral fins, It is characterized in that The base comprises a bionic shell (6), a central cabin (1) and power supply cabins symmetrically arranged on both sides of the central cabin, the central cabin (1) being a sealed structure, the center of gravity adjustment auxiliary device (11) of the central cabin (1) being slidably arranged near the head of the bionic fish, changing the center of gravity position of the central cabin, and being used to control the pitch angle of the head; the power supply cabin comprises a sealing flange, a cabin body, a buoyancy center of gravity adjustment device and an inlet / water discharge flange, the sealing flange, the cabin body and the buoyancy center of gravity adjustment device forming a sealed structure, the buoyancy center of gravity adjustment device being slidably arranged near the tail of the bionic fish, changing the displacement on one side of the buoyancy center of gravity adjustment device and the inlet / water discharge flange, and being used to control the buoyancy and center of gravity position of the power supply cabin; the bionic shell (6) is provided with an inlet / water discharge port.
2. The highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 1, It is characterized in that The center of gravity adjustment auxiliary device (11) comprises a sealed cabin flange (111), a linear steering gear and a counterweight unit, wherein the counterweight unit is located inside the sealed cabin flange (111), the linear steering gear is installed outside the sealed cabin flange (111) via a connecting plate and a bracket, and a telescopic rod of the linear steering gear is connected to the counterweight unit to control the position of the counterweight unit.
3. The highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 2, It is characterized in that The counterweight unit comprises a first lithium battery pack (118), a fixed support and a mounting plate, wherein the fixed support and the mounting plate are connected via a connecting rod, and the first lithium battery pack (118) is mounted on the fixed support.
4. The highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 1, It is characterized in that The central cabin (1) also includes a control system (12), a central cabin intermediate cabin body (13), a central cabin rear sealing flange (14) and a central cabin rear end cover (15).
5. The highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 1, It is characterized in that The buoyancy center of gravity adjustment device comprises a linear steering gear, a second lithium battery pack (447), a piston and a piston sealing ring.
6. The highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 1, It is characterized in that Digital servos are installed at both ends of the power supply cabin, and the pectoral fins are connected to the digital servos through fin rays and connecting brackets; each digital servo is equipped with a CPG control unit.
7. A method for controlling the submergence and floating of a highly maneuverable manta ray-like bionic fish based on the combined regulation of buoyancy and center of gravity. It is characterized in that The following steps are involved: The initial state of the manta ray bionic fish is preset to be a suspended state. In this state, the piston positions of the buoyancy center of gravity adjustment devices of the left power supply cabin and the right power supply cabin are x l0 and x r0 , corresponding to the middle position of the piston stroke, the piston is defined as pushing outward as the positive direction, and the maximum stroke position is x l0 +x max and x r0 +x max , the minimum travel position is x l0 -x max and x r0 -x max , the lithium battery pack of the gravity center adjustment auxiliary device is located at x a0 , x a0 Corresponding to the middle position of the first lithium battery pack travel, the lithium battery pack is defined as being pushed forward in the positive direction, and the maximum travel position is x a0 +x amax , the minimum stroke position is x a0 -x amax , the flexible pectoral fin is in the initial horizontal position, and the current buoyancy of the manta ray bionic fish is f 浮 Equal to the current gravity G; The pectoral fins are controlled by two CPG control units; the CPG model is Among them, a i 、b i and x i is the amplitude, offset and phase of the i-th oscillator; i=1, 2, 3, 4 are the phase oscillators corresponding to the left rear, left front, right rear and right front servos of the manta ray bionic fish respectively; A i With B i are the expected amplitude and expected offset of the i-th oscillator respectively; α i With β i are the convergence coefficients of amplitude and offset respectively; f i is the oscillation frequency; μ ij is the coupling coefficient between the i-th oscillator and the j-th oscillator; x j is the current phase of the jth oscillator; is the phase difference between the i-th oscillator and the j-th oscillator; θ i is the servo angle output by the i-th phase oscillator; Define the distance target depth threshold ε 1 , ε 2 , ε 3 , where ε 1 The target depth threshold for the manta ray bionic fish to switch from the fast diving stage to the slow gliding diving stage or from the fast ascent stage to the slow gliding ascent stage when performing a diving task or an ascent task; ε 2 The depth threshold of the distance to the target when the manta ray bionic fish switches from the slow gliding diving stage to the fine-tuning diving stage close to the target or from the slow gliding surfacing stage to the fine-tuning surfacing stage close to the target; ε 3 A target depth threshold for the manta ray-like bionic fish to switch from a close-to-target fine-tuning diving phase or a close-to-target fine-tuning surfacing phase to a target depth; Through the target depth d tar With the current depth d t The difference in size |d tar -d t | and the distance target depth threshold ε 1 , ε 2 , ε 3 Make comparisons and switch to different ascent or descent stages.
8. The method for controlling the submergence and floating of a highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 7, It is characterized in that When (d tar -d t )>0, perform the diving mission; When |d tar -d t |≥ε 1 When the rapid diving stage begins, the piston moves linearly from the initial middle position to the minimum stroke position, the displacement decreases to the minimum value, and the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to minimum buoyancy. At this time, the buoyancy f 浮 Less than the gravity G, the center of gravity moves forward, the manta ray-like bionic fish adjusts from a horizontal posture to a posture with its head pointing to the bottom of the water, and dives toward the bottom of the water in this posture, with the pectoral fins moving forward and backward with a fixed phase difference Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically downward, so that the manta ray-like bionic fish can dive quickly until ε 1 >|d tar -d t |≥ε 2 ; When ε 1 >|d tar -d t |≥ε 2 When the slow gliding dive phase begins, the CPG controller controls the pectoral fin to adjust to the initial position, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the center cabin is x adown for The center of gravity of the manta ray bionic fish gradually moves backwards, and when |d tar -d t |=ε 2 When the center of gravity adjustment auxiliary device is in the position of the lithium battery pack, it is adjusted to the minimum travel position x a0 -x amax , the center of gravity of the manta ray bionic fish returns to the center position in the initial state; in this process, the pitch posture of the manta ray bionic fish deflects from vertical downward to upward and finally reaches a horizontal posture; while the manta ray bionic fish maintains the minimum buoyancy and continues to dive. In the slow gliding diving stage, the manta ray bionic fish glides downward and gradually dives in a horizontal posture until ε 2 >|d tar -d t |≥ε 1 ; When ε 2 >|d tar -d t |≥ε 3 When the target is approached, the dive begins with fine-tuning. The pectoral fins maintain their initial horizontal position, and the piston moves linearly from the minimum stroke position to a position close to the minimum stroke position. At the same time, the position of the lithium battery pack of the gravity center adjustment auxiliary device is linearly moved to a position close to the minimum stroke position. The manta ray bionic fish maintains the center of gravity at the initial state, and the manta ray bionic fish slowly dives in a horizontal posture until |d tar -d t |<ε 3 ; When |d tar -d t |<ε 3 When the target depth is reached, the piston moves to the middle position, the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position, the manta ray bionic fish hovers at the target depth in a horizontal posture or achieves a soft landing on the bottom of the water, and the mission is completed.
9. The method for controlling the submergence and floating of a highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity according to claim 7, It is characterized in that Immediately (d tar -d t )<0, determine the current distance D between the manta ray bionic fish and the bottom of the water t Whether it exceeds the safe distance from the bottom of the water; If D t <ξ, the manta ray bionic fish maintains the initial position of the pectoral fin, and the piston moves linearly to a position close to the maximum stroke position. The stroke position is to move the lithium battery pack of the gravity center adjustment auxiliary device linearly to the position close to the maximum stroke position. At the stroke position, the manta ray-like bionic fish slowly floats up in a horizontal position until D t >ξ; When D t >ξ, the manta ray-like bionic fish has exceeded the safe distance from the bottom of the water and is performing the task of floating up; When |d tar -d t |≥ε 1 When the piston moves linearly from the middle position to the maximum stroke position, the buoyancy of the manta ray bionic fish is adjusted from neutral buoyancy to maximum buoyancy. At this time, the buoyancy f 浮 When the G is greater than the gravity, the center of gravity moves backward, and the manta ray bionic fish adjusts from a horizontal posture to a posture with its head pointing upward to the water surface, and floats toward the water surface in this posture. At this time, the manta ray bionic fish uses the designed CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fin. Fixed amplitude A i1 , fixed frequency f i1 Amplitude offset B with a sum value of zero i The flapping motion provides the manta ray-like bionic fish with a thrust in the direction of the head, that is, vertically upward, so that the manta ray-like bionic fish can float up quickly until ε 1 >|d tar -d t |≥ε 2 ; When ε 1 >|d tar -d t |≥ε 2 When the slow gliding and floating phase begins, the pectoral fins are adjusted to the initial position, and the position of the lithium battery pack of the center of gravity adjustment auxiliary device of the center cabin is x aup for During this process, the center of gravity of the manta ray bionic fish gradually moves forward, and when |d tar -d t |=ε 2 When the center of gravity adjustment auxiliary device is in the position of the lithium battery pack, it is adjusted to the maximum travel position x a0 +x amax , the center of gravity of the manta ray bionic fish returns to the center position in the initial state; during this process, the pitch posture of the manta ray bionic fish gradually deflects from vertical upward and downward and finally reaches a horizontal posture; while the manta ray bionic fish maintains maximum buoyancy and continues to float up, decelerating and gliding upward and gradually floating up in a horizontal posture until ε 2 >|d tar -d t |≥ε 1 ; When ε 2 >|d tar -d t |≥ε 1 When the target is approached, the fine-tuning and buoyancy stage begins. The pectoral fins maintain their initial horizontal position, and the piston moves linearly from the maximum stroke position to a position close to the maximum stroke position. At the same time, the position of the lithium battery pack of the gravity center adjustment auxiliary device is linearly moved to a position close to the maximum stroke position. The center of gravity of the manta ray bionic fish remains at the center position in the initial state, and the manta ray bionic fish slowly floats up in a horizontal posture until |d tar -d t |<ε 3 ; When |d tar -d t |<ε 3 When the target depth is reached, the piston moves linearly to the middle position, the position of the lithium battery pack of the center of gravity adjustment auxiliary device moves linearly to the middle position, the manta ray bionic fish hovers at the target depth in a horizontal posture, and the mission is completed.
10. An obstacle avoidance and steering control method for a highly maneuverable manta ray-like bionic fish based on combined regulation of buoyancy and center of gravity. It is characterized in that The following steps are involved: The preset current distances between the left and right front of the manta ray bionic fish and the obstacle are D lt and D rt , the current straight-line forward swimming speed of the manta ray bionic fish is v t The speed threshold for the manta ray-like bionic fish to perform high-maneuverability obstacle avoidance and steering tasks is v 1 The obstacle threshold distance for the manta ray bionic fish to enter the high maneuverability large deflection angle steering mode is dis 1 The obstacle threshold distance for the manta ray bionic fish to enter the high maneuverability small deflection angle steering mode is dis 2 ; The parameters of the CPG controller in the high maneuverability obstacle avoidance steering task are preset to a fixed phase difference. Fixed amplitude A i2 , fixed frequency f i2 , dynamically adjust the amplitude bias B i , the preset maximum amplitude bias is B imax , amplitude bias B i >0; When the swimming speed v t ≥v 1 And the minimum distance to the obstacle min(D lt ,D rt )≤dis 1 When the manta ray-like bionic fish autonomously performs high-maneuverability obstacle avoidance and steering tasks; When v t ≥v 1 And dis 1 ≥min(D lt ,D rt )≥dis 2 When D lt >D rt , enter the high maneuverability small deflection left turn mode, the first piston of the left power supply cabin moves linearly from the middle position to the minimum stroke position, and the second piston of the right power supply cabin moves linearly from the middle position to the maximum stroke position. The center of gravity of the manta ray bionic fish is balanced in the front and rear directions, and the center of buoyancy in the left and right directions moves to the right. The manta ray bionic fish rolls 90° to the left, presenting a posture with the left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the fixed phase difference between the front and back of the flexible pectoral fins Fixed amplitude A i2 , fixed frequency f i2 The sum is The amplitude of the bias flapping motion provides the manta ray bionic fish with a torque to turn left, so that the manta ray bionic fish can turn left with a small deflection angle in three-dimensional space with high maneuverability to avoid the obstacle on the right. When the current distance from the manta ray bionic fish to the obstacle is D obst The safety distance threshold greater than the obstacle is dis safe , and the current lateral distance from the initial heading is D latt The lateral safety distance threshold greater than the deviation from the initial heading is dis latsafe When the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues; When v t ≥v 1 And min(D lt ,D rt )<dis 2 When D lt >D rt When the fish enters the high maneuverability large deflection left turn mode, the first piston moves linearly from the initial middle position to the minimum stroke position, and the second piston moves linearly from the initial middle position to the maximum stroke position. The center of gravity of the manta ray bionic fish in the front and rear directions remains balanced, and the center of buoyancy in the left and right directions moves to the right. The manta ray bionic fish rolls 90° to the left, presenting a posture with the left and right pectoral fins in the vertical direction and the right pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the front and back fixed phase difference of the flexible pectoral fins. Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn left, so that the manta ray bionic fish can turn left with high maneuverability and large deflection angle in three-dimensional space to avoid obstacles on the right. obst >dis safe And D latt >dis latsafe When the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the right and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues; When v t ≥v 1 And dis 1 ≥min(D lt ,D rt )≥dis 2 When D lt <D rt When the fish enters the high maneuverability small deflection angle right turn mode, the first piston moves linearly from the initial middle position to the maximum stroke position, and the second piston moves linearly from the initial middle position to the minimum stroke position. The center of gravity of the manta ray bionic fish is balanced in the front and rear directions, and the center of buoyancy moves leftward in the left and right directions. The manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upward. The buoyancy of the manta ray bionic fish is equal to the gravity. At this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the flexible pectoral fin with a fixed phase difference between the front and the back. Fixed amplitude A i2 , fixed frequency f i2 The sum is The amplitude of the biased flapping motion provides a torque for the manta ray bionic fish to turn right, so that the manta ray bionic fish can turn right with a small angle and high maneuverability in three-dimensional space to avoid obstacles on the left. obst >dis safe And D latt >dis latsafe When the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left and deflects to a horizontal posture, the high maneuverability obstacle avoidance mission is completed, and the cruise mission continues; When v t ≥v 1 And min(D lt ,D rt )<dis 2 When D lt <D rt , enter the high maneuverability large deflection angle right turn mode, the first piston moves linearly from the initial middle position to the maximum stroke position, the second piston moves linearly from the initial middle position to the minimum stroke position, the manta ray bionic fish keeps the center of gravity balanced in the front and rear directions, the buoyancy center moves to the left in the left and right directions, the manta ray bionic fish rolls 90° to the right, presenting a posture with the left and right pectoral fins in the vertical direction and the left pectoral fin pointing upwards, the buoyancy of the manta ray bionic fish is equal to the gravity, at this time, the manta ray bionic fish uses the CPG controller based on the phase oscillator to realize the flexible pectoral fin with a fixed phase difference between the front and back Fixed amplitude A i2 , fixed frequency f i2 The sum is B imax The amplitude of the biased flapping motion provides a greater torque for the manta ray bionic fish to turn right, so that the manta ray bionic fish can turn right with a large deflection angle in three-dimensional space with high maneuverability and avoid obstacles on the left. obst >dis safe And D latt >dis latsafe When the manta ray fish is in the air, the first piston and the second piston are adjusted to the initial middle position, the pectoral fin is adjusted to the initial zero position, the buoyancy center of the manta ray bionic fish in the left and right directions returns to the center position, the manta ray bionic fish rolls to the left to a horizontal posture, the high-maneuverability obstacle avoidance mission is completed, and the cruise mission continues.
Citation Information
Patent Citations
Vertical and horizontal attitude comprehensive adjusting device for underwater glider
CN107310701A
Composite buoyancy adjusting device, autonomous underwater vehicle and control method of autonomous underwater vehicle
CN116215813A
Benthic diving control method for manta ray imitating aircraft based on tail fin and variable buoyancy system
CN117148727A
Manta ray imitating submersible integrating solar energy harvesting, ocean current energy power generation and temperature difference energy buoyancy driving
CN117360732A
Manta ray imitating flexible underwater vehicle with chest tail fin flapping, heavy buoyancy gliding and propeller propelling
CN117382858A
