Electric-hydraulic hybrid drive explosion-proof leg-foot robot
The electro-hydraulic combined drive explosion-proof legged robot addresses the lack of explosion-proof performance in robots by using a positive pressure chamber and coaxial transmission to isolate electrical components from flammable gases, ensuring safety and simplifying control algorithms in hazardous environments.
Patent Information
- Application Number
- JP2023133008
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2023-02-14
- Filing Date
- 2023-08-17
- Publication Date
- 2024-11-01
- Estimated Expiration
- 2043-08-17
AI Technical Summary
Existing robots, particularly four-legged robots, lack explosion-proof performance when operating in flammable or explosive environments, posing a risk of inducing explosions due to electrical components interacting with flammable gases.
An electro-hydraulic combined drive explosion-proof legged robot design featuring a positive pressure chamber with hydraulic cylinders and servo pumps outside the chamber, ensuring electro-hydraulic separation to prevent flammable gases from contacting electrical components, and a coaxial transmission design for the leg foot assembly joints to simplify control algorithms.
The design provides explosion-proof performance by isolating electrical components from flammable gases and simplifies the control algorithm complexity, enhancing safety and operational stability in hazardous environments.
Smart Images

Figure 0007576868000005 
Figure 0007576868000006 
Figure 0007576868000007
Abstract
Description
[Technical field]
[0001] The present application relates to the technical field of robots, and in particular to an electro-hydraulic hybrid drive explosion-proof leg-foot robot. [Background technology]
[0002] With the development of intelligent equipment, robots are increasingly being used in people's working lives. There are two types of robots: wheeled robots and legged robots. Legged robots have better adaptability to terrains and are therefore more widely used in inspection and other situations.
[0003] The related technology is disclosed in patent application number 202222609655.1, which discloses a hydraulic pump-controlled explosion-proof four-legged robot, including a hydraulic structure and a mechanical structure, the mechanical structure including an explosion-proof hold and leg and foot components, the leg and foot components including a lateral swing unit, a hip unit and a knee unit, the hydraulic structure including an accumulator and a drive unit, the drive unit including a servo motor, a hydraulic pump and a hydraulic cylinder connected in series, and each lateral swing unit, hip unit or knee unit is respectively controlled by the drive unit.
[0004] In the above related technologies, when a four-legged robot is used for inspection work in a flammable or explosive environment, there is a possibility that an explosion will be triggered when each joint motor of the four-legged robot operates, and the robot does not have explosion-proof performance. Summary of the Invention
[0005] In order to improve the problem that current robots including electric control do not have explosion-proof performance when working in flammable and explosive environments, this application provides an explosion-proof electric-hydraulic hybrid drive leg robot.
[0006] The electro-hydraulic hybrid drive explosion-proof leg-foot robot provided in this application adopts the following technical solutions.
[0007] The electro-hydraulic hybrid drive explosion-proof leg / foot robot includes a positive pressure chamber and a leg / foot assembly, the leg / foot assembly including a hydraulic cylinder, a servo pump is provided in the chamber, the hydraulic cylinder is located outside the chamber, and an oil inlet / outlet is provided in the wall of the chamber for communication between the servo pump and the hydraulic cylinder;
[0008] The leg / foot assembly includes a mounting bracket, a leg / foot swing mechanism, a hip joint mechanism and a leg / foot mechanism, the leg / foot swing mechanism and the hip joint mechanism are connected to the outside of the chamber via the mounting bracket, the hip joint mechanism is connected to the leg / foot mechanism so as to drive the leg / foot mechanism to swing inward and outward, the leg / foot swing mechanism is transmissibly connected to the hip joint mechanism, and the leg / foot swing mechanism rotatably drives the hip joint mechanism.
[0009] According to the above technical solution, the chamber adopts a positive pressure design, which can eliminate the possibility of external flammable and explosive gases entering the chamber and contacting electrical components, thus achieving the explosion-proof effect. The hydraulic cylinder is located outside the chamber, and the control unit and servo pump are located inside the chamber, which exerts the effect of electro-hydraulic isolation under the electro-hydraulic drive system, which can eliminate the possibility of flammable and explosive gases contacting electricity and causing an explosion, making the robot explosion-proof. The leg / foot swing mechanism is coaxially and transmissibly connected to the hip joint mechanism and contributes to the optimization of the robot control algorithm program.
[0010] The simplified principle of the control algorithm is explained as follows. Take the transfer of two adjacent joints as an example. The three-dimensional Cartesian coordinate system 1 (x1, y1, z1) is rotated around the z1 axis by θ1, and the three-dimensional Cartesian coordinate system 2 (x2, y2, z2) is rotated around the x2 axis by θ2. For the general two-joint transformation, the coordinate system 1 is taken as the reference coordinate system, and the spatial coordinates of the coordinate system 2 relative to the coordinate system 1 are expressed as follows: JPEG0007576868000001.jpg28170When the two joint coordinate systems intersect at the point where the origins of the two joint axes coincide, the x2, y2, and z2 matrices that indicate the origin distances of the two joint coordinate systems are 0, and the determinant in the transmission control software can be simplified. The simplified spatial coordinates are JPEG0007576868000002.jpg29170
[0011] As described above, the present application has the following beneficial technical effects. 1. The electro-hydraulic separation design and positive pressure storehouse make the robot explosion-proof. 2. The coaxial transmission design of the robot leg foot assembly joints can reduce the difficulty of the control algorithm. [Brief description of the drawings]
[0012] [Figure 1] FIG. 1 is a schematic diagram showing the structure of an electro-hydraulic hybrid drive explosion-proof leg-foot robot according to an embodiment of the present application. [Diagram 2] FIG. 2 is a top view of FIG. [Diagram 3] FIG. 2 is a schematic diagram showing the structure of a robot leg assembly according to an embodiment of the present application. [Figure 4] FIG. 4 is a schematic diagram showing the structure of a mounting bracket. [Diagram 5] FIG. 5 is a top view of FIG. [Figure 6] 6 is a cross-sectional view taken along the line AA in FIG. 5. [Figure 7] FIG. 4 is a schematic diagram showing the structure of a leg forward / backward swinging mechanism. [Figure 8] FIG. 8 is a top view of FIG. [Figure 9] 9 is a cross-sectional view taken along the line BB in FIG. 8. [Figure 10] FIG. 13 is a schematic diagram showing a connection structure at a slide rest position. [Figure 11] FIG. 2 is a schematic diagram showing the structure of a drive gear component. [Figure 12] FIG. 4 is a schematic diagram showing the structure of a mounting seat. [Figure 13]FIG. 4 is a schematic diagram showing a connection structure between the hip joint mechanism and the thigh arm. [Figure 14] 5A and 5B are schematic diagrams illustrating a structure of a connecting member. [Figure 15] FIG. 15 is a left side view of FIG. 14. [Figure 16] 16 is a cross-sectional view taken along the CC direction in FIG. 15. [Figure 17] FIG. 13 is a schematic diagram showing the structure of a lateral swing drive component. [Figure 18] FIG. 2 is a cross-sectional view of the hip joint mechanism. [Figure 19] FIG. 2 is a schematic diagram showing the structure of a leg mechanism. [Figure 20] FIG. 20 is a cross-sectional view of the plane DD in FIG. 19. [Figure 21] FIG. 2 is a schematic diagram showing the structure of the thigh arm. [Figure 22] 22 is a cross-sectional view of the E-E plane in FIG. 21. [Figure 23] FIG. 2 is a schematic diagram showing the structure of the lower leg arm. [Figure 24] 24 is a cross-sectional view of the FF plane in FIG. 23. [Diagram 25] FIG. 2 is a schematic diagram showing the local structure of the ankle joint. [Figure 26] 4 is a schematic diagram showing a connection structure between a chamber and a mounting bracket. FIG. [Figure 27] 4 is a cross-sectional view showing a connection structure between a first oil cylinder, a mounting bracket, and a first servo pump. FIG. [Figure 28] 6 is a cross-sectional view showing a connection structure between a second oil passage of the mounting bracket and a third servo pump. FIG. [Figure 29] 1 is a schematic diagram showing the mounting structure of the chamber top cover accessory. FIG. [Diagram 30] FIG. 30 is a top view of FIG. 29. [Diagram 31] FIG. 2 shows the EHA closed hydraulic system for lateral rocking and pitch of the hip joint mechanism of the present invention. [Diagram 32] FIG. 2 is a diagram showing the EHA closed hydraulic system of the knee joint of the present invention. [Diagram 33]This is an FV diagram of the load force and the velocity direction of the piston rod of the hydraulic cylinder. [Diagram 34] FIG. 2 is a diagram showing a loaded state of a knee joint. [Diagram 35] FIG. 4 is a schematic diagram showing a loaded state of a first hydraulic cylinder. [Diagram 36] FIG. 4 is a schematic diagram showing a loaded state of a second hydraulic cylinder. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0013] The present application will now be described in further detail with reference to Figures 1 to 36.
[0014] An embodiment of the present application provides an electro-hydraulic hybrid drive explosion-proof leg-foot robot.
[0015] 1 to 3, the electro-hydraulic composite drive explosion-proof leg and foot robot includes a control assembly 1 and a plurality of leg assemblies, each of which includes a mounting bracket 2, a leg and foot forward and backward swinging mechanism 3, a hip joint mechanism and a leg and foot mechanism, the hip joint mechanism includes a connecting member 4 and a lateral swinging drive mechanism 5, the leg and foot mechanism includes a thigh arm 6 and a lower leg arm 7, the connecting member 4 is rotatably connected to the mounting bracket 2, the lateral swinging drive mechanism 5 is attached to the connecting member 4, the lateral swinging drive mechanism 5 is connected to the thigh arm 6 to drive the thigh arm 6 to swing inward and outward, the leg and foot forward and backward swinging mechanism 3 rotates the hip joint mechanism to drive the leg and foot mechanism to swing forward and backward, and the leg and foot forward and backward swinging mechanism 3 and the hip joint mechanism are attached to the mounting bracket 2 and can be transmitted coaxially, simplifying the difficulty of the control system algorithm.
[0016] Referring to Figures 4 to 6, the mounting bracket 2 includes a first side plate 21, a second side plate 22 and a connecting seat 23, the first side plate 21 is arranged parallel to the second side plate 22, and the connecting seat 23 is fixed between the first side plate 21 and the second side plate 22.
[0017] A first shaft hole 25 is opened corresponding to the central portion of the second side plate 22 and the first side plate 21, and a second shaft hole 26 is opened corresponding to one end of the second side plate 22 and the first side plate 21, and the center lines of the first shaft hole 25 and the second shaft hole 26 are parallel to the longitudinal direction of the connecting seat 23.
[0018] In order to reduce the overall weight of the mounting bracket 2, weight-reducing holes are provided in the first side plate 21 and the second side plate 22, respectively, and the first side plate 21 and the second side plate 22 have a hollow structure. The contours of the ends of the first side plate 21 and the second side plate 22 corresponding to the second shaft hole 26 are rounded.
[0019] One end of the second side plate 22 remote from the second shaft hole 26 extends further than the first side plate 21 to form a fixing portion 24, and a fixing hole 221 is opened on one side of the second side plate 22 remote from the connecting seat 23. One end of the first side plate 21 remote from the second shaft hole 26 is formed in a trapezoidal shape. A mounting groove 27 is provided in the area between the connecting seat 23 and the second shaft hole 26 of the mounting bracket 2. Nail holes are opened in the mounting bracket 2 around the first shaft hole 25 and the second shaft hole 26, and the mounting bracket 2 is further provided with a plurality of connecting ribs around the second shaft hole 26. Nail holes are opened in the connecting seat 23.
[0020] 7 to 9, the leg forward / backward swing mechanism 3 includes a forward / backward swing drive component and a drive gear component, and the forward / backward swing drive component drives the drive gear component to realize the transmission.
[0021] The forward and backward swing drive components include a first hydraulic cylinder 31, a first slide rail 32, a slide rest, and a first connecting rod 35. The first slide rail 32 is fixed to the connecting seat 23 of the mounting bracket 2 via a bolt, the longitudinal direction of the first slide rail 32 is perpendicular to the axis of the first shaft hole 25, the slide rest slides relatively along the longitudinal direction of the first slide rail 32, the cylinder of the first hydraulic cylinder 31 is fixed to the fixing part 24 of the mounting bracket 2 via a bolt, the piston rod 311 of the first hydraulic cylinder 31 is connected to the slide rest, and the first hydraulic cylinder 31 drives the slide rest to reciprocate along the first slide rail 32. The first hydraulic cylinder 31 may be a double-action hydraulic cylinder.
[0022] 10, the slide rest includes a slide block 33 and a connection block 34 which are fixedly connected, and the fixing method of the slide block 33 and the connection block 34 can be bolt connection, engagement connection, embedding, welding, integral molding, etc. The slide block 33 is formed with a chute which fits with the first slide rail 32, and the slide block 33 can slide relatively along the length direction of the first slide rail 32. Here, the connection block 34 is fixed to the slide block 33 through a bolt, which is convenient for installation, removal and replacement.
[0023] An insertion port 341 is opened at one end of the connection block 34, the end of the piston rod 311 of the first hydraulic cylinder 31 is inserted into and fixed in the insertion port 341, a first ear plate 342 is fixed to the other end of the connection block 34, and the end of the first connecting rod 35 is hingedly connected to the first ear plate 342 via a pin rod, the axis of the pin rod is perpendicular to the first slide rail 32 and parallel to a plane away from the first slide rail 32 of the connection block 34, and the first connecting rod 35 can rotate on a plane passing through the first slide rail 32.
[0024] The thickness of the area of the connection block 34 where the first ear plate 342 is provided is smaller than the thickness of the area of the connection block 34 where the insertion hole 341 is provided, and in order to reduce the influence of the connection block 34 on the rotation of the first connecting rod 35, an inclined surface 343 is provided at the position of the connection block 34 between the insertion hole 341 and the first ear plate 342.
[0025] 11 and 12, the drive gear component includes a mounting seat 36 and a toothed plate 37, the mounting seat 36 includes an axial sleeve having a third axial hole 364, and a connection portion 361 for fixing the connecting toothed plate 37 is provided on the circumferential outer wall of the axial sleeve, the toothed plate 37 is detachably fixed to the connection portion 361, and the central axis of the outer edge of the teeth on the toothed plate 37 coincides with the center of the axial sleeve.
[0026] The mounting seat 36 is rotatably connected to the first shaft hole 25 of the mounting bracket 2 through the third shaft hole 364 and the rotating shaft 38, the mounting seat 36 can rotate around the rotating shaft 38, the rotating shaft 38 and the mounting bracket 2 are connected through a bearing, and the toothed plate 37 fixed to the mounting seat 36 is located in the mounting groove 27, so as to perform a gear rotation motion. When the teeth on the toothed plate 37 are worn or damaged and need to be replaced, the toothed plate 37 can be removed from the connection part 361 and a new toothed plate 37 can be installed, so that the driving gear component can still function, thereby extending the overall service life. The toothed plate 37 and the mounting seat 36 can also be connected in other detachable ways, such as engagement connection, insertion, joggling, embedding, etc.
[0027] At least one connection hole is provided in the connection part 361, and the toothed plate 37 is fixedly connected to the connection part 361 through a bolt provided in the connection hole. Here, four connection holes are provided, and the four connection holes can be uniformly distributed. In other embodiments, the number of connection holes can be 1, 2, 3, 5 or more, etc., and can be specifically selected according to actual needs.
[0028] In cases where the drive gear component does not need to perform a complete circular motion but only a partial circular motion, the toothed plate 37 can be an arc-shaped plate and correspondingly the connecting portion 361 can also be an arc-shaped plate.
[0029] A second ear plate 362 is fixed to the outer wall of the shaft sleeve, and is hingedly connected to the first connecting rod 35, and a first hydraulic cylinder 31 moves the slide rest to apply torque to the drive gear component.
[0030] When the first connecting rod 35 is at the intermediate position of the mounting seat 36, in order to prevent the first connecting rod 35 from interfering with the mounting seat 36 and affecting the rotation, an opening 313 is opened in the middle of the shaft sleeve along a curved surface in the circumferential direction, and the second ear plate 362 is disposed in the area of the outer wall of the shaft sleeve corresponding to the opening. The second ear plate 362 is provided at one end of the opening 313, and allows the mounting seat 36 to rotate at a larger angle. In other embodiments, the second ear plate 362 may be disposed at a position in the middle of the shaft sleeve corresponding to the opening 313.
[0031] In order to minimize the center of gravity shift of the entire drive gear component after the toothed plate 37 is installed, here, the two second ear plates 362 are distributed on both sides of the opening 313. The connecting portion 361 is disposed in a curved surface area of the shaft sleeve facing the opening 313. One end face of the connecting portion 361 is disposed close to the middle cross section of the opening 313, and the other end face of the connecting portion 361 is disposed away from the opening 313.
[0032] In order to facilitate the attachment and detachment of the rotating shaft 38 and the mounting seat 36, a fixing hole 315 is formed in the mounting seat 36, penetrating the side wall in the radial direction. As a result, after the mounting seat 36 is fitted onto the rotating shaft 38, a bolt is inserted into the fixing hole 315 and tightened to fix it.
[0033] To ensure tight contact between the cap of the bolt and the outer wall of the mounting seat 36 and to reduce the possibility of the bolt loosening, the area surrounding the fixing hole 315 in the outer wall of the shaft sleeve of the mounting seat 36 is flat.
[0034] In another embodiment of the present application, one second ear plate 362 is located on one side of the mounting base 36, in which case the opening 313 does not need to be opened in the mounting base 36, and when mounted, the first connecting rod 35 is hingedly connected to the second ear plate 362 from the side end of the mounting base 36.
[0035] In another embodiment of the embodiment of the present application, the number of connecting portions 361 may be two or more, the multiple connecting portions 361 may be distributed along the circumferential direction of the mounting seat 36, and the toothed plate 37 connected to the multiple connecting portions 361 may be formed into an incomplete gear. Or, at least two connecting portions 361 may be provided along the axial direction of the shaft sleeve, so that the multiple arranged connecting portions 361 may be driven to rotate when the mounting seat 36 rotates, and the driving gear component may be formed into a duplex gear structure.
[0036] According to need, the toothed plate 37 can be an arcuate plate, a sector plate, or a circular plate. The tooth coefficient on the toothed plate 37 is adjustable, so as to meet different transmission ratio requirements.
[0037] When the first hydraulic cylinder 31 drives the slide rest to move along the first slide rail 32, the first connecting rod 35 is eccentrically connected to the drive gear component, and the slide rest drives the drive gear component to rotate via the first connecting rod 35, and as the slide rest moves back and forth linearly on the first slide rail 32, the drive gear component swings back and forth around its own axis, rotating the hip joint mechanism meshed with the drive gear component to achieve forward and backward swing of the leg. Because the first hydraulic cylinder 31 drives the slide rest to move linearly, no torque effect generated by conventional motor drive occurs, making it easy to control.
[0038] Referring to FIG. 13, the hip joint mechanism includes a connection member 4 and a lateral swing drive mechanism 5, and the lateral swing drive mechanism 5 drives a thigh arm 6 to swing inward and outward.
[0039] 14 to 16, the connecting member 4 includes an attachment tube 41 and a connecting ring 42 which are fixedly connected coaxially, and a pair of support arms 43 are fixed to one end of the connecting ring 42 remote from the attachment tube 41, and the support arms 43 are rotatably connected to the thigh arm 6.
[0040] Referring to FIG. 17, the lateral swing drive mechanism 5 includes a second hydraulic cylinder 51, a second slide rail 52, a slide rest 53 and a second connecting rod 54, the second hydraulic cylinder 51 is coaxially connected to one end of the mounting tube 41 remote from the connecting ring 42, the second slide rail 52 is fixed to the inner wall of the mounting tube 41 along the axial direction of the mounting tube 41, the slide rest 53 is connected to the second slide rail 52 and slides relative to the second slide rail 52, the piston rod of the second hydraulic cylinder 51 is connected to the slide rest 53, one end of the second connecting rod 54 is connected to the slide rest 53 by a hinge, and the other end of the second connecting rod 54 is connected to the thigh arm 6 by a hinge.
[0041] The support arm 43 is rotatably connected to the thigh arm 6 to form a backup support, and the connecting member 4 is rotatably connected to the second shaft hole 26 of the mounting bracket 2 via a bearing 45, and the extension and contraction of the piston rod of the second hydraulic cylinder 51 drives the slide rest 53 in the mounting tube 41 to slide on the second slide rail 52, and the slide rest 53 drives the thigh arm 6 to swing around the rotation axis via the second connecting rod 54. Thus, when the robot moves, the axis of the second hydraulic cylinder 51 of the hip joint can be kept relatively unchanged, which simplifies the position reference and is convenient for optimizing the robot control algorithm program.
[0042] A fourth shaft hole 431 is formed at one end of the support arm 43 away from the mounting tube 41, and the axis of the fourth shaft hole 431 is perpendicular to the axis of the mounting tube 41. An inner ear plate 63 is provided at the end of the thigh arm 6, and the support arm 43 is rotatably connected to the thigh arm 6 by inserting the rotation axis of the fourth shaft hole 431, and the second connecting rod 54 is rotatably connected to the inner ear plate 63 via a pin axis.
[0043] 14 to 16, the side wall of the attachment tube 41 is provided with insertion holes 415 along the radial direction, and the driven gear 44 is fixedly fitted to the outside of the attachment tube 41. The driven gear 44 is fixed by a screw inserted into the insertion hole 415 to prevent sliding in the circumferential direction. The driven gear 44 meshes with the outer edge of the toothed plate 37, so that after the hip joint mechanism is connected to the forward / backward swing drive component via the drive gear component, the entire hip joint mechanism rotates synchronously around the axis of the attachment tube 41, and the gear transmission can improve the accuracy of the forward / backward swing of the leg. The multiple insertion holes 415 are uniformly distributed along the circumferential direction of the attachment tube 41, and uniform force is applied to the connection points of the driven gear 44 and the attachment tube 41, thereby achieving reliable fixation.
[0044] 14 to 16, a mounting groove 413 is provided in the inner wall of the mounting tube 41 along the axial direction, and fixing holes 416 are formed in the mounting groove 413 in the region of the mounting tube 41, and the second slide rail 52 is fixed to the mounting tube 41 by screws inserted through the fixing holes 416. The cross section of the mounting groove 413 may be stepped, or may have other shapes such as a rectangle, a trapezoid, a semicircle, or a circle.
[0045] In other embodiments of the present application, the second slide rail 52 may be embedded in or integrally formed with the mounting tube 41 .
[0046] The mounting tube 41 is hollow inside to form a mounting hole 411, and a positioning ring 412 is fixed to the inner wall of one end of the mounting tube 41 away from the connecting ring 42, and the cylinder end of the second hydraulic cylinder 51 abuts against the positioning ring 412 and is connected to the mounting tube 41 via a bearing.
[0047] For ease of operation and observation, an operation port 414 is further provided in the mounting tube 41, and the operation port 414 is provided near the positioning ring 412. The insertion hole 415 and the positioning ring 412 are located on both ends of the operation port 414 in the axial direction of the mounting tube 41.
[0048] The outer wall of the connecting ring 42 may have a stepped structure, and a bearing 45 is fitted into the connecting ring 42 so that the robot leg hip joint is rotatably supported on the mounting bracket 2. To protect the bearing 45, an end cap 46 is further fitted into the connecting ring 42, and the end cap 46 is fixed to the second shaft hole 26 of the mounting bracket 2 via a screw. The outer diameter of the contour of the connecting ring 42 is larger than the outer diameter of the mounting tube 41, and the connecting ring 42 can increase the structural strength of the connection between the support arm 43 and the mounting tube 41.
[0049] 14 to 16, the height of fourth shaft hole 431 on support arm 43 is set to correspond to mounting hole 411. Support arm 43 is provided with pin hole 432 along the radial direction of fourth shaft hole 431, and the rotating shaft is fixed by a screw after passing through pin hole 432, thereby achieving fixation of the rotating shaft to support arm 43, and only thigh arm 6 is able to rotate.
[0050] In order to reduce the possibility of the lines getting tangled and causing a breakdown when the robot legs move, a wire channel 434 for inserting the cables is provided in the support arm 43, and the wire channel 434 is provided along the axial direction of the mounting tube 41. The wire channel 434 may be distributed in one support arm 43 or in two support arms 43. One, two or three wire channels may be distributed in each support arm 43, and it may be designed according to specific needs.
[0051] 16 to 18, in order to prevent the top end of thigh arm 6 from interfering with support arm 43 and affecting the swing range when thigh arm 6 swings around the axis of the rotation shaft, support arm 43 has a retraction groove 433 formed on one edge near connecting ring 42 of fourth shaft hole 431.
[0052] The process by which the leg assembly swings inward and outward and swings forward and backward is as follows: the first hydraulic cylinder 31 drives the slide block 33 to move back and forth on the first slide rail 32, the first connecting rod 35 connected to the connection block 34 eccentrically pulls the mounting base 36 to swing back and forth, and the toothed plate 37 swings back and forth, and accordingly the driven gear 44 meshing with the toothed plate 37 rotates back and forth.
[0053] The connecting member 4 is fixedly connected coaxially to the driven gear 44, the connecting member 4 rotates back and forth, and the thigh arm 6 rotatably connected to the connecting member 4 swings back and forth. The hip joint mechanism rotates under the power of the front-back swing drive component 2 via gear transmission, and is accurately controlled so that the thigh arm 6 swings around the axis of the mounting tube 41.
[0054] The second hydraulic cylinder 51 is actuated to drive the slide rest 53 to slide back and forth along the second slide rail 52, and the second connecting rod 54 connected to the slide rest 53 pulls the inner ear plate 63 on the thigh arm 6 to swing back and forth, thereby achieving inward and outward swinging of the thigh arm 6.
[0055] During the entire movement process of the robot leg, the axis of the second hydraulic cylinder 51 of the lateral swing drive mechanism 5 and the axis of the first hydraulic cylinder 31 of the leg forward / backward swing mechanism 3 remain unchanged, which contributes to the optimization of the robot control algorithm program.
[0056] The principle of simplifying the control algorithm is explained below. Taking the transfer of two adjacent joints as an example, the three-dimensional Cartesian coordinate system 1 (x1, y1, z1) is rotated around the z1 axis by θ1, and the three-dimensional Cartesian coordinate system 2 (x2, y2, z2) is rotated around the x2 axis by θ2. In general, when transforming two joints, the coordinate system 1 is taken as the reference coordinate system, and the spatial coordinates of the coordinate system 2 relative to the coordinate system 1 are shown as follows: JPEG0007576868000003.jpg25170When two joint coordinate systems intersect at the point where the origins of the two joint axes coincide, x2, y2, and z2, which indicate the origin distance between the two joint coordinate systems in the matrix, become 0, and the matrix expression in the transmission control software can be simplified. The simplified spatial coordinates are shown as follows: JPEG0007576868000004.jpg23170
[0057] 19 and 20, the leg mechanism includes a thigh arm 6, a lower leg arm 7 and a knee joint 9, the knee joint 9 includes a third hydraulic cylinder 91, a first connection part 92 and a second connection part 93, the thigh arm 6 is rotatably connected to the lower leg arm 7, a cylinder 911 of the third hydraulic cylinder 91 is rotatably connected to the thigh arm 6, the first connection part 92 and the second connection part 93 are rotatably connected to a piston rod 912 of the third hydraulic cylinder 91, the other end of the first connection part 92 is rotatably connected to the thigh arm 6, and the other end of the second connection part 93 is rotatably connected to the lower leg arm 7, and the rotation axis point of the thigh arm 6 and the lower leg arm 7, the rotation axis point of the first connection part 92 and the thigh arm 6, the rotation axis point of the second connection part 93 and the lower leg arm 7, and the rotation axis point of the first connection part 92 and the second connection part 93 form a quadrilateral.
[0058] The knee joint 9 is transmitted using a four-link structure, and when the deployment angle of the lower leg arm 7 is the same, the swing width of the third hydraulic cylinder 91 of the four-link structure becomes smaller.
[0059] The third hydraulic cylinder 91 is a bidirectional hydraulic oil cylinder, in which a two-rod hydraulic cylinder is adopted. To protect the piston rod 912 of the third hydraulic cylinder 91, a mounting bracket 913 is fixedly connected to the cylinder 911 of the third hydraulic cylinder 91, and the mounting bracket 913 may be a cylindrical rod hingedly connected to the thigh arm 6, and one end of the cylindrical rod connected to the cylinder 911 is provided with a cavity for receiving the piston rod 912 along the axis. The mounting bracket 913 is fixed to the cylinder 911 via a screw.
[0060] The first connecting part 92 and the second connecting part 93 are both arc-shaped plates, and the recesses of the arc-shaped plates are arranged toward the rotation axis points of the thigh arm 6 and the calf arm 7, which are suitable for the stress transmission path of the structural components and can extend the service life. In other embodiments, the first connecting part 92 and the second connecting part 93 may be straight plates, S-shaped plates, V-shaped plates, etc.
[0061] 21 and 22, the overall outer contour of the thigh arm 6 is a rectangular prism structure, and a cavity is formed inside the thigh arm 6. To further reduce weight, a plurality of first weight-reducing holes 11 are formed on the surface of the thigh arm 6 to form a hollow structure.
[0062] A pair of outer ear plates 62 are provided on both opposing side walls of one end of the thigh arm 6, and an axial hole is provided on the outer ear plates 62. An inner ear plate 63 is fixed between the two outer ear plates 62, and there may be two inner ear plates 63, and the two outer ear plates 62 are arranged in parallel with the two inner ear plates 63. To attach an angle monitor, a mounting groove 64 is opened on the outside of the outer ear plate 62 corresponding to the axial hole.
[0063] A pin hole 65 is opened at a position close to the inner ear plate 63 of the thigh arm 6, the axis of the pin hole 65 is arranged perpendicular to the axial hole of the inner ear plate 63, the end of the mounting bracket 33 is connected to the pin hole 65 by a hinge, and the entire third hydraulic cylinder 91 can be stored in the cavity inside the thigh arm 6.
[0064] A pair of first knee ear plates 66 are formed on both opposing side walls of the other end of the thigh arm 6, and an axial hole is provided on the first knee ear plate 66. The first knee ear plate 66 and the outer ear plate 62 are respectively located on different sides of the thigh arm 6, and the axial hole on the first knee ear plate 66 is arranged perpendicular to the axis of the axial hole on the outer ear plate 62.
[0065] In order to achieve further weight reduction of the thigh arm 6, the thigh arm 6 has a cross-sectional area that gradually decreases from one end close to the outer ear plate 62 to the other end.
[0066] A wire hole 68 is further provided at one end of the thigh arm 6 close to the outer ear plate 62, and the wire hole 68 is configured to allow a cable to pass through so as to be wired inside the thigh arm 6, thereby reducing line tangling during leg and foot movements and protecting the stable operation of the leg and foot system.
[0067] A through hole 67 is provided in the thigh arm 6 at a position close to the first knee ear plate 66, and the axis of the through hole 67 is parallel to the axis of the shaft hole of the first knee ear plate 66. The through hole 67 is used for connecting the first connection part 92 to the thigh arm 6 by a hinge.
[0068] The thigh arm 6 is rotatably connected to the support arm 43 of the connecting member 4 through an axial hole on the outer ear plate 62, and the thigh arm 6 swings inward and outward under external power. The thigh arm 6 is rotatably connected to the lower leg arm 7 through an axial hole on the first knee ear plate 66, and a rotation similar to that at the human knee is realized between the thigh arm 6 and the lower leg arm 7. The structure of the thigh arm 6 is simple, optimizing the structure of the entire leg and foot.
[0069] 23 and 24, the lower leg arm 7 resembles a rectangular prism structure overall, the inside of the lower leg arm 7 is hollow, and in order to achieve further weight reduction of the lower leg arm 7, a plurality of second weight reduction holes 71 are opened on the surface of the lower leg arm 7 to form a hollow structure.
[0070] A pair of second knee ear plates 72 are formed on both opposing side walls of one end of the lower leg arm 7, and an axial hole is opened in the second knee ear plate 72. The lower leg arm 7 and the thigh arm 6 are rotatably connected by an axial rod, aligned with the axial hole of the second knee ear plate 72 via the first knee ear plate 66.
[0071] An insertion hole 73 is provided in the shaft hole near the second knee ear plate 72 of the lower leg arm 7, and the axis of the insertion hole 73 is parallel to the axis of the shaft hole of the second knee ear plate 72. The insertion hole 73 is used to connect the second connection part 93 to the lower leg arm 7 by a hinge. The width of the second knee ear plate 72 gradually decreases from the insertion hole 73 part toward the shaft hole part.
[0072] The other end of the shank arm 7 is curved to form an arc segment, and one end of the shank arm 7 remote from the second knee plate 72 becomes the foot connecting end 74, which has a square frustum structure. An attachment hole 75 communicating with the internal cavity of the shank arm 7 is formed in the end face of the foot connecting end 74, and nail holes are formed in the shank arm 7 around the attachment hole 75.
[0073] In order to better conform to human body simulation science and enhance the support of leg foot movement, the arc segment close to the foot connection end 74 of the crus arm 7 is curved toward one side, the inner radius of the curved part is R2, the inner arc central angle is β, the outer radius of the curved part is R3, and the outer arc central angle is γ. Specifically, R2=54mm, β=52°, R3=80mm, and γ=20°. A part of the surface close to the shaft hole of the crus arm 7 is curved, the curved radius is R1, and the curved surface central angle is α, specifically, R1=100mm, and α=26°. Referring to FIG. 24, the center O of R1 and the center M of R2 are located on both sides of the crus arm 7, and the curved surfaces corresponding to R1 and R2 are located on the opposite sides of the crus arm 7, respectively. In other embodiments of the embodiments of the present application, R1, R2, R3, α, β, and γ can all be appropriately selected according to actual needs.
[0074] In order to reduce the weight of the lower leg arm 7 as much as possible, an extension groove 76 is provided on the edge of the mounting hole 75 in the lower leg arm 7 .
[0075] 25, an ankle joint 8 is connected to the foot connecting end 74. The ankle joint 8 includes a foot sleeve 81 and a cover plate 83, the foot sleeve 81 can be a rubber sleeve, the cover plate 83 is fixed to the foot connecting end 74 via a screw, and the foot sleeve 81 can be fixed to the cover plate 83 by gluing, welding or screws. A number of anti-slip grooves 811 are formed on the surface of the foot sleeve 81.
[0076] In order to conveniently detect the stress state of the ankle joint 8, the ankle joint 8 further includes an elastic inner capsule 82, the inner capsule 82 is filled with a fluid medium such as hydraulic oil, the inner capsule 82 is wrapped by the foot sleeve 81, a screw segment 821 is fixed to the inner capsule 82, the screw segment 821 penetrates the cover plate 83 and is fixed by a fixing nut 84. A pressure sensor 85 is connected to the inner capsule 82 at the screw segment 821, and the pressure sensor 85 is connected to an external central processing unit such as a chip or a computer via a cable 10. When the foot sleeve 81 is stressed to deform and the inner capsule 82 is compressed, the oil pressure of the inner capsule 82 increases, and the pressure sensor 85 detects the pressure value and transmits it to the central processing unit via the cable 10.
[0077] During the walking process of the robot, the foot sleeve 81 will undergo a certain deformation when pressed by an external object, and the foot sleeve 81 will press the elastic inner capsule 82 inward, causing the pressure in the inner capsule 82 to change, and the pressure sensor 85 can detect this pressure change in real time. All the pressures from different directions of the foot sleeve 81 will be finally transmitted to the inner capsule 82, so the pressure sensor 85 can detect the stress situations in different directions.
[0078] Referring to FIG. 26, the control assembly 1 includes a chamber 11 and a control unit 12, the leg assembly is connected to the chamber 11 via a mounting bracket 2, a first servo pump 13 is attached to the chamber 11, a second servo pump 15 and a third servo pump 14, the control unit 12 is connected to the first servo pump 13, the second servo pump 15 and the third servo pump 14 respectively for control, the first servo pump 13 is connected to a first hydraulic cylinder 31, the second servo pump 15 is connected to a second hydraulic cylinder 51, the third servo pump 14 is connected to a third hydraulic cylinder 91, the first hydraulic cylinder 31 drives the leg to swing back and forth, the second hydraulic cylinder 51 drives the leg to swing inward and outward, and the third hydraulic cylinder 91 drives the knee joint portion to bend.
[0079] The chamber 1 is a rectangular shell structure, and four sets of leg foot assemblies are attached to the four corners of the chamber 1 to form a four-legged robot. Each set of leg foot assemblies corresponds to a set of a first servo pump 13, a second servo pump 15 and a third servo pump 14, and the control unit 12 can be a central processing unit or chip, and the control unit 12 is connected to and controls each of the four sets of hydraulic pumps.
[0080] The first servo pump 13, the third servo pump 14 and the second servo pump 15 are arranged in sequence along the length direction of the chamber 1. Nail holes are provided in the side walls along the length direction of the chamber 1, and the first servo pump 13 and the second servo pump 15 are attached to the side walls along the length direction of the chamber 1 via bolts. Nail holes are also provided in the side walls along the width direction of the chamber 1, and the third servo pump 14 is provided in the side wall along the width direction of the chamber 1 via a bolt.
[0081] Conventional hydraulic pumps and hydraulic cylinders are connected through flexible oil pipes, and the flexible oil pipes may be entangled or caught by external foreign objects during the robot's walking, which may affect the stable operation of the robot. In order to improve the stability of the robot's operation, the present application is optimized by eliminating or reducing the use of oil pipes.
[0082] 6, 26 and 27, the mounting bracket 2 is fixed to the longitudinal side wall of the chamber 11 via a bolt, the first hydraulic cylinder 31 is fixed to the mounting bracket 2 via a bolt, and the second hydraulic cylinder 51 is fixed to the width direction side wall of the chamber 11 via a bolt.
[0083] A first oil outlet 111 and a first oil inlet 112 are opened on the side wall along the length of the chamber 11, an oil inlet and an oil outlet are provided on the first servo pump 13, and the positions and intervals of the first oil outlet 111 and the first oil inlet 112 correspond to the oil inlet and outlet of the first servo pump 13, such that after the first servo pump 13 is installed, the oil inlet on the first servo pump 13 coincides with the first oil inlet 112 on the side wall of the chamber 11, and the oil outlet on the first servo pump 13 coincides with the first oil outlet 111 on the side wall of the chamber 11. The contact positions of the first servo pump 13 and the first oil outlet 111 and the first oil inlet 112 are sealed by seal rings.
[0084] Two first oil passages 29 are opened in the area of the mounting bracket 2 located at the fixed part 24, and the distance between the two first oil passages 29 is the same as the distance between the first oil outlet 111 and the first oil inlet 112. After the mounting bracket 2 is fixed to the side wall of the chamber 11, one of the first oil passages 29 coincides with the first oil outlet 111, and the other first oil passage 29 coincides with the first oil inlet 112. The contact positions of the mounting bracket 2 with the first oil outlet 111 and the first oil inlet 112 are sealed by seal rings. To accommodate the seal rings, seal grooves are opened in the chamber 11 around the first oil outlet 111 and the first oil inlet 112, and the seal rings are disposed in the seal grooves.
[0085] The first hydraulic cylinder 31 also has an oil inlet and outlet, and the oil inlet of the first hydraulic cylinder 31 communicates with the first oil passage 29 and the first oil inlet 112, and the oil outlet of the first hydraulic cylinder 31 communicates with the first oil passage 29 and the first oil outlet 111.
[0086] As can be understood, due to the specifications and design reasons of the first hydraulic cylinder 31 and the first servo pump 13, the spacing of the oil inlet and outlet on the first hydraulic cylinder 31 may be different from the spacing of the oil inlet and outlet on the first servo pump 13, and in this case, based on one of the first oil outlet 111 and the first oil inlet 112 on the processing chamber 11, for example, the oil inlet and outlet spacing on the first servo pump 13, when the oil inlet and outlet spacing on the first hydraulic cylinder 31 is large, the axis of the first oil outlet 111 and / or the first oil inlet 112 is obliquely disposed at an acute angle from the normal to the side wall of the chamber 11. When the oil inlet and outlet spacing on the first hydraulic cylinder 31 and the oil inlet and outlet spacing on the first servo pump 13 are the same, the axis of the first oil outlet 111 and the first oil inlet 112 is perpendicular to the side wall of the chamber 11.
[0087] Similarly, an oil inlet / outlet is provided on a side wall along the width direction of the chamber 11 and is used to communicate with the second servo pump 15 and the second hydraulic cylinder 51 .
[0088] 2, 5 and 7, a second oil outlet 113 and a second oil inlet 114 are further opened on the side wall of the chamber 11, and the second oil outlet 113 and the second oil inlet 114 are correspondingly connected to the oil inlet and outlet on the third servo pump 14.
[0089] The third hydraulic cylinder 91 is located on the thigh arm 6, and in order to shorten the length of the flexible oil pipe, two second oil passages 28 are further opened in the mounting bracket 2, and the second oil passages 28 penetrate the first side plate 21 and the second side plate 22 of the mounting bracket 2, and the distance between the two second oil passages 28 is the same as the distance between the second oil outlet 113 and the second oil inlet 114. The contact positions of the mounting bracket 2 with the second oil outlet 113 and the second oil inlet 114 are sealed by seal rings. The chamber 11 has seal grooves opened around the second oil outlet 113 and the second oil inlet 114, and seal rings are disposed in the seal grooves.
[0090] One end of the second oil outlet 113 and the second oil inlet 114 remote from the chamber 11 is respectively connected to the oil inlet / outlet of the third hydraulic cylinder 91 via an oil pipe, and the oil pipe can be laid inside the mounting bracket 2, which can shorten the length of the oil pipe while reducing the possibility of the oil pipe being caught or entangled by external foreign objects.
[0091] 29 and 30, in order to improve the explosion-proof performance of the robot, the internal air pressure of the chamber 11 is designed to be positive, and an air nozzle is opened on the upper cover of the chamber 11 to fill the chamber 11 with protective gas. The control unit 12 and the servo motors of the first servo pump 13, the second servo pump 15 and the third servo pump 14 are disposed in the chamber 11, so that the first oil cylinder 3, the second oil cylinder 4 and the third oil cylinder 5 are disposed outside the chamber 11, and the electric components of the robot are insulated and protected by the chamber 11, thereby achieving the effect of electro-hydraulic isolation and improving the explosion-proof performance of the robot.
[0092] According to the functional requirements of the robot, at least one of the laser radar 16, the RTK antenna 17, the explosion-proof button 18 and the explosion-proof sound and light alarm 19 is further installed on the upper cover of the chamber 11. Here, the laser radar 16 is sealed by an external glass cover to improve the explosion-proof performance, and the RTK antenna 17, the explosion-proof button 18 and the explosion-proof sound and light alarm 19 adopt an explosion-proof circuit, and the part where the circuit penetrates the chamber 11 is sealed by applying adhesive, improving the explosion-proof performance.
[0093] Through the oil inlets and outlets designed on the side wall of chamber 11, each hydraulic pump is directly connected to the oil inlets and outlets on chamber 11, and the first hydraulic cylinder 31 and the second hydraulic cylinder 51 are respectively connected to the oil inlets and outlets designed on the side wall of chamber 11, which reduces the use of oil paths and improves the operational stability of the robot.
[0094] By simplifying the configuration and reducing the volume of the hydraulic system, the volume of the chamber 11 and the volume of the robot can be reduced, and in order to facilitate the load-bearing and application of the robot, the present application adopts an EHA closed hydraulic system.
[0095] 31 and 32, the EHA closed hydraulic system includes a bidirectional pump k1, a motor k2 for rotating the bidirectional pump k1, a main oil passage 1k3, a main oil passage 2k4, an accumulator k5 and a symmetrical actuation unit k6, in which the two suction ports of the bidirectional pump k1 communicate with the main oil passage 1k3 and the main oil passage 2k4, respectively, and the bidirectional pump k1 communicates with the accumulator k5; The one-way balance valve 1k7, the one-way balance valve 2k8, and the oil filling port k9 communicate with one of the two-way pump k1 and the accumulator k5, the first valve port k10 of the one-way balance valve 1k7 and the one-way balance valve 2k8 communicate with the oil port 1 and the oil port 2 of the symmetrical operating unit k6, respectively, the second valve port k13 of the one-way balance valve 1k7 and the one-way balance valve 2k8 communicate with the oil inlets of the main oil passage 1k3 and the main oil passage 2k4, respectively; The control valve port k14 of the one-way balance valve 1k7 communicates with the main oil passage 2k4 in front of the second valve port k13 of the one-way balance valve 2k8, and the control valve port k14 of the one-way balance valve 2k8 communicates with the main oil passage 1k3 in front of the second valve port k13 of the one-way balance valve 1k7; The first valve port k10 of the one-way balance valve 1k7 is bidirectionally connected to the first valve port k10 of the one-way balance valve 2k8 via an overflow valve; The accumulator k5 communicates with the second valve port k13 of the one-way balancing valve 1k7 and the one-way balancing valve 2k8 via a one-way valve k16.
[0096] When the bidirectional pump k1 rotates clockwise, the oil from the bidirectional pump k1 enters the upper cavity of the symmetrical operating unit k6 through the second valve port k13 and the first valve port k10 of the one-way balancing valve 1k7, and when the symmetrical operating unit k6 is loaded, this circuit becomes high pressure oil in time. In the oil return path of the lower cavity of the symmetrical operating unit k6, the oil returns to the bidirectional pump k1 through the first valve port k10 and the second valve port k13 of the balancing valve 2 only when the control valve port k14 of the one-way balancing valve 2k8 is turned on due to the pressure control of the high pressure oil in the oil path before the second valve port k13 of the one-way balancing valve 1k7, and when the pressure in the upper cavity of the symmetrical operating unit k6 decreases, the control valve port k14 of the one-way balancing valve 2k8 is not turned on, and the symmetrical operating unit k6 maintains its position.
[0097] When the bidirectional pump k1 rotates counterclockwise, the oil liquid from the bidirectional pump k1 enters the lower cavity of the symmetrical working unit k6 through the second valve port k13 and the first valve port k10 of the one-way balance valve 2k8, and when the symmetrical working unit k6 is loaded, this circuit becomes high pressure oil in time. In the oil return path of the lower cavity of the symmetrical working unit k6, due to the pressure control of the high pressure oil in the oil path before the second valve port k13 of the one-way balance valve 1k7, the oil liquid returns to the bidirectional pump k1 through the first valve port k10 and the second valve port k13 of the one-way balance valve only when the control valve port k14 of the one-way balance valve 1k7 is turned on, and when the pressure of the lower cavity decreases, the control valve port k14 of the one-way balance valve 1k7 is not turned on, and the symmetrical working unit k6 maintains its position, and at the same time, the one-way balance valve 2k8 is also in a one-way flow state or a closed state, at this time, the system motor k2 can stop rotating, and the symmetrical working unit k6 can maintain its position within any travel range. The two-way overflow valve connected between the one-way balancing valve 1k7 and the one-way balancing valve 2k8 plays a protective function, limiting the system pressure within a certain value and preventing the system from being overpressurized. When one side is overpressurized, the overflow valve on this side will be turned on and the oil will flow to the low pressure side.
[0098] The accumulator k5 is configured to store the oil required in the closed hydraulic circuit and make-up oil to the system due to leakage of hydraulic oil, while maintaining the suction oil pressure of the bidirectional pump k1 and supplying oil to the low-pressure oil suction side. The oil filling port k9 supplies oil to the system via the one-way valve k16, and the accumulator k5 is configured to supply oil to the low-pressure side of the bidirectional pump k1 via the one-way valve k16.
[0099] In this embodiment, the two-way pump k1 is a gear pump, which includes a driving gear and a driven gear that mesh with each other. The balance valve adopts a plug-in method, which has the advantages of compact flow path and small volume, which can further reduce the volume of the pump-valve integrated device and make the overall structure more compact. The accumulator k5 is a spring-type accumulator, a piston-type accumulator or an oil-resistant elastomer-type accumulator. The oil-resistant elastomer-type accumulator is an airbag-type or diaphragm-type accumulator. In this embodiment, a spring-type accumulator is used, which stores and releases hydraulic energy by compressing and expanding the spring, and the spring and the pressure oil are isolated by the piston, and the force of the spring acts on the hydraulic oil by the piston.
[0100] Rather than asymmetric hydraulic cylinders, which increase the complexity of the system due to the different volumes and flow rates of the upper and lower cavities, the present invention adopts an electrostatic circuit based on symmetric hydraulic cylinders. This system does not require an oil supply circuit composed of a double hydraulic control one-way valve and a large accumulator, so the circuit principle is greatly simplified. When this system is applied to the leg joints of a four-legged robot, the balancing valve on the circuit achieves two purposes: first, regardless of whether the robot is powered off or not, the joints of the robot can be locked at any angle within the joint angle range, and with this function, the robot can continue to stand in a stable posture for a long time even when the power is off; second, it can adapt to the squatting load-bearing state corresponding to the fourth quadrant, allowing the robot to perform squatting smoothly. Not only is the requirement of the working state realized, but the simplicity of the system also greatly reduces the volume and weight required for the hydraulic system, improves the reliability of the system, and allows the robot to stand in a stable posture even when the power is off.
[0101] In this embodiment, the symmetrical working unit k6 is specifically a double piston rod hydraulic cylinder, and the bidirectional pump k1 of this system adopts a constant-volume gear pump. When the system is in a working state requiring variable flow rate, specifically, the change in flow rate and the change in oil flow direction can be realized by changing the rotation speed and rotation direction of the motor k2. The motor k2 is controlled by the driver 44 through the encoder to realize the closed-loop control of the rotation speed of the motor k2, and the rotation speed and rotation direction can be accurately controlled. The overflow valve includes an overflow valve 111 and an overflow valve 212.
[0102] The EHA closed hydraulic system may further include a pressure sensor k17 connected to the first valve port k10 of the one-way balance valve 1k7 and the one-way balance valve 2k8, respectively. The two pressure sensors k17 are used to measure the oil pressure of the main oil passage 1k3 and the main oil passage 2k4 in the system, respectively, to realize the dynamic control of the hydraulic system and the actuator mechanism.
[0103] The EHA closed hydraulic system may further include a temperature sensor k18 connected to the main oil passage 1 and the main oil passage 2, respectively. The temperature sensor k18 is used to measure the oil leakage and oil supply temperature of the system, and the oil temperature is used to set a temperature alarm signal of the system.
[0104] This equipment integrates all components and parts into one valve block, the gear pump does not have an independent shell, the rated speed of the gear pump is 3000r / min, the peak speed reaches 4000r / min. The maximum oil flow rate of the double piston rod hydraulic cylinder is 3L / min, and the maximum working pressure of the system is 20MPa. The transmission shaft of the motor is also designed and processed together as the transmission shaft of the gear pump, and the transmission shaft is connected to the driving gear of the gear pump through the coupler.
[0105] In the design of the traditional hydraulic system, it is necessary to use a standard motor, coupler, bell cover and gear pump, which increases the volume significantly. The pump valve integrated device in this solution solves the problem that the volume and external shape of the closed system are too large compared with the traditional hydraulic system, and can avoid the fact that when applied to a walking robot, the hydraulic system is too large, which makes the whole product's volume too large, resulting in difficulties in load bearing and application.
[0106] This solution provides a joint electro-hydraulic composite transmission solution according to the joint application working state of the four-legged robot. The leg joints of the robot are mainly divided into a hip lateral swing joint, a hip rotation joint and a knee joint. The ground environment is divided into three environments: flat ground, slope and stairs. No matter what the environment, the legged robot has the working state of the four legs touching the ground to adjust the posture, and for the robot's trunk, the posture of the center of gravity is adjusted in the direction of six spatial degrees of freedom. For the three different joints of the hip lateral swing, hip rotation and knee rotation, they are arranged in different positions, so when the four legs touch the ground to adjust the posture, their respective load working states are also different. The second hydraulic cylinder 51 and the first hydraulic cylinder 31 are both arranged on the trunk, so the corresponding working states are similar. However, the third hydraulic cylinder 91 of the knee joint 9 is attached to the leg, so its working state is different from the other two hydraulic cylinders.
[0107] The operating state of the hydraulic cylinder 91 of the knee joint 9 is as follows.
[0108] When all the feet of the four-legged robot are in contact with the ground, the knee joint 9 has two working states: first, under the action of the robot trunk and load, the hydraulic cylinder piston rod contracts, and the corresponding angle of the knee joint 9 becomes smaller, which is a negative load working state; second, overcoming the weight of the robot trunk and load, the hydraulic cylinder piston rod extends, and the corresponding angle of the knee joint 9 becomes larger, which is a positive load working state.
[0109] When a foot of a four-legged robot leaves the ground and executes a certain trajectory in the air, in the process of lifting the leg, the knee revolute joint overcomes the weight of the leg to contract the hydraulic cylinder piston rod, and the corresponding joint angle becomes small, which is a positive load operating state; in the process of landing the leg, the leg generally adopts a metering design, so the weight of the leg is small at that time, in order to speed up the landing speed of the foot, the hydraulic cylinder of the knee joint 9 extends, at that time, the hydraulic pump enters a pumping state, and the hydraulic cylinder may enter a load operating state; at the same time, it is also necessary to consider the extreme state in which the knee joint 9 is pulled by an external force. Based on the above analysis, in a four-legged robot, the load operating state of the knee joint 9 is shown in Figure 33 and Figure 34.
[0110] Figure 33 is a schematic diagram showing the joint layout of a quadruped robot, in which the knee joint 9 adopts a rotary drive mode of hydraulic cylinder + connecting rod. In a plane coordinate system composed of load force F and hydraulic cylinder piston rod velocity v, the load operating state of the third hydraulic cylinder 91 of the knee joint 9 is concentrated in the first, second, third and fourth quadrants, and each quadrant completes a corresponding function, and the direction of the load force and the hydraulic cylinder piston rod velocity is as shown in the FV diagram in Figure 33.
[0111] The EHA closed hydraulic system in the present invention adopts a closed hydraulic system of a symmetrical actuation unit, and does not require an oil supply circuit composed of a double hydraulic control one-way valve and a large accumulator, compared with an asymmetrical hydraulic cylinder, so that the circuit principle is greatly simplified, and a one-way balancing valve 1k7 and a one-way balancing valve 2k8 are installed in the circuit, and the balancing valve achieves two purposes: first, regardless of whether the robot is powered off or not, the joints of the robot can be locked at any angle within the joint angle range, and this function allows the robot to stand in a stable posture for a long time even when the power is off; second, it can adapt to the squatting load state corresponding to the fourth quadrant, so that the robot can smoothly perform squatting. Not only is the requirement of the working state realized, but also due to the simplicity of the system, the volume and weight required for the hydraulic system are greatly reduced, the reliability of the system is improved, and the robot can stand in a stable posture even when the power is off.
[0112] The lateral swing and pitch operation states of the hydraulic cylinder of the hip joint mechanism are as follows:
[0113] Figure 35(a) shows an operating state in which the toe of the hip pitch joint is in contact with the ground, Figure 35(b) shows an operating state in which the toe of the hip pitch joint is off the ground, Figure 36(a) shows an operating state in which the toe of the hip lateral swing joint is in contact with the ground, and Figure 36(b) shows an operating state in which the toe of the hip lateral swing joint is off the ground.
[0114] The load operating state of the hip lateral swing joint changes depending on the angle of the hip lateral swing joint.
[0115] When the toe touches the ground, the force acting on the toe from the ground is directed upward, and the torque direction generated in the crotch side swing and crotch pitch joints is different according to the different positions of the leg relative to the chamber 11. As shown in the operation state of the toe of the crotch pitch joint touching the ground in FIG. 35(a) and the operation state of the toe of the crotch side swing joint touching the ground in FIG. 36(a), when the leg is in the left position of the center line OA as shown in OB, the torque acting on the crotch side swing and crotch pitch joints by the ground is in the clockwise direction, and when the leg is in the right position of the center line OA as shown in OB', the torque acting on the crotch side swing and crotch pitch joints by the ground is in the counterclockwise direction. Therefore, when the crotch side swing and crotch pitch joints swing bidirectionally at the OB or OB' position, all the loaded operating states, positive load and negative load operating states of the four quadrants will appear.
[0116] When the toe is off the ground, the gravity of the entire leg is always directed downward, and as shown in the working state of the hip pitch joint toe off the ground in Fig. 35(b) and the working state of the hip lateral swing joint toe off the ground in Fig. 36(b), when the leg is at the left OB position of the center line OA, the torque generated by the leg gravity is in the counterclockwise direction along the hip lateral swing center, and when the leg is at the right OB' position of the center line OA, the torque generated by the leg gravity is in the clockwise direction along the hip lateral swing center. Since the entire leg adopts a metric design, when the torque generated by the friction force of the hip lateral swing joint actuator is greater than the torque generated by gravity, there are only two positive load working states.
[0117] When the EHA closed hydraulic system of the present invention is applied to a four-legged robot, the hydraulic principles of the hip pitch joint, hip lateral swing joint, and knee rotation joint of the four-legged robot are unified, the extreme condition in which the knee joint is pulled by an external force and the situation of bidirectional negative load on all joints are taken into consideration, and subsequent shared use and maintenance of components and parts are made convenient.
[0118] The one-way balancing valve 1k7 and the one-way balancing valve 2k8 in the hydraulic circuit can avoid the state in which the two-way pump k1 becomes a motor and the motor becomes a generator in the negative load operating state, and can avoid the subsequent failure of the electric energy control. For example, in the following operating state, if the resultant force direction of the hydraulic cylinder is the same as the motion direction and both are downward, the working state is the negative load operating state, the pressure in the upper cavity of the hydraulic cylinder decreases, the control oil passage pressure of the one-way balancing valve 2k8 is insufficient, and the one-way balancing valve 2k8 cannot be turned on, the oil in the lower cavity is sealed in the oil chamber and the pipeline of the hydraulic cylinder, and does not return to the two-way pump k1, and the hydraulic cylinder maintains its position even in the negative load operating state, and the abnormal operation of the two-way pump k1 can be avoided.
[0119] The above are only preferred embodiments of the present application, and are not intended to limit the scope of protection of the present application, so that any equivalent modifications made according to the structure, shape and principle of the present application shall be included in the scope of protection of the present application. [Explanation of symbols]
[0120] 1 Control Assembly 11. Chamber 111 First oil outlet 112 First oil inlet 113 Second oil outlet 114 Second oil inlet 12 Control unit 13 No. 1 servo pump 14 No. 2 servo pump 15 3rd servo pump 16 Laser radar 17 RTK antenna 18 Explosion-proof button 19 Explosion-proof sound and light alarm 2 Mounting brackets 21 1st side plate 22 Second side plate 221 Fixed hole 23 Connection seat 24 Fixed part 25 First shaft hole 26 Second shaft hole 27 Mounting groove 28 2nd oilway 29 No. 1 oil road 3-leg forward / backward swing mechanism 31 First hydraulic cylinder 311 Piston rod 32 First slide rail 33 Slide Block 34 Connection Blocks 341 Insertion port 342 1st ear plate 343 Slope 35 First connecting rod 36 Mounting seat 361 Connection 362 2nd ear plate 363 Aperture 364 3rd shaft hole 365 Fixed hole 37 Toothed plate 38 Rotational Axis 4 Connection parts 41 Mounting tube 411 Mounting hole 412 Positioning ring 413 Mounting groove 414 Operation port 415 Insertion hole 416 Fixed hole 42 Connecting Ring 43 Support Arm 431 4th shaft hole 432 Pinhole 433 Evacuation Ditch 434 Wire Channel 44 Driven gear 45 Bearings 46 End Cap 5. Lateral swing drive mechanism 51 Second hydraulic cylinder 52 Second slide rail 53 Slide Rest 54 Second connecting rod 6 Thigh Arm 61 First lightening hole 62 External ear plate 63 Inner ear plate 64 Mounting groove 65 Pinhole 66 1st knee ear plate 67 Through hole 68 Wire Hole 7 Lower Leg Arm 71 Second lightening hole 72 Second knee ear plate 73 Insertion hole 74 Foot connection end 75 Mounting hole 76 Extension groove 8 Ankle 81 Foot Sleeve 811 Anti-slip groove 82 Inner Capsule 821 Screw Segment 83 Cover Plate 84 Fixing nut 85 Pressure Sensor 9. Knee Joint 91 Third hydraulic cylinder 911 Cylinder 912 Piston rod 913 Mounting bracket 92 First connection part 93 Second Connection 10 Cable k1 bidirectional pump k2 motor k3 Main oil passage 1 k4 Main oil passage 2 k5 accumulator k6 Symmetrical actuation unit k7 One-way balancing valve 1 k8 One-way balance valve 2 k9 Oil filling port k10 1st valve port k11 overflow valve 1 k12 overflow valve 2 k13 2nd valve port k14 Control valve port K15 3rd valve port k16 one-way valve k17 pressure sensor k18 temperature sensor
Claims
1. The robot includes a positive pressure chamber (11) and a leg / foot assembly, the leg / foot assembly including a hydraulic cylinder. The robot has a servo pump installed in the chamber (11), the hydraulic cylinder is located outside the chamber (11), and an oil inlet / outlet is provided in the wall of the chamber (11) for communication between the servo pump and the hydraulic cylinder. The leg / foot assembly includes a mounting bracket (2), a leg / foot forward / backward swinging mechanism (3), a hip joint mechanism, and a leg / foot mechanism, the leg / foot forward / backward swinging mechanism (3) and the hip joint mechanism are connected to the outside of the chamber (11) via the mounting bracket (2), the hip joint mechanism is connected to the leg / foot mechanism so as to drive the leg / foot mechanism to swing inward and outward, the leg / foot forward / backward swinging mechanism (3) is connected to the hip joint mechanism in a manner that allows signals to be transmitted, and the leg / foot forward / backward swinging mechanism (3) rotatably drives the hip joint mechanism, The leg / foot swing mechanism (3) is connected to the hip joint mechanism so as to be capable of coaxial transmission; The hip joint mechanism includes a connecting member (4) and a lateral swing drive mechanism (5), the connecting member (4) is rotatably connected to the mounting bracket (2), the lateral swing drive mechanism (5) is connected between the connecting member (4) and the leg mechanism, and the lateral swing drive mechanism (5) provides power for the inward and outward swing of the leg mechanism; The electrohydraulic hybrid drive explosion-proof leg / foot robot is characterized in that a driven gear (44) is coaxially fitted and fixed on the connecting member (4), the leg / foot forward / backward swing mechanism (3) includes a drive gear component and a power component, the drive gear component is rotatably connected to the mounting bracket (2) and meshes with the driven gear (44), and the power component rotatably drives the drive gear component.
2. The electrohydraulic hybrid drive explosion-proof leg foot robot according to claim 1, characterized in that the power component includes a first hydraulic cylinder (31), a first slide rail (32), slide rests (33, 34) and a first connecting rod (35), the first slide rail (32) is fixed to the mounting bracket (2), the length direction of the first slide rail (32) is perpendicular to the rotation axis of the connecting member (4), the cylinder of the first hydraulic cylinder (31) is fixed to the mounting bracket (2), the piston rod (311) of the first hydraulic cylinder (31) is connected to the slide rests (33, 34) to drive the slide rests (33, 34) to relatively slide along the first slide rail (32), one end of the first connecting rod (35) is hingedly connected to the slide rests (33, 34), and the other end of the first connecting rod (35) is eccentrically rotatably connected to the driving gear component.
3. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 1 or 2, characterized in that the connecting member (4) includes an attachment tube (41) and a pair of support arms (43), the support arms (43) are arranged along the axis of the attachment tube (41) and fixed to one end of the attachment tube (41), the attachment tube (41) is rotatably connected to the attachment bracket (2), an axial hole is opened at one end of the support arms (43) remote from the attachment tube (41), and the axis of the axial hole is perpendicular to the axis of the attachment tube (41).
4. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 3, characterized in that the lateral swing drive mechanism (5) includes a second hydraulic cylinder (51), a second slide rail (52), slide rests (33, 34) and a second connecting rod (54), the second slide rail (52) is fixed to the inner wall of the mounting tube (41) along its axis, the second hydraulic cylinder (51) is connected to one end of the mounting tube (41) remote from the support arm (43), the second hydraulic cylinder (51) drives the slide rests (33, 34) to relatively slide along the second slide rail (52), one end of the second connecting rod (54) is connected to the slide rests (33, 34) by a hinge, and the other end of the second connecting rod (54) is extended from the mounting tube (41) toward the support arm (43).
5. 3. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 1 or 2, characterized in that: a first servo pump (13) is connected within the chamber (11); the leg / foot forward / backward swing mechanism (3) includes a first hydraulic cylinder (31); a first oil outlet (111) and a first oil inlet (112) are opened through the side wall of the chamber (11); and the first oil outlet (111) and the first oil inlet (112) are used for communication between the first servo pump (13) and the first hydraulic cylinder (31).
6. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 5, characterized in that a second servo pump (15) is connected within the chamber (11), the hip joint mechanism includes a second hydraulic cylinder (51), and an oil inlet / outlet is provided on a side wall of the chamber (11) for communication between the second servo pump (15) and the second hydraulic cylinder (51).
7. An electro-hydraulic hybrid drive explosion-proof leg-foot robot comprising a positive pressure chamber (11) and a leg-foot assembly, the leg-foot assembly including a hydraulic cylinder, a servo pump is provided within the chamber (11), the hydraulic cylinder is located outside the chamber (11), and an oil inlet / outlet is provided in the wall of the chamber (11) for communication between the servo pump and the hydraulic cylinder, The leg / foot assembly includes a mounting bracket (2), a leg / foot forward / backward swinging mechanism (3), a hip joint mechanism, and a leg / foot mechanism, the leg / foot forward / backward swinging mechanism (3) and the hip joint mechanism are connected to the outside of the chamber (11) via the mounting bracket (2), the hip joint mechanism is connected to the leg / foot mechanism so as to drive the leg / foot mechanism to swing inward and outward, the leg / foot forward / backward swinging mechanism (3) is connected to the hip joint mechanism in a manner that allows signals to be transmitted, and the leg / foot forward / backward swinging mechanism (3) rotatably drives the hip joint mechanism, A first servo pump (13) is connected in the chamber (11), the leg forward and backward swing mechanism (3) includes a first hydraulic cylinder (31), a first oil outlet (111) and a first oil inlet (112) are opened through the side wall of the chamber (11), and the first oil outlet (111) and the first oil inlet (112) are used for communication between the first servo pump (13) and the first hydraulic cylinder (31); The electrohydraulic hybrid drive explosion-proof leg / foot robot is characterized in that the first hydraulic cylinder (31) is fixed to a mounting bracket (2), and a first oil passage (29) is provided on the mounting bracket (2) for respectively connecting the first oil outlet (111) and the first oil inlet (112).
8. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 6, characterized in that a third servo pump (14) is connected within the chamber (11), the leg / foot mechanism includes a third hydraulic cylinder (91), and a second oil outlet (113) and a second oil inlet (114) are provided on the side wall of the chamber (11) for communicating with the third servo pump (14).
9. An electro-hydraulic hybrid drive explosion-proof leg-foot robot comprising a positive pressure chamber (11) and a leg-foot assembly, the leg-foot assembly including a hydraulic cylinder, a servo pump is provided within the chamber (11), the hydraulic cylinder is located outside the chamber (11), and an oil inlet / outlet is provided in the wall of the chamber (11) for communication between the servo pump and the hydraulic cylinder, The leg / foot assembly includes a mounting bracket (2), a leg / foot forward / backward swinging mechanism (3), a hip joint mechanism, and a leg / foot mechanism, the leg / foot forward / backward swinging mechanism (3) and the hip joint mechanism are connected to the outside of the chamber (11) via the mounting bracket (2), the hip joint mechanism is connected to the leg / foot mechanism so as to drive the leg / foot mechanism to swing inward and outward, the leg / foot forward / backward swinging mechanism (3) is connected to the hip joint mechanism in a manner that allows signals to be transmitted, and the leg / foot forward / backward swinging mechanism (3) rotatably drives the hip joint mechanism, A first servo pump (13) is connected in the chamber (11), the leg forward and backward swing mechanism (3) includes a first hydraulic cylinder (31), a first oil outlet (111) and a first oil inlet (112) are opened through the side wall of the chamber (11), and the first oil outlet (111) and the first oil inlet (112) are used for communication between the first servo pump (13) and the first hydraulic cylinder (31); A second servo pump (15) is connected in the chamber (11), the hip joint mechanism includes a second hydraulic cylinder (51), and an oil inlet / outlet is provided in a side wall of the chamber (11) for communication between the second servo pump (15) and the second hydraulic cylinder (51); A third servo pump (14) is connected in the chamber (11), the leg mechanism includes a third hydraulic cylinder (91), and a second oil outlet (113) and a second oil inlet (114) are provided in a side wall of the chamber (11) for communicating with the third servo pump (14); The electrohydraulic hybrid drive explosion-proof leg / foot robot is characterized in that a second oil passage (28) is further provided in the mounting bracket (2) for respectively connecting a second oil outlet (113) and a second oil inlet (114), and the second oil passage (28) communicates with a third hydraulic cylinder (91).
10. 7. The electrohydraulic hybrid drive explosion-proof leg-foot robot according to claim 6, characterized in that sealing rings are provided at both ends of the oil inlet and outlet of the chamber (11).
11. The electrohydraulic hybrid drive explosion-proof leg-foot robot according to claim 10, characterized in that a sealing groove for arranging a sealing ring on the chamber (11) is provided.
12. An electro-hydraulic hybrid drive explosion-proof leg-foot robot comprising a positive pressure chamber (11) and a leg-foot assembly, the leg-foot assembly including a hydraulic cylinder, a servo pump is provided within the chamber (11), the hydraulic cylinder is located outside the chamber (11), and an oil inlet / outlet is provided in the wall of the chamber (11) for communication between the servo pump and the hydraulic cylinder, The leg / foot assembly includes a mounting bracket (2), a leg / foot forward / backward swinging mechanism (3), a hip joint mechanism, and a leg / foot mechanism, the leg / foot forward / backward swinging mechanism (3) and the hip joint mechanism are connected to the outside of the chamber (11) via the mounting bracket (2), the hip joint mechanism is connected to the leg / foot mechanism so as to drive the leg / foot mechanism to swing inward and outward, the leg / foot forward / backward swinging mechanism (3) is connected to the hip joint mechanism in a manner that allows signals to be transmitted, and the leg / foot forward / backward swinging mechanism (3) rotatably drives the hip joint mechanism, the leg / foot mechanism includes a thigh arm (6), a lower leg arm (7) and a knee joint (9), the thigh arm (6) is rotatably connected to the lower leg arm (7), the knee joint (9) includes a third hydraulic cylinder (91), a first connection part (92) and a second connection part (93), the cylinder of the third hydraulic cylinder (91) is rotatably connected to the thigh arm (6), the other end of the first connection part (92) is rotatably connected to the thigh arm (6), and the other end of the second connection part (93) is rotatably connected to the lower leg arm (7), and a rotation axis point of the thigh arm (6) and the lower leg arm (7), a rotation axis point of the first connection part (92) and the thigh arm (6), a rotation axis point of the second connection part (93) and the lower leg arm (7), and a rotation axis point of the first connection part (92) and the second connection part (93) form a quadrilateral.
13. The electric-hydraulic hybrid drive explosion-proof leg / foot robot according to claim 1 or 2, characterized in that the leg / foot mechanism includes an ankle joint (8), the ankle joint (8) includes a foot sleeve (81) and an elastic inner capsule (82) provided in the foot sleeve (81), and a pressure sensor (85) is connected to the inner capsule (82).
14. The electrohydraulic hybrid drive explosion-proof leg / foot robot according to claim 1 or 2, characterized in that at least one of a laser radar (16), an RTK antenna (17), an explosion-proof button (18), and an explosion-proof sound and light alarm (19) is provided on the chamber (11).
15. The explosion-proof electric-hydraulic hybrid drive type explosion-proof leg-foot robot according to claim 14, characterized in that a sealing glass cover is provided around the laser radar (16).
16. The explosion-proof electric-hydraulic hybrid drive explosion-proof leg-foot robot according to claim 14, characterized in that the lines of the RTK antenna (17), explosion-proof button (18) and explosion-proof sound and light alarm (19) are explosion-proof cables, and adhesive sealing is applied to the parts where the explosion-proof cables pass through the chamber (11).
Citation Information
Patent Citations
Inspection robot
CN111496805A
Explosion-proof quadruped robot controlled by hydraulic pump
CN218141844U
JP1991011582U
Legged mobile work device
JP2009101469A
