A robot wrist and control method thereof
By introducing an angle sensing unit and a rope drive mechanism into the robot wrist, the problems of inaccurate joint angle feedback and difficulty in controlling the joint in the prior art are solved, and precise angle control and efficient motion operation of the robot wrist are realized.
Patent Information
- Application Number
- CN202411282519.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-13
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2044-09-13
AI Technical Summary
Existing humanoid robot wrists cannot provide precise feedback on the joints at the current angle and difficulty in controlling the angle of the robot wrist.
A robot wrist is designed, including a driving base, bearing seat, universal joint structure and angle sensing unit. The universal joint structure is driven by a rope drive mechanism, and the angle sensing unit is used to sense the rotation angle to achieve precise control.
It realizes precise feedback of the robot wrist at the current angle position and precise control of the angle, providing more efficient and flexible motion operation.
Smart Images

Figure CN118789533B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of manipulators, and in particular to a robot wrist and a control method thereof. Background Art
[0002] The humanoid robot wrist is a highly sophisticated robotic device that mimics the flexibility and functionality of the human wrist and is a key component that connects the robot's upper arm and end effector. The robot wrist is usually composed of multiple joints, each of which corresponds to a degree of freedom of the wrist. These joints can be revolute joints, sliding joints, or a combination of both to simulate the flexion, extension, rotation, and lateral bending of the human wrist. Among them, the revolute joint refers to a joint that allows the wrist to rotate in the horizontal or vertical plane, similar to the rotation ability of the human wrist; the flexion and extension joint refers to a joint that simulates the flexion and extension of the wrist, usually located on the front of the wrist; the lateral bending joint allows the wrist to bend inward or outward, providing additional range of motion. In order to drive these joints, the wrist uses a variety of drive technologies, such as electric, hydraulic, pneumatic, etc., each of which has its own unique advantages and application scenarios. As the key to power transmission, the transmission system uses a variety of mechanisms such as tendons, gears, and connecting rods to ensure the effective transmission and precise control of power.
[0003] The tendon-driven wrist controls the movement of the joint by stretching and contracting the cable or rope. The tendon is the main element of the wrist drive, and the pulley system is used to change the path of the rope to achieve multi-directional movement of the joint. The wire-driven wrist has a compact structure and can achieve complex movements in a limited space. It can easily achieve multi-degree-of-freedom movement and provide high flexibility. This driving method is similar to human tendons and has a place in the field of humanoid robots with its unique advantages.
[0004] Currently, existing humanoid robot wrists cannot provide accurate feedback on the current angle position of the joints and it is difficult to control the angle of the robot wrist.
[0005] Therefore, the prior art still needs to be improved and developed. Summary of the invention
[0006] The technical problem to be solved by the present invention is to provide a robot wrist and a control method thereof in view of the above-mentioned defects of the prior art, aiming to solve the problems in the prior art that the existing robot wrist cannot provide accurate feedback on the current angular position of the joint and it is difficult to control the angle of the robot wrist.
[0007] The technical solution adopted by the present invention to solve the technical problem is as follows:
[0008] A robot wrist comprises a driving base, a bearing seat, a universal joint structure, an angle sensing unit and a rope drive mechanism;
[0009] The rope drive mechanism is disposed in the driving base and connected to the universal joint structure, and the universal joint structure is driven to rotate in a first direction when the rope drive mechanism is tightened;
[0010] The bearing seat is arranged on the driving base, the universal joint structure is arranged on the bearing seat, the angle sensing unit is arranged on the universal joint structure, and the angle sensing unit is used to sense the rotation angle along the first direction.
[0011] Optionally, the rope drive mechanism includes:
[0012] A driving assembly, disposed in the driving base;
[0013] A driving main rope, one end of which is wound around the driving assembly and the other end of which is connected to the universal joint structure;
[0014] A driving auxiliary rope, one end of which is wound around the driving assembly and the other end of which is connected to the universal joint structure;
[0015] Among them, the transmission directions of the driving main rope and the driving auxiliary rope are opposite, and they are respectively located on two opposite sides of the universal joint structure; the driving component is used to pull the driving auxiliary rope and the driving main rope to drive the universal joint structure to rotate around the first direction.
[0016] Optionally, the driving component includes:
[0017] A motor is disposed in the driving base;
[0018] A winding wheel is arranged on the motor, and the main driving rope and the auxiliary driving rope having opposite transmission directions are wound around the winding wheel;
[0019] A first transmission component connected to the driving main rope;
[0020] A second transmission component connected to the driving auxiliary rope;
[0021] When the motor rotates, the main driving rope is tightened and the auxiliary driving rope is relaxed, or the main driving rope is relaxed and the auxiliary driving rope is tightened, so as to drive the universal joint structure to rotate around the first direction.
[0022] Optionally, the first transmission component includes:
[0023] A first lower pulley is disposed on the bearing seat and is located on one side of the first direction;
[0024] A first upper pulley is disposed on the universal joint structure and is located on the same side as the first lower pulley;
[0025] Wherein, the driving main rope is wound around the first lower pulley and the first upper pulley in sequence, and is connected to one side of the bearing seat.
[0026] Optionally, the second transmission component includes:
[0027] A second lower pulley is disposed on the bearing seat and is located on the other side of the first direction;
[0028] A second upper pulley is disposed on the universal joint structure and is located on the same side as the second lower pulley;
[0029] A first transmission pulley is disposed in the bearing seat;
[0030] A second transmission pulley is disposed in the bearing seat;
[0031] Among them, one end of the driving auxiliary rope is wound out from the upper side of the first transmission pulley and the lower side of the second transmission pulley, and is wound around the second lower pulley and the second upper pulley in sequence, and is connected to the other side of the bearing seat.
[0032] Optionally, the rope drive mechanism further includes a pre-tightening component for adjusting the pre-tightening force of the driving main rope and the driving auxiliary rope, and the pre-tightening component includes:
[0033] A first channel is provided on the bearing seat, and the driving main rope is passed through the first channel;
[0034] A first abutment member, disposed on the first channel, and used for locking the main driving rope;
[0035] A second channel is provided on the bearing seat, and the driving auxiliary rope is passed through the second channel;
[0036] The second abutment member is disposed on the second channel and is used for locking the secondary driving rope.
[0037] Optionally, a plurality of rope drive mechanisms are provided and are cross-arranged on the driving base.
[0038] Optionally, the universal joint structure includes:
[0039] A universal joint, one end of which is arranged at the middle position of the bearing seat;
[0040] A connecting seat is rotatably arranged on the universal joint, and the connecting seat is used to connect to the robot palm.
[0041] Optionally, the robot wrist also includes a control system, and the control system is electrically connected to the angle sensing unit and the rope drive mechanism.
[0042] A control method for a robot wrist, the control method being applied to the robot wrist as described in any one of the above technical solutions, the control method comprising:
[0043] Get the current bending state information;
[0044] Calculate a target bending direction and a target bending angle based on the current bending state information, and obtain a tightening instruction;
[0045] The rope drive mechanism is controlled based on the tightening instruction to drive the robot wrist to bend to a target position.
[0046] Beneficial effects:
[0047] The present invention sets an angle sensing unit on the universal joint structure, and the angle sensing unit is used to sense the rotation angle along the first direction, so as to directly obtain accurate feedback of the current angular position of the robot wrist in the first direction; the present invention sets a rope drive mechanism, and uses the rope drive method to drive the universal joint structure to rotate along the first direction, so as to achieve efficient driving of the robot wrist to rotate, and cooperates with the angle sensing unit to achieve precise control of the angle of the robot wrist and perform more precise operations. BRIEF DESCRIPTION OF THE DRAWINGS
[0048] Figure 1 is a structural diagram of the robot wrist of the present invention;
[0049] Figure 2 is a structural diagram of the robot wrist of the present invention from another perspective;
[0050] Figure 3 is a diagram of the internal structure of the robot wrist of the present invention;
[0051] Figure 4 is a diagram of the internal structure of the robot wrist of the present invention from another perspective;
[0052] Figure 5 It is a structural diagram of the bearing seat and the universal joint structure of the present invention;
[0053] Figure 6 It is a structural diagram of the driving base and the bearing seat of the present invention;
[0054] Figure 7 is a diagram of a first use state of the robot wrist of the present invention;
[0055] Figure 8 is a second use state diagram of the robot wrist of the present invention;
[0056] Fig. 9 is a diagram of a third use state of the robot wrist of the present invention;
[0057] Fig.10It is a flow chart of the steps of the control method of the present invention.
[0058] In the figure:
[0059] 100. Driving base;
[0060] 200, bearing seat;
[0061] 300, universal joint structure; 310, universal joint; 320, connecting seat;
[0062] 410, motor; 420, winding wheel; 430, driving main rope; 440, driving auxiliary rope; 4501, first lower pulley; 4502, first upper pulley; 4601, first transmission pulley; 4602, second transmission pulley; 4603, second lower pulley; 4604, second upper pulley;
[0063] 510, first through hole; 520, first channel; 530, second through hole; 540, second channel. DETAILED DESCRIPTION
[0064] The embodiments of the present application are described in detail below, and examples of the embodiments are shown in the accompanying drawings, wherein the same or similar reference numerals throughout represent the same or similar elements or elements having the same or similar functions. The embodiments described below with reference to the accompanying drawings are exemplary and are only used to explain the present application, and cannot be understood as limiting the present application.
[0065] In the description of the present application, it should be understood that the terms "center", "longitudinal", "lateral", "up", "down", "front", "back", "left", "right", "vertical", "horizontal", "top", "bottom", "inside", "outside" and the like indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, and are only for the convenience of describing the present application and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present application. In addition, the terms "first" and "second" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Thus, the features defined as "first" and "second" may explicitly or implicitly include one or more of the features. In the description of the present application, unless otherwise specified, "multiple" means two or more.
[0066] In the description of this application, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a robot connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, or it can be the internal connection of two components. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0067] See also Figure 1 As shown, the present application provides a robot wrist, including a driving base 100, a bearing seat 200, a universal joint structure 300, an angle sensing unit and a rope drive mechanism; the rope drive mechanism is arranged in the driving base 100 and is connected to the universal joint structure 300, and the rope drive mechanism is tightened to drive the universal joint structure 300 to rotate in a first direction; the bearing seat 200 is arranged on the driving base 100, the universal joint structure 300 is arranged on the bearing seat 200, and the angle sensing unit is arranged on the universal joint structure 300, and the angle sensing unit is used to sense the rotation angle along the first direction.
[0068] Specifically, a bearing seat 200 is provided at one end of the driving base 100 disclosed in the present embodiment. The driving base 100 is mainly used to connect the robotic arm. The specific shape can be set according to the usage scenario, and can be manufactured into a cylindrical shape and a rectangular shape with a hollow interior. The bearing seat 200 matches the corresponding shape of the driving base 100, for example, a cylindrical driving base 100 is matched with a cylindrical bearing seat 200; preferably, the shape of the driving base 100 in the present embodiment is cylindrical, which can simulate the shape of a human arm and is more realistic.
[0069] Furthermore, the present embodiment also discloses that an angle sensing unit is provided on the universal joint structure 300, such as Figure 1 As shown, one end of the universal joint structure 300 is arranged in the middle position of the bearing seat 200, and an angle sensing unit is installed on the universal joint structure 300. The angle sensing unit can directly obtain accurate feedback of the current angle position of the robot wrist in the first direction, and can perform more precise operations; the other end of the universal joint structure 300 is used to connect to the robot palm, so that the device can be directly assembled with the robot palm to achieve a plug-and-play effect.
[0070] Further, the present embodiment discloses a driving base 100 and a bearing seat 200, see Figure 1As shown, X is set as the first direction, and the first direction has two directions, the left side and the right side. Y is set as the second direction, and the second direction has two directions, the upper side and the lower side. By installing the rope drive mechanism in the driving base 100, the movement control of the robot wrist can be achieved in a smaller space, and then the universal joint structure 300 is driven to rotate around the first direction by the rope drive mechanism, so as to achieve efficient driving of the robot wrist to move in the first direction.
[0071] See also Figure 2 As shown, in another embodiment of the present application, a through hole is provided at the other end of the driving base 100, and the through hole is a threaded hole for threaded assembly with the robot arm, so that the device is easy to assemble.
[0072] See also Figures 1 to 3 As shown, in another specific embodiment of the present application, the rope drive mechanism includes a driving assembly, a driving main rope 430 and a driving auxiliary rope 440, the driving assembly is arranged in the driving base 100, one end of the driving main rope 430 is wound around the driving assembly, and the other end is connected to the universal joint structure 300, one end of the driving auxiliary rope 440 is wound around the driving assembly, and the other end is connected to the universal joint structure 300, wherein the transmission directions of the driving main rope 430 and the driving auxiliary rope 440 are opposite, and are respectively located on opposite sides of the universal joint structure 300; the driving assembly is used to pull the driving auxiliary rope 440 and the driving main rope 430 to drive the universal joint structure 300 to rotate around the first direction.
[0073] Specifically, the rope drive mechanism disclosed in this embodiment includes a driving component, a driving main rope 430 and a driving auxiliary rope 440. The driving main rope 430 and the driving auxiliary rope 440 are simultaneously controlled by the driving component. When the driving component is driven, the driving main rope 430 is tightened and the driving auxiliary rope 440 is relaxed, or the driving main rope 430 is relaxed and the driving auxiliary rope 440 is tightened, so as to drive the universal joint structure 300 to rotate around the first direction. In this application, the driving main rope 430 and the driving auxiliary rope 440 are used as transmission media, which greatly reduces the mass of the robot wrist, is beneficial to increase the load capacity of the robot wrist, and reduces energy loss and robot wear.
[0074] For example Figures 1 to 3As shown, in another embodiment of the present application, the driving assembly includes a motor 410, a winding wheel 420, a first transmission component and a second transmission component, the motor 410 is arranged in the driving base 100, the winding wheel 420 is arranged on the motor 410, the driving main rope 430 and the driving auxiliary rope 440 with opposite transmission directions are wound on the winding wheel 420, the first transmission component is connected to the driving main rope 430, and the second transmission component is connected to the driving auxiliary rope 440; when the motor 410 rotates, the driving main rope 430 is tightened and the driving auxiliary rope 440 is relaxed, or the driving main rope 430 is relaxed and the driving auxiliary rope 440 is tightened, so as to drive the universal joint structure 300 to rotate around the first direction.
[0075] Specifically, the present embodiment discloses a driving assembly including a motor 410, a winding wheel 420, a first transmission component and a second transmission component, wherein the motor 410, the winding wheel 420, the first transmission component and the second transmission component are all installed in the driving base 100. More specifically, the winding wheel 420 has two wheels, and the two wheels are respectively wound with a driving main rope 430 and a driving auxiliary rope 440, and the other end of the driving main rope 430 is connected to the universal joint structure 300 through the first transmission component, and the other end of the driving auxiliary rope 440 is connected to the universal joint structure 300 through the second transmission component, wherein the connection position is located on two opposite sides of the universal joint structure 300, and it can be understood that the opposite sides refer to the left and right sides of the first direction. In this solution, the first transmission component and the second transmission component are used to change the direction of the driving main rope 430 and the driving auxiliary rope 440, which is not only convenient for operation, but also can achieve a labor-saving effect, so that the driving main rope 430 and the driving auxiliary rope 440 are more flexible.
[0076] See also Figures 1 to 3 As shown, in another specific embodiment of the present application, the first transmission component includes a first lower pulley 4501 and a first upper pulley 4502, the first lower pulley 4501 is arranged on the bearing seat 200 and is located on one side of the first direction, the first upper pulley 4502 is arranged on the universal joint structure 300 and is located on the same side as the first lower pulley 4501, wherein the driving main rope 430 is sequentially wound around the first lower pulley 4501 and the first upper pulley 4502, and is connected to one side of the bearing seat 200.
[0077] Specifically, the first transmission component disclosed in this embodiment includes a first lower pulley 4501 and a first upper pulley 4502. The first lower pulley 4501 is installed on the bearing seat 200 and is located on one side of the first direction. The first upper pulley 4502 is installed on the universal joint structure 300. The two are aligned and are respectively located at the upper and lower positions of the first direction, so that the transmission connection between the driving main rope 430 and the universal joint structure 300 can be realized, and the structure is simple and easy to assemble. More specifically, since the installation position of the motor 410 is directly opposite to the first upper pulley 4502 and the first lower pulley 4501, the positions of the motor 410, the first upper pulley 4502 and the first lower pulley 4501 are respectively at different heights of the same position. At this time, the power of the driving main rope 430 can be output without an additional pulley, which simplifies the structural layout and reduces the assembly cost.
[0078] For example Figures 1 to 3 As shown, in another specific embodiment of the present application, the second transmission component includes a second lower pulley 4603, a second upper pulley 4604, a first transmission pulley 4601 and a second transmission pulley 4602, the second lower pulley 4603 is arranged on the bearing seat 200 and is located on the other side of the first direction, the second upper pulley 4604 is arranged on the universal joint structure 300 and is located on the same side as the second lower pulley 4603, the first transmission pulley 4601 is arranged in the bearing seat 200, and the second transmission pulley 4602 is arranged in the bearing seat 200; wherein, one end of the driving auxiliary rope 440 is wound out from the upper side of the first transmission pulley 4601 and the lower side of the second transmission pulley 4602, and is sequentially wound on the second lower pulley 4603 and the second upper pulley 4604, and is connected to the other side of the bearing seat 200.
[0079] Specifically, the second transmission component disclosed in the present embodiment includes a second lower pulley 4603, a second upper pulley 4604, a first transmission pulley 4601 and a second transmission pulley 4602. The positions of the second lower pulley 4603, the second upper pulley 4604 and the first lower pulley 4501, the first upper pulley 4502 are at different heights at the same position. In order to enable the driving sub-rope 440 to be connected to the other side, through the cooperation of the first transmission pulley 4601 and the second transmission pulley 4602, the first transmission pulley 4601 and the second transmission pulley 4602 can not only change the direction of the driving sub-rope 440, but also keep the driving sub-rope 440 in a tensioned state, avoid the driving sub-rope 440 from loosening, and improve the stability of the driving sub-rope 440.
[0080] See also Figure 5 and Figure 6As shown, in another embodiment of the present application, the rope drive mechanism also includes a pre-tensioning component for adjusting the pre-tensioning force of the driving main rope 430 and the driving auxiliary rope 440, and the pre-tensioning component includes a first channel 520, a first abutment, a second channel 540 and a second abutment. The first channel 520 is arranged on the bearing seat 200, and the driving main rope 430 is passed through the first channel 520. The first abutment is arranged on the first channel 520 for locking the driving main rope 430. The second channel 540 is arranged on the bearing seat 200, and the driving auxiliary rope 440 is passed through the second channel 540. The second abutment is arranged on the second channel 540 for locking the driving auxiliary rope 440.
[0081] Specifically, the present solution discloses a pre-tightening assembly for adjusting the pre-tightening force of the driving main rope 430 and the driving auxiliary rope 440. In the present solution, the first channel 520 and the second channel 540 can be installed at any position of the bearing seat 200 to adjust the pre-tightening force of the driving main rope 430 and the driving auxiliary rope 440. Specifically, the first channel 520 includes an inlet and an outlet. The first through hole 510 is provided on the first channel 520. The driving main rope 430 passes through the inlet of the first channel 520 and then passes through the outlet of the first channel 520, and is tightened by the first abutment on the first through hole 510. Since the lengths of the driving main rope 430 fixed on the bearing seat 200 are different, the pre-tightening force of the driving main rope 430 is also different, so that the pre-tightening force of the driving main rope 430 can be adjusted through the first channel 520. Similarly, the second channel 540 includes an entrance and an exit, and a second through hole 530 is provided on the second channel 540. The driving sub-rope 440 passes through the entrance of the second channel 540, and then passes through the exit of the second channel 540, and is pressed by the second abutment member on the second through hole 530. Then, the pre-tightening force of the driving sub-rope 440 can be adjusted by fixing the different lengths of the driving sub-rope 440.
[0082] Furthermore, the first abutment member and the second abutment member disclosed in the present embodiment are mainly used to fix the driving main rope 430 and the driving auxiliary rope 440. The first abutment member and the second abutment member have exactly the same structural shape and can be fixed by pins, bolts or latches. Preferably, in the present solution, the first abutment member is a bolt, and the first through hole 510 is a bolt hole, which can be quickly installed and disassembled, and is simple and reliable.
[0083] See also Figure 5 and Figure 6 As shown, in another embodiment of the present application, the first channel 520 is installed on the side of the bearing seat 200 close to the driving main rope 430, and the second channel 540 is installed on the side of the bearing seat 200 close to the driving auxiliary rope 440.
[0084] Specifically, the driving main rope 430 first passes through the first lower pulley 4501, and then passes through the first upper pulley 4502. Since the first channel 520 is installed on the side of the bearing seat 200 close to the driving main rope 430, the driving main rope 430 can be directly inserted into the first channel 520 to prevent it from being too entangled on the bearing seat 200 and easily knotted. The length of the driving main rope 430 can be reduced accordingly, which is conducive to saving materials and reducing costs. Similarly, the material of the driving auxiliary rope 440 can also be reduced accordingly. In this embodiment, the position of the first channel 520 and the second channel 540 is limited, which is conducive to the driving main rope 430 and the driving auxiliary rope 440 directly inserting therein, which not only reduces costs, but also achieves the effect of aesthetics and preventing mutual knotting.
[0085] See also Figures 1 to 6 As shown, in another embodiment of the present application, a plurality of rope drive mechanisms are provided and are cross-arranged on the driving base 100 .
[0086] Specifically, in this embodiment, a plurality of rope drive mechanisms are provided, each of which is provided in the driving base 100, and each rope drive mechanism corresponds to a direction of the universal joint structure 300, and is used to drive the universal joint structure 300 to rotate in different directions, so that the robot wrist of the device is more flexible and reliable. More specifically, the cross arrangement on the driving base 100 means that the positions of the rope drive mechanisms are staggered to avoid interference. In addition, the use of standardized multiple rope drive mechanisms can promote modular production, facilitate the interchangeability and common use of parts, and can also reduce manufacturing costs, reduce investment, facilitate maintenance and replacement, and improve the reliability and consistency of the device.
[0087] See also Figure 5 As shown, in another embodiment of the present application, the universal joint structure 300 includes a universal joint 310 and a connecting seat 320, one end of the universal joint 310 is arranged at the middle position of the bearing seat 200, and the connecting seat 320 is rotatably arranged on the universal joint 310, and the connecting seat 320 is used to connect to the robot palm.
[0088] Specifically, the present embodiment also discloses a universal joint structure 300, which includes a universal joint 310 and a connecting seat 320. The universal joint 310 is used to drive the connecting seat 320 to rotate, and the connecting seat 320 is used to connect to the robotic palm, so that the device can be assembled with the robotic palm to achieve a plug-and-play effect.
[0089] In another embodiment of the present application, the angle sensing unit is an angle sensor, which is also called an angle displacement sensor. It is a sensor that can measure the rotation angle relative to a fixed reference point. By using the angle sensor to measure the rotation angle of the robot wrist in a first direction, the accuracy of the angle measurement is improved.
[0090] In another embodiment of the present application, the robot wrist further includes a control system, and the control system is electrically connected to the angle sensing unit and the rope drive mechanism.
[0091] Specifically, the control system is an integrated device, such as a controller, a single-chip microcomputer, etc. The control system is used to receive information feedback from the angle sensing unit, and then control the rope drive mechanism through the control system, thereby realizing the angle position control of the robot wrist, which is convenient for user operation.
[0092] In another specific embodiment of the present application, the universal joint structure 300 is preferably a cross-shaped structure, which has two cross-shaped rotation directions, wherein the two rotation directions of the cross-shaped structure include a first direction X and a second direction Y, such as Figure 1 As shown, the direction indicated by the arrow is the position of the driving main rope 430, the first direction X has two directions, the left side and the right side, and the second direction Y also has two directions, the upper side and the lower side. Therefore, the corresponding rope drive mechanism is also set to two, and the corresponding angle sensing unit is also set to two, which are respectively located in the two rotation directions of the cross-shaped structure, thereby driving the robot wrist to move in the two rotation directions of the cross-shaped structure, with two degrees of freedom.
[0093] Based on all the above examples, see Figures 7 to 9 As shown, the cross-shaped structure gradually bends to the left. When the motor 410 drives the winding wheel 420 clockwise, the main rope 430 is driven to relax and the auxiliary rope 440 is driven to tighten, because the transmission directions are opposite. The main rope 430 is driven to relax and the auxiliary rope 440 is driven to tighten, which drives the universal joint structure 300 to rotate to the left side of the first direction, forming a universal joint structure 300 with a low left side and a high right side. Similarly, when the motor 410 drives the winding wheel 420 counterclockwise, it drives the universal joint structure 300 to rotate to the right side of the first direction, which is not shown in the figure. As a result, the robot wrist of the present application can rotate at a larger angle and more flexibly.
[0094] See also Fig.10 As shown, the present application also provides a control method for a robot wrist, the control method is applied to the robot wrist described in any one of the above technical solutions, and the control method includes:
[0095] S100, obtaining current bending state information;
[0096] S200, calculating a target bending direction and a target bending angle based on the current bending state information, and obtaining a tightening instruction;
[0097] S300: Based on the tightening instruction, control the rope drive mechanism to tighten, so as to drive the robot wrist to bend to a target position.
[0098] Specifically, the current bending state information includes the initial state of the robot wrist, that is, the robot wrist in a balanced state without being used, and also includes the position state of the robot wrist that has been bent to the previous instruction target position. The current bending state information is obtained through the angle sensing unit.
[0099] Please combine Fig.10 As shown, in the above technical solution, the user sends the target bending direction and the target bending angle to the rope-driven mechanism, the angle sensing unit obtains the current bending state information of the universal joint structure, the current bending state information is sent to the rope-driven mechanism, the rope-driven mechanism parses the difference between the current bending state information and the target bending direction and the target bending angle, and parses out the tightening instruction through the rope-driven mechanism, the tightening instruction refers to the tightening length of the rope-driven mechanism, and then controls the universal joint structure to rotate along the first direction to the target position, thereby realizing closed-loop control of the robot wrist.
[0100] In summary, the present invention provides a robot wrist and a control method thereof. Compared with the existing robot wrist, the robot wrist of the present invention has high flexibility, light weight, compact structure, and a larger range of motion. By arranging an angle sensing unit on the universal joint structure, accurate feedback of the current angular position of the robot wrist in a first direction can be directly obtained. By arranging a rope drive mechanism, a rope drive method is adopted to achieve efficient rotation of the robot wrist. At the same time, the angle of the robot wrist can be accurately controlled in conjunction with the angle sensing unit to perform more precise operations. Through the setting of the universal joint structure and the driving base, the device can be directly assembled with the manipulator palm and the robot arm to achieve plug-and-play.
[0101] It should be understood that the application of the present invention is not limited to the above examples. For ordinary technicians in this field, improvements or changes can be made based on the above description. All these improvements and changes should fall within the scope of protection of the claims attached to the present invention.
Claims
1. A robot wrist, It is characterized in that It includes a driving base, a bearing seat, a universal joint structure, an angle sensing unit and a rope drive mechanism; The rope drive mechanism is disposed in the driving base and connected to the universal joint structure, and the universal joint structure is driven to rotate in a first direction when the rope drive mechanism is tightened; The bearing seat is arranged on the driving base, the universal joint structure is arranged on the bearing seat, the angle sensing unit is arranged on the universal joint structure, and the angle sensing unit is used to sense the rotation angle along the first direction; The rope drive mechanism comprises: A driving assembly, disposed in the driving base; A driving main rope, one end of which is wound around the driving assembly and the other end of which is connected to the universal joint structure; A driving auxiliary rope, one end of which is wound around the driving assembly and the other end of which is connected to the universal joint structure; The transmission directions of the driving main rope and the driving auxiliary rope are opposite, and they are respectively located on two opposite sides of the universal joint structure; the driving assembly is used to pull the driving auxiliary rope and the driving main rope to drive the universal joint structure to rotate around the first direction; There are multiple rope drive mechanisms, which are cross-arranged on the driving base. Each rope drive mechanism is arranged in the driving base, and each rope drive mechanism corresponds to a direction of the universal joint structure, and is used to drive the universal joint structure to rotate in different directions.
2. A robot wrist according to claim 1, It is characterized in that The drive assembly comprises: A motor is disposed in the driving base; A winding wheel is arranged on the motor, and the main driving rope and the auxiliary driving rope having opposite transmission directions are wound around the winding wheel; A first transmission component connected to the driving main rope; A second transmission component connected to the driving auxiliary rope; When the motor rotates, the main driving rope is tightened and the auxiliary driving rope is relaxed, or the main driving rope is relaxed and the auxiliary driving rope is tightened, so as to drive the universal joint structure to rotate around the first direction.
3. A robot wrist according to claim 2, It is characterized in that The first transmission component comprises: A first lower pulley is disposed on the bearing seat and is located on one side of the first direction; A first upper pulley is disposed on the universal joint structure and is located on the same side as the first lower pulley; Wherein, the driving main rope is wound around the first lower pulley and the first upper pulley in sequence, and is connected to one side of the bearing seat.
4. A robot wrist according to claim 2, It is characterized in that The second transmission component comprises: A second lower pulley is disposed on the bearing seat and is located on the other side of the first direction; A second upper pulley is disposed on the universal joint structure and is located on the same side as the second lower pulley; A first transmission pulley is disposed in the bearing seat; A second transmission pulley is disposed in the bearing seat; Among them, one end of the driving auxiliary rope is wound out from the upper side of the first transmission pulley and the lower side of the second transmission pulley, and is wound around the second lower pulley and the second upper pulley in sequence, and is connected to the other side of the bearing seat.
5. A robot wrist according to claim 1, It is characterized in that The rope drive mechanism further includes a pre-tightening assembly for adjusting the pre-tightening force of the driving main rope and the driving auxiliary rope, and the pre-tightening assembly includes: A first channel is provided on the bearing seat, and the driving main rope is passed through the first channel; A first abutment member, disposed on the first channel, and used for locking the main driving rope; A second channel is provided on the bearing seat, and the driving auxiliary rope is passed through the second channel; The second abutment member is disposed on the second channel and is used for locking the secondary driving rope.
6. A robot wrist according to claim 1, It is characterized in that The universal joint structure comprises: A universal joint, one end of which is arranged at the middle position of the bearing seat; A connecting seat is rotatably arranged on the universal joint, and the connecting seat is used to connect to the robot palm.
7. A robot wrist according to claim 1, It is characterized in that The robot wrist also includes a control system, and the control system is electrically connected to the angle sensing unit and the rope drive mechanism.
8. A method for controlling a robot wrist. It is characterized in that The control method is applied to the robot wrist according to any one of claims 1 to 7, and the control method comprises: Get the current bending state information; Calculate a target bending direction and a target bending angle based on the current bending state information, and obtain a tightening instruction; The rope drive mechanism is controlled based on the tightening instruction to drive the robot wrist to bend to a target position.
Citation Information
Patent Citations
Fully-closed loop feedback globe joint driven by rope
CN101590651A
Rope-driven wrist module based on three-degree-of-freedom series-parallel hybrid mechanism and use method of rope-driven wrist module
CN112894780A
