ANTAGONISTIC DRIVE DEVICE WITH CAPSTANS AND TENDON TRANSMISSION

Abstract

The application discloses an antagonistic drive device which adopts capstans and tendon transmission. The device adopts a pair of rotary actuators which are fixedly connected with the capstans of their respective output shafts respectively to drive the controlled joint and constitute an antagonistic drive. Since the rotary actuator can use a small rotary motor, and the capstans can be arranged properly to make full use of the space in the dexterous hand (especially the forearm) or the robot body. The device has the advantages of small overall size, light weight and low noise, which is especially suitable for driving the joints of dexterous hands with small overall size and a large number of joints. It can also be used for driving the joints of other robots.

Claims

1. An antagonistic drive device using capstans and tendon transmission, comprising a tendon; a first rotary actuator; a second rotary actuator; a first capstan; a second capstan; a first tendon sheath guide element at joints; a second tendon sheath guide element at the first rotary actuator; a third tendon sheath guide element at the second rotary actuator; a first tendon sheath; a second tendon sheath; and a controlled joint, wherein the controlled joint comprises a rotational part and a joint base, the rotational part and the joint base are hinged so that the controlled joint can rotate, wherein the first tendon sheath guide element at joints comprises a first tendon sheath mounting interface through which the tendon can pass, wherein the first tendon sheath guide element at joints is relatively fixed with the joint base, wherein the second tendon sheath guide element at the first rotary actuator comprises a second tendon sheath mounting interface through which the tendon can pass, wherein the second tendon sheath guide element at the first rotary actuator is relatively fixed with the first rotary actuator's stator, wherein the third tendon sheath guide element at the second rotary actuator comprises a third tendon sheath mounting interface through which the tendon can pass, wherein the third tendon sheath guide element at the second rotary actuator is relatively fixed with the second rotary actuator's stator, wherein one end of the first tendon sheath is fixed to the first tendon sheath mounting interface of the first tendon sheath guide element at joints, and the other end of the first tendon sheath is fixed to the second tendon sheath mounting interface of the second tendon sheath guide element at the first rotary actuator, wherein one end of the second tendon sheath is fixed to the first tendon sheath mounting interface of the first tendon sheath guide element at joints, and the other end of the second tendon sheath is fixed to the third tendon sheath mounting interface of the third tendon sheath guide element at the second rotary actuator, wherein the rotational part is fixedly connected to any point in the middle of the tendon, wherein the controlled joint is jointly driven by the first rotary actuator and the second rotary actuator, wherein the first rotary actuator is configured to pull one end of the tendon through the first capstan fixed to the first rotary actuator's output shaft, wherein the second rotary actuator is configured to pull the other end of the tendon through the second capstan fixed to the second rotary actuator's output shaft, wherein the tendon is configured to slide in the first tendon sheath and the second tendon sheath, wherein the first tendon sheath and the second tendon sheath are hoses, wherein the controlled joint is a dexterous hand's joint, the dexterous hand is a manipulator with at least three fingers and a total of at least six degrees of freedom.

2. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the controlled joint is provided with a joint angle sensor.

3. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the controlled joint is provided with a joint force and torque sensor.

4. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the tendon is provided with one or more tendon tension sensors.

5. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the first capstan is provided with a torque sensor to measure torque of the first rotary actuator's output shaft acting on the first capstan.

6. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the second capstan is provided with a torque sensor to measure torque of the second rotary actuator's output shaft acting on the second capstan.

7. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein any one of position, velocity, torque, joint damping, and joint stiffness of the controlled joint is controlled by configuring speed and output forces of the first rotary actuator and the second rotary actuator respectively.

8. The antagonistic drive device using capstans and tendon transmission of claim 1, wherein the first rotary actuator is configured to apply a first traction force to the upper part of the tendon, while at the same time the second rotary actuator is configured to apply a second traction force to the lower part of the tendon, controlling joint damping and/or joint stiffness of the controlled joint by dynamically adjusting the magnitude of the first traction force and that of the second traction force.

9. The antagonistic drive device using capstans and tendon transmission of claim 8 being configured to dynamically adjust the joint damping to cause rotational part of the controlled joint to move in a smooth or burst manner.

10. The antagonistic drive device using capstans and tendon transmission of claim 9, wherein dynamically adjusting the joint damping to cause rotational part of the controlled joint to move in the smooth manner comprises controlling the first traction force applied by the first rotary actuator to the upper part of the tendon and the second traction force applied by the second rotary actuator to the lower part of the tendon such that the amplitude of the first traction force is close to that of the second traction force.

