CN110758698B - Method, system and device for controlling gliding depth of bionic gliding dolphin - Google Patents
Method, system and device for controlling gliding depth of bionic gliding dolphin Download PDFInfo
- Publication number
- CN110758698B CN110758698B CN201911189693.2A CN201911189693A CN110758698B CN 110758698 B CN110758698 B CN 110758698B CN 201911189693 A CN201911189693 A CN 201911189693A CN 110758698 B CN110758698 B CN 110758698B
- Authority
- CN
- China
- Prior art keywords
- gliding
- depth
- dolphin
- control
- bionic
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 241001481833 Coryphaena hippurus Species 0.000 title claims abstract description 125
- 239000011664 nicotinic acid Substances 0.000 title claims abstract description 93
- 238000000034 method Methods 0.000 title claims abstract description 64
- 230000009189 diving Effects 0.000 claims abstract description 29
- 230000007246 mechanism Effects 0.000 claims description 20
- 239000011159 matrix material Substances 0.000 claims description 19
- 210000000006 pectoral fin Anatomy 0.000 claims description 19
- 230000033001 locomotion Effects 0.000 claims description 15
- 230000003592 biomimetic effect Effects 0.000 claims description 14
- 230000005484 gravity Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 11
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 8
- 238000013016 damping Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 4
- 230000002146 bilateral effect Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000001276 controlling effect Effects 0.000 description 14
- 230000008569 process Effects 0.000 description 12
- 238000013461 design Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 5
- 238000005259 measurement Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 241000251468 Actinopterygii Species 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000007789 sealing Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 229910052744 lithium Inorganic materials 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000013575 regulation of buoyancy Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63C—LAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
- B63C11/00—Equipment for dwelling or working underwater; Means for searching for underwater objects
- B63C11/52—Tools specially adapted for working underwater, not otherwise provided for
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Toys (AREA)
Abstract
The invention belongs to the field of underwater robot control, and particularly relates to a gliding depth control method, system and device of a bionic gliding dolphin, aiming at solving the problem of low gliding depth control accuracy of the bionic gliding dolphin. The method of the system comprises the steps of obtaining a preset glide depth and a preset yaw angle; based on depth and inertial navigation information, acquiring an estimated speed through a sliding mode observer, and acquiring control quantity of pectoral fins on two sides through a yaw controller in combination with a preset yaw angle; constructing a Bezier curve and segmenting the Bezier curve based on preset glide depth and depth information to obtain a segmented diving speed reference track, and obtaining a diving control quantity by combining an estimated speed through a model prediction control method; according to the submergence control quantity, the target position of the piston is obtained through the buoyancy principle, and the control quantity of the piston is obtained according to the current piston position; and controlling the gliding based on the control quantity of the piston and the pectoral fins on two sides. The invention improves the precision of the dolphin gliding depth control of the bionic gliding machine.
Description
Technical Field
The invention belongs to the field of underwater robot control, and particularly relates to a gliding depth control method, system and device for a bionic gliding dolphin robot.
Background
In recent years, underwater biomimetic robots play more and more important roles in operations such as underwater detection, search and rescue, facility maintenance and the like, and attract wide attention. By simulating dorsoventral wave motion of the dolphin, the bionic dolphin robot obtains high maneuverability, and successfully realizes high-difficulty actions such as jumping water, rolling back and forth and the like, but the high maneuverability motion usually causes great energy consumption. Therefore, in order to improve the cruising ability of the robotic dolphin, researchers introduce the buoyancy driving mechanism of the underwater glider into the design of the bionic robotic dolphin, develop a bionic gliding robotic dolphin platform, and realize high maneuverability and strong cruising by combining gliding motion and simulated dolphin wave motion, thereby greatly expanding the application field and range.
The problem of depth control has been a research hotspot of underwater robots. The high-precision depth control can lay a solid foundation for autonomous navigation and path planning of the underwater robot, and has great significance for autonomous operation of the underwater robot. According to different control modes, the depth control of the underwater robot is mainly divided into three categories: center of gravity adjustment, buoyancy adjustment, and movable fin surface adjustment. The gravity center adjustment mainly depends on the movable sliding block in the body to change the gravity center distribution, obtain the pitching moment and realize the depth control; the buoyancy adjustment realizes depth control by changing self water discharge and depending on the buoyancy adjustment. The two methods only need static sealing operation, so that the safety is high and the realization difficulty is small. However, due to the slider movement and buoyancy regulation speed limitation, the system delay is large, and overshoot is easy. The depth control is realized by controlling the rotation angle of the fin surface in a movable fin surface adjusting mode, the response speed is high, the structure is simple, and the application is wide. However, this method has high sealing requirements and is prone to strong coupling effects on yaw motion. The method is widely applied to underwater bionic robot research. According to the depth fixing problem of the bionic dolphin robot, the Shen designs a fuzzy proportional-integral-derivative (PID) controller by utilizing a gravity center adjusting mode to realize the gravity center adjustment, and obtains a depth error of 5 cm. References may be made to: (1) shenfei, "modeling and control of biomimetic robotic dolphin and application research thereof in water quality monitoring," doctor academic thesis, Beijing, institute of graduate school of Chinese academy of sciences, 2012.
Makrodimitris realizes the depth error of 2 centimeters by utilizing a buoyancy adjusting mode aiming at the depth fixing problem of the bionic robot fish. References may be made to: (2) M.Makrodimitris, I.Alitrantis, and E.Papadopoulos, "Design and implementation of a low cost, pump-based, depth control of a small fibrous fish," in Proc.IEEE/RSJ int. Conf. Intell. Robots. Syst., Chicago, USA, Sep.2014, pp.1127-1132.
Yu aims at the depth fixing problem of the bionic dolphin machine, and realizes the depth error of 0.5 cm by controlling the rotating angle of the pectoral fin through improving a sliding mode fuzzy controller by utilizing a movable fin surface adjusting mode. References may be made to: (3) yu, J.Liu, Z.Wu, and H.Fang, "Depth control of a bipolar fibrous dolphin based on sliding modular approach control method," IEEE Trans.Ind.Electron., vol.65, No.3, pp.2429-2438,2018.
The depth control of the bionic gliding machine dolphin is divided into gliding depth setting and dolphin depth setting, wherein the accuracy problem of gliding depth setting control is not well solved all the time due to the characteristics of large system delay and low accuracy. The invention aims at the problem of controlling the gliding depth of a gliding dolphin machine, and realizes a depth control task by designing a depth controller to control buoyancy.
Disclosure of Invention
In order to solve the above problems in the prior art, that is, to solve the problem of low precision of the gliding fixed depth control of the existing bionic gliding dolphin, the invention provides a method for controlling the gliding depth of the bionic gliding dolphin, which comprises the following steps:
step S100, acquiring a preset glide depth and a preset yaw angle;
step S200, acquiring estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin machine at the current moment, and acquiring the control quantity of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
step S300, constructing a Bezier curve and segmenting the Bezier curve based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, acquiring a segmented diving speed reference track, and acquiring a diving control amount of the bionic glide robotic dolphin by a model prediction control method in combination with the estimated speed at the current moment;
step S400, according to the submergence control quantity, obtaining a target position of a piston in a buoyancy adjusting mechanism of the bionic gliding dolphin through a buoyancy principle, and obtaining a control quantity of the piston according to the current piston position;
and S500, controlling the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantities of the pectoral fins on the two sides.
In some preferred embodiments, the step S200 of "obtaining the estimated speed by a sliding-mode observer" includes:
constructing a corresponding full-state three-dimensional dynamic model based on the coordinate system of the bionic gliding dolphin;
simplifying the full-state three-dimensional dynamic model by neglecting lateral motion to obtain a simplified dynamic model;
and acquiring a speed vector of the simplified dynamic model through a sliding-mode observer according to the depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and taking the speed vector as the estimated speed of the bionic gliding dolphin.
In some preferred embodiments, the simplified kinetic model is represented as:
wherein v ═ u, w, q]TRespectively represents the forward velocity, the longitudinal velocity and the pitch angle velocity in the dolphin coordinate system, and M is diag { M }1,m2,m3Denotes an inertial mass matrix containing additional masses, m1,m2,m3As a quality parameter, D ═ diag { D ═ D1,d2,d3Denotes a damping matrix simplified to a constant term, d1,d2,d3In order to be a parameter of the damping,
representing an input matrix, ucIn order to control the quantity in real time,
is the position vector of the center of gravity and the floating center of the robot, GmIs the acceleration of gravity, theta is the pitch angle, C (v) is the matrix of Coriolis and centripetal forces,
is the velocity derivative.
In some preferred embodiments, the method of "obtaining the control amount of the bilateral pectoral fins by the yaw controller" in step S300 is as follows:
wherein u isfControl quantity of bilateral pectoral fins, kfIs the weight coefficient, k, of the yaw controllerpIs a scale factor, kiIs an integration factor, kdIs a differential factor, eψIn order to be a yaw angle error,
is the yaw angle error derivative.
In some preferred embodiments, in step S400, "building a bezier curve and segmenting the bezier curve to obtain a segmented reference trajectory of the submerged speed" includes:
constructing a second-order Bezier curve track based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, and taking the second-order Bezier curve track as a depth reference track of the bionic glide robotic dolphin;
deriving the depth reference track to obtain a submergence speed reference track;
and segmenting the diving speed reference track according to the absolute value of the difference between the preset glide depth and the depth information of the bionic glide machine dolphin at the current moment and the preset depth threshold value to obtain a segmented diving speed reference track.
In some preferred embodiments, the segmented reference trajectory of the submerged speed is calculated by:
wherein, YrefBeing a segmented reference trajectory for the speed of descent, c1、c2Represents a weight coefficient, drIs the target depth, d is the measured value of the depth sensor, dthesholdIs a preset depth threshold value, VrefThe trajectory is referenced for the dive speed.
In some preferred embodiments, the step S500 of obtaining the target position of the piston in the buoyancy adjusting mechanism of the biomimetic gliding robotic dolphin according to the principle of buoyancy includes:
wherein r issrρ is the density of water, g is the gravitational acceleration, S is the bottom area of the buoyancy adjusting mechanism, u is the target position of the pistonc(t) is a submergence control amount.
The invention provides a system for controlling the gliding depth of a bionic gliding dolphin, which comprises a preset value acquisition module, a pectoral fin acquisition control module, a submergence acquisition control module, a piston acquisition control module and a gliding control module, wherein the preset value acquisition module is used for acquiring the gliding depth of the bionic gliding dolphin;
the default value acquiring module is configured to acquire a default glide depth and a default yaw angle;
the acquisition pectoral fin control module is configured to acquire an estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and acquire control quantity of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
the acquisition diving control module is configured to construct a Bezier curve and segment the Bezier curve based on the preset glide depth and the depth information of the bionic glide machine dolphin at the current moment, acquire a segmented diving speed reference track, and acquire a diving control quantity of the bionic glide machine dolphin by combining with the estimated speed at the current moment through a model prediction control method;
the piston control acquisition module is configured to acquire a target position of a piston in the buoyancy adjusting mechanism of the bionic gliding dolphin according to the submergence control amount and a buoyancy principle, and acquire a control amount of the piston according to the current position of the piston;
the control gliding module is configured to control the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantity of the two side pectoral fins.
In a third aspect of the present invention, a storage device is provided, in which a plurality of programs are stored, the programs being applied to be loaded and executed by a processor to implement the above-mentioned glide depth control method for a biomimetic glide robotic dolphin.
In a fourth aspect of the present invention, a processing apparatus is provided, which includes a processor, a storage device; a processor adapted to execute various programs; a storage device adapted to store a plurality of programs; the program is suitable for being loaded and executed by a processor to realize the gliding depth control method of the bionic gliding dolphin.
The invention has the beneficial effects that:
the invention improves the precision of the dolphin gliding depth control of the bionic gliding machine. According to the method, the full-state dynamic model of the bionic gliding dolphin is constructed, and the full-dynamic model is simplified by neglecting lateral motion, so that the simplified dynamic model is obtained. And acquiring the estimated speed of the bionic gliding dolphin machine by using information such as depth, attitude and the like through a sliding-mode observer. Considering the characteristic of large delay of the bionic gliding dolphin machine system, based on the estimated speed, the piston motion of the buoyancy adjusting mechanism of the bionic gliding dolphin machine is adjusted through the designed sectional Bessel reference track and the depth controller based on model prediction, so that the buoyancy is controlled, and the gliding depth control with high precision is realized.
Meanwhile, the control quantity of the pectoral fins on the two sides of the bionic gliding dolphin is obtained based on the improved PID yaw controller, and the gliding posture is adjusted by utilizing the differential motion of the movable pectoral fins. The yaw disturbance in the gliding depth fixing process is avoided, and the heading of the bionic gliding machine dolphin in the gliding depth fixing stage is kept unchanged.
Drawings
Other features, objects and advantages of the present application will become more apparent upon reading of the following detailed description of non-limiting embodiments thereof, made with reference to the accompanying drawings.
FIG. 1 is a schematic flow chart of a method for controlling the glide depth of a biomimetic gliding dolphin according to an embodiment of the present invention;
FIG. 2 is a schematic diagram of a frame of a gliding depth control system of a bionic gliding dolphin according to an embodiment of the present invention;
FIG. 3 is a schematic diagram of a system coordinate system of a bionic gliding dolphin according to an embodiment of the present invention;
FIG. 4 is a schematic view showing an electromechanical structure of a bionic gliding dolphin according to an embodiment of the present invention;
FIG. 5 is a schematic view of a gliding depth control structure of a bionic gliding dolphin according to an embodiment of the present invention;
fig. 6 is a schematic view of a gliding depth-fixing experiment of a bionic gliding dolphin according to an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention clearer, the technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings, and it is apparent that the described embodiments are some, but not all embodiments of the present invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The present application will be described in further detail with reference to the following drawings and examples. It is to be understood that the specific embodiments described herein are merely illustrative of the relevant invention and not restrictive of the invention. It should be noted that, for convenience of description, only the portions related to the related invention are shown in the drawings.
It should be noted that the embodiments and features of the embodiments in the present application may be combined with each other without conflict.
The gliding depth control method of the bionic gliding dolphin comprises the following steps as shown in figure 1:
step S100, acquiring a preset glide depth and a preset yaw angle;
step S200, acquiring estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin machine at the current moment, and acquiring the control quantity of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
step S300, constructing a Bezier curve and segmenting the Bezier curve based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, acquiring a segmented diving speed reference track, and acquiring a diving control amount of the bionic glide robotic dolphin by a model prediction control method in combination with the estimated speed at the current moment;
step S400, according to the submergence control quantity, obtaining a target position of a piston in a buoyancy adjusting mechanism of the bionic gliding dolphin through a buoyancy principle, and obtaining a control quantity of the piston according to the current piston position;
and S500, controlling the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantities of the pectoral fins on the two sides.
In order to more clearly explain the gliding depth control method of the bionic gliding dolphin, the following will explain the steps of an embodiment of the method in detail with reference to the attached drawings.
And S100, acquiring a preset glide depth and a preset yaw angle.
In this embodiment, first, a preset depth and a yaw angle for controlling the bionic gliding dolphin to glide are obtained. The preset glide depth is manually set, and the preset yaw angle is set as an initial direction, namely the course is kept unchanged.
And S200, acquiring an estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and acquiring the control quantity of the pectoral fins on two sides through a yaw controller in combination with the preset yaw angle.
The system coordinate system of the gliding dolphin is shown in FIG. 3, where cg＝ogxgygzgAnd cb＝obxbybzbRespectively representing a global inertia coordinate system and a dolphin coordinate system, wherein the x-axis direction of the dolphin coordinate system is the positive direction of the dolphin head, and the positive direction of the z-axis is along the gravity direction.
Secondly, the invention establishes a respective united coordinate system at each movable joint, comprising cw＝owxwywzw，ct＝otxtytzt，cl＝olxlylzlAnd cr＝orxryrzrThe lumbar, caudal, left pectoral fin and right pectoral fin coordinate systems are respectively represented.
Fig. 4 is an electromechanical structure schematic diagram of a bionic gliding robot dolphin, which mainly comprises three cabins, namely a pectoral fin cabin, a battery cabin and a waist tail cabin, wherein the structural diagrams of the pectoral fin cabin and the battery cabin are shown in fig. 4, the pectoral fin cabin comprises a buoyancy adjusting structure, a piston motor and a pectoral fin steering engine, and the battery cabin comprises a movable sliding block, a sliding block motor and a lithium battery pack. Wherein, waist joint, afterbody joint, buoyancy adjustment mechanism and focus adjustment mechanism are driven by the motor, and the pectoral fin of both sides is by steering wheel drive. The bionic gliding dolphin machine also comprises various sensors and a power switch, and an inertial navigation sensor and a depth sensor are shown in the figure.
According to the coordinate system in the figure 3, a full-state three-dimensional dynamic model of the bionic gliding dolphin machine is constructed, and the model has a gliding mode and a dolphin mode. The gliding mode is calculated by utilizing the kinetic energy and momentum relationship as shown in formulas (1) and (2):
p＝gRbP (1)
π＝gRbΠ+l×p (2)
wherein P and pi respectively represent the system momentum and angular momentum under the inertial coordinate system, P and pi respectively represent the system momentum and angular momentum under the dolphin coordinate system,gRbrepresenting a rotation matrix, l representing the origin of the inertial frame to the origin of the dolphin frameAnd (5) vector quantity.
And establishing a Newton Euler equation of a gliding mode by solving the kinetic energy of the system.
For the dolphin mode, according to the multi-link dynamics theory, Newton Euler equations of the waist joint, the tail joint and the left and right pectoral fin joints are respectively established, and the force and the moment of each joint are respectively solved through the speed transmission of forward kinematics, so that the acceleration and the speed are obtained.
By neglecting the lateral motion, the above dynamic model is simplified, making it more suitable for the real embedded platform, as shown in formula (3):
wherein v ═ u, w, q]TRespectively represents the forward velocity, the longitudinal velocity and the pitch angle velocity in the dolphin coordinate system, and M is diag { M }1,m2,m3Denotes an inertial mass matrix containing additional masses, m1,m2,m3As a quality parameter, D ═ diag { D ═ D1,d2,d3Denotes a damping matrix simplified to a constant term, d1,d2,d3In order to be a parameter of the damping,
representing an input matrix, C (v) representing a Coriolis force and centripetal force matrix,
is the velocity derivative, ucIn order to control the quantity in real time,
is the position vector of the center of gravity and the floating center of the robot, GmIs the acceleration of gravity, theta is the pitch angle.
Therefore, from the coriolis force and centripetal force matrix, by simplifying the kinetic model to extract the vertical direction component, equation (4) can be obtained:
wherein,
the derivative of the submergence velocity.
When a controller is designed, a speed vector of a simplified dynamic model needs to be calculated, most of sensors used for accurate underwater positioning are heavy and expensive, and therefore the speed estimation algorithm based on the sliding-mode observer is provided by the invention. Wherein, the concrete process of the gliding depth control method of the bionic gliding dolphin is shown in figure 5, drIndicating a preset glide depth, psirThe preset yaw angle is shown, and the following steps will explain the blocks in fig. 5.
Firstly, the actual measurement values of the sensors are obtained, the actual measurement values comprise the measurement values of a depth sensor, an inertial navigation sensor and a piston position sensor of a buoyancy adjusting mechanism, namely depth information, inertial navigation information and piston information, and the inertial navigation sensor obtains three-axis Euler angles, angular velocities and acceleration of the head of the robot through a nine-axis algorithm to serve as navigation information.
According to the depth information d, acquiring the real diving speed, and estimating the diving speed by defining an inertial coordinate system
Defining the estimation error s as shown in equations (5) and (6), respectively:
wherein,
is the derivative of the depth information and,gUbzis the true submergence speed.
Then, according to the transformation relationship between the inertial coordinate system and the dolphin coordinate system, the estimated velocity of the global coordinate system is calculated, as shown in formula (7):
wherein,
for the estimated acceleration of the global coordinate system, (cx cy cz) represents the weight vector of the sliding-mode observer, sat(s) represents the saturation function, the design objective of this item is to reduce the buffeting effect of the sliding-mode observer,gRbis a rotation matrix from the dolphin coordinate system to the inertial coordinate system,
is a diagonally symmetric matrix of angular velocities,
representing the estimated acceleration in the dolphin coordinate system. From the estimated acceleration, an estimated velocity can be obtained by iteration.
Due to the mechanical structure gap, the bionic gliding dolphin is easy to deflect in the yawing direction in the gliding process, so that a yaw controller needs to be designed to meet the assumption that lateral motion is neglected in a simplified dynamic model. Because the basic principle of yaw movement is the differential hydrodynamic moment generated by the deflection of the pectoral fins on two sides, and hydrodynamic force is closely related to speed, the yaw control quantity is not too large when the speed is higher, so that overshoot is avoided. Therefore, in the present embodiment, a yaw controller is proposed, which is designed based on the velocity vector (estimated velocity) obtained as described above, obtains a control amount, and controls the pectoral fin bias angles on both sides.
First, a weight coefficient k of the yaw controller is obtained based on the estimated speedfThe solving process is shown in equation (8):
wherein v ismaxRepresents the maximum glide velocity, which is a constant value obtained by simulation, vexFor estimated x-axis velocity, vezIs the estimated z-axis velocity. Then, the coefficient is applied to a classical PID controller to obtain a final control quantity ufAs shown in formula (9):
wherein k ispIs a scale factor, kiIs an integration factor, kdIs a differential factor, eψIn order to be a yaw angle error,
for the yaw angle error derivative, i denotes the index.
By adjusting PID parameters, the control quantity is directly mapped into left and right angles kappa of the pectoral finl、κrIn this embodiment, it is preferable to use only one pectoral fin for yaw adjustment, that is, when one pectoral fin deflects, the angle of the other pectoral fin is zero, and the adjustment method is as shown in equation (10):
and step S300, constructing a Bezier curve and segmenting the Bezier curve based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, acquiring a segmented diving speed reference track, and acquiring a diving control amount of the bionic glide robotic dolphin by combining the estimated speed at the current moment through a model prediction control method.
The gliding motion response speed is low, so that the system is easy to delay greatly, and the model prediction control is more suitable for the system and has low requirement on the model accuracy. Therefore, according to the obtained simplified dynamic model and the estimated speed, the invention provides a depth controller based on model predictive control, and the depth controller realizes high-precision depth control by improving the reference track of the depth controller.
The method comprises the following specific steps:
converting the simplified kinetic model into a discrete domain representation as shown in equation (11):
w(k+1)＝Aw(k)+Buc(k)+L(k) (11)
wherein,
k represents a natural number.
For convenience of representation, the system variables are unified and defined as shown in equation (12):
where (k | t) denotes the prediction of k steps on the basis of time t, the simplified kinetic model can be expressed as in equation (13) (14):
wherein,
Δucto control the increments, η (k | t) is the expanded output quantity.
Then, by setting the control step number NcAnd predicting the number of steps NpIteratively predicting future state variables, as shown in equation (15):
in this example
The term remains a constant term during a prediction to decouple the submarine speed from the forward and pitch speeds. Secondly, uniformly integrating the predicted state variables to obtain a formula (16):
Y(t)＝Υξ(k|t)+ΗΔUc(t)+Δ (16)
wherein y (t) ═ (η (k +1| t), …, η (k + N)c|t)…,…,η(k+Np|t))TThe superscript T is the notation for transpose,
i is an identity matrix and is a matrix of the identity,
then, by optimizing the objective function of the model predictive control method, the optimal solution of the control signal is calculated, the selection of which should be considered by two factors. First, the depth steady-state error (the difference between the target depth and the actual depth) should be controlled to a minimum. The invention converts the depth of the control target into the diving speed, and the target depth can be achieved by designing a proper diving speed reference track. Secondly, the control increments should not be too large, otherwise mechanical and electrical damage to the robot is likely to result. Therefore, based on the above considerations, the present invention proposes an objective function based on steady-state error and control increment, as shown in equation (17):
wherein J (ξ (t), Δ Uc(t)) represents an objective function based on steady state error and control delta, ηref(.) represents a reference trajectory, R is a control increment parameter, and Q is an error parameter.
Integrating the objective functions into a matrix form, resulting in equation (18) (19):
wherein,
E(t)＝Υξ(k|t)+Δ-Yref(t)，
Yrefrepresenting a segmented reference trajectory of the submerged speed, acquired hereinafter, NxThe number of state quantities.
By optimizing the feasible solution of the above function, a sequence of control increments within the control step number is obtained, as shown in equation (20):
ΔUc *＝(Δuc(t)*…Δuc(t+Nc-1)*)T(20)
wherein, Delta Uc *Representing a sequence of control increments, Δ uc(t)*The optimum control amount is indicated.
Then, the first value in the sequence is selected as the final control increment value to obtain the control quantity, as shown in formula (21):
uc(t)＝uc(t-1)+Δuc(t)*(21)
for a large-delay system, a good reference track is designed to avoid overshoot. Therefore, the invention provides a reference track design method based on a Bezier curve. The Bezier curve is generally used to smooth paths, altering the curve shape by setting different control points. In depth control systems, it is desirable to minimize overshoot. Therefore, based on the predicted step number, the present invention first applies a second order bezier curve to the depth reference trajectory. And then, a depth reference point is calculated to provide a real-time submerged speed reference track. Depth reference track PrefThe design is shown in formula (22):
Pref(i)＝(1-t(i))2d+2t(i)(1-t(i))2dr+t(i)2dr(22)
wherein,
drrepresenting a preset glide depth, d representing a real-time depth, i.e., depth information.
By deriving depth reference tracks
And obtaining a reference track of the submergence speed. In the actual control process, because the design of the reference track can be changed due to different target depths, the invention provides a sectional reference track design method, and the depth threshold d is setthesholdAnd realizing reference tracks of different stages as shown in the formula (23):
wherein, YrefBeing a segmented reference trajectory for the speed of descent, c1And c2Representing the weight coefficients. However, in practical application, the method should not be limited to two-segment reference trajectories, and multiple segments of trajectories may be set according to different target depths, or even a continuous function may be designed to implement depth control.
And S400, obtaining the target position of the piston in the buoyancy adjusting mechanism of the bionic gliding dolphin according to the submergence control amount and the buoyancy principle, and obtaining the control amount of the piston according to the current piston position.
In this embodiment, since the depth control is realized by adjusting the buoyancy in the glide mode, and the buoyancy adjustment is realized by moving the piston in the mechanism to suck and discharge water, the obtained control amount needs to be mapped to the position of the piston in the buoyancy adjustment mechanism. Considering that the physical meaning of the controlled variable is force, the target position of the piston can be obtained according to the buoyancy principle, and the calculation process is shown as the formula (24):
wherein r issrFor the target position of the piston, ρ represents the density of water, g represents the gravitational acceleration, and S represents the bottom area of the cylindrical buoyancy regulating mechanism. However, since the motor is greatly accelerated and decelerated in the position mode, the depth control is real-time control, and the control period is short, the position mode may damage mechanical and electrical structures. In order to protect the buoyancy drive mechanism, the invention sets the motor to a speed mode and designs the PID controller to realize the position ring to move smoothly according to the mode.
And S500, controlling the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantities of the pectoral fins on the two sides.
In the embodiment, the floating and diving of the bionic gliding dolphin are controlled by the piston control amount, and the yaw adjustment of the bionic gliding dolphin is controlled by the control amounts of the pectoral fins on the two sides, so that the gliding control of the bionic gliding dolphin is realized. FIG. 6 shows the schematic diagram of the gliding depth control experiment of the bionic gliding dolphin, wherein the black dotted line represents the target depth and the water surface image is the dolphin inverted image.
A second embodiment of the present invention is a system for controlling a gliding depth of a biomimetic gliding robotic dolphin, as shown in fig. 2, comprising: the method comprises the following steps of obtaining a preset value module 100, obtaining a pectoral fin control module 200, obtaining a submergence control module 300, obtaining a piston control module 400 and controlling a glide module 500;
the preset value obtaining module 100 is configured to obtain a preset glide depth and a preset yaw angle;
the acquisition pectoral fin control module 200 is configured to acquire an estimated speed through a sliding-mode observer based on depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and acquire control quantities of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
the obtaining diving control module 300 is configured to construct a bezier curve and segment the bezier curve based on the preset glide depth and the depth information of the bionic glide machine dolphin at the current time, obtain a segmented diving speed reference trajectory, and obtain a diving control amount of the bionic glide machine dolphin by a model predictive control method in combination with an estimated speed at the current time;
the acquiring piston control module 400 is configured to acquire a target position of a piston in the buoyancy adjusting mechanism of the bionic gliding dolphin according to the submergence control amount and a buoyancy principle, and acquire a control amount of the piston according to a current piston position;
the control gliding module 500 is configured to control the bionic gliding dolphin to glide based on the control amount of the piston and the control amount of the two lateral pectoral fins.
It can be clearly understood by those skilled in the art that, for convenience and brevity of description, the specific working process and related description of the system described above may refer to the corresponding process in the foregoing method embodiment, and details are not described herein again.
It should be noted that, the gliding depth control system of the biomimetic gliding dolphin provided in the above embodiment is only illustrated by the division of the above functional modules, and in practical applications, the above functions may be distributed by different functional modules according to needs, that is, the modules or steps in the embodiment of the present invention are further decomposed or combined, for example, the modules in the above embodiment may be combined into one module, or may be further split into a plurality of sub-modules, so as to complete all or part of the above described functions. The names of the modules and steps involved in the embodiments of the present invention are only for distinguishing the modules or steps, and are not to be construed as unduly limiting the present invention.
A storage device according to a third embodiment of the present invention stores therein a plurality of programs adapted to be loaded by a processor and to realize the above-described method for controlling the glide depth of a biomimetic gliding dolphin.
A processing apparatus according to a fourth embodiment of the present invention includes a processor, a storage device; a processor adapted to execute various programs; a storage device adapted to store a plurality of programs; the program is suitable for being loaded and executed by a processor to realize the gliding depth control method of the bionic gliding dolphin.
It can be clearly understood by those skilled in the art that, for convenience and brevity, the specific working processes and related descriptions of the storage device and the processing device described above may refer to the corresponding processes in the foregoing method examples, and are not described herein again.
Those of skill in the art would appreciate that the various illustrative modules, method steps, and modules described in connection with the embodiments disclosed herein may be implemented as electronic hardware, computer software, or combinations of both, and that programs corresponding to the software modules, method steps may be located in Random Access Memory (RAM), memory, Read Only Memory (ROM), electrically programmable ROM, electrically erasable programmable ROM, registers, hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art. To clearly illustrate this interchangeability of electronic hardware and software, various illustrative components and steps have been described above generally in terms of their functionality. Whether these functions are performed in electronic hardware or software depends on the intended application of the solution and design constraints. Those skilled in the art may implement the described functionality in varying ways for each particular application, but such implementation decisions should not be interpreted as causing a departure from the scope of the present invention.
The terms "first," "second," and the like are used for distinguishing between similar elements and not necessarily for describing or implying a particular order or sequence.
The terms "comprises," "comprising," or any other similar term are intended to cover a non-exclusive inclusion, such that a process, method, article, or apparatus that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or apparatus.
So far, the technical solutions of the present invention have been described in connection with the preferred embodiments shown in the drawings, but it is easily understood by those skilled in the art that the scope of the present invention is obviously not limited to these specific embodiments. Equivalent changes or substitutions of related technical features can be made by those skilled in the art without departing from the principle of the invention, and the technical scheme after the changes or substitutions can fall into the protection scope of the invention.
Claims (10)
1. A method for controlling the gliding depth of a bionic gliding dolphin is characterized by comprising the following steps:
step S100, acquiring a preset glide depth and a preset yaw angle;
step S200, acquiring estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin machine at the current moment, and acquiring the control quantity of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
step S300, constructing a Bezier curve and segmenting the Bezier curve based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, acquiring a segmented diving speed reference track, and acquiring a diving control amount of the bionic glide robotic dolphin by a model prediction control method in combination with the estimated speed at the current moment;
step S400, according to the submergence control quantity, obtaining a target position of a piston in a buoyancy adjusting mechanism of the bionic gliding dolphin through a buoyancy principle, and obtaining a control quantity of the piston according to the current piston position;
and S500, controlling the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantities of the pectoral fins on the two sides.
2. The method for controlling the gliding depth of a biomimetic gliding robotic dolphin according to claim 1, wherein "obtaining the estimated speed by a sliding-mode observer" in step S200 is performed by:
constructing a corresponding full-state three-dimensional dynamic model based on the coordinate system of the bionic gliding dolphin;
simplifying the full-state three-dimensional dynamic model by neglecting lateral motion to obtain a simplified dynamic model;
and acquiring a speed vector of the simplified dynamic model through a sliding-mode observer according to the depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and taking the speed vector as the estimated speed of the bionic gliding dolphin.
3. The method of claim 2, wherein the simplified dynamical model is expressed as:
wherein v ═ u, w, q]TRespectively represents the forward velocity, the longitudinal velocity and the pitch angle velocity in the dolphin coordinate system, and M is diag { M }1,m2,m3Denotes an inertial mass matrix containing additional masses, m1,m2,m3As a quality parameter, D ═ diag { D ═ D1,d2,d3Denotes a damping matrix simplified to a constant term, d1,d2,d3In order to be a parameter of the damping,
representing an input matrix, ucIn order to control the quantity in real time,
is the position vector of the center of gravity and the floating center of the robot, GmIs the acceleration of gravity, theta is the pitch angle, C (v) is the matrix of Coriolis and centripetal forces,
is the velocity derivative.
4. The method for controlling gliding depth of a biomimetic gliding robotic dolphin as claimed in claim 1, wherein the method of "obtaining the control amount of the pectoral fins on both sides by the yaw controller" in step S300 is:
wherein u isfControl quantity of bilateral pectoral fins, kfIs the weight coefficient, k, of the yaw controllerpIs a scale factor, kiIs an integration factor, kdIs a differential factor, eψIn order to be a yaw angle error,
is the yaw angle error derivative.
5. The method for controlling gliding depth of a biomimetic gliding robotic dolphin as claimed in claim 1, wherein the step S400 of "constructing and segmenting a bezier curve to obtain a segmented reference trajectory of the submerging velocity" comprises the steps of:
constructing a second-order Bezier curve track based on the preset glide depth and the depth information of the bionic glide robotic dolphin at the current moment, and taking the second-order Bezier curve track as a depth reference track of the bionic glide robotic dolphin;
deriving the depth reference track to obtain a submergence speed reference track;
and segmenting the diving speed reference track according to the absolute value of the difference between the preset glide depth and the depth information of the bionic glide machine dolphin at the current moment and the preset depth threshold value to obtain a segmented diving speed reference track.
6. The method as claimed in claim 5, wherein the sectional type diving speed reference trajectory is calculated by:
wherein, YrefBeing a segmented reference trajectory for the speed of descent, c1、c2Represents a weight coefficient, drIs a preset glide depth, d is depth information, dthesholdIs a preset depth threshold value, VrefThe trajectory is referenced for the dive speed.
7. The method as claimed in claim 1, wherein the step S500 of obtaining the target position of the piston in the buoyancy adjusting mechanism of the biomimetic gliding dolphin based on the principle of buoyancy comprises:
wherein r issrρ is the density of water, g is the gravitational acceleration, S is the bottom area of the buoyancy adjusting mechanism, u is the target position of the pistonc(t) is a submergence control amount.
8. A gliding depth control system of a bionic gliding dolphin is characterized by comprising a preset value acquisition module, a pectoral fin acquisition control module, a submergence acquisition control module, a piston acquisition control module and a gliding control module;
the default value acquiring module is configured to acquire a default glide depth and a default yaw angle;
the acquisition pectoral fin control module is configured to acquire an estimated speed through a sliding mode observer based on the depth information and inertial navigation information of the bionic gliding dolphin at the current moment, and acquire control quantity of pectoral fins on two sides through a yaw controller in combination with the preset yaw angle;
the acquisition diving control module is configured to construct a Bezier curve and segment the Bezier curve based on the preset glide depth and the depth information of the bionic glide machine dolphin at the current moment, acquire a segmented diving speed reference track, and acquire a diving control quantity of the bionic glide machine dolphin by combining with the estimated speed at the current moment through a model prediction control method;
the piston control acquisition module is configured to acquire a target position of a piston in the buoyancy adjusting mechanism of the bionic gliding dolphin according to the submergence control amount and a buoyancy principle, and acquire a control amount of the piston according to the current position of the piston;
the control gliding module is configured to control the bionic gliding dolphin to glide based on the control quantity of the piston and the control quantity of the two side pectoral fins.
9. A storage device in which a plurality of programs are stored, characterized in that the program applications are loaded and executed by a processor to realize the glide depth control method of the biomimetic glide robotic dolphin according to any one of claims 1 to 7.
10. A processing device comprising a processor, a storage device; a processor adapted to execute various programs; a storage device adapted to store a plurality of programs; characterized in that said program is adapted to be loaded and executed by a processor to implement the method of glide depth control of a biomimetic gliding robotic dolphin as claimed in any one of claims 1-7.
Priority Applications (3)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911189693.2A CN110758698B (en) | 2019-11-28 | 2019-11-28 | Method, system and device for controlling gliding depth of bionic gliding dolphin |
| PCT/CN2020/085043 WO2021103391A1 (en) | 2019-11-28 | 2020-04-16 | Method and system for controlling gliding depth of biomimetic robotic gliding dolphin, and apparatuses |
| US17/069,868 US10935986B1 (en) | 2019-11-28 | 2020-10-14 | Gliding depth control method, system and device for biomimetic gliding robotic dolphin |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911189693.2A CN110758698B (en) | 2019-11-28 | 2019-11-28 | Method, system and device for controlling gliding depth of bionic gliding dolphin |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110758698A CN110758698A (en) | 2020-02-07 |
| CN110758698B true CN110758698B (en) | 2020-10-02 |
Family
ID=69339663
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911189693.2A Active CN110758698B (en) | 2019-11-28 | 2019-11-28 | Method, system and device for controlling gliding depth of bionic gliding dolphin |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN110758698B (en) |
| WO (1) | WO2021103391A1 (en) |
Families Citing this family (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US10935986B1 (en) | 2019-11-28 | 2021-03-02 | Institute Of Automation, Chinese Academy Of Sciences | Gliding depth control method, system and device for biomimetic gliding robotic dolphin |
| CN110758698B (en) * | 2019-11-28 | 2020-10-02 | 中国科学院自动化研究所 | Method, system and device for controlling gliding depth of bionic gliding dolphin |
| CN111547212B (en) * | 2020-06-02 | 2021-12-07 | 哈尔滨工程大学 | Buoyancy control method for unpowered rapid submerged-floating AUV |
| CN111830832B (en) * | 2020-07-27 | 2021-08-31 | 中国科学院自动化研究所 | Bionic gliding machine dolphin plane path tracking method and system |
| CN112363401B (en) * | 2020-11-29 | 2022-06-07 | 西北工业大学 | Underwater glider self-adaptive inversion depth control method based on buoyancy adjustment |
| CN113277046B (en) * | 2021-06-08 | 2022-08-05 | 西北工业大学 | Simulated bat ray underwater vehicle depth control method based on centroid and tail fin |
| CN113325857B (en) * | 2021-06-08 | 2022-08-05 | 西北工业大学 | Simulated bat ray underwater vehicle depth control method based on centroid and buoyancy system |
| CN113515134B (en) * | 2021-06-24 | 2021-12-14 | 天津海翼科技有限公司 | Underwater robot applied to underwater/water surface detection |
| CN113419422B (en) * | 2021-07-02 | 2022-01-28 | 哈尔滨理工大学 | Marine rudder fin combined anti-rolling control system |
| CN113734393B (en) * | 2021-09-28 | 2022-12-02 | 深圳先进技术研究院 | Bionic robot fish depth control method and device based on attack angle method |
| CN114371698A (en) * | 2021-12-09 | 2022-04-19 | 沈阳航天新光集团有限公司 | Autonomous obstacle-avoiding swimming bionic robot fish |
| CN114355777B (en) * | 2022-01-06 | 2023-10-10 | 浙江大学 | Dynamic gliding method and system based on distributed pressure sensor and sectional attitude control |
| CN115774967A (en) | 2022-09-15 | 2023-03-10 | 厦门理工学院 | Multi-joint bionic dolphin motion control method and system and underwater damage detection method |
| CN116700015B (en) * | 2023-07-28 | 2023-10-31 | 中国科学院自动化研究所 | Active stability augmentation control method and device for underwater vehicle |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE19712257A1 (en) * | 1997-03-24 | 1998-10-01 | Rudolph Stephan Dr Ing | Diving device and method for its manufacture |
| CN102962843A (en) * | 2012-12-03 | 2013-03-13 | 中国科学院自动化研究所 | Porpoising robotic dolphin |
| CN104627342A (en) * | 2014-12-08 | 2015-05-20 | 中国科学院自动化研究所 | Gliding machine dolphin |
| CN104881045A (en) * | 2015-06-17 | 2015-09-02 | 中国科学院自动化研究所 | Bionic robot fish three-dimensional tracking method based on embedded visual guidance |
| CN109018271A (en) * | 2018-06-27 | 2018-12-18 | 哈尔滨工程大学 | A kind of novel big span combination drive UAV navigation |
Family Cites Families (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US6814634B2 (en) * | 2003-01-30 | 2004-11-09 | Seagoon Boat Building | Self-propelled aquatic toy |
| CN100519331C (en) * | 2005-04-12 | 2009-07-29 | 北京大学 | Intelligent robot dolphin |
| CN101315563A (en) * | 2007-05-31 | 2008-12-03 | 中国科学院自动化研究所 | Bionic machine fish depth control method based on mass centre changing |
| CN100589055C (en) * | 2008-04-08 | 2010-02-10 | 哈尔滨工程大学 | Control method for changing structure of underwater hiding-machine space based on recursion fuzzy neural network |
| CN101916071B (en) * | 2010-08-04 | 2012-05-02 | 中国科学院自动化研究所 | CPG feedback control method of biomimetic robot fish movement |
| KR101278708B1 (en) * | 2011-05-18 | 2013-06-25 | 부산대학교 산학협력단 | Underwater robot and Method for controlling the same |
| CN104554681B (en) * | 2014-12-30 | 2017-02-22 | 中国科学院自动化研究所 | Method and device for controlling movement of mechanical dolphin |
| CN105676867B (en) * | 2016-04-21 | 2019-02-22 | 南京工程学院 | A kind of ROV underwater robot suspension pose stabilization control method |
| CN110758698B (en) * | 2019-11-28 | 2020-10-02 | 中国科学院自动化研究所 | Method, system and device for controlling gliding depth of bionic gliding dolphin |
-
2019
- 2019-11-28 CN CN201911189693.2A patent/CN110758698B/en active Active
-
2020
- 2020-04-16 WO PCT/CN2020/085043 patent/WO2021103391A1/en active Application Filing
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE19712257A1 (en) * | 1997-03-24 | 1998-10-01 | Rudolph Stephan Dr Ing | Diving device and method for its manufacture |
| CN102962843A (en) * | 2012-12-03 | 2013-03-13 | 中国科学院自动化研究所 | Porpoising robotic dolphin |
| CN104627342A (en) * | 2014-12-08 | 2015-05-20 | 中国科学院自动化研究所 | Gliding machine dolphin |
| CN104881045A (en) * | 2015-06-17 | 2015-09-02 | 中国科学院自动化研究所 | Bionic robot fish three-dimensional tracking method based on embedded visual guidance |
| CN109018271A (en) * | 2018-06-27 | 2018-12-18 | 哈尔滨工程大学 | A kind of novel big span combination drive UAV navigation |
Non-Patent Citations (1)
| Title |
|---|
| 胸鳍推进型机器鱼的CPG控制及实现;汪明等;《机器人》;20100330;第32卷(第二期);全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110758698A (en) | 2020-02-07 |
| WO2021103391A1 (en) | 2021-06-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110758698B (en) | Method, system and device for controlling gliding depth of bionic gliding dolphin | |
| US10935986B1 (en) | Gliding depth control method, system and device for biomimetic gliding robotic dolphin | |
| CN107168312B (en) | Space trajectory tracking control method for compensating UUV kinematic and dynamic interference | |
| Suebsaiprom et al. | Maneuverability modeling and trajectory tracking for fish robot | |
| CN104589349B (en) | With the autonomous control method of assembly of simple joint mechanical arm under a kind of mix suspending microgravity environment | |
| Xue et al. | Coordinate control, motion optimization and sea experiment of a fleet of Petrel-II gliders | |
| Zhang et al. | Reaction-wheel-based roll stabilization for a robotic fish using neural network sliding mode control | |
| Wang et al. | Model predictive control-based depth control in gliding motion of a gliding robotic dolphin | |
| CN114115262B (en) | Multi-AUV actuator saturation cooperative formation control system and method based on azimuth information | |
| CN114428517B (en) | End-to-end autonomous landing control method for unmanned plane and unmanned ship cooperative platform | |
| Wu et al. | Gliding motion regulation of a robotic dolphin based on a controllable fluke | |
| CN114967714A (en) | Anti-interference motion control method and system for autonomous underwater robot | |
| CN114545935A (en) | Fuzzy PID (proportion integration differentiation) dynamic positioning cable laying ship tracking control method based on improved sparrow algorithm | |
| Yan et al. | Towards unusual rolled swimming motion of a bioinspired robotic hammerhead shark under negative buoyancy | |
| Binugroho et al. | EROV: depth and balance control for rov motion using fuzzy pid method | |
| Yu et al. | Adaptive station-keeping strategy for wave gliders considering uncertain environmental disturbances | |
| Song et al. | Using an active disturbance rejection decoupling control algorithm to improve operational performance for underwater glider applications | |
| Antervedi et al. | Terrain-relative diver following with autonomous underwater vehicle for coral reef mapping | |
| CN117250971B (en) | Control method of microminiature AUV | |
| CN113110512A (en) | Benthonic AUV self-adaptive trajectory tracking control method for weakening unknown interference and buffeting influence | |
| CN108227723A (en) | A kind of underwater robot and its application process of stability analysis and structure optimization | |
| CN114545953B (en) | Bionic fish path control method and device and bionic fish | |
| Naser et al. | Labriform swimming robot with steering and diving capabilities | |
| CN112904719B (en) | Annular area tracking control method suitable for underwater robot position | |
| CN112506052B (en) | Control method for resisting rotational interference of holder of underwater archaeological robot |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |