Annular robot with multi-joint mechanical arm as heavy pendulum and walking control method of annular robot
By using multi-joint robots as heavy pendulums in ring robots and using straight drive motors and bevel gear sets to drive robots, the problem of insufficient driving torque of traditional spherical robots is solved, the climbing ability and flexibility are improved, and the stronger climbing and steering capabilities.
Patent Information
- Application Number
- CN202411019572.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-29
- Publication Date
- 2024-11-15
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
Due to the limited space of heavy pendulum, the driving torque of traditional spherical robots is limited, which limits its climbing and obstacle-surfing capabilities. The existing technology is complex and cannot effectively enhance the weight of heavy pendulum and the length of the force arm.
The multi-joint robot arm is used as the heavy pendulum, and the intermediate long axis is driven by the straight driving motor and bevel gear set, which drives the robot arm to rotate, changes the center of gravity and provides deflection torque, and combines the multi-stage joint angle solution to improve the climbing ability.
It achieves stronger climbing capabilities and flexibility, increases driving torque, compact overall structure, simple control and convenient steering.
Smart Images

Figure CN118953529A_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a robot, in particular to a ring-shaped robot with a multi-joint mechanical arm as a heavy pendulum and a walking control method thereof. Background Art
[0002] The spherical robot consists of a spherical shell and an internal control system, power system, actuator, sensor, etc. located inside the sphere. It moves by rolling the sphere and can achieve omnidirectional movement. The ground contact is a single point, the friction is small, the energy utilization efficiency is high, and the internal components are protected by the shell and are not easily damaged. Traditional spherical robots are driven by the eccentric torque of the weight pendulum, and the driving torque is closely related to the weight pendulum mass and the swing angle. The weight of the spherical robot is always inside the sphere. The internal space of the spherical robot is limited, and the weight pendulum is difficult to be very large, so the weight is limited. At the same time, the swing arm is difficult to exceed the radius of the spherical robot, which makes the arm length limited. The two together cause the spherical robot to have a limited driving torque, which in turn limits its ability to climb and jump obstacles.
[0003] In the prior art, for example, Chinese patent application No. 202111001289.5 discloses an all-terrain obstacle-crossing spherical robot, which adopts a double pendulum structure and enhances the robot's climbing ability by transferring the kinetic energy of the high-speed rotation of the flywheel to the heavy pendulum. Another example is Chinese patent application No. 201710170969.7, which discloses a spherical robot that uses the torque generated by the yaw motor and the drive motor to superimpose to enhance the climbing and obstacle-crossing capabilities. The above-mentioned driving force enhancement method has a complex structure and essentially neither increases the weight of the heavy pendulum nor increases the heavy pendulum force arm.
[0004] In the prior art, such as the Chinese patent with application number 202410432802.3, the center of mass offset is achieved by driving the trolley to roll, and the weight of the heavy swing and the heavy swing arm are essentially not increased. The spherical robot removes the ball crowns on both sides, making the robot as a whole ring-shaped, and mechanical arms are symmetrically installed on both sides of the ring-shaped robot, but the mechanical arms are only used to support the ring-shaped robot to stand up, and are not used to drive the ring-shaped robot forward, nor does it involve a control method based on the mechanical arm to drive the movement of the ring-shaped robot. Summary of the invention
[0005] Purpose of the invention: In view of the above problems, the present invention provides a ring-shaped robot with a multi-joint mechanical arm as a heavy pendulum that has expanded climbing and obstacle crossing capabilities.
[0006] The present invention also provides a walking control method of the ring-shaped robot.
[0007] Technical solution: To solve the above problems, the present invention adopts an annular robot with a multi-joint mechanical arm as a heavy pendulum, comprising an annular body, a driving device and a mechanical arm, wherein the annular body comprises an annular shell assembly, the annular shell assembly comprises an annular inner shell, a left end cover and a right end cover arranged at both ends of the annular inner shell, the annular inner shell, the left end cover and the right end cover surround and form a cavity for accommodating the driving device, the driving device comprises an intermediate long shaft penetrating the annular left end cover and the annular right end cover, a bevel gear set and a plurality of straight-moving driving motors uniformly arranged around the intermediate long shaft, the intermediate long shaft is located at the center of the left end cover and the right end cover, and rotates relative to the left end cover and the right end cover, the mechanical arm is arranged on both sides of the annular body and fixedly connected to both ends of the intermediate long shaft, the straight-moving driving motor drives the intermediate long shaft to rotate through the bevel gear set, the intermediate long shaft drives the mechanical arm to rotate relative to the annular shell assembly, thereby changing the center of gravity of the annular robot, driving the annular robot to move straight, and the intermediate long shaft drives one side of the mechanical arm to extend relative to the annular shell assembly, thereby realizing the lateral offset of the center of gravity of the annular robot, so that the robot turns.
[0008] Furthermore, the bevel gear set includes a small bevel gear fixed to the output end of the linear drive motor and a large bevel gear fixedly sleeved on the intermediate long shaft, and the small bevel gears on several linear drive motors are all meshed with the large bevel gear.
[0009] Furthermore, the annular body also includes a plurality of I-shaped plates, which are evenly arranged around the middle long axis in the circumferential direction, and the I-shaped plates are used to install control elements.
[0010] Furthermore, a rubber outer shell is sleeved on the outer side of the annular inner shell.
[0011] Furthermore, the robotic arm includes a first joint fixedly connected to the middle long axis, a second joint hinged to the first joint, and a third joint hinged to the second joint, and the extension direction of the first joint is parallel to the plane where the left end cover and the right end cover are located.
[0012] Furthermore, the length of the first joint is equal to the radius of the annular inner shell, and the length of the second joint is longer than the first joint and the third joint.
[0013] The present invention also adopts a walking control method for the above-mentioned ring-shaped robot, comprising the following steps:
[0014] Determine the slope angle of the circular robot's travel direction;
[0015] Determine the driving torque required by the ring robot according to the slope angle, and solve the joint angles of each joint of the robot arm;
[0016] Control the joints of the robotic arm to adjust to the solved joint angles and drive the ring robot to move forward.
[0017] Furthermore, the method of solving the joint angles of each joint of the robotic arm comprises the following steps:
[0018] (1) The first stage solution is to first take the end of the robot arm touching the slope and the third joint being perpendicular to the slope as the initial control condition, change the joint angle of the first joint, and change the angle of the second joint synchronously to determine the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, then the joint angles of the first joint and the second joint are obtained based on the required driving torque and the joint angle of the third joint; if the required driving torque is greater than the maximum torque, then the second stage solution is performed;
[0019] (2) The second stage solution takes the joint angles of the first joint and the second joint at the maximum torque in the first stage as the initial control condition, changes the joint angle of the third joint, and determines the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, the joint angle of the third joint is obtained according to the required driving torque and the joint angles of the first joint and the second joint; if the required driving torque is greater than the maximum torque, the third stage solution is performed;
[0020] (3) The third stage solution is to use the joint angles of the second and third joints at the maximum torque in the second stage as the initial control conditions, change the joint angle of the first joint, and obtain the joint angle of the first joint based on the required driving torque and the joint angles of the second and third joints.
[0021] Furthermore, when solving in the third stage, if the required driving torque is greater than the maximum torque provided by the robotic arm, the robotic arm is controlled to clamp the weight so that the torque provided by the robotic arm meets the required driving torque.
[0022] Furthermore, in the third stage solution, when the slope angle is 0≤γ≤γ mid When , the joint angle of the first joint is increased; when the slope angle is γ mid <γ≤γ max , reduce the joint angle of the first joint until the end of the robot arm contacts the slope, and the slope angle γ mid The calculation formula is:
[0023]
[0024] Where R is the outer diameter of the rubber shell of the annular robot, a 1 is the length of the first joint, a 2 is the length of the second joint, a 3 is the length of the third joint.
[0025] Beneficial effects: Compared with the prior art, the significant advantage of the present invention is that the multi-joint mechanical arm acts as a weight pendulum. When the annular robot climbs a slope, it generates different deflection torques by controlling the angles of each joint of the mechanical arm, thereby climbing different slopes. Compared with the traditional eccentric torque drive based on the weight pendulum, it has high flexibility and stronger climbing ability. The annular robot is driven by multiple straight-moving motors, and the middle long axis is driven to rotate by large and small bevel gears. Compared with the traditional spherical robot, it has a larger driving torque and stronger climbing ability. Multiple straight-moving motors are evenly installed on the I-type plate in a circular shape, and the mass is evenly distributed. The electronic components are evenly distributed on the I-type plate. The overall structure is compact and the space utilization rate is high. The mechanical arm on one side is pushed out by the cylinder, so that the mass on the left and right of the annular robot is unequal, thereby realizing the center of gravity offset of the annular robot, so that the robot can turn, and the turning is convenient and flexible, and the control is simple. The control joint angle of the mechanical arm is obtained by multiple stages, which simplifies the joint angle calculation problem of the mechanical arm control and improves the control speed. BRIEF DESCRIPTION OF THE DRAWINGS
[0026] Figure 1 It is a schematic diagram of the overall structure of the ring-shaped robot of the present invention;
[0027] Figure 2 This is a schematic diagram of the structure of the ring-shaped robot of the present invention without the left and right end covers;
[0028] Figure 3 A radial cross-sectional view of the ring-shaped robot of the present invention;
[0029] Figure 4 A circumferential cross-sectional view of the ring-shaped robot of the present invention;
[0030] Figure 5 A schematic diagram of a climbing ring-shaped robot of the present invention;
[0031] Figure 6 A schematic diagram of the coordinate system of the ring-shaped robot of the present invention when climbing a slope;
[0032] Figure 7 It is a schematic diagram of force analysis of the ring-shaped robot of the present invention;
[0033] Figure 8 It is a schematic diagram of force analysis of a spherical heavy-swing robot in the prior art;
[0034] Fig. 9 The present invention is that when the climbing angle is less than γ mid Schematic diagram of the range of angle changes of the ring robot's arm joints during the first stage of climbing;
[0035] Fig.10 The present invention is that when the climbing angle is less than γ mid Schematic diagram of the range of joint angle changes of the ring robot's second stage climbing manipulator arm;
[0036] Fig.11 The present invention is that when the climbing angle is less than γ mid Schematic diagram of the range of angle changes of the ring robot's arm joints during the third stage of climbing;
[0037] Fig.12 The present invention is that when the climbing angle is greater than γ mid Schematic diagram of the range of angle changes of the ring robot's arm joints during the first stage of climbing;
[0038] Fig.13 The present invention is that when the climbing angle is greater than γ mid Schematic diagram of the range of joint angle changes of the ring robot's second stage climbing manipulator arm;
[0039] Fig.14 The present invention is that when the climbing angle is greater than γ mid Schematic diagram of the range of joint angle changes of the ring robot's climbing arm during the third stage. DETAILED DESCRIPTION
[0040] Example 1
[0041] Depend on Figure 1 As shown, in this embodiment, a ring robot with a multi-joint mechanical arm as a weight pendulum is mainly composed of a ring body, a drive device, a mechanical arm and other parts. The drive device is mainly composed of six straight-moving motors, which provide driving torque for the ring robot to climb; the mechanical arm acts as a weight pendulum to provide a deflection torque, with high control flexibility and stronger climbing ability. This embodiment uses the right mechanical arm 2 as a reference, and the left mechanical arm has the same structure and control method, which will not be repeated here.
[0042] like Figure 2 , 3 As shown, the annular body 3 is mainly composed of an annular shell assembly 31, an I-shaped plate 32, etc. The annular shell assembly 31 is composed of an annular inner shell 312, an annular outer shell 311, a left end cover 313, a right end cover 314, etc. The annular outer shell 311 is sleeved on the annular inner shell 312 and is a rubber shell. The six I-shaped plates 32 are connected by bolts, evenly distributed on the annular inner shell 312, and installed on the annular inner shell 312 by bolts. The left end cover 313 and the right end cover 314 are installed on the annular outer shell 311 by bolts. The mechanical arm 2 includes a first joint fixedly connected to the intermediate long axis 13, a second joint hinged to the first joint, and a third joint hinged to the second joint. The extension direction of the first joint is parallel to the plane where the left end cover 313 and the right end cover 314 are located. The length of the first joint is equal to the radius of the annular inner shell 312, and the length of the second joint is longer than the first joint and the third joint.
[0043] like Figure 3 , Figure 4As shown, the driving device 1 is composed of a straight driving motor 11, a motor base 12, an intermediate long shaft 13, a bevel gear set 14, a shaft base 15, a control element 18, a left cylinder 191, a right cylinder 192, etc. The straight driving motor 11 is fixed to the I-shaped plate 32 by bolts through the motor base 12, the end of the rotating shaft passes through the small hole preset in the I-shaped plate 32, and a small bevel gear 17 is installed at the tail. The remaining five straight driving motors are installed in the same manner as above, and are installed on the I-shaped plate 32 in a circumferential distribution with the intermediate long shaft 13 as the center of the circle. The shaft base 15 is installed on the left and right end covers 313 and 314 by bolts, the middle long shaft 13 is installed on the shaft base 15 and passes through the small holes preset in the left and right end covers 313 and 314. The left cylinder 191 and the right cylinder 192 are installed in the middle long shaft by bolts. The end of the middle long shaft 13 is connected to the robot arm 2. The left cylinder 191 or the right cylinder 192 is extended to push out the left end or the right end of the middle long shaft 13. The robot arm on one side is pushed out by the cylinder, so that the left and right masses of the annular robot are unequal, thereby realizing the center of gravity offset of the annular robot, so that the robot can turn, the turning is convenient and flexible, and the control is simple. The large bevel gear 16 is fixed on the middle long shaft and meshes with six small bevel gears 17. The control element 18 is installed on the I-shaped plate 32 in a circumferential distribution.
[0044] like Figure 5 As shown, the working principle of the ring-shaped robot's straight-moving walking and climbing is: the control element 18 controls the six straight-moving drive motors 11 to rotate, and the six straight-moving drive motors 11 respectively drive the corresponding small bevel gears 17 to rotate, and the six small bevel gears 17 drive the large bevel gear 16 to rotate, and then drive the mechanical arm 2 acting as a weight to rotate through the intermediate long shaft 13, which will form a deflection torque on the center of the ring-shaped robot, and the mechanical arm 2 changes the size of the driving torque by changing the angles of each joint, thereby driving the ring-shaped robot to move straight forward and backward.
[0045] Example 2
[0046] In this embodiment, a walking control method of a ring-shaped robot with a multi-joint mechanical arm as a heavy pendulum comprises the following steps:
[0047] Step 1: Determine the slope angle of the circular robot's moving direction;
[0048] Step 2: Determine the driving torque required by the ring robot according to the slope angle, and solve the joint angles of each joint of the robot arm;
[0049] Step 21: Establish the coordinate system of the ring robot and each joint of the robotic arm;
[0050] like Figure 6As shown in the figure, the robot has three rotational joints, with a total of three rotational degrees of freedom. The standard_DH modeling method is used to establish the coordinate system of each joint, with the intersection of the geometric center axis of the ring robot and the plane where the robot arm is located as the origin O 0 Establish the robot arm base coordinate system O 0 -X 0 Y 0 Z 0 , Z 1 Z is the direction along the first rotation axis and perpendicular to the annular housing outward. 2 Z is the direction along the second rotation axis and perpendicular to the annular housing outward. b The end of the robot arm establishes the robot arm end coordinate system O along the third rotation axis and perpendicular to the outward direction of the annular shell. b -X b Y b Z b .
[0051] Step 22: Calculate the position coordinates of each joint;
[0052] The robot arm has three revolute joints, and the coordinate transformation matrix T between link i-1 and link i is i i-1 As shown in the formula:
[0053]
[0054] The four physical definition parameters are as follows:
[0055] (1) Connecting rod length a i :X i Looking in the direction, the Z coordinate system of the rotating joint i-1 and joint i i-1 to Z i distance.
[0056] (2) Connecting rod angle α i :X i Direction: Z i-1 and Z i The angle between.
[0057] (3) Connecting rod offset d i : Along Z i-1 The direction of rotation of joint i-1 and joint i in the coordinate system X i-1 To X i distance.
[0058] (4) Joint angle θ i :Z i-1 Looking in the direction of X i-1 Rotate to X i angle.
[0059] According to the geometric dimensions of the robot arm, the forward kinematics DH parameters are established as shown in Table 1.
[0060] Table 1 Robot arm joint parameters
[0061]
[0062] The motion equation of the end of the ring robot arm is established as shown in the formula:
[0063]
[0064] in, Represents the robot end coordinate system O b -X b Y b Z b Position and orientation relative to the robot base.
[0065] Step 23: Perform force analysis and calculate driving torque;
[0066] like Figure 7 As shown, γ is the slope angle, and the ring body of the ring robot is equivalent to mass m 1 , the driving device is equivalent to mass m 2 , the equivalent mass of each segment of the robot arm is m 31 、m 32 、m 33 , and are equivalently concentrated at the end of each segment. The radius of the annular shell is R, and the lengths of each segment of the robotic arm are a 1 、a 2 、a 3 Get the driving torque τ and each joint angle θ 1 ,θ 2 ,θ 3 The relationship is as follows:
[0067]
[0068] The force analysis of the traditional heavy-swing ring robot is as follows: Figure 8 As shown, the driving torque is:
[0069] τ=m 3 glsinφ 0 -(m 1 +m 2 +m 3 )gRsinγ (4)
[0070] In the formula, there is only one degree of freedom, the driving torque and the swing angle φ of the pendulum 0 The only thing that is certain is that given the driving torque, the swing angle can be calculated.
[0071] In the driving torque calculation formula (3) of this embodiment, there are multiple degrees of freedom, namely, θ 1 ,θ 2 ,θ 3 When the driving torque is given, there will be infinite sets of solutions. Therefore, solving the joint angle based on the given driving torque is a new problem faced, and the solution method is the innovation of this method.
[0072] Step 24: Calculate the joint angle according to the given driving torque;
[0073] (1) Divide the solution interval according to geometric relationships.
[0074] When θ 1 =θ 2 =θ 3 = 0, the end of the robot arm contacts the slope, and the slope angle is γ mid :
[0075]
[0076] (2) When the slope angle is 0≤γ≤γ mid The solution process is divided into three stages:
[0077] The first stage: First, the end of the robot arm touches the slope and the third joint is perpendicular to the slope as the initial control condition, the joint angle of the first joint is changed, and the second joint angle is changed synchronously to determine the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, the joint angles of the first joint and the second joint are obtained based on the required driving torque and the joint angle of the third joint; if the required driving torque is greater than the maximum torque, the second stage solution is performed.
[0078] like Fig. 9 As shown: the end of the robot arm is always in vertical contact with the slope surface, with the robot arm base coordinate system O 0 -X 0 Y 0 Z 0 As the base coordinate system, the analytical solution is used to solve the angles of each joint of the robot arm, and the relationship between x and torque τ in the base coordinate system is established based on the angles of each joint. Solve for θ 1 ,θ 2 ,θ 3 Where x represents the displacement of the end of the robot in the X direction in the base coordinate system.
[0079] According to formula (2), the motion equation of the end of the ring robot arm is established.
[0080] in
[0081]
[0082]
[0083] Solving for θ 2 :
[0084]
[0085] Solving for θ 1 :
[0086]
[0087] Let k 1 =a 1 +a 2 cosθ 2 , k 2 =a 2 sinθ 2 , b = Atan2(k 2 ,k 1 ).
[0088]
[0089] Solving for θ 3 :
[0090]
[0091] In the first stage, by combining equations (3), (12), (15), and (16), we can obtain the relationship between the moment τ and x:
[0092]
[0093] in,
[0094]
[0095] Maximum torque in the first stage:
[0096]
[0097] The second stage: taking the joint angles of the first joint and the second joint at the maximum torque in the first stage as the initial control conditions, changing the joint angle of the third joint, and determining the maximum torque provided by the robot arm; if the required driving torque is less than the maximum torque, obtaining the joint angle of the third joint based on the required driving torque and the joint angles of the first joint and the second joint; if the required driving torque is greater than the maximum torque, performing the third stage solution.
[0098] like Fig.10 As shown, in order to further increase the torque, fix joint 1 and joint 2 at this time, gradually increase the angle of joint 3 until the angle of joint 3 is 0. θ 2=0, the range of the angle of joint 3 is From formula (3), we can see that the torque τ and θ in the second stage are 3 The relationship is:
[0099]
[0100] Maximum torque in the second stage:
[0101]
[0102] The third stage: taking the joint angles of the second joint and the third joint at the maximum torque in the second stage as the initial control conditions, changing the joint angle of the first joint, and obtaining the joint angle of the first joint based on the required driving torque and the joint angles of the second joint and the third joint.
[0103] like Fig.11 As shown, in order to further increase the torque, fix joints 2 and 3 at this time, gradually increase the angle of joint 1 to make the angle of joint 1 0. In this process, θ 1 =0,θ 2 =0, the range of joint 1 angle is
[0104] From formula (3), we can see that the torque τ and θ in the third stage are 1 The relationship is:
[0105]
[0106] Maximum torque in the third stage:
[0107]
[0108] (3) When the slope angle is γ mid <γ≤γ max The solution process is divided into three stages:
[0109] The first stage: First, the end of the robot arm touches the slope and the third joint is perpendicular to the slope as the initial control condition, the joint angle of the first joint is changed, and the second joint angle is changed synchronously to determine the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, the joint angles of the first joint and the second joint are obtained based on the required driving torque and the joint angle of the third joint; if the required driving torque is greater than the maximum torque, the second stage solution is performed.
[0110] like Fig.12 As shown, the solution method and slope angle are 0≤γ≤γ mid Same time.
[0111] Combining formulas (3), (12), (15), and (16), we can obtain the relationship between moment τ and x:
[0112]
[0113] in,
[0114]
[0115] Maximum torque in the first stage:
[0116]
[0117] The second stage: taking the joint angles of the first joint and the second joint at the maximum torque in the first stage as the initial control conditions, changing the joint angle of the third joint, and determining the maximum torque provided by the robot arm; if the required driving torque is less than the maximum torque, obtaining the joint angle of the third joint based on the required driving torque and the joint angles of the first joint and the second joint; if the required driving torque is greater than the maximum torque, performing the third stage solution.
[0118] like Fig.13 As shown, in order to further increase the torque, fix joint 1 and joint 2 at this time, gradually increase the angle of joint 3 until the angle of joint 3 is 0. θ 2 =0, the range of the angle of joint 3 is
[0119] From formula (3), we can see that the torque τ and θ in the second stage are 3 The relationship is:
[0120]
[0121] Maximum torque in the second stage:
[0122]
[0123] The third stage: taking the joint angles of the second joint and the third joint at the maximum torque in the second stage as the initial control conditions, changing the joint angle of the first joint, and obtaining the joint angle of the first joint based on the required driving torque and the joint angles of the second joint and the third joint.
[0124] like Fig.14 As shown, in order to further increase the torque, fix joints 2 and 3, reduce the angle of joint 1, and make the angle of joint 1 The range of joint 1 angle is
[0125]
[0126] From formula (3), we can see that the torque τ and θ in the third stage are 1 The relationship is:
[0127]
[0128] Maximum torque in the third stage:
[0129]
[0130] When 0<τ<τ 1max , select the first stage to solve the moment; τ 1max <τ<τ 2max , select the second stage to solve the moment; τ 2max <τ<τ 3max , select the third stage to solve the moment.
[0131] The end of the robot arm holds a heavy object to increase the robot's climbing ability. When the climbing ability is insufficient, the climbing ability can be increased by clamping a heavy object at the end of the robot arm.
[0132] During the climbing process, the driving torque provided by the robot arm is:
[0133]
[0134] (1) Divide the solution interval according to geometric relationships
[0135] Same as step 4, when θ 1 =θ 2 =θ 3 = 0, the end of the robot arm contacts the slope, and the slope angle is γ mid , solve for γ mid :
[0136]
[0137] (2) When the slope angle is 0≤γ≤γ mid When , the solution process is the same as step 4:
[0138] Phase 1:
[0139] Combining equations (31), (12), (15), and (16), we can obtain the relationship between moment τ and x:
[0140]
[0141] in,
[0142]
[0143] Maximum torque in the first stage:
[0144]
[0145] Phase 2:
[0146] In order to further increase the torque, fix joint 1 and joint 2 at this time, gradually increase the angle of joint 3, and make the angle of joint 3 0 in this process. θ 2 =0, the range of the angle of joint 3 is
[0147] From formula (31), we can see that the torque τ and θ in the second stage are 3 The relationship is:
[0148]
[0149] Maximum torque in the second stage:
[0150]
[0151] Phase 3:
[0152] In order to further increase the torque, fix joint 2 and joint 3, gradually increase the angle of joint 1, and make the angle of joint 1 0. In this process, θ 1 =0,θ 2 =0, the range of joint 1 angle is
[0153]
[0154] From formula (31), we can see that the torque τ and θ in the third stage are 1 The relationship is:
[0155]
[0156] Maximum torque in the third stage:
[0157]
[0158] When 0<τ<τ 1max , select the first stage to solve the moment; τ 1max <τ<τ 2max , select the second stage to solve the moment; τ 2max <τ<τ 3max , select the third stage to solve the moment.
[0159] (3) When the slope angle is γ mid <γ≤γ max When , the solution process is the same as step 4:
[0160] Phase 1:
[0161] Combining equations (31), (12), (15), and (16), we can obtain the relationship between moment τ and x:
[0162]
[0163] in,
[0164]
[0165] Maximum torque in the first stage:
[0166]
[0167] Phase 2:
[0168] In order to further increase the torque, fix joint 1 and joint 2 at this time, gradually increase the angle of joint 3, and make the angle of joint 3 0 in this process. θ 2 =0, the range of the angle of joint 3 is
[0169] From formula (31), we can see that the torque τ and θ in the second stage are 3 The relationship is:
[0170]
[0171] Maximum torque in the second stage:
[0172]
[0173] Phase 3:
[0174] In order to further increase the torque, fix joints 2 and 3, reduce the angle of joint 1, and make the angle of joint 1 The range of joint 1 angle is
[0175] From formula (31), we can see that the torque τ and θ in the third stage are 1 The relationship is:
[0176]
[0177] Maximum torque in the third stage:
[0178]
[0179] Step 3: Control the joints of the robotic arm to adjust to the solved joint angles and drive the ring robot to move forward.
Claims
1. A ring-shaped robot with a multi-joint mechanical arm as a heavy pendulum, characterized in that: The invention comprises an annular body (3), a driving device (1) and a mechanical arm (2), wherein the annular body (3) comprises an annular housing assembly (31), the annular housing assembly (31) comprises an annular inner housing (312), a left end cover (313) and a right end cover (314) arranged at both ends of the annular inner housing, the annular inner housing (312), the left end cover (313) and the right end cover (314) surrounding each other to form a cavity for accommodating the driving device (1), the driving device (1) comprising an intermediate long shaft (13) penetrating the annular left end cover (313) and the annular right end cover (314), a bevel gear set (14) and a plurality of straight-moving driving motors (11) uniformly arranged in the circumferential direction around the intermediate long shaft, the intermediate long shaft ( 13) is located at the center of the left end cover (313) and the right end cover (314), and rotates relative to the left end cover (313) and the right end cover (314); the mechanical arm (2) is arranged on both sides of the annular body (3) and is fixedly connected to both ends of the intermediate long shaft (13); the straight-moving drive motor (11) drives the intermediate long shaft (13) to rotate through the bevel gear set (14); the intermediate long shaft (13) drives the mechanical arm (2) to rotate relative to the annular shell assembly (31), thereby changing the center of gravity of the annular robot and driving the annular robot to move straight; the intermediate long shaft (13) drives one side of the mechanical arm to extend relative to the annular shell assembly (31), thereby realizing the lateral offset of the center of gravity of the annular robot and making the robot turn.
2. The ring-shaped robot according to claim 1, characterized in that: The bevel gear set (14) comprises a small bevel gear (17) fixed to the output end of the linear drive motor (11) and a large bevel gear (16) fixedly sleeved on the intermediate long shaft (13), and the small bevel gears (17) on the linear drive motors are all meshed with the large bevel gear (16).
3. The ring-shaped robot according to claim 1, characterized in that: The annular body (3) further comprises a plurality of I-shaped plates (32), wherein the plurality of I-shaped plates (32) are evenly arranged circumferentially around the middle long axis (13), and the I-shaped plates (32) are used for mounting control elements (18).
4. The ring-shaped robot according to claim 3, characterized in that: The outer side of the annular inner shell (312) is sleeved with a rubber outer shell (311).
5. The ring-shaped robot according to claim 4, characterized in that: The mechanical arm (2) comprises a first joint fixedly connected to the middle long axis (13), a second joint hinged to the first joint, and a third joint hinged to the second joint, wherein the extension direction of the first joint is parallel to the plane where the left end cover (313) and the right end cover (314) are located.
6. The ring-shaped robot according to claim 5, characterized in that: The length of the first joint is equal to the radius of the annular inner shell (312), and the length of the second joint is longer than the first joint and the third joint.
7. A walking control method for the ring-shaped robot according to claim 6, characterized in that: The following steps are involved: Determine the slope angle of the circular robot's travel direction; Determine the driving torque required by the ring robot according to the slope angle, and solve the joint angles of each joint of the robot arm; Control the joints of the robotic arm to adjust to the solved joint angles and drive the ring robot to move forward.
8. The walking control method of the ring-shaped robot according to claim 7, characterized in that: The method for solving the joint angles of each joint of the robotic arm comprises the following steps: (1) The first stage solution is to first take the end of the robot arm touching the slope and the third joint being perpendicular to the slope as the initial control condition, change the joint angle of the first joint, and change the angle of the second joint synchronously to determine the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, then the joint angles of the first joint and the second joint are obtained based on the required driving torque and the joint angle of the third joint; if the required driving torque is greater than the maximum torque, then the second stage solution is performed; (2) The second stage solution takes the joint angles of the first joint and the second joint at the maximum torque in the first stage as the initial control condition, changes the joint angle of the third joint, and determines the maximum torque provided by the robot arm. If the required driving torque is less than the maximum torque, the joint angle of the third joint is obtained according to the required driving torque and the joint angles of the first joint and the second joint; if the required driving torque is greater than the maximum torque, the third stage solution is performed; (3) The third stage solution is to use the joint angles of the second and third joints at the maximum torque in the second stage as the initial control conditions, change the joint angle of the first joint, and obtain the joint angle of the first joint based on the required driving torque and the joint angles of the second and third joints.
9. The walking control method of the ring-shaped robot according to claim 8, characterized in that: When solving in the third stage, if the required driving torque is greater than the maximum torque provided by the robotic arm, the robotic arm is controlled to clamp the weight so that the torque provided by the robotic arm meets the required driving torque.
10. The walking control method of the ring-shaped robot according to claim 9, characterized in that: In the third stage solution, when the slope angle is 0≤γ≤γ mid When , the joint angle of the first joint is increased; when the slope angle is γ mid <γ≤γ max , reduce the joint angle of the first joint until the end of the robot arm contacts the slope, and the slope angle γ mid The calculation formula is: Wherein, R is the outer diameter of the rubber shell of the annular robot, a1 is the length of the first joint, a2 is the length of the second joint, and a3 is the length of the third joint.