11. The antagonistic drive device using capstans and tendon transmission of claim 10, wherein the amplitude difference between the first traction force and the second traction force is configured to be reduced so as to make the motion of the controlled joint's rotational end smoother.

12. The antagonistic drive device using capstans and tendon transmission of claim 9, wherein dynamically adjusting the joint damping to cause rotational part of the controlled joint to move in the burst manner comprises controlling the first traction force applied by the first rotary actuator to the upper part of the tendon and the second traction force applied by the second rotary actuator to the lower part of the tendon so as to increase the amplitude difference between the first traction force and the second traction force.

13. The antagonistic drive device using capstans and tendon transmission of claim 12, wherein the amplitude difference between the first traction force and the second traction force is configured to be increased so as to make the motion of the controlled joint's rotational end closer to an eruption.

14. The antagonistic drive device using capstans and tendon transmission of claim 8, wherein the amplitude of the first traction force is configured to vary with time and/or load, wherein the amplitude of the second traction force is configured to vary with time and/or load.

Description

DRAWINGS OF EMBODIMENTS

[0034] In order to more clearly describe the technical solution in this application embodiment, the following is a brief description of the drawings needed for embodiments or demonstration technical descriptions. The following is a brief description of the drawings needed for embodiments or demonstration technical descriptions.

[0035] FIG. 1 is a schematic diagram of the overall structure of an antagonistic drive device with capstans and tendon transmission provided in this application example; and

[0036] FIG. 2 shows a controlled joint diagram of an antagonistic drive device with capstans and tendon transmission provided for this applied embodiment.

DETAILED DESCRIPTION

[0037] In order to make the purpose, technical scheme and advantages of this application more clear, the application is explained in detail in combination with the attached drawings and examples. It should be understood that embodiments described herein are intended only to interpret and not to limit this application.

[0038] In order to explain the technical scheme of this application, the following details are given in combination with the attached drawings and embodiments.

[0039] Referring to FIG. 1, this application proposes an antagonistic drive device using capstans and tendon transmission, comprising: a tendon 10; a first rotary actuator; a second rotary actuator; a first capstan 13; a second capstan 8; a first tendon sheath guide element 4 at joints; a second tendon sheath guide element 12 at the first rotary actuator; a third tendon sheath guide element 6 at the second rotary actuator; a first tendon sheath 11; a second tendon sheath 5; and a controlled joint.

[0040] The first rotary actuator and the second rotary actuator are configured with rotary type motors.

[0041] The controlled joint comprises a rotational part 3 and a joint base (not shown in FIG. 1), the rotational part and the joint base are hinged so that the controlled joint can rotate.

[0042] The first tendon sheath guide element 4 at joints comprises a first tendon sheath mounting interface 10 through which the tendon can pass.

[0043] The first tendon sheath guide element 4 at joints is relatively fixed with the joint base.

[0044] The second tendon sheath guide element 12 at the first rotary actuator comprises a second tendon sheath mounting interface through which the tendon 10 can pass.

[0045] The second tendon sheath guide element 12 at the first rotary actuator is relatively fixed with the first rotary actuator's stator.

[0046] The third tendon sheath guide element 6 at the second rotary actuator comprises a third tendon sheath mounting interface through which the tendon can pass.

[0047] The third tendon sheath guide element 6 at the second rotary actuator is relatively fixed with the second rotary actuator's stator.

[0048] One end of the first tendon sheath 11 is fixed to the first tendon sheath mounting interface of the first tendon sheath guide element 4 at joints, and the other end of the first tendon sheath is fixed to the second tendon sheath mounting interface of the second tendon sheath guide element 12 at the first rotary actuator.

[0049] One end of the second tendon sheath 5 is fixed to the first tendon sheath mounting interface of the first tendon sheath guide element 4 at joints, and the other end of the second tendon sheath is fixed to the third tendon sheath mounting interface of the third tendon sheath guide element 6 at the second rotary actuator.

[0050] The rotational part 3 is fixedly connected to any point in the middle of the tendon 10, the controlled joint is jointly driven by the first rotary actuator and the second rotary actuator, the first rotary actuator is configured to pull one end of the tendon 10 through the first capstan 13 fixed to the first rotary actuator's output shaft, the second rotary actuator is configured to pull the other end of the tendon 10 through the second capstan 8 fixed to the second rotary actuator's output shaft.

[0051] The tendon 10 is configured to slide in the first tendon sheath 11 and the second tendon sheath 5.

[0052] The first tendon sheath 11 and the second tendon sheath 5 can be made of rubber tube, PVC, spring tube and other hoses.

[0053] The controlled joint is provided with a joint angle sensor 9.

