WO2022100557A1 - Underwater turtle-like robot and control method thereof - Google Patents

Underwater turtle-like robot and control method thereof Download PDF

Info

Publication number
WO2022100557A1
WO2022100557A1 PCT/CN2021/129418 CN2021129418W WO2022100557A1 WO 2022100557 A1 WO2022100557 A1 WO 2022100557A1 CN 2021129418 W CN2021129418 W CN 2021129418W WO 2022100557 A1 WO2022100557 A1 WO 2022100557A1
Authority
WO
WIPO (PCT)
Prior art keywords
turtle
shell
forelimb
cabin
steering gear
Prior art date
Application number
PCT/CN2021/129418
Other languages
French (fr)
Chinese (zh)
Inventor
张建
狄陈阳
李永胜
李泓运
连雪海
赵坦
唐文献
李凯
Original Assignee
江苏科技大学
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 江苏科技大学 filed Critical 江苏科技大学
Publication of WO2022100557A1 publication Critical patent/WO2022100557A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63CLAUNCHING, 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/00Equipment for dwelling or working underwater; Means for searching for underwater objects
    • B63C11/52Tools specially adapted for working underwater, not otherwise provided for

Definitions

  • the invention relates to the field of bionic robot design and control, in particular to an underwater detection bionic turtle robot and a control method thereof.
  • An underwater robot is a mechatronic intelligent device that can move underwater, has a perception system, and uses manipulators or other tools to replace or assist people to complete underwater tasks through remote control or autonomous operation.
  • Underwater robot is one of the indispensable tools for human beings to understand the ocean and develop the ocean. It is also a necessary high-tech means to build a strong ocean country and achieve sustainable development.
  • underwater bionic robots Compared with traditional underwater robots, underwater bionic robots have the advantages of low resistance, high efficiency, high maneuverability and high environmental adaptability. It can complete various tasks in a small and complex environment, and can be used in military, detection and other fields.
  • the existing underwater bionic turtle robots have the following shortcomings:
  • the thickness of the shell of the turtle body is the same thickness, which leads to excess safety margin, waste of unnecessary raw materials, and high cost.
  • the shape and structure are simple, and the streamline shape of the actual turtle shell is greatly different, the water resistance is large, and the power consumption is high;
  • the O-ring seal cannot effectively solve the problem of dynamic sealing in practical application.
  • the mechanical seal has the defects of complex structure and difficult assembly, which is not suitable for the robot structure that needs to be disassembled frequently;
  • the present invention designs the upper shell of the underwater turtle imitation robot with equal strength and thickening, which solves the problem of unnecessary waste of materials; the design of detachable protective fence solves the problem of shell pressure resistance after the turtle body accidentally hits The problem of insufficient performance; by setting up a safe retraction cabin, the problem that the robot cannot be retracted in emergencies is solved; the shell shape that satisfies the elliptical sphere and the spherical equation, and the shape of the forelimb and limb section of the turtle that satisfies the involute equation are designed to solve the problem.
  • CSIC Global System for Mobile Communications
  • CN202010441804.0 It includes an upper protective cover and a lower protective cover, the ends of which are close to each other are provided with fixed waist rings, the upper protective cover is also provided with iron chains, and a second sleeve is arranged at the center of the top surface of the blocking cover, which is insufficient.
  • the disadvantage is that the structure is complex and heavy. If it is installed on an underwater robot, it will generate large water resistance, the protection range cannot be adjusted, and the flexibility is poor.
  • Our invention fully takes into account the following points: 1.
  • the guardrail Underwater environmental conditions, the guardrail can be installed and removed and the protection range of the guardrail can be adjusted; 2. Flexibility, the whole is divided into two quarter circles, each circle The rings can be adjusted independently; 3. The size of the water resistance, the section of the guardrail is designed to be oval and streamline-like.
  • the present invention proposes an underwater bionic turtle robot and a control method thereof, which have the effects of buffering impact, reducing energy consumption for underwater motion, and facilitating recovery.
  • An underwater bionic turtle robot comprising a bionic turtle upper shell, a bionic turtle lower shell, turtle limbs, a sealing structure, and a driving device arranged inside the turtle shell for driving the action of the turtle limbs;
  • the upper shell of the bionic turtle and the lower shell of the bionic turtle are separated by silicone rubber for static sealing and connected with screws;
  • the four limbs of the turtle are divided into forelimbs and hindlimbs, and the transmission shaft of the hindlimb protrudes from the shaft section of the tortoise shell and between the lower shell of the bionic tortoise, and between the shaft section of the forelimb bevel gear shaft protruding from the tortoise shell and the lower shell of the bionic tortoise.
  • a pressure sensor is installed on the top of the underwater turtle-like robot, and its real-time depth is judged by the magnitude of the pressure; a temperature and humidity sensor is installed inside the underwater turtle-like robot to detect the internal sealing of the turtle body. If water enters, it will immediately alarm; A gyroscope is set on the turtle shell to adjust the posture of the turtle body; a camera is installed on the head of the underwater turtle imitation robot for observation, and the upper shell of the bionic turtle is composed of an ellipsoidal shell part and a spherical shell part,
  • the shell thickness of the ellipsoid shell portion is obtained by the following formula:
  • p is the external pressure on the shell
  • ⁇ s is the yield stress of the material
  • a is the radius of the major axis of the ellipsoid
  • is the ellipticity
  • t is the thickness of the shell
  • x and y are the Cartesian coordinate system
  • the shell thickness of the spherical shell portion is obtained by the following formula:
  • R is the radius of the spherical shell.
  • the guardrail mechanism includes two groups, which are symmetrically arranged on the left and right sides of the turtle shell. Each group of guardrail mechanisms includes:
  • the guardrail has a quarter ring structure, one end of the inner side of the guardrail is connected to the turtle shell through a buffer mechanism, and the other end of the inner side of the guardrail is connected to the turtle shell through an adjustment mechanism;
  • the buffer mechanism includes a cylindrical shock absorbing cavity, a connecting rod and a spring, wherein the spring is arranged in the cylindrical shock absorbing cavity, and one end of the cylindrical shock absorbing cavity is provided with a rod hole;
  • the inner side of the guardrail is provided with a chute, one end of the connecting rod is provided with a first chute contact matched with the chute, and the other end of the connecting rod extends into the cylindrical shock absorbing cavity through the rod hole;
  • the middle part of the connecting rod is provided with a shaft shoulder, and the shaft shoulder divides the part of the connecting rod located in the cavity of the shock absorber into a first connecting rod segment and a second connecting rod segment, the first connecting rod segment and the The second connecting rod segments are respectively sleeved with one of the springs;
  • the outer side of the bottom of the cylindrical shock-absorbing cavity is rotatably connected with the turtle shell through a hinge;
  • the adjustment mechanism includes an adjustment box, the adjustment box is arranged on the tortoise shell, a first threaded rod and a first transmission shaft are arranged in parallel in the first adjustment box, and the first threaded rod and the first transmission shaft pass through. Transmission connection of gear transmission group;
  • the outer end of the first transmission shaft extends out of the adjustment box and is connected with an adjustment handle. Under the adjustment of the adjustment handle, the first threaded rod can move back and forth in the horizontal direction to adjust the protection range of the guardrail;
  • the outer end of the first threaded rod is slidably connected to the guardrail through the second sliding groove contact, and a restriction block is provided on the inner end of the first threaded rod.
  • the cross-section of the guardrail is oval and streamline-like.
  • the forelimb is driven by a steering gear combined with a software drive to achieve dual-degree-of-freedom motion: one is the steering gear drive: the forelimb is driven by the forelimb steering gear to drive the forelimb to rotate through the forelimb bevel gear set; the second is the polypyrrole strip drive: the two sides of the forelimb Symmetrically covered with a plurality of polypyrrole strips, which are connected to the lower electrode plate of the clip, followed by wires and connected to the software drive control module through the center hole of the bevel gear shaft of the front limb, and the polypyrrole strips are controlled by the software control module. Drive the forelimbs to swing up and down;
  • the driving device of the rear limb includes a rear limb steering gear, a steering gear disc, a bearing seat, a connecting shaft, a small elastic belt and a rear limb transmission shaft, wherein the rear limb steering gear, the steering gear disc and the steering gear sleeve are connected by screws. , the connecting shaft and the steering gear sleeve are connected by screws; the small elastic belt transmits the power to the rear limb transmission shaft, and drives the rear limb to make a rotating motion.
  • Balance wings are provided on both sides of the lower shell of the bionic turtle to assist in maintaining balance.
  • a safety retraction pod connected to the turtle shell by a tow line, including:
  • a cabin the cabin is provided with a partition, the partition divides the cabin into an upper cabin and a lower cabin, the upper cabin is provided with a hatch cover that can be opened or closed, and the upper cabin is provided with a compression Airbag, the bottom of the compressed airbag is connected with the hook ear fixed in the inner cavity of the upper cabin through the lead wire;
  • the lower cabin is a sealed cabin, and the lower cabin is provided with a hatch cover opening mechanism.
  • the hatch cover opening mechanism includes: a second transmission shaft and a second threaded rod arranged in parallel, and the second transmission shaft and the second threaded rod pass through gear drive connection
  • the servo motor is drivingly connected with the second transmission shaft, and the part of the second threaded rod in the hatch opening mechanism penetrates the baffle and protrudes into the upper cabin. Driven by the servo motor, the second threaded rod can move in the up and down direction inside the cabin to open the hatch cover of the cabin;
  • the lower cabin is also provided with a transverse plate and a pressure bottom plate, the transverse plate and the pressure bottom plate are connected by bolts, and the pressure plate and the transverse plate are both provided with card slots for fixing the second transmission shaft and the gear transmission. Group;
  • the cabin is also provided with a signal receiving device for receiving external signals
  • a controller the input end of which is connected to the signal receiving device, and the output end of which is connected to the servo motor;
  • a power supply which supplies power to the servo motor, the signal receiving device and the controller
  • the first is between the upper cabin and the lower cabin, which is a static seal and is sealed with a silicone gasket;
  • the second place is between the bulkhead and the upper cabin pillar in the upper cabin, which is a static seal and is sealed with a silicone gasket;
  • the third place is between the second threaded rod and the upper cabin strut in the upper cabin. It is a dynamic seal. It is sealed by a transparent elastic film. on the upper hull strut.
  • the tortoise's limbs are formed by two involutes that intersect at the tips of the limbs.
  • their equations are:
  • C 1 is the value range of the angle u1, the range is 240° ⁇ 270°, C 2 is the value range of the angle u2, the range is 210° ⁇ 265°;
  • u′ i ⁇ ′ i + ⁇ ′ i
  • ⁇ ′ i the expansion angle
  • ⁇ ′ i the pressure angle
  • r′ i the radius of the base circle
  • C′ 1 is the value range of the angle u′ 1
  • the range is 210° ⁇ 226°
  • C' 2 is the value range of the angle u' 2
  • the range is 210° ⁇ 221°;
  • the hindlimbs are thin around the edges, with a gradual increase in cross-sectional thickness from the edge to the center.
  • the shell of the turtle-like robot is streamlined.
  • a working method based on the underwater bionic turtle robot comprising the following steps:
  • Step 1 Check, deploy and dive
  • the dive is completed by the cooperation of the forelimb and the hindlimb.
  • the details are as follows: after the hindlimb servo is instructed, the left servo of the hindlimb rotates 90° clockwise, while the right servo of the hindlimb rotates 90° counterclockwise, so that both hindlimbs are equally Keep vertical and upward, and swing back and forth for a total of 60° at this center position, drive the connecting shaft through the steering gear sleeve, and drive the rear limb drive shaft to rotate by the small elastic belt.
  • the left forelimb servo rotates 30° clockwise, and the right forelimb servo rotates 30° counterclockwise, and the motion is transmitted to the forelimb bevel gear set.
  • the forelimbs are lifted, so that the front ends of the forelimbs on both sides rise.
  • the steering gear of the forelimbs stops rotating, and then the software control module applies a reverse voltage to the polypyrrole strips, so that the hind limbs flap backwards and upwards, so that the reaction force of the water pushes the turtle body move forward and downward;
  • the software control module applies a reverse voltage to the polypyrrole strip to make it flap forward and upward, so that the reaction force of the water pushes the turtle body to move backward and downward, and then it is repeatedly turned on in this order to complete the diving movement;
  • the propulsion is accomplished by the mutual cooperation of the forelimb and the hindlimb.
  • the details are as follows: after the servo of the hindlimb is commanded, it rotates back and forth for a total of 60°, the connecting shaft is driven by the steering gear sleeve, and the drive shaft of the hindlimb is driven by the small elastic belt to rotate, and the hindlimb is erected. Swing back and forth for a total of 60°, obtain forward thrust, and keep the movement during the whole process.
  • the forelimbs are all driven by the polypyrrole strips, and the polypyrrole strips are applied with a positive voltage and bend downward, that is, flap down, with appropriate intervals Time, and then apply a negative voltage to make the polypyrrole strips bend upwards, that is, flap upwards.
  • This cycle completes the propulsion movement.
  • the swing frequency of the forelimb and the hindlimb should be kept the same, so as to maintain balance;
  • Option 1 Realized by the hind limbs, the forelimbs swing up and down a total of 60° to maintain balance, one of the two hind limb servos remains stationary, the other hind limb servo drives the connecting shaft through the steering gear sleeve, and then the small elastic belt drives the hind limbs
  • the drive shaft rotates to realize the vertical reciprocating swing of the hind limbs for a total of 60°, obtain forward thrust, and keep the movement during the whole process;
  • Option 2 Realized by the forelimb, the hind limb swings up and down to maintain a balance and provide a certain thrust, one of the two forelimbs remains motionless, and the other moves as follows: after the forelimb servo is commanded, the left forelimb servo rotates 90° clockwise, The steering gear on the right side of the forelimb is rotated 90° counterclockwise, so that the forelimbs on both sides are vertical. At this time, the steering gear of the forelimb stops rotating immediately, and then applies a reverse voltage to the polypyrrole strip and flaps it to the rear side, so that the reaction force of the water is caused by the water. Push the turtle body to turn;
  • Step 4 Float
  • the uplift is mainly accomplished by the hind limbs.
  • the forelimbs swing up and down a total of 60° to maintain balance.
  • the movement of the hind limbs is as follows: After the hind limb servo is commanded, the left servo of the hind limb rotates 90° counterclockwise, while the right servo of the hind limb rotates clockwise. Rotate 90 degrees, keep both hind limbs vertically downward, and rotate back and forth for a total of 60° with this as the center position, drive the connecting shaft through the steering gear sleeve, and drive the hind limb drive shaft to rotate by the small elastic belt, and complete the horizontal reciprocation of the hind limbs downward. Swing a total of 60°, get upward thrust, and maintain motion throughout the process;
  • Step 5 Take Back
  • the steering gear of the hind limb drives the connecting shaft through the steering gear sleeve, and then the drive shaft of the hind limb is driven to rotate by the small elastic belt, so as to realize the vertical reciprocating swing of the hind limb for a total of 60°, obtain the forward thrust, row to the shore, and complete the recovery. Also, throughout the process, .
  • the safe retraction is carried out by controlling the safe retraction cabin, specifically:
  • the operator sends an ascending command to the safe retraction cabin, so that the servo motor in the cabin rotates, the hatch cover is opened through the hatch cover opening mechanism, the compressed air bag is released, and the imitation turtle robot is driven to float up.
  • the present invention adopts the equal-strength thickening design of the upper shell of the underwater turtle imitation robot to prevent serious excess of safety margins, reduce the use of shell materials, reduce costs, and maintain good compression and impact resistance at the same time. ability.
  • the upper shell of the underwater turtle-like robot largely imitates the shape of the turtle, which satisfies the elliptical spherical and spherical equations.
  • the shell of the turtle-like robot is streamlined. The water resistance is greatly reduced, and the motion energy consumption of the underwater turtle imitation robot is reduced.
  • the dynamic seal adopts silicone rubber elastic film, which can elastically deform with the small reciprocating rotation of the shaft, which has the advantages of low cost, simple structure and reliable sealing.
  • the forelimb of the present invention is driven by a steering gear combined with polypyrrole (PPy), which simplifies the mechanical structure, reduces wear, and effectively simulates the actual movement of the turtle.
  • the main driving force is provided by the rear limb steering gear, which can quickly realize the three functions of ascending, descending and propulsion, reducing the ascending and descending time and improving work efficiency.
  • 1 is a three-dimensional model diagram of an underwater turtle imitation robot of the present invention
  • FIG. 2 is a schematic diagram of the internal structure of the underwater turtle imitation robot of the present invention.
  • FIG. 3 is a schematic diagram of the hindlimb structure of the underwater turtle imitation robot of the present invention.
  • FIG. 4 is a schematic diagram of the forelimb structure of the underwater turtle imitation robot of the present invention.
  • FIG. 5 is a schematic structural diagram of an underwater turtle imitation robot guardrail device of the present invention.
  • FIG. 6 is a schematic diagram of the buffer mechanism of the underwater turtle imitation robot of the present invention.
  • FIG. 7 is a schematic diagram of an underwater turtle imitation robot guardrail adjustment mechanism of the present invention.
  • FIG. 8 is a schematic diagram of the connection between the contact of the chute and the chute of the underwater turtle imitation robot of the present invention.
  • FIG. 9 is a schematic structural diagram of the safe retraction cabin of the underwater turtle imitation robot of the present invention.
  • FIG. 10 is a schematic diagram of the upper shell of the underwater turtle imitation robot of the present invention.
  • FIG. 11 is a schematic cross-sectional view of the forelimb of the underwater turtle imitation robot of the present invention.
  • Fig. 12 is the control flow chart of the underwater turtle imitation robot of the present invention.
  • Fig. 13 is the signal transmission processing block diagram of the main controller of the underwater turtle imitation robot of the present invention.
  • Fig. 14 is the control schematic diagram of the safe recovery cabin of the underwater imitation turtle robot of the present invention.
  • Fig. 15 is a control flow chart of the safe retraction cabin of the underwater turtle imitation robot of the present invention.
  • the structure of the underwater bionic turtle robot consists of a turtle shell, limbs, driving devices, safety retraction cabins, guardrail devices and sensors.
  • the turtle shell is composed of a bionic turtle upper shell 65 , a bionic turtle lower shell 23 , a bionic turtle head 24 and a balance wing 20 .
  • the silicone rubber is used for static sealing and connected with screws, and the balance wings 20 are used to assist in maintaining balance, making it difficult for the turtle body to tilt.
  • the limb structure is divided into forelimb structure and hind limb structure.
  • the forelimb structure includes forelimb 21, clip 14, polypyrrole strip 22, electrode pad, and lead wire, wherein the forelimb 21 is clamped by clip 14, and more
  • the polypyrrole strips 22 are symmetrically attached to both sides of the forelimb 21 and are connected to the lower electrode plate of the clip, followed by wires and connected to the software drive control module through the central hole of the forelimb bevel gear shaft 15;
  • the hindlimb structure includes hindlimb 1, hindlimb drive shaft 10, wherein the hind limb 1 is connected with the hind limb transmission shaft 10 through the connecting screw 2.
  • the driving device is divided into a forelimb driving device and a hind limb driving device.
  • the fore limb driving device includes a fore limb steering gear 18 , a steering gear disc 5 , a steering gear sleeve 17 , a bearing seat 7 , a bevel gear shaft 16 , and a fore limb bevel gear shaft 15 .
  • the fore limb steering gear 18, the steering gear disc 5 and the steering gear sleeve 17 are connected by screws, the rear end of the bevel gear shaft 16 is connected with the steering gear sleeve 17, and the power is transmitted to the forelimb bevel gear shaft 15 through the bevel gear meshing Forelimbs 21.
  • the forelimb is driven by a steering gear combined with a software drive to achieve double-degree-of-freedom motion: one is the steering gear drive: the forelimb steering gear 18 provides power through the bevel gear shaft 16, and then the forelimb bevel gear shaft 15 drives the foreleg 21 to rotate; Pyrrole strip (PPy) drive: The polypyrrole strip (PPy) 22 is controlled by the software control module to drive the limbs to swing up and down.
  • the rear limb driving device includes a rear limb steering gear 3, a steering gear disc 5, a bearing seat 7, a connecting shaft 8, a small elastic belt 9, and a rear limb transmission shaft 10.
  • the rear limb steering gear 3, the steering gear disc 5, and the steering gear sleeve 17 are connected by screws, and the set screw connects the connecting shaft 8 and the steering gear sleeve 17, and the small elastic belt 9 transmits the power to the rear limb transmission shaft 10 to drive Hind limb 1 makes a rotational movement.
  • the hind limbs mainly rotate in three directions, lateral upward swing, lateral downward swing, and vertical swing.
  • the steering gear fixing block 4 fixes the steering gear and the turtle body.
  • the guardrail device is composed of guardrail 25 , limiting block 27 , turntable 28 , adjusting mechanism 29 , slot cover 30 , bolt 31 , buffer mechanism 32 , rotating block 33 , and rotating sleeve 34 . Since the rotating block 33 , the rotating sleeve 34 and the turntable 28 form a rotating pair, the buffer mechanism and the lower buffer mechanism in FIG. 5 can both rotate freely.
  • the buffer mechanism 32 is composed of a chute contact 35 , a connecting rod 36 , a spring 39 and a fixing washer 40 , wherein the shock absorber 38 and the shock absorber cover 37 are connected by threads, and the chute contact 35 is connected to the
  • the connecting rod 36 is connected by a wedge block, and springs 39 are installed on both sides of the shaft shoulder of the connecting rod 36 , which are fixed in the shock absorbing body 38 through the fixing gasket 40 .
  • the adjustment mechanism 29 consists of a pressure plate 45 , a handle 41 , a first transmission shaft 42 , a first gear 44 , a second gear 46 , a first threaded rod 49 , a small end cap 43 , a large end cap 48 and a bearing 47
  • the first transmission shaft 42 is fixed in the adjustment box by the bearing 47 and the end caps, the handle 41 and the first transmission shaft 42 are connected by a wedge block, and the second gear 46 and the first threaded rod 49 are connected by a thread. Twisting the handle 41 makes the first transmission shaft 42 rotate, which drives the gear 44 to rotate, and drives the second gear 46 to rotate through meshing.
  • the restriction block 27 restricts the degree of freedom of its rotational direction, so the first threaded rod 49 can only move in the axial direction, and is connected with the chute on the guard rail through the chute contact 35 to drive the guard rail 25 to move, so that the Rotate the handle 41 to adjust the protection range of the guardrail 25 .
  • the side spring is compressed; if it is subjected to the C-direction impact force, after the buffer mechanism rotates clockwise, under tension, the right spring is stretched, the left spring is compressed, the lower buffer mechanism is under pressure, the right spring is compressed, and the left spring is stretched . It can be seen that, no matter which direction the guardrail is subjected to the impact force, the guardrail device can effectively play the role of buffering and shock absorption.
  • the function of the guardrail device is:
  • the protection range of the guardrail 25 is controlled by adjusting the valve 41, a small protection radius is selected in the narrow water area, and a large protection radius is selected in the open water area, which has extremely high flexibility.
  • each ring can be adjusted independently, which is convenient to adapt to the complex environment. If it is made as a whole, its flexibility will be reduced.
  • the cross-section of the guardrail is oval and streamlined, which can reduce the water resistance of the underwater turtle-like robot when it moves and reduce the energy consumption of the movement.
  • the safe retraction compartment includes a servo motor 50, a motor sleeve 51, a second transmission shaft 52, a fourth gear 53, a pressing bottom plate 54, a partition plate 55, a rubber gasket 56, an upper cabin body 57, a second Threaded rod 58, hatch cover 59, small spring 61, hook lug 62, lower cabin 63, ring lug 64;
  • the motion is transmitted to the fourth gear 53, and then the thread of the inner diameter of the fourth gear 53 is screwed with the thread of the second threaded rod 58, and the rotary motion is converted into the linear motion of the second threaded rod 58, and then the second threaded rod 58 Open the hatch cover 59, release the compressed air bag in the upper cabin body 57, the compressed air bag is connected with the hook ear 62 through the lead wire, and the buoyancy of the compressed air bag drives the safe retraction cabin to float up, because the safe retraction cabin is connected with the bionic turtle shell
  • the partition plate 55 is used to separate the upper cabin 57 and the lower cabin 63, and cooperate with other components to complete the sealing to prevent water from entering the lower cabin 63; Both the bottom plate 54 and the horizontal plate are provided with card slots for fixing the second transmission shaft 52 , the third gear and the fourth gear 53 .
  • seals in the cabin there are three seals in the cabin, one is between the upper and lower cabins, which is a static seal, which is sealed with a silicone gasket; the other is between the partition 55 and the upper cabin pillar in the upper cabin 57, which is a static seal and is sealed with silicone Gasket sealing; the third is the dynamic seal between the second threaded rod 58 and the upper cabin body pillar in the upper cabin body 57, which is sealed by a transparent elastic film, and one end of the second threaded rod 58 exposed to the upper cabin body pillar part is completely wrapped , and the other end is glued to the upper cabin strut.
  • the function of the safety retraction cabin the lower cabin 63 has an independent signal receiving device, power supply, and controller.
  • the operator can issue a floating command to the safety retraction cabin to make the servo motor in the cabin rotate.
  • a turtle-like robot floats up. It has the characteristics of small size, and has little effect on the water resistance of the turtle body.
  • this device can make the imitation turtle robot float on the water surface, recover and maintain it safely, and avoid abandoning it at the bottom of the water. Save costs, and at the same time facilitate the analysis of the cause of the accident and further improvement.
  • the shell of the underwater turtle imitation robot largely imitates the shape of the turtle.
  • the upper shell satisfies the elliptical spherical and spherical equations (as shown in Figure 1).
  • the equation is:
  • the analysis shows that the parameter It is related to the water resistance of the underwater turtle-like robot when it moves in water.
  • the structure is better and the water resistance is small, here we take
  • the underwater turtle-like robot has a flat structure and a streamline shape, which greatly reduces the water resistance and reduces the motion energy consumption of the underwater turtle-like robot. and intersect at the limb tips, their parametric equations are:
  • the thickness of the hind limb is composed of an arc and two tangents.
  • the surrounding edges are thinner. From the edge to the center, the thickness of the cross section gradually increases Increase, the above features take full advantage of the water's reaction force, so that the limbs get the maximum thrust.
  • the specific geometric parameters are selected as follows:
  • Equal-strength thickening design Through the equal-strength thickening design of the upper shell of the underwater turtle imitation robot, the safety margin is prevented from being seriously excessive, the use of shell materials is reduced, and the cost is reduced, while maintaining good compressive and Shock resistance.
  • the upper case is made of
  • the equivalent stress of each point is required to be less than the yield stress of the material. According to the relevant references, the equivalent stress formula of the equal-strength ellipsoid shell can be expressed as:
  • p is the external pressure on the shell
  • ⁇ s is the yield stress of the material
  • t is the thickness of the shell.
  • the thickness of the equal-strength ellipsoid shell is:
  • the first and second curvature radii of the spherical shell are:
  • R is the radius of the spherical shell.
  • the polypyrrole strip (PPy) has the characteristic of bending in the direction of the negative electrode.
  • the software controller applies a forward voltage to the polypyrrole strip through the electrode sheet, the polypyrrole strip (PPy) will bend in the negative direction to achieve the purpose of bending downward, thereby driving the forelimb 1 to bend downward; after changing the voltage direction, the polypyrrole strip (PPy) will bend downward.
  • the pyrrole strip (PPy) changes the bending direction to achieve the purpose of upward bending, thereby driving the forelimb 1 to bend upward.
  • Limb movement in the initial state, the forelimbs and hind limbs are kept horizontal, and the forelimbs have two movements, which are the rotational movement achieved by the steering gear and the up and down swing achieved by the energized bending of polypyrrole strips (PPy); the hind limbs are only rotated by the steering gear. Movement, a total of three directions of rotation: horizontal swing up, horizontal swing down, vertical swing.
  • the invention divides the seal into static seal and dynamic seal, the static seal adopts rubber gasket to seal, and the dynamic seal adopts silicone rubber elastic membrane. It is fixed at one shaft segment that protrudes from the outside, and the other end is glued to the end cover. The end cover is fixed with the lower shell of the bionic turtle through screws, so that when the hindlimb drive shaft and the forelimb bevel gear shaft move, the elastic film can be driven with the hindlimb.
  • the small reciprocating rotation of the shaft and the forelimb bevel gear shaft causes elastic deformation, and at the same time plays a sealing role. This is similar to the rotation of bones driven by human muscles, and the elastic skin can follow it to make small rotations, which has the advantages of low cost, simple structure and reliable sealing.
  • a pressure sensor is installed on the top of the underwater turtle imitation robot, and its real-time depth is judged by the magnitude of the pressure; a temperature and humidity sensor is added to detect the internal sealing of the turtle body, and an alarm will be issued immediately if water enters; a gyroscope is added to adjust the turtle body posture; a camera is installed on the head of the underwater turtle-like robot for observation.
  • the invention provides a control method for an underwater turtle imitation robot, comprising the following steps:
  • Step 1 Check, deploy and dive
  • the main content is whether the limbs move normally, whether the seal is intact, whether the sensor is working normally, whether the power is sufficient, etc. Choose a suitable water area and gently put the underwater turtle robot into the water.
  • the dive is completed by the mutual cooperation of the forelimb and the hindlimb.
  • the details are as follows: after the hindlimb servo 3 is commanded, the left servo of the hindlimb rotates 90° clockwise, while the right servo of the hindlimb rotates 90° counterclockwise, so that the hindlimbs on both sides are rotated 90° counterclockwise. They are all kept vertically upward, and oscillate reciprocatingly for a total of 60° with this as the center position.
  • the connecting shaft 8 is driven by the steering gear sleeve 17, and the rear limb drive shaft 10 is driven by the small elastic belt 9 to rotate, and the rear limb 1 is oscillated horizontally upward for a total of 60°, a downward thrust is obtained, and the motion is maintained throughout.
  • the left steering gear of the forelimb rotates 30° clockwise, and the right steering gear of the forelimb rotates 30° counterclockwise, and the motion is transmitted to the forelimb bevel gear shaft 15 through the bevel gear shaft 16, so that the The front ends of the forelimbs 21 on both sides rise.
  • the forelimb steering gear 18 stops rotating, and then the software control module applies a reverse voltage to the polypyrrole strip (PPy) 22 to make the hind limbs flap backward and upward, so that the reaction force of the water pushes the turtle body to move forward and downward.
  • Py polypyrrole strip
  • the forelimb steering gear 18 will receive a reverse rotation motion command, and rotate counterclockwise twice the first rotation angle, that is, 60°, so that the rear end of the forelimb 21 rises , the forelimb steering gear 18 is stopped, and the software control module applies a reverse voltage to the polypyrrole strip (PPy) 22 to make it flap forward and upward, so that the reaction force of the water pushes the turtle body to move backward and downward. After that, it is repeatedly connected in this order to complete the dive.
  • the propulsion is accomplished by the mutual cooperation of the forelimb and the hindlimb.
  • the details are as follows: after the hindlimb steering gear 3 is instructed, it rotates back and forth for a total of 60°, the connecting shaft is driven by the steering gear sleeve 17, and the hindlimb drive shaft 10 is driven by the small elastic belt 9 to rotate, After completing the vertical reciprocating swing of hind limb 1 for a total of 60°, the forward thrust is obtained, and the movement is maintained throughout the process.
  • the forelimbs are all driven by the polypyrrole strip (PPy) 22, and the polypyrrole strip (PPy) 2 is applied with a positive voltage and bends downwards, that is, flaps down, at a suitable time interval, and then applies a negative voltage to make the polypyrrole stripe (PPy) 22.
  • (PPy) 22 bends upwards, ie flaps upwards. This cycle completes the propulsion movement.
  • the swing frequency of the forelimbs and hindlimbs should be kept the same, so as to maintain balance.
  • Option 1 Realized by the hind limbs, the fore limbs 21 swing up and down a total of 60° to maintain balance.
  • the two rear limb steering gears one remains stationary, the other steering gear drives the connecting shaft through the steering gear sleeve, and then the small elastic belt 9 drives the rear limb transmission shaft 10 to rotate, so that the rear limb 1 can swing vertically back and forth for a total of 60°, and obtain Forward thrust, and motion is maintained throughout.
  • Option 2 It is realized by the front limbs, and the hind limbs swing up and down to maintain balance and provide a certain thrust. Of the two forelimbs, one remains motionless, and the other moves as follows: after the forelimb steering gear is commanded, the left forelimb servo rotates 90° clockwise, and the right forelimb servo rotates 90° counterclockwise to make the forelimb upright. At this time, the forelimb steering gear immediately stopped rotating, and then applied a reverse voltage to the polypyrrole strip (PPy) 22 and flapped it backward, so that the reaction force of the water pushed the turtle body to turn.
  • Py polypyrrole strip
  • Step 4 Float
  • Lifting is mainly done by the hind limbs, and the forelimbs swing up and down a total of 60° to maintain balance.
  • the movement of the hind limb is as follows: After the rear limb servo 3 is instructed, the left servo of the hind limb rotates 90° counterclockwise, while the right servo of the hind limb rotates 90 clockwise, and the center position is reciprocated for a total of 60°.
  • the cylinder 17 drives the connecting shaft 8, and the small elastic belt 9 drives the hindlimb drive shaft 5 to rotate, and the hindlimb oscillates horizontally downward for a total of 60° to obtain an upward thrust, and the motion is maintained throughout the process.
  • Step 5 Take Back
  • the rear limb steering gear 3 drives the connecting shaft 8 through the steering gear sleeve 17, and then drives the rear limb transmission shaft 10 to rotate by the small elastic belt 9, so as to realize the vertical reciprocating swing of the rear limb for a total of 60°, obtain forward thrust, row to the shore, and complete the recovery.
  • an emergency failure such as failure of the main controller or drive module, it can be retracted by controlling the safe retraction compartment.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Toys (AREA)
  • Manipulator (AREA)
  • Rehabilitation Tools (AREA)

