多关节仿人型机器人手臂 Multi-joint humanoid robot arm
：本发明涉及一种安装在机器人上的机械手臂。 : The present invention relates to a robot arm mounted on a robot.
背景技术 Background technique
：现有的机器人关节型手臂大多体积大，重量大，动作欠灵活，活动范围小，多数采用交流伺服电机，只能在固定场所作业，不适用于移动型机器人。 : Conventional articulated robot arm mostly bulky, heavy, less flexible operation, a small range of motion, the majority of AC servo motor, can only work in a fixed place, it is not available for mobile robot. 同时大多数为单臂，对于需要双臂协调作业的场合无能为力。 While most of the single-arm, both arms for applications requiring coordinated operations powerless.
：本发明提供一种多关节仿人型机器人手臂，该手臂可以模仿人的手臂功能进行各种各样的操作，完成取、放、拧紧、开关等动作，并通过双手臂的合作与协调动作实现一定的作业功能。 : The present invention provides a multi-articulated humanoid robot arm, which arm can mimic human arms operate various functions, complete take, place, tighten, operation switches, etc., and through cooperation and coordination of the operation of the double arm to achieve a certain job functions. 本发明的多关节仿人型机器人手臂由具有回转副和摆动副的肩部关节A、具有两个回转副和一个摆动副的肘部关节C、具有回转副和摆动副的腕部关节E、连接在肩部关节A和肘部关节C之间的大臂B、连接在肘部关节C和腕部关节E之间的小臂D、与腕部关节E相连接的夹持手F组成；夹持手F由壳体F1、安装在壳体F1内的蜗杆F2、设置在蜗杆F2两侧并与蜗杆F2啮合的一对蜗轮F3、分别与一对蜗轮F3固定连接的一对手爪F4组成，手爪F4伸至壳体F1的外面；各关节的回转副和摆动副、以及夹持手F的蜗杆F2的运动分别由一台伺服电机驱动。 Humanoid robot multi-joint arm by the shoulder joint of the present invention and having a swing revolute pairs A, having two rotors and a sub-sub swing elbow joint C, and swings the sub-sub having a rotary wrist joint E, a connection between the shoulder joint and the elbow joint C of the boom B, the connection between the elbow joint and the wrist joint E of the C arm D, the chucking hand wrist joint E and F connected to the composition; one pair of worm gear housing by a holding hand F F1, F1 is mounted within the housing F2, F2 disposed on both sides of the worm meshed with the worm and F2, F3, respectively, a pair of pawls opponents F3 F4 fixedly connected to the worm wheel composed of , extends to the outside of the gripper housing F1, F4; revolute joint and respective sub swing, and the chucking hand movement F worm F2 are respectively driven by a servo motor. 该多关节仿人型机器人手臂的肩部关节有两个自由度：电机通过齿轮副传动带动手臂绕手臂纵长轴线(0-0以下同)回转(运动范围330°)，另一电机通过连接盘带动大臂绕I轴摆动(运动范围-90°～+100°)；肘部关节分两段：上肘部、下肘部，上肘部有2个自由度：电机通过齿轮副传动带动肘部绕手臂纵长轴线回转(运动范围330°)，电机通过连接盘带动小臂绕II轴摆动(运动范围-90°～+90°)，下肘部有1个自由度：电机通过齿轮副传动带动小臂绕手臂纵长轴线回转(运动范围330°)，增加此自由度可增强避障能力，增大作业范围；腕部关节有2个自由度：电机通过齿形带传动带动腕部绕III轴摆动(运动范围-30°～+45°)、电机通过连接盘，带动夹持手绕手臂纵长轴线回转(运动范围-60°～+60°)，夹持手内电机通过蜗轮蜗杆传动，带动两个手爪进行开闭动作。 The multi-joint arm humanoid robot shoulder joint has two degrees of freedom: the motor drive arm about the longitudinal axis arm (0-0 hereinafter the same) rotation (movement range 330 °) via the auxiliary drive gear, the motor further through the connection disk drive arm I about the pivot axis (motion range -90 ° ~ + 100 °); elbow joints in two stages: the elbow, the elbow, the elbow has two degrees of freedom: the auxiliary drive gear driven by the motor elbow swivel about the longitudinal axis arm (motion range of 330 °), driven by a motor connected to the swing plate arm about the axis II (motion range -90 ° ~ + 90 °), the elbow has one degree of freedom: the motor via a gear auxiliary drive driving the arm turning around the arm longitudinal axis (motion range 330 °), this increases the degree of freedom can be enhanced obstacle avoidance capability, increasing the operating range; wrist joint has two degrees of freedom: the drive motor through a toothed belt drive arm portion around the pivot axis III (motion range -30 ° ~ + 45 °), the motor is connected through the disk, the chucking hand drive arm about the longitudinal axis rotation (movement range of -60 ° ~ + 60 °), the gripping by the hand motor a worm gear, two driven gripper opening and closing operation. 本发明的多关节仿人型机器人手臂，可左右对称安装于机器人上，其双臂在计算机控制下可协调动作，相互配合(见图1)。 Polyarticular humanoid robot arm of the present invention may be mounted symmetrically on robot arms may coordinate operation under computer control, cooperate with each other (see FIG. 1). 手臂采用7+1(冗余)自由度仿人结构，长度与人臂相仿。 Using the arm 7 + 1 (redundancy) DOF anthropomorphic structure, similar to the length of the human arm. 该机器人手臂机械结构简捷紧凑、体积小、重量轻，各关节连接可靠，拆卸方便，电机线、传感器线内置，传动关系简单明了；手臂具有7+1自由度的特点，手臂运动范围大、灵活，避障能力强；安全性强、可达性强、双手协调运动灵活，应用范围广；作业手臂能耗低，采用直流24v供电；单作业臂最大抓取重量：1Kg。 The robotic arm mechanically simple compact structure, small volume, light weight, reliable connection of the joints, easy removal, simple motor wire sensor line built, transmission relationship; 7 + 1 degree of freedom arm having the characteristics of a large range of arm motion, flexible , obstacle avoidance capability; strong safety, accessibility and strong, flexible and coordinated movement of his hands, a wide range of applications; low power consumption operating arm, 24v DC power supply; the maximum weight of a single job crawling arm: 1Kg.
附图说明 BRIEF DESCRIPTION
：图1是本发明的机器人手臂安装在机器人身上的作业原理图，图2是本发明的机器人手臂的结构示意图，图3是图2的俯视图，图4是肩部关节A的结构示意图，图5是肘部关节C的结构示意图，图6是腕部关节E的结构示意图，图7是夹持手F的结构示意图。 : FIG. 1 is a robot arm according to the present invention is installed in the robot body work diagram, Figure 2 is a schematic view of the robot arm of the present invention, FIG. 3 is a plan view of FIG. 2, FIG. 4 is a schematic view of the shoulder joint A of FIG. 5 is a schematic view of the elbow joint C, FIG. 6 is a schematic view of the wrist joint E, FIG. 7 is a schematic view of the gripping hand F.
具体实施方式 Detailed ways
：参阅图2、图3，本实施方式的机器人手臂由具有回转副和摆动副的肩部关节A、具有两个回转副和一个摆动副的肘部关节C、具有回转副和摆动副的腕部关节E、连接在肩部关节A和肘部关节C之间的大臂B、连接在肘部关节C和腕部关节E之间的小臂D、与腕部关节E相连接的夹持手F组成；参阅图4，肩部关节A由关节体A1、肩转关节体A2、第一电机A3、第一齿轮A4、第一齿圈A5、肩摆轴A6、第二电机A7组成；第一电机A3安装在关节体A1上，第一齿圈A5套装在关节体A1的轴A8上，第一齿圈A5与肩转关节体A2固定连接，第一齿轮A4与第一电机A3的主轴相连接，第一齿轮A4与第一齿圈A5相啮合并形成肩部关节A的回转副；与第二电机A7的主轴相连接的肩摆轴A6固定在大臂B左端的轴套B1内，在肩转关节体A2上还固定有连接盘A9和电机护罩A10，连接盘A9与电机护罩A10支撑在轴套B1的两端， : Refer to FIG. 2, FIG. 3, the robot arm embodiment of the present embodiment by a shoulder joint A and having a swing revolute pair, having two rotors and a sub-sub swing elbow joint C, and having a swivel sub swing arm pairs joint portions E, B connected to the boom between the shoulder joints and elbow joints a C, D connected to the arm between the elbow joints and wrist joint C E, E are disposed between the wrist joint is connected to hand composition F; refer to FIG. 4, the shoulder joint of the joint body A A1, the shoulder rotation joint member A2, a first motor A3, a first gear A4, the first ring gear A5, pendulum shaft shoulder A6, A7 composed of a second motor; a first motor mounted on the joint body A3 A1, A5 fitted over the first ring gear shaft joint A1 and A8, A5 and the first ring gear fixedly connected to the shoulder rotation joint A2, a first gear with a first motor A3, A4 the spindle is connected to the first gear and the first ring gear A4 and A5 engages a shoulder swivel joint a sub; A7 shoulder of the spindle motor is connected to the second pivot axis A6 in the sleeve is fixed to the left end of the boom B B1 inside, the shoulder rotation joint connecting member A2 is also fixed to the motor cover plate A9 and A10, A9 is connected with the motor shield plate A10 B1 supported at both ends of the sleeve, 连接盘A9和电机护罩A10与轴套B1形成转动配合并形成肩部关节A的摆动副。 The lands and the motor cover A10 and A9 B1 form a wobble sleeve rotatably fitted and the sub shoulder joint A is formed. 参阅图5，肘部关节C由安装在大臂B内的第三电机C1、第二齿轮C2、第二齿圈C3、肘转关节体C4、第四电机C5、肘摆轴C6、肘摆关节体C7、第三齿轮C8、第三齿圈C9、安装在小臂D内的第五电机C10组成；第二齿圈C3套装在大臂B内的轴B2上，第二齿圈C3与肘转关节体C4固定连接，第二齿轮C2与第三电机C1的主轴相连接，第二齿轮C2与第二齿圈C3相互啮合并形成肘部关节C的上回转副；与第四电机C5的主轴相连接的肘摆轴C6固定在肘摆关节体C7的轴套C11内，在肘转关节体C4上固定连接有连接盘C12和电机护罩C13，连接盘C12和电机护罩C13支撑在轴套C11的两端，轴套C11与连接盘C12和电机护罩C13形成转动配合并形成肘部关节C的摆动副；第三齿圈C9套装在小臂D内的轴D1上，第三齿圈C9与肘摆关节体C7固定连接，第三齿轮C8与第五电机C10的主轴固定连接，第三齿圈C9与第三齿轮C8相互啮合 Referring to FIG. 5, the elbow joint C C1 by a third motor mounted in the boom B, the second gear C2, second ring gear C3, the elbow rotation joint body C4, fourth motor C5, elbow pivot axis C6, swing elbows joint body C7, third gear C8, third ring gear C9, fifth motor mounted in the arm D C10 form; C3 suit the second ring gear shaft B2 in the boom B, the second ring gear and C3 revolute joint on the elbow rotation C4 is fixedly connected to the second gear C2 and C1 of the spindle motor is connected to the third, the second gear C2 and C3 of the second ring gear meshing with each other and form C of the elbow joint; C5 fourth motor elbow connected to spindle pivot axis fixed to the elbow C6 roll joint body the inner bushing C11 C7, and on the elbow rotation joint connecting member is fixedly connected to the disc C4 C12 and C13 motor shroud, the shroud lands C12 and C13 motor support in both ends of the sleeve C11, C11 and sleeve lands C12 and C13 to form a wobble motor shroud cooperate to form the sub-rotation of the elbow joint C; the third ring gear shaft C9 Kit arm D D1 in the first a third ring swing elbow joints C7 and C9 fixed connecting body, a third connecting shaft is fixed to the motor gear and the fifth C10, C8, C9 C8 third ring gear meshing with each other and the third gear 并形成肘部关节C的下回转副。 And forming the swivel elbow joint C of the sub. 参阅图6，腕部关节E由安装在小臂D内的第六电机E1、齿形带传动机构E2、腕轴E3、第七电机E4、腕转关节体E5组成；齿形带传动机构E2分别连接第六电机E1的主轴和腕轴E3，腕轴E3的两端与小臂D端部形成转动配合即构成腕部关节E的摆动副；第七电机E4通过固定装置E6固定在腕轴E3上，腕转关节体E5与第七电机E4的主轴固定连接即构成腕部关节E的回转副，腕转关节体E5与夹持手F的壳体F1固定连接。 Referring to Figure 6, a wrist joint E E1 sixth motor mounted within the arm D, a toothed belt drive E2, E3 wrist axis, a seventh motors E4, E5 wrist and joint body composition; E2 belt drive mechanism are connected to the arm shaft E3 and the sixth spindle motor E1, and ends with the end portion of the arm D arm rocking shaft is formed E3 constitute the sub-fitting rotation of the wrist joint E; E4 seventh motor is fixed by a fixing means E6 wrist shaft on E3, E5 and wrist and the seventh joint body spindle motor fixedly connected E4 constitute turning pairs wrist joint E of the wrist and hand joints the clamp member E5 F F1 is fixedly connected to the housing. 参阅图7，夹持手F由壳体F1、安装在壳体F1内的螺杆F2、设置在蜗杆F2两侧并与蜗杆F2啮合的一对蜗轮F3、分别与一对蜗轮F3固定连接的一对手爪F4组成，手爪F4伸至壳体F1的外面。 A pair of worm screws refer to FIG. 7, the chucking hand F F1 by the housing, mounted within the housing F1 is F2, F2 is provided on both sides of the worm meshed with the worm and F2, F3, F3, respectively, the pair of worm gear fixedly connected to a opponents pawl composition F4, F4 gripper extending to outside the housing F1. 以上各电机均为伺服电机。 The above motors are servo motors.