[0054] The controlled joint is provided with a joint force and torque sensor 2. In the embodiment of FIG. 1, rotational part 3 is fixedly connected with phalangel, and joint force and torque sensor 2 is installed at the connection between rotational part 3 and phalangel.

[0055] The tendon is provided with one or more tendon tension sensors 7.

[0056] The first capstan 13 is provided with a torque sensor to measure torque of the first rotary actuator's output shaft acting on the first capstan 13.

[0057] The second capstan 8 is provided with a torque sensor to measure torque of the second rotary actuator's output shaft acting on the second capstan 8.

[0058] Referring to FIG. 2 for an example of an embodiment of this application, the controlled joint is an interphalangeal joint, comprising the rotational part 17 of the interphalangeal joint and the interphalangeal joint base 19. Both are hinged through the interphalangeal joint flexion/extension shaft 15. The rotational part 17 of the interphalangeal joint is provided with a V-shaped groove wheel, and the middle point of tendon 10 is fixed to the V-shaped groove wheel of the rotational end 17 of the interphalangeal joint through the tendon fixing element 18, and half wrapped around the V-shaped groove wheel.

[0059] The interphalangeal joint angle sensor 14 and the interphalangeal joint force and torque sensor 16 are arranged in the interphalangeal joint.

[0060] Referring to FIG. 1, since to judge the motion trend of the controlled joint, one only needs to refer to the motion of the first capstan 13 and second capstan 8. The first rotary actuator and second rotary actuator are hidden in FIG. 1.

[0061] Position, velocity, torque, joint damping, and joint stiffness of the controlled joint are controlled by configuring speed and output forces of the first rotary actuator and the second rotary actuator respectively.

[0062] 1) When the first rotary actuator tightens the upper part of tendon 10 through the first capstan 13, and when the second rotary actuator releases the lower part of tendon 10 through the second capstan 8, the controlled joint rotational part 3 will rotate upward.

[0063] 2) When the first rotary actuator releases the upper part of tendon 10 through the first capstan 13, and when the second rotary actuator tightens the lower part of tendon 10 through the second capstan 8, the controlled joint rotational part 3 rotates downward.

[0064] The joint damping and joint stiffness of the controlled joint can be controlled by dynamically adjusting the traction force on both sides when the first rotary actuator exerts a certain first traction force on the upper part of tendon 10 through the first capstan 13, and the second rotary actuator exerts a certain second traction force on the lower part of tendon 10 through the second capstan 8. The joint damping and/or joint stiffness of the controlled joint can be controlled by dynamically adjusting the amount of traction on both parts. Dynamic adjustment of joint damping causes the rotational end 3 of the controlled joint to move in a smooth or burst (such as a flick of the finger) manner. Dynamic adjustment of the joint stiffness of the controlled joint can make it resist disturbance from external forces, or flexibly adapt to external forces.

[0065] Dynamically adjusting the joint damping to cause rotational part of the controlled joint to move in the smooth manner comprises controlling the first traction force applied by the first rotary actuator to the upper part of the tendon and the second traction force applied by the second rotary actuator to the lower part of the tendon, such that the amplitude of the first traction force is close to that of the second traction force.

[0066] The amplitude difference between the first traction force and the second traction force may be reduced to make the motion of the controlled joint's rotational end smoother.

[0067] Dynamically adjusting the joint damping to cause rotational part of the controlled joint to move in the burst manner comprises controlling the first traction force applied by the first rotary actuator to the upper part of the tendon and the second traction force applied by the second rotary actuator to the lower part of the tendon, so as to increase the amplitude difference between the first traction force and the second traction force.

[0068] The amplitude difference between the first traction force and the second traction force may be increased to make the motion of the controlled joint's rotational end closer to an eruption (such as a flick of the finger).

[0069] The amplitude of the first traction force may vary with time and/or load, wherein the amplitude of the second traction force may vary with time and/or load.

[0070] For example, when the first finger of the dexterous hand has a tendency to perform extension motion but is blocked by the second finger, the second finger constitutes the load, and the corresponding joints of the first finger constitute the controlled joint. By controlling the first rotary actuator and the second rotary actuator, the amplitude of the first traction force and the second traction force of the corresponding tendon are greatly different. When the second finger releases the blocking, the first finger can perform a flick of finger.

[0071] The antagonistic drive mechanism based on tendon transmission provides a foundation for the control of joint damping and joint stiffness of dexterous hands, which enables dexterous hands to take into account both the flexibility of operation and the robustness of anti-interference.

[0072] The above are only optional embodiments of this application and are not intended to limit this application. This application is subject to various changes and variations for those skilled in the field. Any modification, equivalent replacement, improvement etc. made in the spirit and principle of this application shall be included in the scope of claims of this application.