Abstract

An underwater turtle-like robot and a control method thereof. The underwater turtle-like robot comprises a bionic turtle upper shell (65), a bionic turtle lower shell (23), a turtle limb, a sealing structure, a drive device provided inside a turtle shell and used for driving the turtle limb to move, a secure withdrawal cabin, a protective device, and a sensor. The bionic turtle upper shell (65) consists of an ellipsoidal shell part and a spherical shell part, and carries out an equal-strength thickening design. The underwater turtle-like robot reduces the use of the shell materials, and maintains good compression resistance and anti-impact capabilities.

Description

一种水下仿龟机器人及其控制方法An underwater turtle imitating robot and its control method 技术领域technical field
本发明涉及仿生机器人设计及控制领域,具体涉及一种水下探测仿生龟机器人及其控制方法。The invention relates to the field of bionic robot design and control, in particular to an underwater detection bionic turtle robot and a control method thereof.
背景技术Background technique
水下机器人是一种可以在水下移动,具有感知系统,通过遥控或自主操作方式,使用机械手或其他工具代替或者辅助人去完成水下作业任务的机电一体化智能装置。水下机器人是人类认识海洋,开发海洋不可缺少的工具之一,也是建设海洋强国,实现可持续发展的必要高技术手段。An underwater robot is a mechatronic intelligent device that can move underwater, has a perception system, and uses manipulators or other tools to replace or assist people to complete underwater tasks through remote control or autonomous operation. Underwater robot is one of the indispensable tools for human beings to understand the ocean and develop the ocean. It is also a necessary high-tech means to build a strong ocean country and achieve sustainable development.
与传统的水下机器人相比,水下仿生机器人具有低阻力、高效率、高机动性和高环境适应性等优点。在空间狭小、复杂的环境下可以完成各种任务,可用于军事、探测等领域。Compared with traditional underwater robots, underwater bionic robots have the advantages of low resistance, high efficiency, high maneuverability and high environmental adaptability. It can complete various tasks in a small and complex environment, and can be used in military, detection and other fields.
现有的水下仿生龟机器人存在以下不足:The existing underwater bionic turtle robots have the following shortcomings:
1、龟体外壳厚度均为同一厚度,导致安全裕度出现过剩,同时浪费了不必要的原材料,成本高。1. The thickness of the shell of the turtle body is the same thickness, which leads to excess safety margin, waste of unnecessary raw materials, and high cost.
2、在仿生龟机器人壳体外缺乏有效的防护装置,无法有效保护龟体及相关重要部件。若龟体与外界物体发生碰撞,会产生几何缺陷,降低龟体的耐压性能;2. There is no effective protective device outside the shell of the bionic turtle robot, which cannot effectively protect the turtle body and related important components. If the turtle body collides with an external object, geometric defects will occur, reducing the pressure resistance of the turtle body;
3、缺乏安全可靠的收回装置,无法应对控制器或驱动模块失灵等一些突发情况,造成机器人失联,浪费等;3. Lack of safe and reliable recovery device, unable to deal with some emergencies such as controller or drive module failure, resulting in robot loss, waste, etc.;
4、外形结构简单,与实际的海龟壳体的流线型差别大,水阻力大,功耗高;4. The shape and structure are simple, and the streamline shape of the actual turtle shell is greatly different, the water resistance is large, and the power consumption is high;
5、O形圈密封在实际运用中不能有效解决动密封问题,采用机械密封又有结构复杂,装配困难的缺陷,不适合需要经常拆卸的机器人结构;5. The O-ring seal cannot effectively solve the problem of dynamic sealing in practical application. The mechanical seal has the defects of complex structure and difficult assembly, which is not suitable for the robot structure that needs to be disassembled frequently;
6、常用水下仿龟机器人的驱动有机械驱动、介电弹性体驱动,在机械驱动下,肢体若实现两自由度运动,结构会复杂化,具有不可避免的易磨损、体积大问题。而介电弹性体驱动,所需驱动电压高,且一般只能实现一个自由度运动,难以模拟龟的实际运动。6. Commonly used underwater turtle-like robots are driven by mechanical drive and dielectric elastomer drive. Under mechanical drive, if the limbs can move with two degrees of freedom, the structure will be complicated, and there will be inevitable problems of easy wear and large volume. The dielectric elastomer drive requires a high drive voltage, and generally only one degree of freedom motion can be achieved, so it is difficult to simulate the actual motion of the turtle.
针对以上问题,本发明对水下仿龟机器人上壳进行等强度变厚设计,解决了材料不必要浪费的问题;设计可拆卸防护栏,解决了龟体在意外撞击后,出现壳体耐压性能不 足的问题;通过设置安全收回舱,解决了突发情况下,无法收回机器人的问题;设计满足椭圆球面与球面方程的壳体外形、满足渐开线方程的龟前肢外形与四肢截面,解决了仿生龟运动时,阻力大,能耗高的问题;通过弹性膜进行动密封,解决了以往水下机器人密封困难且复杂的问题;采用前肢采用舵机结合聚吡咯(PPy)驱动,提供了一种新型驱动模式。、In view of the above problems, the present invention designs the upper shell of the underwater turtle imitation robot with equal strength and thickening, which solves the problem of unnecessary waste of materials; the design of detachable protective fence solves the problem of shell pressure resistance after the turtle body accidentally hits The problem of insufficient performance; by setting up a safe retraction cabin, the problem that the robot cannot be retracted in emergencies is solved; the shell shape that satisfies the elliptical sphere and the spherical equation, and the shape of the forelimb and limb section of the turtle that satisfies the involute equation are designed to solve the problem. It solves the problems of large resistance and high energy consumption when the bionic tortoise moves; dynamic sealing through elastic membrane solves the difficult and complex problems of previous underwater robots; the use of forelimbs and steering gear combined with polypyrrole (PPy) drive provides A new drive mode. ,
中船重工(青岛)海洋装备研究院有限责任公司曾申请过一个名为《一种船载海洋水下探测装置的全方位防碰撞装置》的发明专利,专利申请号为:CN202010441804.0。其包括上保护罩的和下保护罩,其相互靠近的端部均设置有固定腰环,上保护罩还设置有铁链,在堵盖的顶面中心处设置第二套管等,其不足之处在于结构复杂沉重,若安装在水下机器人上,会产生较大的水阻力且防护范围不可调整,灵活性差。我们的发明充分考虑到以下几点:1、水下的环境状况,防护栏可装卸并且可以调整防护栏保护范围;2、灵活性,将整体分为两个四分之一圆环,各个圆环均可独立调节;3、水阻力大小,将防护栏截面设计成椭圆形,类流线体型。CSIC (Qingdao) Marine Equipment Research Institute Co., Ltd. has applied for an invention patent titled "An omnidirectional anti-collision device for a shipborne marine underwater detection device". The patent application number is: CN202010441804.0. It includes an upper protective cover and a lower protective cover, the ends of which are close to each other are provided with fixed waist rings, the upper protective cover is also provided with iron chains, and a second sleeve is arranged at the center of the top surface of the blocking cover, which is insufficient. The disadvantage is that the structure is complex and heavy. If it is installed on an underwater robot, it will generate large water resistance, the protection range cannot be adjusted, and the flexibility is poor. Our invention fully takes into account the following points: 1. Underwater environmental conditions, the guardrail can be installed and removed and the protection range of the guardrail can be adjusted; 2. Flexibility, the whole is divided into two quarter circles, each circle The rings can be adjusted independently; 3. The size of the water resistance, the section of the guardrail is designed to be oval and streamline-like.
发明内容SUMMARY OF THE INVENTION
针对上述技术问题,本发明提出一种水下仿生龟机器人及其控制方法,具有缓冲撞击、降低水下运动能耗以及方便回收等效果。In view of the above technical problems, the present invention proposes an underwater bionic turtle robot and a control method thereof, which have the effects of buffering impact, reducing energy consumption for underwater motion, and facilitating recovery.
为了实现上述技术目的,本发明采用如下技术方案:In order to realize above-mentioned technical purpose, the present invention adopts following technical scheme:
一种水下仿生龟机器人,包括仿生龟上壳、仿生龟下壳、龟四肢、密封结构以及设置在龟壳体内部的用于驱动所述龟四肢动作的驱动装置;An underwater bionic turtle robot, comprising a bionic turtle upper shell, a bionic turtle lower shell, turtle limbs, a sealing structure, and a driving device arranged inside the turtle shell for driving the action of the turtle limbs;
仿生龟上壳与仿生龟下壳之间用硅橡胶相隔用于静密封且用螺钉连接;The upper shell of the bionic turtle and the lower shell of the bionic turtle are separated by silicone rubber for static sealing and connected with screws;
所述龟四肢分为前肢与后肢,后肢传动轴伸出龟壳体的轴段处和仿生龟下壳之间、以及前肢锥齿轮轴伸出龟壳体的轴段处与仿生龟下壳之间分别设有防水用的硅橡胶弹性膜;The four limbs of the turtle are divided into forelimbs and hindlimbs, and the transmission shaft of the hindlimb protrudes from the shaft section of the tortoise shell and between the lower shell of the bionic tortoise, and between the shaft section of the forelimb bevel gear shaft protruding from the tortoise shell and the lower shell of the bionic tortoise. There are silicone rubber elastic membranes for waterproofing;
在水下仿龟机器人顶部安装压力传感器,通过压力的大小来判断它的实时深度;在水下仿龟机器人内部安装温湿度传感器来检测龟体内部密封性,若发生进水,会立即报警;在龟壳体上设置陀螺仪调整龟体姿态;在水下仿龟机器人头部安装摄像头进行观察,所述仿生龟上壳由椭球形壳部分与球形壳部分共同组成,A pressure sensor is installed on the top of the underwater turtle-like robot, and its real-time depth is judged by the magnitude of the pressure; a temperature and humidity sensor is installed inside the underwater turtle-like robot to detect the internal sealing of the turtle body. If water enters, it will immediately alarm; A gyroscope is set on the turtle shell to adjust the posture of the turtle body; a camera is installed on the head of the underwater turtle imitation robot for observation, and the upper shell of the bionic turtle is composed of an ellipsoidal shell part and a spherical shell part,
所述椭球形壳部分的壳体厚度通过以下公式获得:The shell thickness of the ellipsoid shell portion is obtained by the following formula:
Figure PCTCN2021129418-appb-000001
Figure PCTCN2021129418-appb-000001
式中,p为壳体所承受的外压,σ s为材料的屈服应力,a为椭球长轴半径,ρ为椭圆率,t为壳体厚度,x,y为直角坐标系; In the formula, p is the external pressure on the shell, σ s is the yield stress of the material, a is the radius of the major axis of the ellipsoid, ρ is the ellipticity, t is the thickness of the shell, and x and y are the Cartesian coordinate system;
所述球形壳部分的壳体厚度通过以下公式获得:The shell thickness of the spherical shell portion is obtained by the following formula:
Figure PCTCN2021129418-appb-000002
Figure PCTCN2021129418-appb-000002
式中,R为球壳体半径。where R is the radius of the spherical shell.
还包括防护栏机构,与所述龟壳体之间可拆卸连接,所述防护栏机构包括两组,对称布置在所述龟壳体左、右两侧,每组防护栏机构均包括:It also includes a guardrail mechanism, which is detachably connected to the turtle shell. The guardrail mechanism includes two groups, which are symmetrically arranged on the left and right sides of the turtle shell. Each group of guardrail mechanisms includes:
防护栏,呈四分之一圆环结构,防护栏内侧一端通过缓冲机构与所述龟壳体连接,防护栏内侧另一端通过调节机构与所述龟壳体连接;The guardrail has a quarter ring structure, one end of the inner side of the guardrail is connected to the turtle shell through a buffer mechanism, and the other end of the inner side of the guardrail is connected to the turtle shell through an adjustment mechanism;
所述缓冲机构包括柱形减震腔、连杆以及弹簧,其中,柱形减震腔中设置所述弹簧,柱形减震腔的一端设有杆孔;The buffer mechanism includes a cylindrical shock absorbing cavity, a connecting rod and a spring, wherein the spring is arranged in the cylindrical shock absorbing cavity, and one end of the cylindrical shock absorbing cavity is provided with a rod hole;
所述防护栏的内侧设有滑槽,连杆一端设有与所述滑槽配合的第一滑槽触头,连杆另一端通过所述杆孔伸入所述柱形减震腔;The inner side of the guardrail is provided with a chute, one end of the connecting rod is provided with a first chute contact matched with the chute, and the other end of the connecting rod extends into the cylindrical shock absorbing cavity through the rod hole;
所述连杆的中部设有轴肩,所述轴肩将所述连杆位于减震体内腔中的部分分为第一连杆段和第二连杆段,所述第一连杆段和第二连杆段上分别套接有一个所述弹簧;The middle part of the connecting rod is provided with a shaft shoulder, and the shaft shoulder divides the part of the connecting rod located in the cavity of the shock absorber into a first connecting rod segment and a second connecting rod segment, the first connecting rod segment and the The second connecting rod segments are respectively sleeved with one of the springs;
柱形减震腔底部外侧通过铰接件与所述龟壳体转动连接;The outer side of the bottom of the cylindrical shock-absorbing cavity is rotatably connected with the turtle shell through a hinge;
所述调节机构包括调整箱,所述调整箱设置在龟壳体上,第一调整箱中平行设置第一螺纹杆和第一传动轴,所述第一螺纹杆和第一传动轴之间通过齿轮传动组传动连接;The adjustment mechanism includes an adjustment box, the adjustment box is arranged on the tortoise shell, a first threaded rod and a first transmission shaft are arranged in parallel in the first adjustment box, and the first threaded rod and the first transmission shaft pass through. Transmission connection of gear transmission group;
所述第一传动轴外端伸出调整箱体连接有调节手柄,在调节手柄的调整下,所述第一螺纹杆能够在水平方向来回移动以调节防护栏的保护范围;The outer end of the first transmission shaft extends out of the adjustment box and is connected with an adjustment handle. Under the adjustment of the adjustment handle, the first threaded rod can move back and forth in the horizontal direction to adjust the protection range of the guardrail;
所述第一螺纹杆的外端通过第二滑槽触头与所述防护栏之间滑动连接,第一螺纹杆的内端部设有限制块。The outer end of the first threaded rod is slidably connected to the guardrail through the second sliding groove contact, and a restriction block is provided on the inner end of the first threaded rod.
所述防护栏的横截面呈椭圆形,类流线体型。The cross-section of the guardrail is oval and streamline-like.
所述前肢以舵机驱动结合软体驱动的方式实现双自由度运动:一为舵机驱动:由前肢舵机提供动力经前肢锥齿轮组带动前肢转动;二为聚吡咯条驱动:前肢的两面上对称贴覆有多个聚吡咯条,多个聚吡咯条与夹片下电极片相连,后接导线并通过前肢锥齿轮 轴中心孔接到软体驱动控制模块,由软体控制模块控制聚吡咯条,带动前肢上、下摆动;The forelimb is driven by a steering gear combined with a software drive to achieve dual-degree-of-freedom motion: one is the steering gear drive: the forelimb is driven by the forelimb steering gear to drive the forelimb to rotate through the forelimb bevel gear set; the second is the polypyrrole strip drive: the two sides of the forelimb Symmetrically covered with a plurality of polypyrrole strips, which are connected to the lower electrode plate of the clip, followed by wires and connected to the software drive control module through the center hole of the bevel gear shaft of the front limb, and the polypyrrole strips are controlled by the software control module. Drive the forelimbs to swing up and down;
所述后肢的驱动装置包括后肢舵机,舵机盘,轴承座,连轴,小弹性带以及后肢传动轴,其中,所述后肢舵机、舵机盘、舵机套筒之间通过螺钉连接,螺钉连接连轴与舵机套筒;所述小弹性带将动力传给后肢传动轴,驱动后肢做出旋转运动。The driving device of the rear limb includes a rear limb steering gear, a steering gear disc, a bearing seat, a connecting shaft, a small elastic belt and a rear limb transmission shaft, wherein the rear limb steering gear, the steering gear disc and the steering gear sleeve are connected by screws. , the connecting shaft and the steering gear sleeve are connected by screws; the small elastic belt transmits the power to the rear limb transmission shaft, and drives the rear limb to make a rotating motion.
所述仿生龟下壳两侧设有平衡翼,用于辅助维持平衡。Balance wings are provided on both sides of the lower shell of the bionic turtle to assist in maintaining balance.
还包括安全收回舱,通过牵引线与龟壳体相连,包括:Also includes a safety retraction pod, connected to the turtle shell by a tow line, including:
一舱体,所述舱体内设有隔板,所述隔板将舱体分为上舱体与下舱体,上舱体上设有可打开或关闭的舱盖,上舱体内设有压缩气囊,压缩气囊底部通过引线与固定在上舱体内腔中的钩耳连接;A cabin, the cabin is provided with a partition, the partition divides the cabin into an upper cabin and a lower cabin, the upper cabin is provided with a hatch cover that can be opened or closed, and the upper cabin is provided with a compression Airbag, the bottom of the compressed airbag is connected with the hook ear fixed in the inner cavity of the upper cabin through the lead wire;
所述下舱体为密封舱,下舱体内设有舱盖打开机构,舱盖打开机构包括:平行设置的第二传动轴和第二螺纹杆,第二传动轴和第二螺纹杆之间通过齿轮传动机构连接The lower cabin is a sealed cabin, and the lower cabin is provided with a hatch cover opening mechanism. The hatch cover opening mechanism includes: a second transmission shaft and a second threaded rod arranged in parallel, and the second transmission shaft and the second threaded rod pass through gear drive connection
伺服电机,与第二传动轴驱动连接,舱盖打开机构中的第二螺纹杆的部分穿过所述隔板伸入所述上舱体中,在伺服电机的驱动下,第二螺纹杆能够在所述舱体内沿上、下方向移动以打开所述舱体的舱盖;The servo motor is drivingly connected with the second transmission shaft, and the part of the second threaded rod in the hatch opening mechanism penetrates the baffle and protrudes into the upper cabin. Driven by the servo motor, the second threaded rod can move in the up and down direction inside the cabin to open the hatch cover of the cabin;
所述下舱体内还设有横板和压底板,所述横板和压底板之间通过螺栓连接,且压底板与横板上都开有卡槽,用于固定第二传动轴和齿轮传动组;The lower cabin is also provided with a transverse plate and a pressure bottom plate, the transverse plate and the pressure bottom plate are connected by bolts, and the pressure plate and the transverse plate are both provided with card slots for fixing the second transmission shaft and the gear transmission. Group;
所述舱体内还设有信号接收装置,用于接收外部的信号;The cabin is also provided with a signal receiving device for receiving external signals;
控制器,其输入端与所述信号接收装置连接,其输出端与所述伺服电机连接;a controller, the input end of which is connected to the signal receiving device, and the output end of which is connected to the servo motor;
电源,为所述伺服电机、信号接收装置以及控制器供电;a power supply, which supplies power to the servo motor, the signal receiving device and the controller;
舱体内共有三处密封,第一处为上舱体和下舱体之间,为静密封,用硅胶垫片密封;There are three seals in the cabin, the first is between the upper cabin and the lower cabin, which is a static seal and is sealed with a silicone gasket;
第二处为隔板与上舱体中的上舱体支柱之间,为静密封,用硅胶垫片密封;The second place is between the bulkhead and the upper cabin pillar in the upper cabin, which is a static seal and is sealed with a silicone gasket;
第三处为第二螺纹杆与上舱体中的上舱体支柱之间,为动密封,通过透明弹性膜密封,一端将第二螺纹杆露出上舱体支柱部分完全包裹,另一端粘在上舱体支柱上。The third place is between the second threaded rod and the upper cabin strut in the upper cabin. It is a dynamic seal. It is sealed by a transparent elastic film. on the upper hull strut.
龟四肢从仿生的角度出发,前肢外形为两渐开线并于肢尖相交,当采用直角坐标来表示时,它们的方程式为:From the perspective of bionics, the tortoise's limbs are formed by two involutes that intersect at the tips of the limbs. When represented by Cartesian coordinates, their equations are:
Figure PCTCN2021129418-appb-000003
Figure PCTCN2021129418-appb-000003
式中,u i=θ ii,θ i为展角,α i为压力角,r i为基圆半径, In the formula, u iii , θ i is the expansion angle, α i is the pressure angle, ri i is the radius of the base circle,
C 1为角度u1的取值范围,范围是240°~270°、C 2为角度u2的取值范围,范围是210°~265°; C 1 is the value range of the angle u1, the range is 240°~270°, C 2 is the value range of the angle u2, the range is 210°~265°;
其截面也由两渐开线组成,以中心截面为例,具体如下:Its section is also composed of two involutes, taking the central section as an example, as follows:
Figure PCTCN2021129418-appb-000004
Figure PCTCN2021129418-appb-000004
式中,u′ i=θ′ i+α′ i,θ′ i为展角,α′ i为压力角,r′ i为基圆半径,C′ 1为角度u′ 1的取值范围,范围是210°~226°、C′ 2为角度u′ 2的取值范围,范围是210°~221°; In the formula, u′ i = θ′ i +α′ i , θ′ i is the expansion angle, α′ i is the pressure angle, r′ i is the radius of the base circle, C′ 1 is the value range of the angle u′ 1 , The range is 210°~226°, C' 2 is the value range of the angle u' 2 , and the range is 210°~221°;
其厚度由前端到后端,先增加再逐渐减小;Its thickness increases first and then gradually decreases from the front end to the rear end;
后肢的四周边缘较薄,从边缘到中心,其横截面厚度逐渐增加。The hindlimbs are thin around the edges, with a gradual increase in cross-sectional thickness from the edge to the center.
仿龟机器人外壳呈流线形。The shell of the turtle-like robot is streamlined.
一种基于所述水下仿生龟机器人的工作方法,包括以下几个步骤:A working method based on the underwater bionic turtle robot, comprising the following steps:
第一步:检查、布放与下潜Step 1: Check, deploy and dive
首先对水下仿龟机器人进行检查,主要内容为四肢是否正常运动、密封是否完好、传感器是否正常工作、电量是否充足,选择合适的水域,将水下仿龟机器人放入水中;First, check the underwater turtle-like robot. The main contents are whether the limbs move normally, whether the seal is intact, whether the sensor is working normally, and whether the power is sufficient. Select the appropriate water area and put the underwater turtle-like robot into the water;
下潜由前肢与后肢的相互配合来完成,具体如下:后肢舵机得到指令后,后肢左侧舵机顺时针旋转90°,同时后肢右侧舵机逆时针旋转90°,让两侧后肢均保持竖直向上,并以此为中心位置往复摆动共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢横向朝上往复摆动共60°,获得向下推力,且在整个过程中运动保持;同时,前肢舵机得到指令后,前肢左侧舵机顺时针旋转30°,前肢右侧舵机逆时针旋转30°,通过前肢锥齿轮组将运动传给了前肢,这样使两侧前肢前端上升,此时,前肢舵机停止转动,接着软体控制模块向聚吡咯条施加反向电压,使后肢向后上方拍动,这样由水的反作用力推动龟体向前下方运动;The dive is completed by the cooperation of the forelimb and the hindlimb. The details are as follows: after the hindlimb servo is instructed, the left servo of the hindlimb rotates 90° clockwise, while the right servo of the hindlimb rotates 90° counterclockwise, so that both hindlimbs are equally Keep vertical and upward, and swing back and forth for a total of 60° at this center position, drive the connecting shaft through the steering gear sleeve, and drive the rear limb drive shaft to rotate by the small elastic belt. At the same time, after the forelimb steering gear is commanded, the left forelimb servo rotates 30° clockwise, and the right forelimb servo rotates 30° counterclockwise, and the motion is transmitted to the forelimb bevel gear set. The forelimbs are lifted, so that the front ends of the forelimbs on both sides rise. At this time, the steering gear of the forelimbs stops rotating, and then the software control module applies a reverse voltage to the polypyrrole strips, so that the hind limbs flap backwards and upwards, so that the reaction force of the water pushes the turtle body move forward and downward;
接着断开电源与聚吡咯条的连接,然后前肢舵机会得到反向旋转运动指令,逆时针旋转第一次旋转角的两倍,即60°,使前肢后端上升,前肢舵机即停转,软体控制模块再向聚吡咯条施加反向电压,使其向前上方拍动,这样由水的反作用力推动龟体向后下方运动,此后按此顺序反复接通,完成下潜运动;Then disconnect the power supply and the polypyrrole strip, and then the forelimb rudder will get a reverse rotation motion command, and rotate counterclockwise twice the first rotation angle, that is, 60°, so that the rear end of the forelimb will rise, and the forelimb rudder will stop. , the software control module applies a reverse voltage to the polypyrrole strip to make it flap forward and upward, so that the reaction force of the water pushes the turtle body to move backward and downward, and then it is repeatedly turned on in this order to complete the diving movement;
第二步:前进Step 2: Go Forward
推进由前肢与后肢的相互配合来完成,具体如下:后肢舵机得到指令后,往复旋转共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢1竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持,此时,前肢全由聚吡咯条驱动,聚吡咯条被施加正电压,向下弯曲,即向下拍动,间隔合适时间,再施加负电压,使聚吡咯条向上弯曲,即向上拍动,如此循环,完成推进运动,在此过程中,应保持前肢与后肢摆动频率相同,便于保持平衡;The propulsion is accomplished by the mutual cooperation of the forelimb and the hindlimb. The details are as follows: after the servo of the hindlimb is commanded, it rotates back and forth for a total of 60°, the connecting shaft is driven by the steering gear sleeve, and the drive shaft of the hindlimb is driven by the small elastic belt to rotate, and the hindlimb is erected. Swing back and forth for a total of 60°, obtain forward thrust, and keep the movement during the whole process. At this time, the forelimbs are all driven by the polypyrrole strips, and the polypyrrole strips are applied with a positive voltage and bend downward, that is, flap down, with appropriate intervals Time, and then apply a negative voltage to make the polypyrrole strips bend upwards, that is, flap upwards. This cycle completes the propulsion movement. During this process, the swing frequency of the forelimb and the hindlimb should be kept the same, so as to maintain balance;
第三步:转向Step 3: Turn
有两种方案,均为差速转向且运动完成后,舵机需要回到原位,There are two solutions, both are differential steering and after the movement is completed, the steering gear needs to return to its original position,
方案一:由后肢实现,前肢上下摆动共60°来保持平衡,两个后肢舵机中,一个保持不动,另一个后肢舵机通过舵机套筒带动连轴,再由小弹性带带动后肢传动轴转动,实现后肢竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持;Option 1: Realized by the hind limbs, the forelimbs swing up and down a total of 60° to maintain balance, one of the two hind limb servos remains stationary, the other hind limb servo drives the connecting shaft through the steering gear sleeve, and then the small elastic belt drives the hind limbs The drive shaft rotates to realize the vertical reciprocating swing of the hind limbs for a total of 60°, obtain forward thrust, and keep the movement during the whole process;
方案二:由前肢实现,后肢上下摆动保持平衡并提供一定推力,两个前肢中,一个保持不动,另一个运动如下:前肢舵机得到指令后,前肢左侧舵机顺时针旋转90°,前肢右侧舵机逆时针旋转90°,使两侧前肢竖直,此时,前肢舵机立即停止转动,接着向聚吡咯条施加反向电压,向后侧拍动,这样由水的反作用力推动龟体转向;Option 2: Realized by the forelimb, the hind limb swings up and down to maintain a balance and provide a certain thrust, one of the two forelimbs remains motionless, and the other moves as follows: after the forelimb servo is commanded, the left forelimb servo rotates 90° clockwise, The steering gear on the right side of the forelimb is rotated 90° counterclockwise, so that the forelimbs on both sides are vertical. At this time, the steering gear of the forelimb stops rotating immediately, and then applies a reverse voltage to the polypyrrole strip and flaps it to the rear side, so that the reaction force of the water is caused by the water. Push the turtle body to turn;
第四步:上浮Step 4: Float
上浮主要由后肢来完成,前肢上、下摆动共60°来保持平衡,后肢运动具体如下:后肢舵机得到指令后,后肢左侧舵机逆时针旋转90°,同时后肢右侧舵机顺时针旋转90,让两侧后肢均保持竖直向下,以此为中心位置往复旋转共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢横向朝下往复摆动共60°,获得向上推力,且在整个过程中运动保持;The uplift is mainly accomplished by the hind limbs. The forelimbs swing up and down a total of 60° to maintain balance. The movement of the hind limbs is as follows: After the hind limb servo is commanded, the left servo of the hind limb rotates 90° counterclockwise, while the right servo of the hind limb rotates clockwise. Rotate 90 degrees, keep both hind limbs vertically downward, and rotate back and forth for a total of 60° with this as the center position, drive the connecting shaft through the steering gear sleeve, and drive the hind limb drive shaft to rotate by the small elastic belt, and complete the horizontal reciprocation of the hind limbs downward. Swing a total of 60°, get upward thrust, and maintain motion throughout the process;
第五步:收回Step 5: Take Back
由后肢运动实现,后肢舵机通过舵机套筒带动连轴,再由小弹性带带动后肢传动轴转动,实现后肢竖向往复摆动共60°,获得前进推力,划向岸边,完成回收,此外,在整个过程中,。It is realized by the movement of the hind limb, the steering gear of the hind limb drives the connecting shaft through the steering gear sleeve, and then the drive shaft of the hind limb is driven to rotate by the small elastic belt, so as to realize the vertical reciprocating swing of the hind limb for a total of 60°, obtain the forward thrust, row to the shore, and complete the recovery. Also, throughout the process, .
若出现紧急故障,通过控制安全收回舱进行收回安全收回,具体是:In the event of an emergency failure, the safe retraction is carried out by controlling the safe retraction cabin, specifically:
操作者向安全收回舱发出上浮命令,使舱内伺服电机转动,通过舱盖打开机构打开舱盖,释放压缩气囊,带动仿龟机器人上浮。The operator sends an ascending command to the safe retraction cabin, so that the servo motor in the cabin rotates, the hatch cover is opened through the hatch cover opening mechanism, the compressed air bag is released, and the imitation turtle robot is driven to float up.
有益效果:Beneficial effects:
1、本发明通过对水下仿龟机器人上壳进行等强度变厚设计,防止安全裕度出现严 重过剩,减少了壳体材料的使用,降低了成本,同时保持了良好的抗压和抗冲击能力。1. The present invention adopts the equal-strength thickening design of the upper shell of the underwater turtle imitation robot to prevent serious excess of safety margins, reduce the use of shell materials, reduce costs, and maintain good compression and impact resistance at the same time. ability.
2、设有可拆卸防护栏,当装有防护栏的仿龟机器人撞到物体时,在缓冲装置的作用下,极大地缓冲了撞击,有效保护了水下仿生龟的龟体及重要部件;同时,可根据水下环境状况,选择装拆防护栏或调整防护栏保护范围,具有极高的灵活性。2. There is a detachable protective fence. When the imitation turtle robot equipped with the protective fence hits an object, the impact is greatly buffered under the action of the buffer device, which effectively protects the turtle body and important parts of the underwater bionic turtle; At the same time, according to the underwater environment, you can choose to install and remove the guardrail or adjust the protection range of the guardrail, which has high flexibility.
3、通过设置安全收回舱,解决突发情况下,无法收回机器人的情况,具有节约成本、便于分析事故原因和保护水下环境的优点。3. By setting up a safe recovery cabin to solve the situation that the robot cannot be recovered in an emergency, it has the advantages of cost saving, easy analysis of the cause of the accident and protection of the underwater environment.
4、水下仿龟机器人上壳很大程度上模仿了海龟外形,满足椭圆球面与球面方程,仿龟机器人外壳呈流线形,龟前肢外形与四肢截面均满足渐开线方程,以上特征极大地减小了水阻力,降低了水下仿龟机器人运动能耗。4. The upper shell of the underwater turtle-like robot largely imitates the shape of the turtle, which satisfies the elliptical spherical and spherical equations. The shell of the turtle-like robot is streamlined. The water resistance is greatly reduced, and the motion energy consumption of the underwater turtle imitation robot is reduced.
5、动密封采用硅橡胶弹性膜,弹性膜可随轴的小幅度往复转动而弹性变形,具有成本低、结构简单、密封可靠的优势。5. The dynamic seal adopts silicone rubber elastic film, which can elastically deform with the small reciprocating rotation of the shaft, which has the advantages of low cost, simple structure and reliable sealing.
6、本发明前肢采用舵机结合聚吡咯(PPy)驱动,简化了机械结构,降低了磨损,有效模拟了龟的实际运动。主要驱动力由后肢舵机提供,可以快速实现上浮、下潜、推进三种功能,缩减上浮、下潜时间,提高工作效率。6. The forelimb of the present invention is driven by a steering gear combined with polypyrrole (PPy), which simplifies the mechanical structure, reduces wear, and effectively simulates the actual movement of the turtle. The main driving force is provided by the rear limb steering gear, which can quickly realize the three functions of ascending, descending and propulsion, reducing the ascending and descending time and improving work efficiency.
附图说明Description of drawings
图1为本发明的水下仿龟机器人三维模型图;1 is a three-dimensional model diagram of an underwater turtle imitation robot of the present invention;
图2为本发明的水下仿龟机器人内部结构示意图;2 is a schematic diagram of the internal structure of the underwater turtle imitation robot of the present invention;
图3为本发明的水下仿龟机器人后肢结构示意图;3 is a schematic diagram of the hindlimb structure of the underwater turtle imitation robot of the present invention;
图4为本发明的水下仿龟机器人前肢结构示意图;4 is a schematic diagram of the forelimb structure of the underwater turtle imitation robot of the present invention;
图5为本发明的水下仿龟机器人防护栏装置结构示意图;5 is a schematic structural diagram of an underwater turtle imitation robot guardrail device of the present invention;
图6为本发明的水下仿龟机器人缓冲机构示意图;6 is a schematic diagram of the buffer mechanism of the underwater turtle imitation robot of the present invention;
图7为本发明的水下仿龟机器人防护栏调节机构示意图;7 is a schematic diagram of an underwater turtle imitation robot guardrail adjustment mechanism of the present invention;
图8为本发明的水下仿龟机器人滑槽触头与滑槽连接示意图;8 is a schematic diagram of the connection between the contact of the chute and the chute of the underwater turtle imitation robot of the present invention;
图9为本发明的水下仿龟机器人安全收回舱结构示意图;9 is a schematic structural diagram of the safe retraction cabin of the underwater turtle imitation robot of the present invention;
图10为本发明的水下仿龟机器人上壳体示意图;10 is a schematic diagram of the upper shell of the underwater turtle imitation robot of the present invention;
图11为本发明的水下仿龟机器人前肢截面示意图;11 is a schematic cross-sectional view of the forelimb of the underwater turtle imitation robot of the present invention;
图12为本发明的水下仿龟机器人控制流程图;Fig. 12 is the control flow chart of the underwater turtle imitation robot of the present invention;
图13为本发明的水下仿龟机器人主控制器的信号传输处理框图;Fig. 13 is the signal transmission processing block diagram of the main controller of the underwater turtle imitation robot of the present invention;
图14为本发明的水下仿龟机器人安全收回舱的控制示意图;Fig. 14 is the control schematic diagram of the safe recovery cabin of the underwater imitation turtle robot of the present invention;
图15为本发明的水下仿龟机器人安全收回舱的控制流程图。Fig. 15 is a control flow chart of the safe retraction cabin of the underwater turtle imitation robot of the present invention.
图1至图15中:1-后肢,2-连接螺钉,3-后肢舵机,4-舵机固定块,5-舵机盘,6-紧定螺钉,7-轴承座,8-连轴,9-小弹性带,10-后肢传动轴,11-端盖,12-调整垫片,13-固定螺钉,14-夹片,15-前肢锥齿轮轴,16-锥齿轮轴,17-舵机套筒,18-前肢舵机,19-仿生龟尾部,20-平衡翼,21-前肢,22-聚吡咯条,23-仿生龟下壳,24-仿生龟头部,25-防护栏,26-电池及控制器区域,27-限制块,28-转盘,29-调节机构,30-槽盖,31-螺栓,32-缓冲机构,33-旋转块,34-旋转套筒,35-滑槽触头,36-连杆,37-减震体盖,38-减震体,39-弹簧,40-固定垫片,41-手柄,42-第一传动轴,43-小端盖,44-第一齿轮,45-压板,46-第二齿轮,47-轴承,48-大端盖,49-第一螺纹杆,50-伺服电机,51-电机套筒,52-第二传动轴,53-第四齿轮,54-压底板,55-隔板,56-橡胶垫片,57-上舱体,58-第二螺纹杆,59-舱盖,60-上舱体支柱,61-小弹簧,62-钩耳,63-下舱体,64-环耳,65-仿生龟上壳。In Figure 1 to Figure 15: 1- hind limb, 2- connecting screw, 3- rear limb steering gear, 4- steering gear fixing block, 5- steering gear plate, 6- set screw, 7- bearing seat, 8- connecting shaft , 9- small elastic belt, 10- hind limb drive shaft, 11- end cover, 12- adjusting washer, 13- fixing screw, 14- clip, 15- front limb bevel gear shaft, 16- bevel gear shaft, 17- rudder Machine sleeve, 18-Forelimb steering gear, 19-Bionic turtle tail, 20-Balance wing, 21-Forelimb, 22-Polypyrrole strip, 23-Bionic turtle lower shell, 24-Bionic turtle head, 25-Guard rail, 26 -Battery and controller area, 27-limiting block, 28-turntable, 29-adjustment mechanism, 30-slot cover, 31-bolt, 32-buffer mechanism, 33-rotating block, 34-rotating sleeve, 35-chute Contact, 36-connecting rod, 37-shock body cover, 38-shock body, 39-spring, 40-fixing washer, 41-handle, 42-first drive shaft, 43-small end cap, 44- 1st gear, 45-pressing plate, 46-second gear, 47-bearing, 48-big end cap, 49-first threaded rod, 50-servo motor, 51-motor sleeve, 52-second drive shaft, 53 - Fourth gear, 54- Pressing bottom plate, 55- Partition plate, 56- Rubber gasket, 57- Upper cabin, 58- Second threaded rod, 59- Hatch cover, 60- Upper cabin strut, 61- Small spring , 62 - hook ear, 63 - lower hull, 64 - ring ear, 65 - upper shell of bionic turtle.
具体实施方式Detailed ways
下面结合附图,详细描述本发明的具体实施方案。Specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings.
如图1-10所示,水下仿生龟机器人结构由龟壳体、四肢、驱动装置、安全收回舱、防护栏装置以及传感器组成。As shown in Figure 1-10, the structure of the underwater bionic turtle robot consists of a turtle shell, limbs, driving devices, safety retraction cabins, guardrail devices and sensors.
如图2和图5所示,龟壳体由仿生龟上壳65,仿生龟下壳23,仿生龟头部24以及平衡翼20组成,其中仿生龟上壳65与仿生龟下壳23之间用硅橡胶相隔用于静密封且用螺钉连接,平衡翼20用于辅助维持平衡,使龟体难以倾斜。As shown in FIG. 2 and FIG. 5 , the turtle shell is composed of a bionic turtle upper shell 65 , a bionic turtle lower shell 23 , a bionic turtle head 24 and a balance wing 20 . The silicone rubber is used for static sealing and connected with screws, and the balance wings 20 are used to assist in maintaining balance, making it difficult for the turtle body to tilt.
如图3和图4所示,四肢结构分为前肢结构与后肢结构,前肢结构包括前肢21,夹片14,聚吡咯条22,电极片,导线,其中前肢21由夹片14夹住,多个聚吡咯条22对称贴在前肢21的两面上并与夹片下电极片相连,后接导线并通过前肢锥齿轮轴15中心孔接到软体驱动控制模块;后肢结构包括后肢1、后肢传动轴10,其中后肢1通过连接螺钉2与后肢传动轴10连接。As shown in Figure 3 and Figure 4, the limb structure is divided into forelimb structure and hind limb structure. The forelimb structure includes forelimb 21, clip 14, polypyrrole strip 22, electrode pad, and lead wire, wherein the forelimb 21 is clamped by clip 14, and more The polypyrrole strips 22 are symmetrically attached to both sides of the forelimb 21 and are connected to the lower electrode plate of the clip, followed by wires and connected to the software drive control module through the central hole of the forelimb bevel gear shaft 15; the hindlimb structure includes hindlimb 1, hindlimb drive shaft 10, wherein the hind limb 1 is connected with the hind limb transmission shaft 10 through the connecting screw 2.
如图3和图4所示,驱动装置分为前肢驱动装置和后肢驱动装置。前肢驱动装置包括前肢舵机18,舵机盘5,舵机套筒17,轴承座7,锥齿轮轴16,前肢锥齿轮轴15。前肢舵机18、舵机盘5、舵机套筒17之间通过螺钉连接,锥齿轮轴16后端与舵机套筒17相接,通过锥齿轮啮合将动力经前肢锥齿轮轴15传递给前肢21。As shown in Figures 3 and 4, the driving device is divided into a forelimb driving device and a hind limb driving device. The fore limb driving device includes a fore limb steering gear 18 , a steering gear disc 5 , a steering gear sleeve 17 , a bearing seat 7 , a bevel gear shaft 16 , and a fore limb bevel gear shaft 15 . The fore limb steering gear 18, the steering gear disc 5 and the steering gear sleeve 17 are connected by screws, the rear end of the bevel gear shaft 16 is connected with the steering gear sleeve 17, and the power is transmitted to the forelimb bevel gear shaft 15 through the bevel gear meshing Forelimbs 21.
前肢以舵机驱动结合软体驱动的方式实现双自由度运动:一为舵机驱动:由前肢舵 机18提供动力经锥齿轮轴16,再由前肢锥齿轮轴15带动前肢21转动;二为聚吡咯条(PPy)驱动:由软体控制模块控制聚吡咯条(PPy)22,带动肢体上下摆动。后肢驱动装置包括后肢舵机3,舵机盘5,轴承座7,连轴8,小弹性带9,后肢传动轴10。其中后肢舵机3、舵机盘5、舵机套筒17之间通过螺钉连接,紧定螺钉连接连轴8与舵机套筒17,小弹性带9将动力传给后肢传动轴10,驱动后肢1做出旋转运动。The forelimb is driven by a steering gear combined with a software drive to achieve double-degree-of-freedom motion: one is the steering gear drive: the forelimb steering gear 18 provides power through the bevel gear shaft 16, and then the forelimb bevel gear shaft 15 drives the foreleg 21 to rotate; Pyrrole strip (PPy) drive: The polypyrrole strip (PPy) 22 is controlled by the software control module to drive the limbs to swing up and down. The rear limb driving device includes a rear limb steering gear 3, a steering gear disc 5, a bearing seat 7, a connecting shaft 8, a small elastic belt 9, and a rear limb transmission shaft 10. Among them, the rear limb steering gear 3, the steering gear disc 5, and the steering gear sleeve 17 are connected by screws, and the set screw connects the connecting shaft 8 and the steering gear sleeve 17, and the small elastic belt 9 transmits the power to the rear limb transmission shaft 10 to drive Hind limb 1 makes a rotational movement.
后肢主要由有三个方向的旋转,横向朝上摆动、横向朝下摆动、竖向摆动。此外舵机固定块4将舵机与龟体固定起来。The hind limbs mainly rotate in three directions, lateral upward swing, lateral downward swing, and vertical swing. In addition, the steering gear fixing block 4 fixes the steering gear and the turtle body.
如图5所示,防护栏装置由防护栏25,限制块27,转盘28,调节机构29,槽盖30,螺栓31,缓冲机构32,旋转块33,旋转套筒34组成。由于旋转块33、旋转套筒34、转盘28会形成旋转副,故图5中缓冲机构与下侧缓冲机构均可以自由旋转。As shown in FIG. 5 , the guardrail device is composed of guardrail 25 , limiting block 27 , turntable 28 , adjusting mechanism 29 , slot cover 30 , bolt 31 , buffer mechanism 32 , rotating block 33 , and rotating sleeve 34 . Since the rotating block 33 , the rotating sleeve 34 and the turntable 28 form a rotating pair, the buffer mechanism and the lower buffer mechanism in FIG. 5 can both rotate freely.
如图6所示,缓冲机构32由滑槽触头35,连杆36,弹簧39以及固定垫片40组成,其中减震体38与减震体盖37采用螺纹连接,滑槽触头35与连杆36采用楔形块连接,连杆36轴肩两侧装有弹簧39,通过固定垫片40固定于减震体38内。当防护栏25受到撞击后,冲击力经滑槽触头35传递至连杆36,使连杆36受压或受拉,若受压力,则右侧弹簧压缩,左侧弹簧伸长,缓冲了压力;若受拉力,右侧弹簧伸长,左侧弹簧压缩,缓冲了拉力,两种情况下均有效起到缓冲减震的作用。As shown in FIG. 6 , the buffer mechanism 32 is composed of a chute contact 35 , a connecting rod 36 , a spring 39 and a fixing washer 40 , wherein the shock absorber 38 and the shock absorber cover 37 are connected by threads, and the chute contact 35 is connected to the The connecting rod 36 is connected by a wedge block, and springs 39 are installed on both sides of the shaft shoulder of the connecting rod 36 , which are fixed in the shock absorbing body 38 through the fixing gasket 40 . When the guardrail 25 is hit, the impact force is transmitted to the connecting rod 36 through the chute contact 35, so that the connecting rod 36 is compressed or pulled. Pressure; if it is under tension, the right spring is stretched, and the left spring is compressed, which buffers the pulling force. In both cases, it effectively plays the role of buffering and shock absorption.
如图7所示,调节机构29由压板45,手柄41,第一传动轴42,第一齿轮44,第二齿轮46,第一螺纹杆49,小端盖43,大端盖48以及轴承47组成,其中,第一传动轴42由轴承47和两端盖固定在调整箱体中,手柄41与第一传动轴42采用楔形块连接,第二齿轮46与第一螺纹杆49采用螺纹连接。扭转手柄41,使第一传动轴42转动,带动齿轮44转动,通过啮合,带动第二齿轮46旋转,由于第二齿轮46的内径上的螺纹与第一螺纹杆49上的外螺纹相旋合,且限制块27限制其旋转方向的自由度,因此第一螺纹杆49只能沿轴向移动,通过滑槽触头35与防护栏上的滑槽连接,带动防护栏25移动,实现了通过旋转手柄41,来调整防护栏25的防护范围的目的。As shown in FIG. 7 , the adjustment mechanism 29 consists of a pressure plate 45 , a handle 41 , a first transmission shaft 42 , a first gear 44 , a second gear 46 , a first threaded rod 49 , a small end cap 43 , a large end cap 48 and a bearing 47 The first transmission shaft 42 is fixed in the adjustment box by the bearing 47 and the end caps, the handle 41 and the first transmission shaft 42 are connected by a wedge block, and the second gear 46 and the first threaded rod 49 are connected by a thread. Twisting the handle 41 makes the first transmission shaft 42 rotate, which drives the gear 44 to rotate, and drives the second gear 46 to rotate through meshing. , and the restriction block 27 restricts the degree of freedom of its rotational direction, so the first threaded rod 49 can only move in the axial direction, and is connected with the chute on the guard rail through the chute contact 35 to drive the guard rail 25 to move, so that the Rotate the handle 41 to adjust the protection range of the guardrail 25 .
防护栏装置防护示例与作用:示例:若承受如图5所示A向撞击力时,缓冲机构发生逆时针旋转后,受压力,右侧弹簧压缩,左侧弹簧伸长,下侧缓冲机构受拉力,右侧弹簧伸长,左侧弹簧压缩,有效起到减震作用;若承受B向撞击力时,上、下侧缓冲机构逆时针旋转后,均受拉力,右侧弹簧伸长,左侧弹簧压缩;若承受C向撞击力时,缓冲机构顺时针旋转后,受拉力,右侧弹簧伸长,左侧弹簧压缩,下侧缓冲机构受压力, 右侧弹簧压缩,左侧弹簧伸长。由此可见,防护栏无论在哪个方向上承受撞击力,防护栏装置均可有效地发挥缓冲减震的作用。防护栏装置作用:Protection examples and functions of the guardrail device: Example: If subjected to the impact force in the direction A as shown in Figure 5, after the buffer mechanism rotates counterclockwise, under pressure, the right spring is compressed, the left spring is extended, and the lower buffer mechanism is affected. Pulling force, the right spring is stretched, and the left spring is compressed, which effectively acts as a shock absorber; if it is subjected to the B-direction impact force, after the upper and lower side buffer mechanisms rotate counterclockwise, both are under tension, the right spring is stretched, and the left side is stretched. The side spring is compressed; if it is subjected to the C-direction impact force, after the buffer mechanism rotates clockwise, under tension, the right spring is stretched, the left spring is compressed, the lower buffer mechanism is under pressure, the right spring is compressed, and the left spring is stretched . It can be seen that, no matter which direction the guardrail is subjected to the impact force, the guardrail device can effectively play the role of buffering and shock absorption. The function of the guardrail device:
1、当防护栏撞到物体后,在缓冲装置的作用下,极大地减缓了撞击,有效保护了水下仿生龟的龟体及重要部件。1. When the guardrail hits the object, under the action of the buffer device, the impact is greatly slowed down, and the turtle body and important parts of the underwater bionic turtle are effectively protected.
2、可根据水下环境状况,选择装拆防护栏或调整防护栏保护范围。具体通过调节阀门41控制防护栏25防护范围,在空间狭窄的水域选择小的防护半径,在开阔的水域选择大的防护半径,具有极高的灵活性。2. According to the underwater environment, you can choose to install and remove the guardrail or adjust the protection range of the guardrail. Specifically, the protection range of the guardrail 25 is controlled by adjusting the valve 41, a small protection radius is selected in the narrow water area, and a large protection radius is selected in the open water area, which has extremely high flexibility.
3、将防护栏整体分为两个四分之一圆环,各个圆环均可独立调节,方便适应复杂的环境,若做成整体,其灵活性会变小。3. Divide the whole guardrail into two quarter rings, each ring can be adjusted independently, which is convenient to adapt to the complex environment. If it is made as a whole, its flexibility will be reduced.
4、防护栏截面呈椭圆形,类流线体型,可以减小水下仿龟机器人运动时的水阻力且降低了运动能耗。4. The cross-section of the guardrail is oval and streamlined, which can reduce the water resistance of the underwater turtle-like robot when it moves and reduce the energy consumption of the movement.
如图9所示,安全收回舱包括伺服电机50,电机套筒51,第二传动轴52,第四齿轮53,压底板54,隔板55,橡胶垫片56,上舱体57,第二螺纹杆58,舱盖59,小弹簧61,钩耳62,下舱体63,环耳64;伺服电机50通过电机套筒51与第二传动轴52连接,通过第三齿轮啮合将电机的旋转运动传递给第四齿轮53,再通过第四齿轮53内径的螺纹与第二螺纹杆58的螺纹相旋合,将旋转运动转换为第二螺纹杆58的直线运动,再由第二螺纹杆58顶开舱盖59,释放上舱体57中的压缩气囊,压缩气囊通过引线与钩耳62相连,通过压缩气囊的浮力带动安全收回舱上浮,由于安全收回舱与仿生龟壳体通过牵引线相连,故仿龟机器人也随之上浮。隔板55板用于分离上舱体57与下舱体63,并与其他部件配合完成密封,防止水进入下舱体63;压底板54与下舱体63的横板通过螺栓连接,且压底板54与横板上都开有卡槽,用于固定第二传动轴52,第三齿轮和第四齿轮53。As shown in FIG. 9 , the safe retraction compartment includes a servo motor 50, a motor sleeve 51, a second transmission shaft 52, a fourth gear 53, a pressing bottom plate 54, a partition plate 55, a rubber gasket 56, an upper cabin body 57, a second Threaded rod 58, hatch cover 59, small spring 61, hook lug 62, lower cabin 63, ring lug 64; The motion is transmitted to the fourth gear 53, and then the thread of the inner diameter of the fourth gear 53 is screwed with the thread of the second threaded rod 58, and the rotary motion is converted into the linear motion of the second threaded rod 58, and then the second threaded rod 58 Open the hatch cover 59, release the compressed air bag in the upper cabin body 57, the compressed air bag is connected with the hook ear 62 through the lead wire, and the buoyancy of the compressed air bag drives the safe retraction cabin to float up, because the safe retraction cabin is connected with the bionic turtle shell through the traction wire. , so the imitation turtle robot also floated up. The partition plate 55 is used to separate the upper cabin 57 and the lower cabin 63, and cooperate with other components to complete the sealing to prevent water from entering the lower cabin 63; Both the bottom plate 54 and the horizontal plate are provided with card slots for fixing the second transmission shaft 52 , the third gear and the fourth gear 53 .
舱体内共有三处密封,一为上下舱体之间,为静密封,用硅胶垫片密封;二为隔板55与上舱体57中的上舱体支柱之间,为静密封,用硅胶垫片密封;三为第二螺纹杆58与上舱体57中的上舱体支柱之间,为动密封,通过透明弹性膜密封,一端将第二螺纹杆58露出上舱体支柱部分完全包裹,另一端粘在上舱体支柱上。There are three seals in the cabin, one is between the upper and lower cabins, which is a static seal, which is sealed with a silicone gasket; the other is between the partition 55 and the upper cabin pillar in the upper cabin 57, which is a static seal and is sealed with silicone Gasket sealing; the third is the dynamic seal between the second threaded rod 58 and the upper cabin body pillar in the upper cabin body 57, which is sealed by a transparent elastic film, and one end of the second threaded rod 58 exposed to the upper cabin body pillar part is completely wrapped , and the other end is glued to the upper cabin strut.
安全收回舱的作用:下舱体63内拥有独立的信号接收装置、电源、控制器,操作者可向安全收回舱发出上浮命令,使舱内伺服电机转动,通过上述传动,释放压缩气囊,带动仿龟机器人上浮。具有小体积的特点,对龟体所受水阻力大小的影响很小,当主控 制器或驱动模块失灵时,可通过此装置使仿龟机器人漂浮在水面,安全收回并维修,避免遗弃在水底,节约成本,同时方便分析事故原因,并进一步改进。The function of the safety retraction cabin: the lower cabin 63 has an independent signal receiving device, power supply, and controller. The operator can issue a floating command to the safety retraction cabin to make the servo motor in the cabin rotate. A turtle-like robot floats up. It has the characteristics of small size, and has little effect on the water resistance of the turtle body. When the main controller or drive module fails, this device can make the imitation turtle robot float on the water surface, recover and maintain it safely, and avoid abandoning it at the bottom of the water. Save costs, and at the same time facilitate the analysis of the cause of the accident and further improvement.
水下仿龟机器人龟外壳很大程度模仿了海龟的外形,在三维直角坐标系下,上壳满足椭圆球面与球面方程(如图1),其方程为The shell of the underwater turtle imitation robot largely imitates the shape of the turtle. In the three-dimensional Cartesian coordinate system, the upper shell satisfies the elliptical spherical and spherical equations (as shown in Figure 1). The equation is:
Figure PCTCN2021129418-appb-000005
Figure PCTCN2021129418-appb-000005
设水下仿龟机器人的上壳高h,前端球面半径为r,经过分析表明,参数
Figure PCTCN2021129418-appb-000006
与水下仿龟机器人在水中运动时的水阻力有关,在
Figure PCTCN2021129418-appb-000007
时,结构较优,所受水阻力小,这里取
Figure PCTCN2021129418-appb-000008
此时水下仿龟机器人为扁平结构,呈流线形,极大减小了水阻力,降低了水下仿龟机器人运动能耗;龟四肢从仿生的角度出发,前肢外形为两渐开线并于肢尖相交,它们的参数方程为:
Assuming that the upper shell height of the underwater turtle imitation robot is h, and the front-end spherical radius is r, the analysis shows that the parameter
Figure PCTCN2021129418-appb-000006
It is related to the water resistance of the underwater turtle-like robot when it moves in water.
Figure PCTCN2021129418-appb-000007
When , the structure is better and the water resistance is small, here we take
Figure PCTCN2021129418-appb-000008
At this time, the underwater turtle-like robot has a flat structure and a streamline shape, which greatly reduces the water resistance and reduces the motion energy consumption of the underwater turtle-like robot. and intersect at the limb tips, their parametric equations are:
Figure PCTCN2021129418-appb-000009
Figure PCTCN2021129418-appb-000009
其截面也由两渐开线组成(如图8),以中心截面为例,具体如下:Its section is also composed of two involutes (as shown in Figure 8). Taking the central section as an example, the details are as follows:
Figure PCTCN2021129418-appb-000010
Figure PCTCN2021129418-appb-000010
其近似于飞机机翼的流线型截面,其厚度由前端到后端,先增加再逐渐减小,后肢外形由圆弧与两切线组成,四周边缘较薄,从边缘到中心,其横截面厚度逐渐增加,以上特征充分利用了水的反作用力,使四肢获得最大的推力。根据上述论证,具体几何参数选取如下表:It is similar to the streamlined section of an aircraft wing. Its thickness increases first and then gradually decreases from the front end to the rear end. The shape of the hind limb is composed of an arc and two tangents. The surrounding edges are thinner. From the edge to the center, the thickness of the cross section gradually increases Increase, the above features take full advantage of the water's reaction force, so that the limbs get the maximum thrust. According to the above arguments, the specific geometric parameters are selected as follows:
Figure PCTCN2021129418-appb-000011
Figure PCTCN2021129418-appb-000011
Figure PCTCN2021129418-appb-000012
Figure PCTCN2021129418-appb-000012
表1龟上壳模型参数及数据Table 1 Turtle upper shell model parameters and data
模型参数Model parameters r 1(mm) r 1 (mm) C 1(°) C 1 (°) r 2(mm) r 2 (mm) C 2(°) C 2 (°)
前肢外形数据Forelimb shape data 100100 240°—270°240°—270° 5050 210°—265°210°—265°
表2前肢外形模型参数及数据Table 2 Forelimb shape model parameters and data
模型参数Model parameters r′ 1(mm) r′ 1 (mm) C′ 1(°) C′ 1 (°) r′ 2(mm) r′ 2 (mm) C′ 2(°) C′ 2 (°)
四肢截面数据Cross-sectional data of limbs 150150 210°—226°210°—226° 200200 210°—221°210°—221°
表3四肢截面模型参数及数据Table 3 Model parameters and data of limb section
等强度变厚设计:通过对水下仿龟机器人上壳进行等强度变厚设计,防止安全裕度出现严重过剩,减少了壳体材料的使用,降低了成本,同时保持了良好的抗压和抗冲击能力。Equal-strength thickening design: Through the equal-strength thickening design of the upper shell of the underwater turtle imitation robot, the safety margin is prevented from being seriously excessive, the use of shell materials is reduced, and the cost is reduced, while maintaining good compressive and Shock resistance.
上壳体由
Figure PCTCN2021129418-appb-000013
The upper case is made of
Figure PCTCN2021129418-appb-000013
绕x轴旋转而成,其由椭球形壳部分与球形壳部分共同组成。①、椭球形壳部分等强度变厚:在直角坐标系中,椭球壳第一、第二主曲率半径的表达式分别为Rotated around the x-axis, it consists of an ellipsoid shell part and a spherical shell part. ①. The equal strength of the ellipsoid shell becomes thicker: In the Cartesian coordinate system, the expressions of the first and second principal curvature radii of the ellipsoid shell are respectively:
Figure PCTCN2021129418-appb-000014
Figure PCTCN2021129418-appb-000014
式中a为椭球长轴半径;b为椭球短轴半径。where a is the radius of the major axis of the ellipsoid; b is the radius of the minor axis of the ellipsoid.
要求每一点的等效应力都要小于材料的屈服应力,根据相关参考文献,等强度椭球壳的等效应力公式可表示为:The equivalent stress of each point is required to be less than the yield stress of the material. According to the relevant references, the equivalent stress formula of the equal-strength ellipsoid shell can be expressed as:
Figure PCTCN2021129418-appb-000015
Figure PCTCN2021129418-appb-000015
式中,p为壳体所承受的外压,σ s为材料的屈服应力,t为壳体厚度。 In the formula, p is the external pressure on the shell, σ s is the yield stress of the material, and t is the thickness of the shell.
等强度椭球壳厚度为:The thickness of the equal-strength ellipsoid shell is:
Figure PCTCN2021129418-appb-000016
Figure PCTCN2021129418-appb-000016
将(5)式代入(7)式得:Substitute (5) into (7) to get:
Figure PCTCN2021129418-appb-000017
Figure PCTCN2021129418-appb-000017
式中,ρ为椭圆率,
Figure PCTCN2021129418-appb-000018
where ρ is the ellipticity,
Figure PCTCN2021129418-appb-000018
具体参数选取如下:选择不锈钢材料,其性能参数:屈服应力σ s=385Mpa,在200m水深时: The specific parameters are selected as follows: select stainless steel material, and its performance parameters: yield stress σ s = 385Mpa, at 200m water depth:
Figure PCTCN2021129418-appb-000019
Figure PCTCN2021129418-appb-000019
表4椭球形壳部分相关数据Table 4 The relevant data of the ellipsoid shell part
②、球形壳部分等强度变厚②, the strength of the spherical shell part becomes thicker
球壳第一、第二曲率半径为:The first and second curvature radii of the spherical shell are:
R 1=R 2=R              (9) R 1 =R 2 =R (9)
式中,R为球壳体半径。where R is the radius of the spherical shell.
由(6)式得From (6), we get
等强度球壳等效应力公式Equivalent stress formula of equal-strength spherical shell
Figure PCTCN2021129418-appb-000020
Figure PCTCN2021129418-appb-000020
则等强度球壳厚度为Then the thickness of the equal-strength spherical shell is
Figure PCTCN2021129418-appb-000021
Figure PCTCN2021129418-appb-000021
具体参数选取如下:选择不锈钢材料,其性能参数:屈服应力σ s=385Mpa,在200米水 深时: The specific parameters are selected as follows: select stainless steel material, and its performance parameters: yield stress σ s = 385Mpa, at a water depth of 200 meters:
模型参数Model parameters R(mm)R(mm) D 2(mm) D 2 (mm) P(Mpa)P(Mpa) σ s(Mpa) σ s (Mpa) t(mm)t(mm)
相关数据related data 110110 78≤x≤160且y≥078≤x≤160 and y≥0 1.961.96 385385 0.280.28
表5球形壳部分相关数据Table 5 Related data of spherical shell part
前肢上、下摆动的实现:施加电压后,正极聚吡咯层氧化膨胀,负极聚吡咯层还原收缩,从而产生弯曲变形的效果,因此聚吡咯条(PPy)具有向负极方向弯曲的特性。在软体控制器通过电极片对聚吡咯条施加正向电压后,聚吡咯条(PPy)会向负极方向弯曲,达到向下弯曲的目的,从而带动前肢1向下弯曲;改变电压方向后,聚吡咯条(PPy)改变弯曲方向,达到向上弯曲的目的,从而带动前肢1向上弯曲。The realization of the upper and lower swing of the forelimb: after the voltage is applied, the positive polypyrrole layer oxidatively expands, and the negative polypyrrole layer reductively shrinks, resulting in the effect of bending deformation, so the polypyrrole strip (PPy) has the characteristic of bending in the direction of the negative electrode. After the software controller applies a forward voltage to the polypyrrole strip through the electrode sheet, the polypyrrole strip (PPy) will bend in the negative direction to achieve the purpose of bending downward, thereby driving the forelimb 1 to bend downward; after changing the voltage direction, the polypyrrole strip (PPy) will bend downward. The pyrrole strip (PPy) changes the bending direction to achieve the purpose of upward bending, thereby driving the forelimb 1 to bend upward.
四肢运动:初始状态前肢与后肢均保持水平,前肢有两个运动,分别是舵机实现的旋转运动和聚吡咯条(PPy)通电弯曲实现的上下摆动;后肢只有由舵机带动肢体实现的旋转运动,共作三个方向的旋转:横向朝上摆动、横向朝下摆动、竖向摆动。Limb movement: in the initial state, the forelimbs and hind limbs are kept horizontal, and the forelimbs have two movements, which are the rotational movement achieved by the steering gear and the up and down swing achieved by the energized bending of polypyrrole strips (PPy); the hind limbs are only rotated by the steering gear. Movement, a total of three directions of rotation: horizontal swing up, horizontal swing down, vertical swing.
本发明将密封分为静密封与动密封,静密封采用橡胶垫片密封,动密封采用硅橡胶弹性膜,由于后肢传动轴和前肢锥齿轮轴的运动幅度较小,弹性膜的一端在传动轴的外伸出的一轴段处固定,另一端粘在端盖上,端盖通过螺钉与仿生龟下壳固定,这样后肢传动轴和前肢锥齿轮轴在运动时,弹性膜能随着后肢传动轴和前肢锥齿轮轴的小幅度往复转动而发生弹性形变,同时起到了密封作用。这类似于人体肌肉带动骨骼旋转,富有弹性皮肤可以跟随做小幅转动,具有成本低、结构简单、密封可靠的优势。The invention divides the seal into static seal and dynamic seal, the static seal adopts rubber gasket to seal, and the dynamic seal adopts silicone rubber elastic membrane. It is fixed at one shaft segment that protrudes from the outside, and the other end is glued to the end cover. The end cover is fixed with the lower shell of the bionic turtle through screws, so that when the hindlimb drive shaft and the forelimb bevel gear shaft move, the elastic film can be driven with the hindlimb. The small reciprocating rotation of the shaft and the forelimb bevel gear shaft causes elastic deformation, and at the same time plays a sealing role. This is similar to the rotation of bones driven by human muscles, and the elastic skin can follow it to make small rotations, which has the advantages of low cost, simple structure and reliable sealing.
传感器:在水下仿龟机器人顶部安装压力传感器,通过压力的大小来判断它的实时深度;添加温湿度传感器来检测龟体内部密封性,若发生进水,会立即报警;增设陀螺仪调整龟体姿态;在水下仿龟机器人头部安装摄像头进行观察。Sensor: A pressure sensor is installed on the top of the underwater turtle imitation robot, and its real-time depth is judged by the magnitude of the pressure; a temperature and humidity sensor is added to detect the internal sealing of the turtle body, and an alarm will be issued immediately if water enters; a gyroscope is added to adjust the turtle body posture; a camera is installed on the head of the underwater turtle-like robot for observation.
本发明提供一种水下仿龟机器人控制方法,包括如下步骤:The invention provides a control method for an underwater turtle imitation robot, comprising the following steps:
第一步:检查、布放与下潜Step 1: Check, deploy and dive
首先对水下仿龟机器人进行检查,主要内容为四肢是否正常运动、密封是否完好、传感器是否正常工作、电量是否充足等。选择合适的水域,将水下仿龟机器人轻轻放入水中。First, check the underwater turtle-like robot, the main content is whether the limbs move normally, whether the seal is intact, whether the sensor is working normally, whether the power is sufficient, etc. Choose a suitable water area and gently put the underwater turtle robot into the water.
下潜由前肢与后肢的相互配合来完成,具体如下:后肢舵机3得到指令后,后肢左侧舵机顺时针旋转90°,同时后肢右侧舵机逆时针旋转90°,让两侧后肢均保持竖直 向上,并以此为中心位置往复摆动共60°,通过舵机套筒17带动连轴8,由小弹性带9带动后肢传动轴10转动,完成后肢1横向朝上往复摆动共60°,获得向下推力,且在整个过程中运动保持。同时,前肢舵机18得到指令后,前肢左侧舵机顺时针旋转30°,前肢右侧舵机逆时针旋转30°,通过锥齿轮轴16将运动传给了前肢锥齿轮轴15,这样使两侧前肢21前端上升。此时,前肢舵机18停止转动,接着软体控制模块向聚吡咯条(PPy)22施加反向电压,使后肢向后上方拍动,这样由水的反作用力推动龟体向前下方运动。接着断开电源与聚吡咯条(PPy)22的连接,然后前肢舵机18会得到反向旋转运动指令,逆时针旋转第一次旋转角的两倍,即60°,使前肢21后端上升,前肢舵机18即停转,软体控制模块再向聚吡咯条(PPy)22施加反向电压,使其向前上方拍动,这样由水的反作用力推动龟体向后下方运动。此后按此顺序反复接通,完成下潜运动。The dive is completed by the mutual cooperation of the forelimb and the hindlimb. The details are as follows: after the hindlimb servo 3 is commanded, the left servo of the hindlimb rotates 90° clockwise, while the right servo of the hindlimb rotates 90° counterclockwise, so that the hindlimbs on both sides are rotated 90° counterclockwise. They are all kept vertically upward, and oscillate reciprocatingly for a total of 60° with this as the center position. The connecting shaft 8 is driven by the steering gear sleeve 17, and the rear limb drive shaft 10 is driven by the small elastic belt 9 to rotate, and the rear limb 1 is oscillated horizontally upward for a total of 60°, a downward thrust is obtained, and the motion is maintained throughout. At the same time, after the forelimb steering gear 18 is instructed, the left steering gear of the forelimb rotates 30° clockwise, and the right steering gear of the forelimb rotates 30° counterclockwise, and the motion is transmitted to the forelimb bevel gear shaft 15 through the bevel gear shaft 16, so that the The front ends of the forelimbs 21 on both sides rise. At this time, the forelimb steering gear 18 stops rotating, and then the software control module applies a reverse voltage to the polypyrrole strip (PPy) 22 to make the hind limbs flap backward and upward, so that the reaction force of the water pushes the turtle body to move forward and downward. Then disconnect the power supply from the polypyrrole strip (PPy) 22, and then the forelimb steering gear 18 will receive a reverse rotation motion command, and rotate counterclockwise twice the first rotation angle, that is, 60°, so that the rear end of the forelimb 21 rises , the forelimb steering gear 18 is stopped, and the software control module applies a reverse voltage to the polypyrrole strip (PPy) 22 to make it flap forward and upward, so that the reaction force of the water pushes the turtle body to move backward and downward. After that, it is repeatedly connected in this order to complete the dive.
第二步:前进Step 2: Go Forward
推进由前肢与后肢的相互配合来完成,具体如下:后肢舵机3得到指令后,往复旋转共60°,通过舵机套筒17带动连轴,由小弹性带9带动后肢传动轴10转动,完成后肢1竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持。此时,前肢全由聚吡咯条(PPy)22驱动,聚吡咯条(PPy)2被施加正电压,向下弯曲,即向下拍动,间隔合适时间,再施加负电压,使聚吡咯条(PPy)22向上弯曲,即向上拍动。如此循环,完成推进运动。在此过程中,应保持前肢与后肢摆动频率相同,便于保持平衡。The propulsion is accomplished by the mutual cooperation of the forelimb and the hindlimb. The details are as follows: after the hindlimb steering gear 3 is instructed, it rotates back and forth for a total of 60°, the connecting shaft is driven by the steering gear sleeve 17, and the hindlimb drive shaft 10 is driven by the small elastic belt 9 to rotate, After completing the vertical reciprocating swing of hind limb 1 for a total of 60°, the forward thrust is obtained, and the movement is maintained throughout the process. At this time, the forelimbs are all driven by the polypyrrole strip (PPy) 22, and the polypyrrole strip (PPy) 2 is applied with a positive voltage and bends downwards, that is, flaps down, at a suitable time interval, and then applies a negative voltage to make the polypyrrole stripe (PPy) 22. (PPy) 22 bends upwards, ie flaps upwards. This cycle completes the propulsion movement. During this process, the swing frequency of the forelimbs and hindlimbs should be kept the same, so as to maintain balance.
第三步:转向Step 3: Turn
有两种方案,均为差速转向且运动完成后,舵机需要回到原位。There are two solutions, both are differential steering and after the movement is completed, the steering gear needs to return to its original position.
方案一:由后肢实现,前肢21上下摆动共60°来保持平衡。两个后肢舵机中,一个保持不动,另一个舵机通过舵机套筒带动连轴,再由小弹性带9带动后肢传动轴10转动,实现后肢1竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持。Option 1: Realized by the hind limbs, the fore limbs 21 swing up and down a total of 60° to maintain balance. Among the two rear limb steering gears, one remains stationary, the other steering gear drives the connecting shaft through the steering gear sleeve, and then the small elastic belt 9 drives the rear limb transmission shaft 10 to rotate, so that the rear limb 1 can swing vertically back and forth for a total of 60°, and obtain Forward thrust, and motion is maintained throughout.
方案二:由前肢实现,后肢上下摆动保持平衡并提供一定推力。两个前肢中,一个保持不动,另一个运动如下:前肢舵机得到指令后,前肢左侧舵机顺时针旋转90°,前肢右侧舵机逆时针旋转90°,使前肢竖直。此时,前肢舵机立即停止转动,接着向聚吡咯条(PPy)22施加反向电压,向后拍动,这样由水的反作用力推动龟体转向。Option 2: It is realized by the front limbs, and the hind limbs swing up and down to maintain balance and provide a certain thrust. Of the two forelimbs, one remains motionless, and the other moves as follows: after the forelimb steering gear is commanded, the left forelimb servo rotates 90° clockwise, and the right forelimb servo rotates 90° counterclockwise to make the forelimb upright. At this time, the forelimb steering gear immediately stopped rotating, and then applied a reverse voltage to the polypyrrole strip (PPy) 22 and flapped it backward, so that the reaction force of the water pushed the turtle body to turn.
第四步:上浮Step 4: Float
上浮主要由后肢来完成,前肢上下摆动共60°来保持平衡。后肢运动具体如下: 后肢舵机3得到指令后,后肢左侧舵机逆时针旋转90°,同时后肢右侧舵机顺时针旋转90,以此为中心位置往复旋转共60°,通过舵机套筒17带动连轴8,由小弹性带9带动后肢传动轴5转动,完成后肢横向朝下往复摆动共60°,获得向上推力,且在整个过程中运动保持。Lifting is mainly done by the hind limbs, and the forelimbs swing up and down a total of 60° to maintain balance. The movement of the hind limb is as follows: After the rear limb servo 3 is instructed, the left servo of the hind limb rotates 90° counterclockwise, while the right servo of the hind limb rotates 90 clockwise, and the center position is reciprocated for a total of 60°. The cylinder 17 drives the connecting shaft 8, and the small elastic belt 9 drives the hindlimb drive shaft 5 to rotate, and the hindlimb oscillates horizontally downward for a total of 60° to obtain an upward thrust, and the motion is maintained throughout the process.
第五步:收回Step 5: Take Back
由后肢运动实现。后肢舵机3通过舵机套筒17带动连轴8,再由小弹性带9带动后肢传动轴10转动,实现后肢竖向往复摆动共60°,获得前进推力,划向岸边,完成回收。此外,若出现紧急故障,如主控制器或驱动模块失灵等,可通过控制安全收回舱进行收回。It is achieved by the movement of the hind limbs. The rear limb steering gear 3 drives the connecting shaft 8 through the steering gear sleeve 17, and then drives the rear limb transmission shaft 10 to rotate by the small elastic belt 9, so as to realize the vertical reciprocating swing of the rear limb for a total of 60°, obtain forward thrust, row to the shore, and complete the recovery. In addition, in the event of an emergency failure, such as failure of the main controller or drive module, it can be retracted by controlling the safe retraction compartment.

