A foldable lightweight mechanical arm system and control method thereof
By designing a foldable robotic arm system and self-immune control strategy, the problems of complex disassembly and assembly, large space and poor torsion resistance of the robotic arm are solved, and the structure is compact, convenient disassembly and assembly and high torsion stiffness are achieved, suitable for specialty Application scenario.
Patent Information
- Application Number
- CN202410917274.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-10
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2044-07-10
AI Technical Summary
The existing robotic arms are not easy to disassemble and assemble, the installation process is complicated, the storage and transportation take up a large space, and the rotation joint connectors of the lightweight robotic arms are large in length and have poor torsion resistance, resulting in easy shaking and low control accuracy during use.
A foldable lightweight robotic arm system is designed, adopting forearm, big arm, rotating base, first rotating joint and second rotating joint, and detached connection is achieved through the connector, driving components are arranged to achieve six degrees of freedom movement, and The joint is connected by a double-end support structure and plum screws, combining self-immune and vertical vibration damping control strategies.
It realizes the compact structure of the robot arm, convenient disassembly and assembly, high torsional stiffness, can be completely folded, reduce space occupation, improves the convenience of transportation and use, and improves the control accuracy and stability of the robot arm.
Smart Images

Figure CN118559693B_ABST
Abstract
Description
Technical Field
[0001] The present invention belongs to the technical field of mechanical arms, and in particular relates to a foldable lightweight mechanical arm system and a control method thereof. Background Art
[0002] In order to make the product installation more universal, the existing robot arm generally does not have a quick release device. Bolts or integrated proprietary parts are used to fix the rotating joints, and the mounting base is also mostly fixed by bolts. The installation process is complicated and takes a lot of time.
[0003] In addition, in order to ensure the overall structural strength, rigidity, and stability of the electrical circuits, traditional robotic arms often use large, thick, and short integral cylindrical parts as connectors between rotating joints to protect the cables and make the overall rigidity of the robotic arm higher. However, this form cannot be completely folded when the robotic arm is retracted, and the joints and joint connectors interfere with each other. Generally, it can only be stored and transported in a fully extended or semi-folded state. This form limits the length of the robotic arm when it is fully extended, and makes it difficult to completely fold the robotic arm. In special application scenarios, the size of the robotic arm is increased, and the overall passability of the robot equipped with the robotic arm is reduced.
[0004] Generally speaking, the longer the connector between the rotating joints of a robot arm, the greater the reach. However, as the connector length increases, its overall stiffness decreases; and lightweight robot arms often use connectors with smaller diameters, which results in reduced torsional resistance and prone to torsional deformation between rotating joints, greatly reducing the end control accuracy. Summary of the invention
[0005] The technical problem to be solved by the present invention is to overcome the shortcomings of the existing robotic arms, such as being difficult to disassemble and assemble, having a complicated installation process, and a long installation and debugging time before use; the existing robotic arms having no folding design, taking up a large space for storage and transportation, and having low efficiency; and the existing lightweight robotic arms with a large reach, in which the connecting arms between the rotating joints are long, have poor torsional resistance, and are prone to shaking during use. The present invention provides a foldable lightweight robotic arm system and a control method thereof which has a compact structure, is easy to disassemble and assemble, has high torsional rigidity, and can be completely folded.
[0006] In order to solve the above technical problems, the present invention adopts the following technical solutions:
[0007] A foldable lightweight robotic arm system comprises: a forearm, an upper arm, a rotating base, a first rotating joint, a second rotating joint and a connecting piece; the two ends of the upper arm are detachably connected to the rotating base and the second rotating joint respectively through the connecting piece, the rotating base is connected to the first motor, and the two ends of the forearm are detachably connected to the second rotating joint and the first rotating joint respectively through the connecting piece; the rotating base, the first rotating joint and the second rotating joint are all provided with driving components, and under the drive of the first motor and the driving component, the rotating base, the first rotating joint and the second rotating joint drive the forearm and the upper arm to move, so as to realize the six-degree-of-freedom movement of the robotic arm system; when the robotic arm system is in a folded state, the forearm is folded and hidden inside the upper arm; when the robotic arm system is in an unfolded state, the forearm and the upper arm are in the same straight line.
[0008] As a further improvement of the present invention, both the first rotary joint and the second rotary joint adopt a double-end support structure to achieve symmetrical arrangement of the forearm and the upper arm.
[0009] As a further improvement of the present invention, the connecting member includes: a first connecting groove, a second connecting groove and a third connecting groove, the first connecting groove and the second connecting groove are respectively used to connect the upper arm and the rotating base or the second rotating joint, and to connect the lower arm and the first rotating joint or the second rotating joint; a first threaded hole is provided through the middle of the second connecting groove, and a second threaded hole is provided through the ends of the first connecting groove and the third connecting groove; when the first connecting groove and the third connecting groove are respectively inserted into the interior of the second connecting groove from both ends, plum screws are screwed into the first threaded hole and the second threaded hole to realize the connection and fixation of the first connecting groove and the third connecting groove with the second connecting groove.
[0010] As a further improvement of the present invention, the outer side surfaces of the first connecting groove and the third connecting groove are evenly distributed with multiple bosses, and the inner side surfaces of the second connecting groove are evenly distributed with multiple grooves. When the first connecting groove and the third connecting groove are respectively inserted into the interior of the second connecting groove from both ends, the bosses are nested in the grooves.
[0011] As a further improvement of the present invention, the rotating base includes: a mounting plate, a first connecting plate and a first mounting seat; the mounting plate is provided with a first connecting plate and a first mounting seat, the first mounting seat is used to install a driving component, the first connecting plate is symmetrically arranged on both sides of the first mounting seat, one end of the first connecting plate is connected to the rotating end of the driving component, and the other end of the first connecting plate is connected to the lower end of the upper arm through a connecting piece; under the drive of the driving component, the first connecting plate drives the upper arm to rotate.
[0012] As a further improvement of the present invention, the mounting plate is also connected to the first motor, and driven by the first motor, the rotating base drives the robotic arm system to rotate.
[0013] As a further improvement of the present invention, it also includes a third rotation joint, which is used to connect the clamping claw; the first rotation joint includes: a second mounting seat, a second connecting plate, a first connecting rod and a connecting hole; the connecting hole is arranged on the side of the second mounting seat, and the third rotation joint is connected to the second mounting seat through the connecting hole; a driving component is arranged in the second mounting seat, and the two sides of the second mounting seat are respectively connected to the rotating end of the driving component, and under the drive of the driving component, the second mounting seat drives the third rotation joint to rotate, and then drives the clamping claw to rotate; the second connecting plates are symmetrically arranged on both sides of the second mounting seat, and the end of the second connecting plate is provided with a first connecting rod, and the first connecting rod is connected to the upper end of the forearm through a connecting member.
[0014] As a further improvement of the present invention, the second rotating joint includes: a third mounting seat, a third connecting plate, a second connecting rod and a third connecting rod; a driving component and a third connecting plate are arranged in the third mounting seat, one end of the third connecting plate is connected to the rotating end of the driving component, and the other end of the third connecting plate is provided with a second connecting rod arranged side by side, and the second connecting rod is connected to the lower end of the forearm through a connecting piece; under the drive of the driving component, the third connecting plate drives the forearm to rotate; the third connecting rods are symmetrically arranged on both outer sides of the third mounting seat, and the third connecting rods are connected to the upper end of the upper arm through a connecting piece.
[0015] As a further improvement of the present invention, the second connecting rod is located inside the third connecting rod, and when the robotic arm system is in a folded state, the small arm is completely hidden in the connecting groove inside the large arm.
[0016] As a general technical concept, the present invention also provides a control method based on the above-mentioned foldable lightweight manipulator system, which controls the manipulator end attitude by adopting an end attitude stabilization control strategy based on self-disturbance rejection, and controls the forearm and upper arm attitude by adopting a vertical vibration reduction control strategy based on imitating a "compression spring";
[0017] An IMU inertial measurement unit is set in the gripper at the end of the robotic arm. The IMU inertial measurement unit is used to detect the actual attitude angle of the gripper, that is, the actual attitude angle of the robotic arm transporting the object. The attitude angle is subtracted from the attitude of the end of the robotic arm controlled by the remote handle to obtain the attitude disturbance error of the end of the robotic arm caused by the mobile platform when driving. The attitude error represented by the quaternion is decoupled into the three directions of pitch, yaw and roll, which correspond to the rotation of the fourth motor, the fifth motor and the sixth motor respectively. At the same time, by establishing a dynamic model of the end rotary joint motion, the parameters of the anti-disturbance control are preliminarily determined according to the dynamic model, and a three-decoupled single-input single-output anti-disturbance control controller is obtained.
[0018] The current positions of the second motor and the third motor recorded by the encoders of the second motor and the third motor are subtracted from the initial positions of the handle remote control to obtain the position deviation of the motor. The position deviation is differentiated with respect to the sampling time. The position deviation and the differential amount are multiplied by the stiffness coefficient C and the damping coefficient D respectively to simulate the elastic stiffness and damping effect. The damping is coordinated to realize the critical damping characteristics of the second-order system to suppress the amplitude and overshoot due to elastic vibration rebound. When the 2 times value of the position deviation of the second motor is greater than the position deviation value of the third motor, a correction current is generated to suppress the elastic damping current of the second motor and supplement the elastic damping current of the third motor, so as to keep the rotation amplitude of the second motor and the third motor at 1:1.8~2.2, thereby maintaining the vertical up and down movement of the entire robotic arm.
[0019] Compared with the prior art, the advantages of the present invention are:
[0020] The foldable lightweight mechanical arm system and control method thereof of the present invention, The two ends of the upper arm are detachably connected to the rotating base and the second rotating joint by connecting pieces, and the rotating base is also connected to the first motor, and the two ends of the lower arm are detachably connected to the second rotating joint and the first rotating joint by connecting pieces, so that a mechanical arm system with compact structure, convenient disassembly and assembly, and high torsional rigidity is obtained, and the overall disassembly, assembly and installation of the mechanical arm can be realized in a shorter time; further, the rotating base, the first rotating joint and the second rotating joint are all provided with driving components, and under the drive of the first motor and the driving component, the rotating base, the first rotating joint and the second rotating joint drive the lower arm and the upper arm to move, so that the mechanical arm system can perform six-degree-of-freedom movement; when the mechanical arm system is in a folded state, the lower arm is folded and hidden inside the upper arm; when the mechanical arm system is in an unfolded state, the lower arm and the upper arm are in the same straight line, which not only achieves the purpose of reducing the spatial volume of the mechanical arm system, but also enables the mechanical arm system to complete operations at a higher place, and well solves the problems of complex disassembly and assembly, large spatial volume, poor torsional resistance, etc. of the existing mechanical arm system, and significantly improves the convenience of transportation, assembly and use of the foldable and lightweight mechanical arm system. BRIEF DESCRIPTION OF THE DRAWINGS
[0021] Figure 1 It is a schematic diagram of the side structural principle of the foldable lightweight robotic arm system of the present invention in an unfolded state.
[0022] Figure 2 It is a schematic diagram of the side structural principle of the foldable lightweight robotic arm system of the present invention in a folded state.
[0023] Figure 3 The figure is a schematic diagram of the top structural principle of the foldable lightweight mechanical arm system of the present invention in a folded state.
[0024] Figure 4It is a schematic diagram of the structural principle of the forearm in the present invention.
[0025] Figure 5 It is a schematic diagram of the structural principle of the upper arm in the present invention.
[0026] Figure 6 It is a schematic diagram of the structural principle of the rotating base in the present invention.
[0027] Figure 7 It is a schematic diagram of the structural principle of the first rotary joint in the present invention.
[0028] Figure 8 It is a schematic diagram of the structural principle of the second rotary joint in the present invention.
[0029] Fig. 9 It is a schematic diagram of the structural principle of the connecting piece in the present invention.
[0030] Fig.10 It is a schematic block diagram of the control process of the robot arm system in the present invention.
[0031] Legend: 1. Forearm; 2. Upper arm; 3. Rotating base; 31. Mounting plate; 32. First connecting plate; 33. First mounting seat; 34. Second motor; 4. First rotating joint; 41. Second mounting seat; 42. Second connecting plate; 43. First connecting rod; 44. Connecting hole; 45. Fourth motor; 5. Second rotating joint; 51. Third mounting seat; 52. Third connecting plate; 53. Second connecting rod; 54. Third connecting rod; 55. Third motor; 6. Connecting piece; 61. First connecting groove; 62. Second connecting groove; 63. Third connecting groove; 64. First threaded hole; 65. Second threaded hole; 66. Plum screw; 67. Groove; 68. Boss; 7. Third rotating joint; 71. Fifth motor; 72. Sixth motor; 8. First motor; 9. Gripper; 10. IMU inertial measurement unit; 100. Robot platform. DETAILED DESCRIPTION
[0032] The present invention is further described below in conjunction with the accompanying drawings and specific preferred embodiments, but the protection scope of the present invention is not limited thereby.
[0033] Special robots are often equipped with six-degree-of-freedom robotic arms. In order to meet application requirements, they have high requirements for installation time, extension length, folding volume, overall weight, and overall rigidity. The shorter the installation time, the faster the robot with a robotic arm can complete the overall assembly, which is of great significance for rescue, bomb disposal and other tasks where every second counts. The greater the extension length, the more positions the load at the end of the robotic arm can reach, and the wider the applicability of the robot. The smaller the folding volume, the less space the robotic arm occupies, and the less impact it has on the narrow space passing ability of the robot equipped with the robotic arm, which is more conducive to storage and transportation. The lighter the overall weight, the more other loads the robot can carry, improving the comprehensive ability of the robot and reducing storage and transportation costs. The higher the overall rigidity, the less the load at the end of the robotic arm shakes, and the more sophisticated the operation.
[0034] Example
[0035] like Figures 1 to 10 As shown, the foldable lightweight robotic arm system of the present invention includes: a forearm 1, an upper arm 2, a rotating base 3, a first rotating joint 4, a second rotating joint 5, a connecting piece 6 and a third rotating joint 7, wherein the third rotating joint 7 is used to connect the end execution component. The two ends of the upper arm 2 are detachably connected to the rotating base 3 and the second rotating joint 5 respectively through the connecting piece 6, the rotating base 3 is connected to the first motor 8, the two ends of the forearm 1 are detachably connected to the second rotating joint 5 and the first rotating joint 4 respectively through the connecting piece 6, and the first rotating joint 4 is connected to the third rotating joint 7; the rotating base 3, the first rotating joint 4, the second rotating joint 5 and the third rotating joint 7 are all provided with driving components, and under the drive of the first motor 8 and the driving components, the rotating base 3, the first rotating joint 4 and the second rotating joint 5 drive the forearm 1 and the upper arm 2 to move, and the third rotating joint 7 drives the end execution component to move, so as to realize the six-degree-of-freedom movement of the robotic arm system. As shown Figure 2 and Figure 3 As shown, when the robot arm system is in a folded state, the small arm 1 is folded and hidden inside the large arm 2; Figure 1 As shown, when the mechanical arm system is in the unfolded state, the small arm 1 and the large arm 2 are in the same straight line. In this embodiment, the driving component can be a driving motor.
[0036] The robotic arm system of this embodiment is designed with quickly disassembled and assembled connectors on the rotating joint connector and the rotating base, which can realize the overall disassembly, assembly and installation of the robotic arm in a shorter time. The installation convenience is far better than the bolt tightening fixation method of the traditional robotic arm.
[0037] In this embodiment, the two ends of the upper arm 2 are detachably connected to the rotating base 3 and the second rotating joint 5 by means of connecting pieces 6, and the rotating base 3 is also connected to the first motor 8, and the two ends of the lower arm 1 are detachably connected to the second rotating joint 5 and the first rotating joint 4 by means of connecting pieces 6, so that a mechanical arm system with a compact structure, convenient disassembly and assembly, and high torsional rigidity is obtained, and the disassembly, assembly, and installation of the entire mechanical arm can be achieved in a shorter time; further, the rotating base 3, the first rotating joint 4, and the second rotating joint 5 are respectively provided with a second motor 34, a fourth motor 45, and a third motor 55, and the third rotating joint 7 is provided with two The fifth motor 71 and the sixth motor 72 in the direction, driven by the first motor 8 and the above-mentioned multiple motors, the rotating base 3, the first rotating joint 4 and the second rotating joint 5 drive the forearm 1 and the upper arm 2 to move, thereby realizing the six-degree-of-freedom movement of the robotic arm system; when the robotic arm system is in a folded state, the forearm 1 is folded and hidden inside the upper arm 2; when the robotic arm system is in an unfolded state, the forearm 1 and the upper arm 2 are in the same straight line, which not only achieves the purpose of reducing the spatial volume of the robotic arm system, but also enables the robotic arm system to complete operations at a higher place, which well solves the problems of complex disassembly and assembly, large spatial volume, poor torsion resistance, etc. existing in the existing robotic arm system.
[0038] In this embodiment, both the first rotary joint 4 and the second rotary joint 5 adopt a double-end support structure to achieve symmetrical arrangement of the forearm 1 and the upper arm 2 .
[0039] The purpose of using double-end support at the rotating joint is:
[0040] (1) The double-end support configuration can provide stability. By providing double-end support at the joint, the swaying and shaking of the joint can be effectively reduced, ensuring the smooth movement of the robotic arm, thereby improving the working accuracy and stability.
[0041] (2) Double-end supports can provide additional support points for the joints, allowing the joints to evenly distribute the load and withstand the pressure and torque from the workload, reducing wear and damage to the joint components.
[0042] (3) Double-end support can improve the overall rigidity of the robot arm joint. Rigidity refers to the resistance of the joint to external torque. Double-end support can reduce the deformation and deflection of the joint and maintain the stability and accuracy of the robot arm.
[0043] (4) Double-end support can reduce the looseness and movement of the joints, making the movement of the robot arm more precise, thereby improving the accuracy and reliability of the work.
[0044] In view of the connecting parts between the rotating joints of the mechanical arm in the form of thin and long cylinders, this embodiment adopts a new configuration of the upper arm and the lower arm connecting parts, improves the upper arm of the traditional thick single-cylinder structure into a thin double-cylinder structure, and improves the traditional thick single-cylinder lower arm into a thin single-cylinder structure, so that the thin single-cylinder lower arm can be completely folded to the middle of the thin double-cylinder upper arm, making the configuration in the folded state more compact and lower in space occupancy. At the same time, a double-end support part that can enhance the torsional rigidity of the structure is designed, and the two slender cylinders of the mechanical arm upper arm connecting part are combined into an overall structure with good torsional resistance, and the single slender cylinder of the lower arm connecting part is more firmly connected to the rotating key, so as to improve the overall rigidity of the mechanical arm and reduce the end shaking.
[0045] like Figure 2 As shown, in this embodiment, the end execution component adopts a clamp 9, and the clamp 9 is connected to the third rotating joint 7. The clamp 9 can be placed stably on the rotating base 3 to reduce the vibration of the end of the mechanical arm when the vehicle is running.
[0046] like Fig. 9 As shown, in this embodiment, the connecting member 6 includes: a first connecting groove 61, a second connecting groove 62 and a third connecting groove 63. The first connecting groove 61 and the second connecting groove 62 are respectively used to connect the upper arm 2 and the rotating base 3 or the second rotating joint 5. The first connecting groove 61 and the second connecting groove 62 are also used to connect the lower arm 1 and the first rotating joint 4 or the second rotating joint 5. A first threaded hole 64 is provided in the middle of the second connecting groove 62, and a second threaded hole 65 is provided at the ends of the first connecting groove 61 and the third connecting groove 63. When the first connecting groove 61 and the third connecting groove 63 are respectively inserted into the second connecting groove 62 from both ends of the second connecting groove 62, the first threaded hole 64 and the second threaded hole 65 are aligned with each other, and a plum screw 66 is screwed into the first threaded hole 64 and the second threaded hole 65 to achieve the connection and fixation of the first connecting groove 61 and the third connecting groove 63 with the second connecting groove 62.
[0047] Furthermore, the outer side surfaces of the first connecting groove 61 and the third connecting groove 63 are evenly distributed with a plurality of bosses 68, and the inner side surface of the second connecting groove 62 is evenly distributed with a plurality of grooves 67. When the first connecting groove 61 and the third connecting groove 63 are respectively inserted into the interior of the second connecting groove 62 from both ends of the second connecting groove 62, the bosses 68 are nested in the grooves 67 to improve the connection stability between the first connecting groove 61 and the third connecting groove 63 and the second connecting groove 62.
[0048] The connecting piece 6 can be used to realize the rapid disassembly and assembly of the upper arm 2, the lower arm 1, and the rotating base 3 of the robot arm system. The upper and lower ends of the upper arm 2 of the robot arm system are respectively connected to the joint support through the connecting piece 6, and the plum screw 66 is tightened to achieve a quick connection. When dismantling, loosen the plum screw 66, and at the same time, the end of the upper arm 2 can be pulled out from the bayonet of the second connecting groove 62, thereby realizing the rapid separation of the upper arm 2 of the robot arm system and the rotating base 3 of the robot arm system. It can be understood that the upper and lower ends of the lower arm 1 of the robot arm system are also connected to the joint support section through the connecting piece 6. As shown in FIG. Figure 6 As shown in the figure, the volume occupied by the folded small arm 1 is small, which is convenient for transportation and handling. Therefore, the foldable lightweight mechanical arm system of this embodiment can be disassembled into five components, namely, the rotating base 3, the first rotating joint 4, the second rotating joint 5, the upper arm 2 and the small arm 1, through the connecting member 6. These components can be fixedly connected without bolts, which is convenient for transportation and reduces the assembly time.
[0049] like Figure 6 As shown, the rotating base 3 includes: a mounting plate 31, a first connecting plate 32 and a first mounting seat 33. The first connecting plate 32 and the first mounting seat 33 are provided on the mounting plate 31. The first mounting seat 33 is used to install the second motor 34. The first connecting plates 32 are symmetrically arranged on both sides of the first mounting seat 33. One end of the first connecting plate 32 is connected to the rotating end of the second motor 34, and the other end of the first connecting plate 32 is connected to the lower end of the arm 2 through the connecting member 6. Under the drive of the second motor 34, the first connecting plate 32 drives the arm 2 to rotate.
[0050] like Figure 1 As shown, the mounting plate 31 at the bottom of the rotating base 3 is also connected to the first motor 8. Driven by the first motor 8, the rotating base 3 drives the robotic arm system to rotate.
[0051] like Figure 4 and Figure 7 As shown, in this embodiment, the first rotary joint 4 includes: a second mounting seat 41, a second connecting plate 42, a first connecting rod 43 and a connecting hole 44. The connecting hole 44 is arranged on the side of the second mounting seat 41, and the third rotary joint 7 is connected to the second mounting seat 41 through the connecting hole 44. A fourth motor 45 is arranged in the second mounting seat 41, and both sides of the second mounting seat 41 are respectively connected to the rotating end of the fourth motor 45. Under the drive of the fourth motor 45, the second mounting seat 41 drives the third rotary joint 7 to rotate, and then drives the clamp 9 to rotate. The second connecting plates 42 are symmetrically arranged on both sides of the second mounting seat 41, and the ends of the second connecting plates 42 are provided with a first connecting rod 43, and the first connecting rod 43 is connected to the upper end of the forearm 1 through the connecting member 6.
[0052] like Figure 5 and Figure 8As shown, in this embodiment, the second rotary joint 5 includes: a third mounting seat 51, a third connecting plate 52, a second connecting rod 53 and a third connecting rod 54. A third motor 55 and a third connecting plate 52 are arranged in the third mounting seat 51, one end of the third connecting plate 52 is connected to the rotating end of the third motor 55, and the other end of the third connecting plate 52 is provided with a second connecting rod 53 arranged side by side, and the second connecting rod 53 is connected to the lower end of the small arm 1 through a connecting member 6. Driven by the third motor 55, the third connecting plate 52 drives the small arm 1 to rotate; the third connecting rod 54 is symmetrically arranged on both outer sides of the third mounting seat 51, and the third connecting rod 54 is connected to the upper end of the large arm 2 through a connecting member 6.
[0053] In this embodiment, the rotating end of the driving motor is connected to the connecting plate by bolts, and the connecting plate is connected to the upper arm or the lower arm by a connecting piece, so that the motor can transmit torque to the shaft of the mechanical arm. The connecting plate is arranged on the output shaft of the motor and is aligned with the shaft of the mechanical arm. Through the connection of the bolts, when the motor rotates, the torque can be transmitted to the shaft of the mechanical arm through the connecting plate.
[0054] The non-rotating end support configuration of the drive motor is different from that of the rotating end. The non-rotating end of the motor is directly connected to the motor using a top cover. The top cover fixes the motor and the robot arm together through pressure, ensuring the stability and position fixation of the motor.
[0055] The advantage of this double-end support configuration for the drive motor is that it can provide good support and torque transmission capabilities at the rotating end while securing the non-rotating end with a simple top cover to ensure the stable position of the motor. The double-end support configuration takes into account the support requirements of the motor while reducing unnecessary weight and complexity, in line with the goal of a lightweight robotic arm.
[0056] like Figure 8 As shown, the second connecting rod 53 is located inside the third connecting rod 54 , and when the robotic arm system is in a folded state, the small arm 1 is completely hidden in the connecting groove inside the large arm 2 .
[0057] The robot arm system of this embodiment is mainly used on a special mobile robot platform 100 and has the characteristics of small size. Figure 2 When the special mobile robot is equipped with a mechanical arm for operation, the mechanical arm is often required to grasp and transport objects. Based on the above-mentioned mechanical arm system, this embodiment provides a control method for stable transportation. Fig.10 As shown in the control block diagram, the control method is mainly divided into two parts, one is the terminal attitude stabilization control based on the anti-disturbance control, and the other is the vertical shock absorption control imitating the "torsion spring".
[0058] like Fig.10As shown, the end gripper 9 of the manipulator grasps an object, and the end attitude stabilization controller based on the anti-disturbance control mainly controls the first rotary joint 4 and the third rotary joint 7 of the manipulator to achieve the purpose of controlling the end attitude of the manipulator, wherein the third rotary joint 7 includes rotation in two directions. The principle is that the IMU inertial measurement unit 10 at the end of the manipulator detects the actual attitude angle of the gripper 9 of the current manipulator, that is, the actual attitude angle of the manipulator transporting the object, and makes a difference between the attitude angle and the end attitude of the manipulator controlled by the remote handle, and obtains the attitude disturbance error of the end attitude of the manipulator caused by the mobile platform when driving, and decouples the attitude error represented by the quaternion to the rotation of the fourth motor 45, the fifth motor 71 and the sixth motor 72 corresponding to the three directions of pitch, yaw and roll, and at the same time, by establishing the dynamic model of the motion of the three rotary joints at the end, the parameters of the anti-disturbance control are preliminarily determined according to the dynamic model, so that a 3-decoupled single-input single-output anti-disturbance control controller is obtained. The attitude errors in three directions measured by the above-mentioned IMU are input into the self-disturbance rejection control, and the output controls the current of the three motors to control the terminal attitude to remain stable and reduce the vibration in the attitude direction. The specific control parameters can be adjusted after the preliminary controller parameters are given.
[0059] For the vertical "bumping" during driving, this embodiment designs a coupled "compression spring" vertical shock absorbing controller. Fig.10 The Z-shaped shape of the robot arm during transportation is considered as a compression spring. Inspired by this, the stiffness of the rotating base 3 and the second rotating joint 5 is controlled by controlling the second motor 34 and the third motor 55, so as to simulate a mechanical "compression spring". The principle is as follows Fig.10As shown in the block diagram in the lower right corner, the encoders of the second motor 34 and the third motor 55 record the current positions of the second motor 34 and the third motor 55. The current position is subtracted from the initial position of the handle remote control to obtain the position deviation of the motor. The position deviation is differentiated with respect to the sampling time, and the position deviation and the differential are multiplied by the coefficients C (the coefficient of the second motor 34 is C2, and the coefficient of the third motor 55 is C3) and D (the coefficient of the second motor 34 is D2, and the coefficient of the third motor 55 is D3) respectively to simulate the elastic stiffness and damping effect. The larger the position deviation, the larger the output current and the larger the torque output by the motor. The damping coordination realizes the critical damping characteristics of the second-order system to suppress the amplitude and overshoot due to elastic vibration rebound. At the same time, the parameter adjustment needs to keep the stiffness and damping of the rotating base 3 to be twice that of the second rotating joint 5, so that the vibration reduction motion of the two-link composed of the upper arm 2 and the lower arm 1 can be kept to simulate the vertical spring. In order to maintain this characteristic, the initial parameter setting not only needs to meet the stiffness coefficient C3 of the third motor 55, but also the damping coefficient D3 is twice the stiffness coefficient C2 and the damping coefficient D2 of the second motor 34. At the same time, the coupling mechanism is designed to compare the 2 times value of the position deviation of the second motor 34 with the position deviation value of the third motor 55 (herein referred to as the motion deviation value between the second motor 34 and the third motor 55). When the 2 times value of the position deviation of the second motor 34 is greater than the position deviation value of the third motor 55, a correction current is generated, and the deviation is multiplied by the coefficient E2 to suppress the elastic damping current of the second motor 34, while for the third motor 55, the deviation is multiplied by E3 to supplement the elastic damping current of the third motor 55. The rotation amplitude of the second motor 34 and the third motor 55 is maintained at approximately 1:2, so that the entire robot arm is kept moving vertically up and down, which promotes rather than interferes with the control of the stability of the posture of the first part.
[0060] In summary, the final control current of the second motor 34 and the third motor 55 is mainly composed of the simulated elastic stiffness current and the simulated damping effect current formed by the position error of each motor and its differential composition, and the correction current composed of the motion deviation value between the second motor 34 and the third motor 55 is added. This control system can achieve the vertical vibration reduction control effect of the robot arm.
[0061] In this embodiment, the robot arm has a special form of being completely folded. Through the design of the mechanical structure, the two ends of the robot arm's upper arm 2 are widened so that it can accommodate the lower arm 1 of the robot arm. Therefore, when the robot arm is in a fully folded state, the lower arm 1 of the robot arm is completely folded into the connecting groove in the upper arm 2 structure, and the lower arm 1 is completely hidden in the lateral projection. Therefore, the space it occupies is only the space where the upper arm 2 is located. At this time, the space occupied by the robot arm is minimized. At the same time, the robot arm also has a fully expanded form, with the upper arm 2 and the lower arm 1 on the same straight line. At this time, the robot arm can reach the state of the longest arm length, and the work can be completed at a higher place.
[0062] Although the present invention is disclosed as above with preferred embodiments, it is not intended to limit the present invention. Any technician familiar with the art can use the above disclosed methods and technical contents to make many possible changes and modifications to the technical solutions of the present invention without departing from the spirit and technical solutions of the present invention, or modify them into equivalent embodiments of equivalent changes. Therefore, any simple modification, equivalent replacement, equivalent change and modification made to the above embodiments according to the technical essence of the present invention without departing from the content of the technical solutions of the present invention still fall within the scope of protection of the technical solutions of the present invention.
Claims
1. A foldable lightweight robotic arm system, characterized in that: include: A forearm (1), an upper arm (2), a rotating base (3), a first rotating joint (4), a second rotating joint (5) and a connecting piece (6); the forearm (1) is a single-tube structure, and the upper arm (2) is a double-tube structure; the two ends of the upper arm (2) are detachably connected to the rotating base (3) and the second rotating joint (5) via the connecting piece (6); the rotating base (3) is connected to a first motor (8); the two ends of the forearm (1) are detachably connected to the second rotating joint (5) and the first rotating joint (4) via the connecting piece (6); the rotating base (3) is provided with a second motor (34) , a driving component is provided in the first rotating joint (4), and a third motor (55) is provided in the second rotating joint (5); under the drive of the first motor (8), the second motor (34), the third motor (55) and the driving component, the rotating base (3), the first rotating joint (4) and the second rotating joint (5) drive the small arm (1) and the large arm (2) to move, so as to realize the six-degree-of-freedom movement of the robotic arm system; when the robotic arm system is in a folded state, the small arm (1) is folded and hidden inside the large arm (2); when the robotic arm system is in an unfolded state, the small arm (1) and the large arm (2) are in the same straight line; The first rotating joint (4) and the second rotating joint (5) both adopt a double-end support structure, so that the lower arm (1) and the upper arm (2) are symmetrically arranged; The end attitude stabilization control strategy based on self-disturbance rejection is used to control the end attitude of the robot arm, and the vertical vibration reduction control strategy based on imitation of "compression spring" is used to control the attitude of the forearm (1) and the upper arm (2); The current positions of the second motor (34) and the third motor (55) recorded by the encoders of the second motor (34) and the third motor (55) are subtracted from the initial positions of the handle remote control to obtain the position deviation of the motor. The position deviation is differentiated with respect to the sampling time. The position deviation and the differential are respectively multiplied by the stiffness coefficient C and the damping coefficient D to simulate the elastic stiffness and damping effect. The damping is coordinated to realize the critical damping characteristics of the second-order system, thereby suppressing the amplitude and overshoot due to elastic vibration rebound.
2. The foldable lightweight robotic arm system according to claim 1, characterized in that: The connecting member (6) comprises: a first connecting groove (61), a second connecting groove (62) and a third connecting groove (63); the first connecting groove (61) and the second connecting groove (62) are respectively used to connect the upper arm (2) and the rotating base (3) or the second rotating joint (5), and to connect the lower arm (1) and the first rotating joint (4) or the second rotating joint (5); a first threaded hole (64) is provided in the middle of the second connecting groove (62); and second threaded holes (65) are provided at the ends of the first connecting groove (61) and the third connecting groove (63); when the first connecting groove (61) and the third connecting groove (63) are respectively inserted into the interior of the second connecting groove (62) from both ends, a plum screw (66) is screwed into the first threaded hole (64) and the second threaded hole (65) to achieve the connection and fixation of the first connecting groove (61) and the third connecting groove (63) with the second connecting groove (62).
3. The foldable lightweight robotic arm system according to claim 2, characterized in that: The outer side surfaces of the first connecting groove (61) and the third connecting groove (63) are evenly distributed with a plurality of bosses (68), and the inner side surface of the second connecting groove (62) is evenly distributed with a plurality of grooves (67); when the first connecting groove (61) and the third connecting groove (63) are respectively inserted into the interior of the second connecting groove (62) from both ends, the bosses (68) are nested in the grooves (67).
4. The foldable lightweight robotic arm system according to claim 2, characterized in that: The rotating base (3) comprises: a mounting plate (31), a first connecting plate (32) and a first mounting seat (33); the mounting plate (31) is provided with the first connecting plate (32) and the first mounting seat (33); the first mounting seat (33) is used to mount the second motor (34); the first connecting plate (32) is symmetrically arranged on both sides of the first mounting seat (33); one end of the first connecting plate (32) is connected to the rotating end of the second motor (34); the other end of the first connecting plate (32) is connected to the lower end of the upper arm (2) through a connecting member (6); under the drive of the second motor (34), the first connecting plate (32) drives the upper arm (2) to rotate.
5. The foldable lightweight robotic arm system according to claim 4, characterized in that: The mounting plate (31) is also connected to the first motor (8), and under the drive of the first motor (8), the rotating base (3) drives the mechanical arm system to rotate.
6. The foldable lightweight robotic arm system according to claim 2, characterized in that: The invention also comprises a third rotating joint (7), wherein the third rotating joint (7) is used to connect the clamping jaw (9); the first rotating joint (4) comprises: a second mounting seat (41), a second connecting plate (42), a first connecting rod (43) and a connecting hole (44); the connecting hole (44) is arranged on the side of the second mounting seat (41), and the third rotating joint (7) is connected to the second mounting seat (41) through the connecting hole (44); a driving component is arranged in the second mounting seat (41), and both sides of the second mounting seat (41) are respectively connected to the rotating end of the driving component, and under the drive of the driving component, the second mounting seat (41) drives the third rotating joint (7) to rotate, thereby driving the clamping jaw (9) to rotate; the second connecting plates (42) are symmetrically arranged on both sides of the second mounting seat (41), and the ends of the second connecting plates (42) are provided with first connecting rods (43), and the first connecting rods (43) are connected to the upper end of the forearm (1) through a connecting member (6).
7. The foldable lightweight robotic arm system according to claim 2, characterized in that: The second rotary joint (5) comprises: a third mounting seat (51), a third connecting plate (52), a second connecting rod (53) and a third connecting rod (54); a third motor (55) and a third connecting plate (52) are arranged in the third mounting seat (51); one end of the third connecting plate (52) is connected to the rotating end of the third motor (55); the other end of the third connecting plate (52) is provided with a second connecting rod (53) arranged in parallel; the second connecting rod (53) is connected to the lower end of the forearm (1) through a connecting piece (6); under the drive of the third motor (55), the third connecting plate (52) drives the forearm (1) to rotate; the third connecting rod (54) is symmetrically arranged on both outer sides of the third mounting seat (51); the third connecting rod (54) is connected to the upper end of the upper arm (2) through the connecting piece (6).
8. The foldable lightweight robotic arm system according to claim 7, characterized in that: The second connecting rod (53) is located inside the third connecting rod (54), and when the mechanical arm system is in a folded state, the small arm (1) is completely hidden in the connecting groove inside the large arm (2).
9. A control method for a foldable lightweight robotic arm system according to any one of claims 1 to 8, characterized in that: The end attitude stabilization control strategy based on self-disturbance rejection is used to control the end attitude of the robot arm, and the vertical vibration reduction control strategy based on imitation of "compression spring" is used to control the attitude of the forearm (1) and the upper arm (2); An IMU inertial measurement unit (10) is provided in the gripper (9) at the end of the robotic arm, and the actual attitude angle of the gripper (9), that is, the actual attitude angle of the robotic arm transporting an object, is detected by using the IMU inertial measurement unit (10), and the attitude angle is different from the attitude of the end of the robotic arm remotely controlled by the remote handle to obtain an attitude disturbance error of the attitude of the end of the robotic arm caused by the mobile platform when driving, and the attitude error represented by the quaternion is decoupled into the three directions of pitch, yaw and roll, which correspond to the rotation of the fourth motor (45), the fifth motor (71) and the sixth motor (72) respectively. At the same time, a dynamic model of the end rotary joint motion is established, and the parameters of the anti-disturbance control are preliminarily determined according to the dynamic model, so as to obtain a three-decoupled single-input single-output anti-disturbance control controller; The current positions of the second motor (34) and the third motor (55) recorded by the encoders of the second motor (34) and the third motor (55) are subtracted from the initial positions of the remote control handle to obtain the position deviation of the motors. The position deviation is differentiated with respect to the sampling time. The position deviation amount and the differential amount are respectively multiplied by the stiffness coefficient C and the damping coefficient D to simulate the elastic stiffness and damping effect. The damping is coordinated to realize the critical damping characteristics of the second-order system, and the amplitude and overshoot due to elastic vibration rebound are suppressed. When the value twice of the position deviation of the second motor (34) is greater than the position deviation value of the third motor (55), a correction current is generated to suppress the elastic damping current of the second motor (34) and supplement the elastic damping current of the third motor (55), so as to maintain the rotation amplitude of the second motor (34) and the third motor (55) at 1:1.8-2.2, thereby maintaining the vertical up and down movement of the entire robot arm.
Citation Information
Patent Citations
Palletizing robot with grabbing function
CN105583819A
Joint assembly of desktop mechanical arm, desktop mechanical arm and robot
CN112454417A
Mechanical arm
CN207942405U
Articulated arm convenient to disassemble and assemble for machine manufacturing
CN210161195U
Automatic moving suction gun automatic detection six-axis mechanical arm based on RFID technology
CN212919383U