Claims (10)

  1. 一种水下仿生龟机器人,包括仿生龟上壳、仿生龟下壳、龟四肢、密封结构以及设置在龟壳体内部的用于驱动所述龟四肢动作的驱动装置;An underwater bionic turtle robot, comprising a bionic turtle upper shell, a bionic turtle lower shell, turtle limbs, a sealing structure, and a driving device arranged inside the turtle shell for driving the action of the turtle limbs;
    仿生龟上壳与仿生龟下壳之间用硅橡胶相隔用于静密封且用螺钉连接;The upper shell of the bionic turtle and the lower shell of the bionic turtle are separated by silicone rubber for static sealing and connected with screws;
    所述龟四肢分为前肢与后肢,后肢传动轴伸出龟壳体的轴段处和仿生龟下壳之间、以及前肢锥齿轮轴伸出龟壳体的轴段处与仿生龟下壳之间分别设有防水用的硅橡胶弹性膜;The four limbs of the turtle are divided into forelimbs and hindlimbs, and the transmission shaft of the hindlimb protrudes from the shaft section of the tortoise shell and between the lower shell of the bionic tortoise, and between the shaft section of the forelimb bevel gear shaft protruding from the tortoise shell and the lower shell of the bionic tortoise. There are silicone rubber elastic membranes for waterproofing;
    在水下仿龟机器人顶部安装压力传感器,通过压力的大小来判断它的实时深度;在水下仿龟机器人内部安装温湿度传感器来检测龟体内部密封性,若发生进水,会立即报警;在龟壳体上设置陀螺仪调整龟体姿态;在水下仿龟机器人头部安装摄像头进行观察,其特征在于,所述仿生龟上壳由椭球形壳部分与球形壳部分共同组成,A pressure sensor is installed on the top of the underwater turtle-like robot, and its real-time depth is judged by the magnitude of the pressure; a temperature and humidity sensor is installed inside the underwater turtle-like robot to detect the internal sealing of the turtle body. If water enters, it will immediately alarm; A gyroscope is arranged on the turtle shell to adjust the attitude of the turtle body; a camera is installed on the head of the underwater turtle imitation robot for observation, and it is characterized in that the upper shell of the bionic turtle is composed of an ellipsoid shell part and a spherical shell part,
    所述椭球形壳部分的壳体厚度通过以下公式获得:The shell thickness of the ellipsoid shell portion is obtained by the following formula:
    Figure PCTCN2021129418-appb-100001
    Figure PCTCN2021129418-appb-100001
    式中,p为壳体所承受的外压,σ s为材料的屈服应力,a为椭球长轴半径,ρ为椭圆率,t为壳体厚度,x,y为直角坐标系; In the formula, p is the external pressure on the shell, σ s is the yield stress of the material, a is the radius of the major axis of the ellipsoid, ρ is the ellipticity, t is the thickness of the shell, and x and y are the Cartesian coordinate system;
    所述球形壳部分的壳体厚度通过以下公式获得:The shell thickness of the spherical shell portion is obtained by the following formula:
    Figure PCTCN2021129418-appb-100002
    Figure PCTCN2021129418-appb-100002
    式中,R为球壳体半径。where R is the radius of the spherical shell.
  2. 根据权利要求1所述的水下仿生龟机器人,其特征在于,还包括防护栏机构,与所述龟壳体之间可拆卸连接,所述防护栏机构包括两组,对称布置在所述龟壳体左、右两侧,每组防护栏机构均包括:The underwater bionic turtle robot according to claim 1, further comprising a guardrail mechanism, which is detachably connected to the turtle shell, and the guardrail mechanism includes two groups, which are symmetrically arranged on the tortoise shell. On the left and right sides of the housing, each set of guardrail mechanisms includes:
    防护栏,呈四分之一圆环结构,防护栏内侧一端通过缓冲机构与所述龟壳体连接,防护栏内侧另一端通过调节机构与所述龟壳体连接;The guardrail has a quarter ring structure, one end of the inner side of the guardrail is connected to the turtle shell through a buffer mechanism, and the other end of the inner side of the guardrail is connected to the turtle shell through an adjustment mechanism;
    所述缓冲机构包括柱形减震腔、连杆以及弹簧,其中,柱形减震腔中设置所述弹簧,柱形减震腔的一端设有杆孔;The buffer mechanism includes a cylindrical shock absorbing cavity, a connecting rod and a spring, wherein the spring is arranged in the cylindrical shock absorbing cavity, and one end of the cylindrical shock absorbing cavity is provided with a rod hole;
    所述防护栏的内侧设有滑槽,连杆一端设有与所述滑槽配合的第一滑槽触头, 连杆另一端通过所述杆孔伸入所述柱形减震腔;The inner side of the guardrail is provided with a chute, one end of the connecting rod is provided with a first chute contact matched with the chute, and the other end of the connecting rod extends into the cylindrical shock absorbing cavity through the rod hole;
    所述连杆的中部设有轴肩,所述轴肩将所述连杆位于减震体内腔中的部分分为第一连杆段和第二连杆段,所述第一连杆段和第二连杆段上分别套接有一个所述弹簧;The middle part of the connecting rod is provided with a shaft shoulder, and the shaft shoulder divides the part of the connecting rod located in the cavity of the shock absorber into a first connecting rod segment and a second connecting rod segment, the first connecting rod segment and the The second connecting rod segments are respectively sleeved with one of the springs;
    柱形减震腔底部外侧通过铰接件与所述龟壳体转动连接;The outer side of the bottom of the cylindrical shock-absorbing cavity is rotatably connected with the turtle shell through a hinge;
    所述调节机构包括调整箱、输入轴、第一齿轮、第二齿轮以及第一螺纹杆,其中,The adjustment mechanism includes an adjustment box, an input shaft, a first gear, a second gear and a first threaded rod, wherein,
    所述调整箱设置在龟壳体上,第一调整箱中平行设置第一螺纹杆和第一传动轴,所述第一螺纹杆和第一传动轴之间通过齿轮传动组传动连接;The adjustment box is arranged on the turtle shell, a first threaded rod and a first transmission shaft are arranged in parallel in the first adjustment box, and the first threaded rod and the first transmission shaft are connected by transmission through a gear transmission group;
    所述第一传动轴外端伸出调整箱体连接有调节手柄;The outer end of the first transmission shaft extends out of the adjustment box and is connected with an adjustment handle;
    所述第一螺纹杆的外端通过第二滑槽触头与所述防护栏之间滑动连接,第一螺纹杆的内端部设有限制块。The outer end of the first threaded rod is slidably connected to the guardrail through the second sliding groove contact, and a restriction block is provided on the inner end of the first threaded rod.
  3. 根据权利要求2所述的水下仿生龟机器人,其特征在于,所述防护栏的横截面呈椭圆形,类流线体型。The underwater bionic turtle robot according to claim 2, wherein the cross-section of the guardrail is oval and streamline-like.
  4. 根据权利要求1所述的水下仿生龟机器人,其特征在于,所述前肢以舵机驱动结合软体驱动的方式实现双自由度运动:一为舵机驱动:由前肢舵机提供动力经前肢锥齿轮组带动前肢转动;二为聚吡咯条驱动:前肢的两面上对称贴覆有多个聚吡咯条,多个聚吡咯条与夹片下电极片相连,后接导线并通过前肢锥齿轮轴中心孔接到软体驱动控制模块,由软体控制模块控制聚吡咯条,带动前肢上、下摆动;The underwater bionic turtle robot according to claim 1, wherein the forelimbs are driven by a steering gear combined with a software drive to realize double-degree-of-freedom motion: one is driven by the steering gear: the forelimb steering gear provides power through the forelimb cone The gear set drives the forelimb to rotate; the second is driven by the polypyrrole strips: the two sides of the forelimb are symmetrically covered with a plurality of polypyrrole strips, which are connected to the electrode plate under the clip, and then connected to the wire through the center of the bevel gear shaft of the forelimb. The hole is connected to the software drive control module, and the software control module controls the polypyrrole strip to drive the forelimb to swing up and down;
    所述后肢的驱动装置包括后肢舵机,舵机盘,轴承座,连轴,小弹性带以及后肢传动轴,其中,所述后肢舵机、舵机盘、舵机套筒之间通过螺钉连接,螺钉连接连轴与舵机套筒;所述小弹性带将动力传给后肢传动轴,驱动后肢做出旋转运动。The driving device of the rear limb includes a rear limb steering gear, a steering gear disc, a bearing seat, a connecting shaft, a small elastic belt and a rear limb transmission shaft, wherein the rear limb steering gear, the steering gear disc and the steering gear sleeve are connected by screws. , the connecting shaft and the steering gear sleeve are connected by screws; the small elastic belt transmits the power to the rear limb transmission shaft, and drives the rear limb to make a rotating motion.
  5. 根据权利要求1所述的水下仿生龟机器人,其特征在于,所述仿生龟下壳两侧设有平衡翼,用于辅助维持平衡。The underwater bionic turtle robot according to claim 1, wherein balance wings are provided on both sides of the lower shell of the bionic turtle to assist in maintaining balance.
  6. 根据权利要求1所述的水下仿生龟机器人,其特征在于,还包括安全收回舱,通过牵引线与龟壳体相连,包括:The underwater bionic tortoise robot according to claim 1, further comprising a safe retraction cabin connected to the tortoise shell through a traction wire, comprising:
    一舱体,所述舱体内设有隔板,所述隔板将舱体分为上舱体与下舱体,上舱 体上设有可打开或关闭的舱盖,上舱体内设有压缩气囊,压缩气囊底部通过引线与固定在上舱体内腔中的钩耳连接;A cabin, the cabin is provided with a partition, the partition divides the cabin into an upper cabin and a lower cabin, the upper cabin is provided with a hatch cover that can be opened or closed, and the upper cabin is provided with a compression Airbag, the bottom of the compressed airbag is connected with the hook ear fixed in the inner cavity of the upper cabin through the lead wire;
    所述下舱体为密封舱,下舱体内设有舱盖打开机构,舱盖打开机构包括:平行设置的第二传动轴和第二螺纹杆,第二传动轴和第二螺纹杆之间通过齿轮传动机构连接。The lower cabin is a sealed cabin, and the lower cabin is provided with a hatch cover opening mechanism. The hatch cover opening mechanism includes: a second transmission shaft and a second threaded rod arranged in parallel, and the second transmission shaft and the second threaded rod pass through The gear transmission mechanism is connected.
    伺服电机,与第二传动轴驱动连接,舱盖打开机构中的第二螺纹杆的部分穿过所述隔板伸入所述上舱体中,在伺服电机的驱动下,第二螺纹杆能够在所述舱体内沿上、下方向移动以打开所述舱体的舱盖;The servo motor is drivingly connected with the second transmission shaft, and the part of the second threaded rod in the hatch opening mechanism penetrates the baffle and protrudes into the upper cabin. Driven by the servo motor, the second threaded rod can move in the up and down direction inside the cabin to open the hatch cover of the cabin;
    所述下舱体内还设有横板和压底板,所述横板和压底板之间通过螺栓连接,且压底板与横板上都开有卡槽,用于固定第二传动轴和齿轮传动组;The lower cabin is also provided with a transverse plate and a pressure bottom plate, the transverse plate and the pressure bottom plate are connected by bolts, and the pressure plate and the transverse plate are both provided with card slots for fixing the second transmission shaft and the gear transmission. Group;
    所述舱体内还设有信号接收装置,用于接收外部的信号;The cabin is also provided with a signal receiving device for receiving external signals;
    控制器,其输入端与所述信号接收装置连接,其输出端与所述伺服电机连接;a controller, the input end of which is connected to the signal receiving device, and the output end of which is connected to the servo motor;
    电源,为所述伺服电机、信号接收装置以及控制器供电;a power supply, which supplies power to the servo motor, the signal receiving device and the controller;
    舱体内共有三处密封,第一处为上舱体和下舱体之间,为静密封,用硅胶垫片密封;There are three seals in the cabin, the first is between the upper cabin and the lower cabin, which is a static seal and is sealed with a silicone gasket;
    第二处为隔板与上舱体中的上舱体支柱之间,为静密封,用硅胶垫片密封;The second place is between the bulkhead and the upper cabin pillar in the upper cabin, which is a static seal and is sealed with a silicone gasket;
    第三处为第二螺纹杆与上舱体中的上舱体支柱之间,为动密封,通过透明弹性膜密封,一端将第二螺纹杆露出上舱体支柱部分完全包裹,另一端粘在上舱体支柱上。The third place is between the second threaded rod and the upper cabin strut in the upper cabin. It is a dynamic seal. It is sealed by a transparent elastic film. on the upper hull strut.
  7. 根据权利要求1所述的水下仿生龟机器人,其特征在于,The underwater bionic turtle robot according to claim 1, wherein,
    龟四肢从仿生的角度出发,前肢外形为两渐开线并于肢尖相交,当采用直角坐标来表示时,它们的方程式为:From the perspective of bionics, the tortoise's limbs are formed by two involutes that intersect at the tips of the limbs. When represented by Cartesian coordinates, their equations are:
    Figure PCTCN2021129418-appb-100003
    Figure PCTCN2021129418-appb-100003
    式中,u i=θ ii,θ i为展角,α i为压力角,r i为基圆半径, In the formula, u iii , θ i is the expansion angle, α i is the pressure angle, ri i is the radius of the base circle,
    C 1为角度u1的取值范围,范围是240°~270°、C 2为角度u2的取值范围,范围是210°~265°; C 1 is the value range of the angle u1, the range is 240°~270°, C 2 is the value range of the angle u2, the range is 210°~265°;
    其截面也由两渐开线组成,以中心截面为例,具体如下:Its section is also composed of two involutes, taking the central section as an example, as follows:
    Figure PCTCN2021129418-appb-100004
    Figure PCTCN2021129418-appb-100004
    式中,u′ i=θ′ i+α′ i,θ′ i为展角,α′ i为压力角,r i′为基圆半径,C′ 1为角度u′ 1的取值范围,范围是210°~226°、C′ 2为角度u′ 2的取值范围,范围是210°~221°; In the formula, u′ i = θ′ i +α′ i , θ′ i is the expansion angle, α′ i is the pressure angle, ri i ′ is the radius of the base circle, C′ 1 is the value range of the angle u′ 1 , The range is 210°~226°, C' 2 is the value range of the angle u' 2 , and the range is 210°~221°;
    其厚度由前端到后端,先增加再逐渐减小;Its thickness increases first and then gradually decreases from the front end to the rear end;
    后肢的四周边缘较薄,从边缘到中心,其横截面厚度逐渐增加。The hindlimbs are thin around the edges, with a gradual increase in cross-sectional thickness from the edge to the center.
  8. 根据权利要求1所述的水下仿生龟机器人,其特征在于,仿龟机器人外壳呈流线形。The underwater bionic turtle robot according to claim 1, wherein the shell of the turtle-like robot is streamlined.
  9. 一种基于权利要求4所述水下仿生龟机器人的工作方法,其特征在于,A working method based on the underwater bionic turtle robot according to claim 4, characterized in that,
    第一步:检查、布放与下潜Step 1: Check, deploy and dive
    首先对水下仿龟机器人进行检查,主要内容为四肢是否正常运动、密封是否完好、传感器是否正常工作、电量是否充足,选择合适的水域,将水下仿龟机器人放入水中;First, check the underwater turtle-like robot. The main contents are whether the limbs move normally, whether the seal is intact, whether the sensor is working normally, and whether the power is sufficient. Select the appropriate water area and put the underwater turtle-like robot into the water;
    下潜由前肢与后肢的相互配合来完成,具体如下:后肢舵机得到指令后,后肢左侧舵机顺时针旋转90°,同时后肢右侧舵机逆时针旋转90°,让两侧后肢均保持竖直向上,并以此为中心位置往复摆动共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢横向朝上往复摆动共60°,获得向下推力,且在整个过程中运动保持;同时,前肢舵机得到指令后,前肢左侧舵机顺时针旋转30°,前肢右侧舵机逆时针旋转30°,通过前肢锥齿轮组将运动传给了前肢,这样使两侧前肢前端上升,此时,前肢舵机停止转动,接着软体控制模块向聚吡咯条施加反向电压,使后肢向后上方拍动,这样由水的反作用力推动龟体向前下方运动;The dive is completed by the cooperation of the forelimb and the hindlimb. The details are as follows: after the hindlimb servo is instructed, the left servo of the hindlimb rotates 90° clockwise, while the right servo of the hindlimb rotates 90° counterclockwise, so that both hindlimbs are equally Keep vertical and upward, and swing back and forth for a total of 60° at this center position, drive the connecting shaft through the steering gear sleeve, and drive the rear limb drive shaft to rotate by the small elastic belt. At the same time, after the forelimb steering gear is commanded, the left forelimb servo rotates 30° clockwise, and the right forelimb servo rotates 30° counterclockwise, and the motion is transmitted to the forelimb bevel gear set. The forelimbs are lifted, so that the front ends of the forelimbs on both sides rise. At this time, the forelimb steering gear stops rotating, and then the software control module applies a reverse voltage to the polypyrrole strips, so that the hind limbs flap backwards and upwards, so that the reaction force of the water pushes the turtle body move forward and downward;
    接着断开电源与聚吡咯条的连接,然后前肢舵机会得到反向旋转运动指令,逆时针旋转第一次旋转角的两倍,即60°,使前肢后端上升,前肢舵机即停转,软体控制模块再向聚吡咯条施加反向电压,使其向前上方拍动,这样由水的反作用力推动龟体向后下方运动,此后按此顺序反复接通,完成下潜运动;Then disconnect the power supply and the polypyrrole strip, and then the forelimb rudder will get a reverse rotation motion command, and rotate counterclockwise twice the first rotation angle, that is, 60°, so that the rear end of the forelimb will rise, and the forelimb rudder will stop. , the software control module applies a reverse voltage to the polypyrrole strip to make it flap forward and upward, so that the reaction force of the water pushes the turtle body to move backward and downward, and then it is repeatedly turned on in this order to complete the diving movement;
    第二步:前进Step 2: Go Forward
    推进由前肢与后肢的相互配合来完成,具体如下:后肢舵机得到指令后,往复旋转共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢1竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持,此时,前肢全由聚吡咯条驱动,聚吡咯条被施加正电压,向下弯曲,即向下拍动,间隔合适时间,再施加负电压,使聚吡咯条向上弯曲,即向上拍动,如此循环,完成推进运动,在此过程中,应保持前肢与后肢摆动频率相同,便于保持平衡;The propulsion is accomplished by the mutual cooperation of the forelimb and the hindlimb. The details are as follows: after the servo of the hindlimb is commanded, it rotates back and forth for a total of 60°, the connecting shaft is driven by the steering gear sleeve, and the drive shaft of the hindlimb is driven by the small elastic belt to rotate, and the hindlimb is erected. Swing back and forth for a total of 60°, obtain forward thrust, and keep the movement during the whole process. At this time, the forelimbs are all driven by the polypyrrole strips, and the polypyrrole strips are applied with a positive voltage and bend downward, that is, flap down, with appropriate intervals Time, and then apply a negative voltage to make the polypyrrole strips bend upwards, that is, flap upwards. This cycle completes the propulsion movement. During this process, the swing frequency of the forelimb and the hindlimb should be kept the same, so as to maintain balance;
    第三步:转向Step 3: Turn
    有两种方案,均为差速转向且运动完成后,舵机需要回到原位,There are two solutions, both are differential steering and after the movement is completed, the steering gear needs to return to its original position,
    方案一:由后肢实现,前肢上下摆动共60°来保持平衡,两个后肢舵机中,一个保持不动,另一个后肢舵机通过舵机套筒带动连轴,再由小弹性带带动后肢传动轴转动,实现后肢竖向往复摆动共60°,获得前进推力,且在整个过程中运动保持;Option 1: Realized by the hind limbs, the forelimbs swing up and down a total of 60° to maintain balance, one of the two hind limb servos remains stationary, the other hind limb servo drives the connecting shaft through the steering gear sleeve, and then the small elastic belt drives the hind limbs The drive shaft rotates to realize the vertical reciprocating swing of the hind limbs for a total of 60°, obtain forward thrust, and keep the movement during the whole process;
    方案二:由前肢实现,后肢上下摆动保持平衡并提供一定推力,两个前肢中,一个保持不动,另一个运动如下:前肢舵机得到指令后,前肢左侧舵机顺时针旋转90°,前肢右侧舵机逆时针旋转90°,使两侧前肢竖直,此时,前肢舵机立即停止转动,接着向聚吡咯条施加反向电压,向后侧拍动,这样由水的反作用力推动龟体转向;Option 2: Realized by the forelimb, the hind limb swings up and down to maintain a balance and provide a certain thrust, one of the two forelimbs remains motionless, and the other moves as follows: after the forelimb servo is commanded, the left forelimb servo rotates 90° clockwise, The steering gear on the right side of the forelimb is rotated 90° counterclockwise, so that the forelimbs on both sides are vertical. At this time, the steering gear of the forelimb stops rotating immediately, and then applies a reverse voltage to the polypyrrole strip and flaps it to the rear side, so that the reaction force of the water is caused by the water. Push the turtle body to turn;
    第四步:上浮Step 4: Float
    上浮主要由后肢来完成,前肢上、下摆动共60°来保持平衡,后肢运动具体如下:后肢舵机得到指令后,后肢左侧舵机逆时针旋转90°,同时后肢右侧舵机顺时针旋转90,让两侧后肢均保持竖直向下,以此为中心位置往复旋转共60°,通过舵机套筒带动连轴,由小弹性带带动后肢传动轴转动,完成后肢横向朝下往复摆动共60°,获得向上推力,且在整个过程中运动保持;The uplift is mainly accomplished by the hind limbs. The forelimbs swing up and down a total of 60° to maintain balance. The movement of the hind limbs is as follows: After the hind limb servo is commanded, the left servo of the hind limb rotates 90° counterclockwise, while the right servo of the hind limb rotates clockwise. Rotate 90 degrees, keep both hind limbs vertically downward, and rotate back and forth for a total of 60° with this as the center position, drive the connecting shaft through the steering gear sleeve, and drive the hind limb drive shaft to rotate by the small elastic belt, and complete the horizontal reciprocation of the hind limbs downward. Swing a total of 60°, get upward thrust, and maintain motion throughout the process;
    第五步:收回Step 5: Take Back
    由后肢运动实现,后肢舵机通过舵机套筒带动连轴,再由小弹性带带动后肢传动轴转动,实现后肢竖向往复摆动共60°,获得前进推力,划向岸边,完成回收,此外,在整个过程中,。It is realized by the movement of the hind limb, the steering gear of the hind limb drives the connecting shaft through the steering gear sleeve, and then the drive shaft of the hind limb is driven to rotate by the small elastic belt, so as to realize the vertical reciprocating swing of the hind limb for a total of 60°, obtain the forward thrust, row to the shore, and complete the recovery. Also, throughout the process, .
  10. 一种基于权利要求6所述的所述水下仿生龟机器人的工作方法,其特征在于,若出现紧急故障,通过控制安全收回舱进行收回安全收回,具体是:A working method based on the described underwater bionic turtle robot according to claim 6, characterized in that, if an emergency failure occurs, the safe recovery is carried out by controlling the safe recovery cabin, specifically:
    操作者向安全收回舱发出上浮命令,使舱内伺服电机转动,通过舱盖打开机构打开舱盖,释放压缩气囊,带动仿龟机器人上浮。The operator sends an ascending command to the safe retraction cabin, so that the servo motor in the cabin rotates, the hatch cover is opened through the hatch cover opening mechanism, the compressed air bag is released, and the imitation turtle robot is driven to float up.
PCT/CN2021/129418 2020-11-16 2021-11-09 Underwater turtle-like robot and control method thereof WO2022100557A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202011277617.XA CN114506428B (en) 2020-11-16 2020-11-16 Underwater tortoise-like robot and control method thereof
CN202011277617.X 2020-11-16

Publications (1)

Publication Number Publication Date
WO2022100557A1 true WO2022100557A1 (en) 2022-05-19

Family

ID=81546761

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2021/129418 WO2022100557A1 (en) 2020-11-16 2021-11-09 Underwater turtle-like robot and control method thereof

Country Status (2)

Country Link
CN (1) CN114506428B (en)
WO (1) WO2022100557A1 (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114954875A (en) * 2022-07-14 2022-08-30 郜旭 Frog-imitating underwater robot
CN115200917A (en) * 2022-09-18 2022-10-18 江苏壹心智能科技有限公司 Test cabin for equipment operation factory detection
CN115406688A (en) * 2022-08-02 2022-11-29 北京蔚蓝集智科技有限公司 Bionic fishtail swing performance testing device and testing method
CN115534601A (en) * 2022-10-15 2022-12-30 哈尔滨商业大学 Bionic robot
CN115751002A (en) * 2022-12-01 2023-03-07 山东航宇数字勘测有限公司 Pipeline detection robot capable of adapting to pipeline diameter
CN116619197A (en) * 2023-07-12 2023-08-22 宁波君瑞精密模具有限公司 Grinding device is used in box mould production

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114834619A (en) * 2022-05-23 2022-08-02 北京市文汇中学 Bionic turtle water quality monitoring robot

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101016081A (en) * 2007-03-01 2007-08-15 北京大学 Bionic machinery chelonian with two-stage freedom degree flipper mechanism
CN201143991Y (en) * 2007-04-30 2008-11-05 哈尔滨工程大学 Bionic turtle underwater robot
US20140343728A1 (en) * 2011-12-15 2014-11-20 Korea Institute Of Ocean Science & Technology Multi-joint underwater robot having complex movement functions of walking and swimming and underwater exploration system using same
CN104648638A (en) * 2015-02-11 2015-05-27 江苏科技大学 Deep sea bionic pressureproof shell
CN108974289A (en) * 2018-08-16 2018-12-11 东莞市奇趣机器人科技有限公司 A kind of underwater robot combined type Anti-collision mechanism
CN209336974U (en) * 2019-01-08 2019-09-03 百奥创新(天津)科技有限公司 Amphibious bionic turtle robot
CN111350798A (en) * 2020-04-10 2020-06-30 橙色云设计有限公司 Gear linkage structure imitating turtle leg movement and bionic turtle movement system
CN111688886A (en) * 2020-05-22 2020-09-22 中船重工(青岛)海洋装备研究院有限责任公司 All-dimensional anti-collision device of shipborne ocean underwater detection device

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6790119B1 (en) * 2003-06-27 2004-09-14 Francis See Chong Chia Swimming toy animal
CN100584695C (en) * 2007-04-30 2010-01-27 哈尔滨工程大学 Bionic underwater chelonian robot
CN205801466U (en) * 2016-07-12 2016-12-14 上海海洋大学 A kind of bionical Testudinis device

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101016081A (en) * 2007-03-01 2007-08-15 北京大学 Bionic machinery chelonian with two-stage freedom degree flipper mechanism
CN201143991Y (en) * 2007-04-30 2008-11-05 哈尔滨工程大学 Bionic turtle underwater robot
US20140343728A1 (en) * 2011-12-15 2014-11-20 Korea Institute Of Ocean Science & Technology Multi-joint underwater robot having complex movement functions of walking and swimming and underwater exploration system using same
CN104648638A (en) * 2015-02-11 2015-05-27 江苏科技大学 Deep sea bionic pressureproof shell
CN108974289A (en) * 2018-08-16 2018-12-11 东莞市奇趣机器人科技有限公司 A kind of underwater robot combined type Anti-collision mechanism
CN209336974U (en) * 2019-01-08 2019-09-03 百奥创新(天津)科技有限公司 Amphibious bionic turtle robot
CN111350798A (en) * 2020-04-10 2020-06-30 橙色云设计有限公司 Gear linkage structure imitating turtle leg movement and bionic turtle movement system
CN111688886A (en) * 2020-05-22 2020-09-22 中船重工(青岛)海洋装备研究院有限责任公司 All-dimensional anti-collision device of shipborne ocean underwater detection device

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114954875A (en) * 2022-07-14 2022-08-30 郜旭 Frog-imitating underwater robot
CN115406688A (en) * 2022-08-02 2022-11-29 北京蔚蓝集智科技有限公司 Bionic fishtail swing performance testing device and testing method
CN115200917A (en) * 2022-09-18 2022-10-18 江苏壹心智能科技有限公司 Test cabin for equipment operation factory detection
CN115200917B (en) * 2022-09-18 2022-12-06 江苏壹心智能科技有限公司 Test cabin for equipment operation factory detection
CN115534601A (en) * 2022-10-15 2022-12-30 哈尔滨商业大学 Bionic robot
CN115751002A (en) * 2022-12-01 2023-03-07 山东航宇数字勘测有限公司 Pipeline detection robot capable of adapting to pipeline diameter
CN116619197A (en) * 2023-07-12 2023-08-22 宁波君瑞精密模具有限公司 Grinding device is used in box mould production
CN116619197B (en) * 2023-07-12 2023-12-08 宁波君瑞精密模具有限公司 Grinding device is used in box mould production

Also Published As

Publication number Publication date
CN114506428B (en) 2023-05-12
CN114506428A (en) 2022-05-17

Similar Documents

Publication Publication Date Title
WO2022100557A1 (en) Underwater turtle-like robot and control method thereof
WO2021004110A1 (en) Water-air amphibious cross-medium bionic robotic flying fish
CN102963514B (en) Portable underwater marine environmental monitoring aerodone
CN106379505B (en) A kind of underwater amphibious robot of single pendulum differential type with deformability
CN107651143B (en) Intelligent spherical robot with underwater sail power
CN113086136B (en) Compound propulsion bionic jellyfish robot
CN104627342A (en) Gliding machine dolphin
US3204596A (en) Hydroglider
CN106741774A (en) A kind of bionic machine fish
CN108909994B (en) Air-drop type underwater glider based on motor-driven wing unfolding
CN108116635B (en) A kind of wave self-adapting type automatic rescue ship
CN113665773A (en) Micro underwater bionic soft adsorption robot driven by contraction/expansion injection
CN113665768B (en) Octopus robot for ocean detection
CN206569240U (en) A kind of underwater robot sink-float and attitude controller
CN218806457U (en) Fish-shaped bionic aircraft
CN109080801A (en) A kind of mixed motivity type underwater glider based on the driving of the tandem wing
CN110304232A (en) A kind of air detection can flight instruments
CN111605684B (en) Shore-based remote control emergency device for rescuing drowners
AU2020103021A4 (en) A Slider-type Barycenter Regulating Mechanism and Its Control and Application Method
CN210258768U (en) Eagle ray type water surface tour device
CN204606179U (en) A kind of space maneuver tail swing propelling unit
CN208248470U (en) The civilian submersible of Biomimetic Fish shape
CN114132466A (en) Dual-drive bionic robotic fish system and multi-mode redundancy control method
CN209321192U (en) Ship stabilizer
CN206914598U (en) Bionic mechanical dolphin

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21891082

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21891082

Country of ref document: EP

Kind code of ref document: A1