CN107775633A - 高灵活度仿人机械手臂 - Google Patents
高灵活度仿人机械手臂 Download PDFInfo
- Publication number
- CN107775633A CN107775633A CN201710734205.6A CN201710734205A CN107775633A CN 107775633 A CN107775633 A CN 107775633A CN 201710734205 A CN201710734205 A CN 201710734205A CN 107775633 A CN107775633 A CN 107775633A
- Authority
- CN
- China
- Prior art keywords
- bevel gear
- mechanical arm
- grade
- gear
- axle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000007246 mechanism Effects 0.000 claims abstract description 27
- 230000001133 acceleration Effects 0.000 claims description 31
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 claims description 20
- 238000001514 detection method Methods 0.000 claims description 14
- 230000009471 action Effects 0.000 claims description 13
- 238000012544 monitoring process Methods 0.000 claims description 2
- 230000002441 reversible effect Effects 0.000 claims description 2
- 230000036961 partial effect Effects 0.000 description 14
- 230000006870 function Effects 0.000 description 7
- 230000004888 barrier function Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 6
- 210000001503 joint Anatomy 0.000 description 6
- 101100262629 Caenorhabditis elegans ubr-1 gene Proteins 0.000 description 3
- 241001465754 Metazoa Species 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000003993 interaction Effects 0.000 description 3
- 230000000979 retarding effect Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 235000002566 Capsicum Nutrition 0.000 description 2
- 239000006002 Pepper Substances 0.000 description 2
- 241000722363 Piper Species 0.000 description 2
- 235000016761 Piper aduncum Nutrition 0.000 description 2
- 235000017804 Piper guineense Nutrition 0.000 description 2
- 235000008184 Piper nigrum Nutrition 0.000 description 2
- 241000124033 Salix Species 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 2
- 230000002427 irreversible effect Effects 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000036651 mood Effects 0.000 description 2
- 241000237858 Gastropoda Species 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 210000002310 elbow joint Anatomy 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000008451 emotion Effects 0.000 description 1
- 229920006248 expandable polystyrene Polymers 0.000 description 1
- 230000035800 maturation Effects 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 210000000323 shoulder joint Anatomy 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 210000000707 wrist Anatomy 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/102—Gears specially adapted therefor, e.g. reduction gears
- B25J9/1035—Pinion and fixed rack drivers, e.g. for rotating an upper arm support on the robot base
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种高灵活度仿人机械手臂,包括一基座、一上臂、一下臂及多个关节。一关节连接于基座与上臂之间,另一关节连接于上臂与下臂之间,又一关节连接于下臂的一末端。各关节包括一等比伞齿轮机构,各等比伞齿轮机构包括两马达、两第一等比伞齿轮及一第二等比伞齿轮。两马达分别连接两第一等比伞齿轮,两第一等比伞齿轮皆连接于第二等比伞齿轮。两马达适于通过两第一等比伞齿轮而驱动第二等比伞齿轮沿一第一轴转动或沿一第二轴转动,以提供各关节两个转动自由度。
Description
技术领域
本发明涉及一种机械手臂,尤其涉及一种高灵活度仿人机械手臂。
背景技术
目前工业用机械人的发展已到成熟的地步,已经有几种经典款式的机器人。而在服务型机器人方面,由于开发的理念与目标不同,因此有相当多不同样式的服务型机器人,其各有优缺点且能完成的任务也有所区别,举例说明如下。
丰田(TOYOTA)所开发的Human Support Robot(HSR),其目的为帮助人们的日常生活,融入于家庭内与家庭成员共存,改善整体生活质量,并且以紧凑(Compact)、轻量机体(Lightweight Body)、安全互动(Safe Interaction)、简易介面(Simple Interface)兼顾的机器人为其特点。该机器人具有一机械手臂配合两指夹持器、视觉识别功能、环境识别与自主移动、远程遥控…等功能。
日本独立行政法人理化学研究所(Institute of Physical and ChemicalResearch,RIKEN)在2006年提出RI-MAN机器人,希望能藉其抬举人类,但并未实现。RIKEN在2011年与东海橡胶工业联合设计出全球第一款能用机械手臂抱起人类的机器人,名为Robot for Interactive Body Assistance(RIBA),其特色为双臂可以抱起60kg的人类或重物,手臂上设有多个触觉传感器,外层用泡沫聚苯乙烯包覆,避免使用者碰撞时感到不舒服。
美国Willow Garage公司所开发出的个人机器人(Personal Robot 2,PR2)是硬体与软体功能非常强大的机器人平台。其被研发出来的主要目的,是希望让软体开发者排除掉硬体上的问题,提供软体给开发者一个完整功能的平台,让使用者通过开源(OpenSource)软体开发出机器人的各种应用程序,而这软体就是目前学术界常用的机器人作业***ROS,使PR2能在复杂环境的办公室里自由的行走。除自动导航外,其主要的软体功能多数应用于图像和手臂上,该平台有两个具7个自由度的手臂,皆能通过手臂上的手爪来执行现实世界中的任务。
Willow Garage公司的转投资公司Unbounded Robotics,也推出一款成本仅PR2十分之一的服务型机器人UBR-1,UBR-1有一个可上下伸缩机构,最高可升到52英寸,而配置七个自由度机械手臂,可以举起达1.5公斤的重物品,UBR-1机器人专为研究人员与企业设计,通过ROS作为软体架构的最先进的移动操作平台。该公司团队现今已停产。
Pepper机器人,由日本电信商软体银行(Softbank)与法国公司AldebaranRobotics共同研发,并委由台湾鸿海公司代工制造。Pepper是首款用来陪伴人类的机器人,以互动为其核心概念,不适合执行家事,主要着重于能说话,能识别使用者的情绪,能自主移动和生活。感测方面具有听觉、触觉以及感情***,也能利用网络帮助使用者。硬体上主要搭载了3D摄影机、触控屏幕与超音波传感器,来与人互动同时确保安全。移动方面采用三颗万向轮能自由移动,全身一共具有17个防夹关节。
此外,国际专利编号WO2015131904A1揭示一种用于工业机器人的安全***,其在机器人的马达与输出轴处分别配置传感器,并通过比较所述传感器的回传值来判断机器人的作动状态,若其***依据所述回传值判断需停止作动时,需主动通过煞车装置来阻止机器人继续作动,故在作动方式上较为复杂且无法达到自动锁定而停止作动的效果。
上列服务型机器人,不论是由学术界或是业界所开发都有不同的目的及功能,然皆朝向与人共存、安全考量、协助人类等为开发目标。因此,开发出一款能与人安全共存、协助人类、高负重能力、甚至能判别情绪等等的多功能服务型机器人,有相当的迫切需求存在,使服务型机器人能真正地协助人类。
发明内容
本发明提供一种机械手臂,为具有高扭矩、高灵活度及高工作空间的仿人居家照护型机械手臂,并具有与人协同工作的机能。
本发明的机械手臂包括一基座、一上臂、一下臂及多个关节。一关节连接于基座与上臂之间,另一关节连接于上臂与下臂之间,又一关节连接于下臂的一末端。各关节包括一等比伞齿轮机构,各等比伞齿轮机构包括两马达、两第一等比伞齿轮及一第二等比伞齿轮。两马达分别连接两第一等比伞齿轮,两第一等比伞齿轮皆连接于第二等比伞齿轮。两马达适于通过两第一等比伞齿轮而驱动第二等比伞齿轮沿一第一轴转动或沿一第二轴转动,以提供各关节两个转动自由度。
在本发明的一实施例中,当两马达分别驱动两第一等比伞齿轮沿一第一轴正转时,两第一等比伞齿轮驱动第二等比伞齿轮沿第一轴正转,当两马达分别驱动两第一等比伞齿轮沿第一轴反转时,两第一等比伞齿轮驱动第二等比伞齿轮沿第一轴反转。
在本发明的一实施例中,当一马达驱动对应的第一等比伞齿轮沿一第一轴正转且另一马达驱动对应的第一等比伞齿轮沿第一轴反转时,两第一等比伞齿轮驱动第二等比伞齿轮沿一第二轴正转或反转。
在本发明的一实施例中,上述的机械手臂包括至少一压力传感器,其中压力传感器配置于机械手臂的外部,当压力传感器感测到机械手臂的外部受一外力时,机械手臂适于停止作动,当压力传感器感测到机械手臂的外部持续受外力时,机械手臂适于沿外力的作用方向作动。
在本发明的一实施例中,上述的各关节包括至少一蜗杆、至少一蜗轮及至少一碰撞检测模块,蜗杆连接于一马达与蜗轮之间,蜗轮连接于蜗杆与对应的第一伞齿轮之间,碰撞检测模块配置于蜗轮,当碰撞检测模块检测来自蜗轮的加速度值不同于一预期值时,各马达停止作动。
在本发明的一实施例中,上述的马达适于通过蜗杆而带动蜗轮,且当马达停止作动且蜗轮受力时,蜗杆不被蜗轮带动以使机械手臂自动锁定。
在本发明的一实施例中,上述的各关节包括一位置传感器、一运动传感器及一减速机构,减速机构连接于对应的马达,位置传感器配置于对应的马达,运动传感器配置于减速机构且适于监控减速机构的实际加速度及实际转速,位置传感器适于感测马达的输出以推算出减速机构的预期加速度值与预期转速值,当减速机构的实际加速度值及实际转速值不同于减速机构的预期加速度值与预期转速值时,依据减速机构的实际加速度值及实际转速值调整马达的输出,直到减速机构的实际加速度值及实际转速值相同于减速机构的预期加速度值与预期转速值。
在本发明的一实施例中,上述的运动传感器包括加速度计、陀螺仪或磁力计。
在本发明的一实施例中,两个所述第一等比伞齿轮分别与所述第二等比伞齿轮相啮合,并且两个所述第一等比伞齿轮的中心线分别与第一轴的轴心线相重合,第二等比伞齿轮的中心线与第二轴的轴心线相重合,所述第一轴的轴心线与所述第二轴的轴心线相空间垂直。
基于上述,在本发明的机械手臂的各关节中,两马达分别驱动两第一等比伞齿轮转动,以利用两第一等比伞齿轮共同驱动第二等比伞齿轮转动。据此,可通过控制两第一等比伞齿轮的转向为相同或相反来驱动第的二等比伞齿轮沿一第一轴转动或沿一第二轴转动,使机械手臂的每一关节如同人体手臂的关节般拥有两个自由度,而可成为具有高灵活度及高工作空间仿人居家照护型机械手臂。此外,由于机械手臂的每一关节是通过两个马达来共同驱动,故具有高扭矩以提供良好的负重能力。
为让本发明的上述特征和优点能更明显易懂,下文特举实施例,并配合附图作详细说明如下。
附图说明
图1是本发明一实施例的机械手臂的立体图。
图2示出图1的机械手臂与人体的手臂的比对。
图3A是图1的基座与上臂之间的关节的部分构件方块示意图。
图3B是图1的基座与上臂之间的关节的部分构件立体图。
图4A是图1的上臂与下臂之间的关节的部分构件方块示意图。
图4B是图1的上臂与下臂之间的关节的部分构件立体图。
图5A是图1的下臂与法兰盘之间的关节的部分构件方块示意图。
图5B是图1的下臂与法兰盘之间的关节的部分构件立体图。
图6示出图3A的第一等比伞齿轮及第二等比伞齿轮。
图7是本发明另一实施例的机械手臂的立体图。
图8是本发明另一实施例的机械手臂于关节处的部分构件立体图。
图9示出图8的机械手臂碰撞障碍物。
图10是图9的机械手臂的作动流程图。
附图标号说明
50:障碍物
100、200、300:机械手臂
110、210、310:基座
120、220、320:上臂
130、230、330:下臂
140、240、340:法兰盘
150、150’、160、160’、170、170’、250、260、270、350、360、370:关节
152、162、172、352:马达
152a、162a、172a、352a:蜗杆
152b、162b、172b、352b:蜗轮
152c、152d、152e、152f、162c、162d:正齿轮
154、164、174:第一等比伞齿轮
156、166、176:第二等比伞齿轮
172c、172e:皮带轮
172d:皮带
280:压力传感器
390:碰撞检测模块
A1:第一轴
A2:第二轴
具体实施方式
图1是本发明一实施例的机械手臂的立体图。请参考图1,本实施例的机械手臂100包括基座110、上臂120、下臂130、法兰盘140及多个关节150、160、170。基座110内设置用以提供机械手臂100第一、第二作动自由度的机构,即连接于基座110与上臂120之间的关节150。上臂120内设置用以提供机械手臂100第三、第四作动自由度的机构,即连接于上臂120与下臂130之间的关节160。下臂130内设置用以提供机械手臂100第五、第六作动自由度的机构,即连接于下臂130的末端且连接于法兰盘140的关节170。
图2示出图1的机械手臂与人体的手臂的比对。请参考图2,连接于基座110与上臂120之间的关节150,相当于人体的肩关节150’。连接于上臂120与下臂130之间的关节160,相当于人体的肘关节160’。连接于下臂130与法兰盘140之间的关节170,相当于人体的腕关节170’。
以下具体说明图1的关节150的机构组成。图3A是图1的基座与上臂之间的关节的部分构件方块示意图。图3B是图1的基座与上臂之间的关节的部分构件立体图。请参考图3A及图3B,关节150包括一等比伞齿轮机构,此等比伞齿轮机构包括两马达152、两第一等比伞齿轮154及一第二等比伞齿轮156。各马达152配置于图1所示的基座110,且依序通过蜗杆152a、蜗轮152b、正齿轮152c、正齿轮152d、正齿轮152e、正齿轮152f而连接于对应的第一等比伞齿轮154,其中蜗杆152a、蜗轮152b、正齿轮152c、正齿轮152d、正齿轮152e、正齿轮152f及第一等比伞齿轮154构成一组减速机构,用以进行大减速比。为使图式较为清楚,图3B仅示出出一马达152及一组减速机构,关节150实际上包含对称的两组减速机构。
在本实施例中,正齿轮152c例如为十二齿,正齿轮152d例如为七十二齿,正齿轮152e例如为十三齿,正齿轮152f例如为五十二齿。蜗轮152b同轴连接正齿轮152c,再传动于正齿轮152d及与之同轴的正齿轮152e,再传动于正齿轮152f及与之同轴的第一等比伞齿轮154,以驱动连接于两第一等比伞齿轮154的第二等比伞齿轮156,进而驱动连接于第二等比伞齿轮156的上臂120(示出于图1)。
以下具体说明图1的关节160的机构组成。图4A是图1的上臂与下臂之间的关节的部分构件方块示意图。图4B是图1的上臂与下臂之间的关节的部分构件立体图。请参考图4A及图4B,关节160包括一等比伞齿轮机构,此等比伞齿轮机构包括两马达162、两第一等比伞齿轮164及一第二等比伞齿轮166。各马达162配置于图1所示的上臂120,且依序通过蜗杆162a、蜗轮162b、正齿轮162c、正齿轮162d而连接于对应的第一等比伞齿轮164,其中蜗杆162a、蜗轮162b、正齿轮162c、正齿轮162d及第一等比伞齿轮164构成一组减速机构,用以进行大减速比。为使图式较为清楚,图4B仅示出出一马达162及一组减速机构,关节160实际上包含对称的两组减速机构。
在本实施例中,正齿轮162c例如为三十五齿,正齿轮162d例如为三十五齿。蜗轮162b同轴连接正齿轮162c,再传动于正齿轮162d及与之同轴的第一等比伞齿轮164,以驱动连接于两第一等比伞齿轮164的第二等比伞齿轮166,进而驱动连接于第二等比伞齿轮166的下臂130(示出于图1)。
以下具体说明图1的关节170的机构组成。图5A是图1的下臂与法兰盘之间的关节的部分构件方块示意图。图5B是图1的下臂与法兰盘之间的关节的部分构件立体图。请参考图5A及图5B,关节170包括一等比伞齿轮机构,此等比伞齿轮机构包括两马达172、两第一等比伞齿轮174及一第二等比伞齿轮176。各马达172配置于图1所示的下臂130,且依序通过蜗杆172a、蜗轮172b、皮带轮172c、皮带172d、皮带轮172e而连接于对应的第一等比伞齿轮174,其中蜗杆172a、蜗轮172b、皮带轮172c、皮带172d、皮带轮172e及第一等比伞齿轮174构成一组减速机构,用以进行大减速比。为使图式较为清楚,图5B仅示出出一马达172及一组减速机构,关节170实际上包含对称的两组减速机构。
在本实施例中,皮带轮172c例如为十四齿,皮带轮172e例如为二十八齿。蜗轮172b同轴连接皮带轮172c,经由皮带172d传动给皮带轮172e及与之同轴的第一等比伞齿轮174,以驱动连接于两第一等比伞齿轮174的第二等比伞齿轮176,进而驱动连接于第二等比伞齿轮176的法兰盘140。法兰盘4可装配机械手使用。
图6示出图3A的第一等比伞齿轮及第二等比伞齿轮。两个所述第一等比伞齿轮154分别与所述第二等比伞齿轮156相啮合,并且两个所述第一等比伞齿轮154的中心线分别与第一轴A1的轴心线相重合,第二等比伞齿轮156的中心线与第二轴A2的轴心线相重合,所述第一轴A1的轴心线与所述第二轴A2的轴心线相空间垂直。在上述配置方式之下,可通过控制两第一等比伞齿轮154的转向为相同或相反来驱动第二等比伞齿轮156沿图6的第一轴A1转动或沿图6的第二轴A2转动,使机械手臂100的关节150如同人体手臂的关节般拥有两个自由度,而能够完成机械手臂100的所述第一、第二自由度的操作。类似地,可通过控制两第一等比伞齿轮164的转向为相同或相反来驱动第二等比伞齿轮166沿两不同轴转动,使机械手臂100的关节160如同人体手臂的关节般拥有两个自由度,而能够完成机械手臂100的所述第三、第四自由度的操作。类似地,可通过控制两第一等比伞齿轮174的转向为相同或相反来驱动第二等比伞齿轮176沿两不同轴转动,使机械手臂100的关节170如同人体手臂的关节般拥有两个自由度,而能够完成机械手臂100的所述第五、第六自由度的操作。
详细而言,以图6所示第一等比伞齿轮154及第二等比伞齿轮156为例,当两马达152(示出于图3A)分别驱动图6的右侧的第一等比伞齿轮154与图6的左侧的第一等比伞齿轮154沿第一轴A1同时正转,可使第二等比伞齿轮156绕第一轴A1正转。反之,当两马达152(示出于图3A)分别驱动图6的右侧的第一等比伞齿轮154与图6的左侧的第一等比伞齿轮154沿第一轴A1同时反转,可使第二等比伞齿轮156绕第一轴A1反转。另一方面,当一马达152(示出于图3A)驱动图6的右侧的第一等比伞齿轮154沿第一轴A1正转,而另一马达152(示出于图3A)驱动图6的左侧的第一等比伞齿轮154沿第一轴A1反转,可使第二等比伞齿轮156绕第二轴A2正转。反之,当一马达152(示出于图3A)驱动图6的右侧的第一等比伞齿轮154沿第一轴A1反转,而另一马达152(示出于图3A)驱动图6的左侧的第一等比伞齿轮154沿第一轴A1正转,可使第二等比伞齿轮156绕第二轴A2反转。本实施例的关节160的第一等比伞齿轮164、第二等比伞齿轮166以及关节170的第一等比伞齿轮174、第二等比伞齿轮176也藉此作动方式而皆具有两轴向的转动自由度。
为提高机械手臂100的安全系数,关节150如上述般采用等比伞齿轮机构并通过两个马达152来共同驱动,关节160如上述般采用等比伞齿轮机构并通过两个马达162来共同驱动,关节170如上述般采用等比伞齿轮机构并通过两个马达172来共同驱动,以具有高扭矩而提供良好的负重能力。
图7是本发明另一实施例的机械手臂的立体图。在图7的机械手臂200中,基座210、上臂220、下臂230、法兰盘240、关节250、260、270的配置与作用方式类似图1的基座110、上臂120、下臂130、法兰盘140、关节150、160、170的配置与作用方式,于此不在赘述。机械手臂200与机械手臂100的不同处在于,机械手臂200包括多个压力传感器280,压力传感器280配置于机械手臂200的外部。具体而言,压力传感器280例如是配置于机械手臂200的可活动的上臂220及下臂230的外壳上,而基座210因不活动,故可不配置压力传感器。当压力传感器280感测到机械手臂200的外部受外力时,机械手臂200可据以停止当前作动,以防止与外部物体撞击。此外,当压力传感器280感测到机械手臂200的外部持续受外力时,机械手臂200可据以沿外力的作用方向作动,让使用者可直接施力于机械手臂200而直接调整、变换机械手臂200的姿态。
图8是本发明另一实施例的机械手臂于关节处的部分构件立体图。图9示出图8的机械手臂碰撞障碍物。在图8及图9所示实施例的机械手臂300中,基座310、上臂320、下臂330、法兰盘340、关节350、360、370、马达352、蜗杆352a、蜗轮352b的配置与作用方式类似于图1及图3B的基座110、上臂120、下臂130、法兰盘140、关节150、160、170、马达152、蜗杆152a、蜗轮152b的配置与作用方式,于此不再赘述。图8、9所示实施例与图1、3B所示实施例的不同处在于,图8、9实施例的机械手臂300包括碰撞检测模块390,碰撞检测模块390例如包含六轴传感器(加速度计、陀螺仪或磁力计等)且配置于蜗轮352b。当马达352通过蜗杆352a而带动蜗轮352b且碰撞检测模块390检测来自蜗轮352b的加速度值不同于一预期值时,马达352据以停止作动。藉此,可监控关节加速度、转速的状况,利用轨迹规划代入机械手臂的运动学或动力学模型,由蜗杆352a处安装的碰撞检测模块390输出值,可以推算出减速机构输出轴应有的加速度与转速,或是推算出角加速度。当回授加速度值有不如预期的增加、减少,则***判定为碰撞、撞击、滑落等突发状况(如碰撞到图9所示的障碍物50,或是有人或动物非预期地靠近与接触机械手臂300造成阻挡),下命令马达352停止运动,此时利用动力传递方向无法由蜗轮352b传递给蜗杆352a的特性,在马达352停止动作后,蜗杆352a不会被蜗轮352b带动,故失去动力源的机械手臂300不会因外力作用而造成旋转、位移,如此无需加装剎车***,也可让机械手臂300完成停机,使机械手臂300自动锁定,故相较于前述国际专利编号WO2015131904A1所揭示的机器人需主动通过煞车装置来阻止机器人继续作动,本实施例的机械手臂300通过较为简单的设计方式达到自动锁定而停止作动的效果。此检测模块390可用于基座310与上臂320之间的关节350、上臂320与下臂330之间的关节360及下臂330与法兰盘340之间的关节370。
以下通过图式说明机械手臂的上述作动的具体流程。图10是图9的机械手臂的作动流程图。首先,机械手臂的***输入位置、速度、加速度命令(步骤S602)。接着,判断***命令是否动作(步骤S604)。若机械手臂在进行步骤S604时非符合所述命令的作动状态,则判断为***命令需作动并使马达动作(步骤S606),且六轴传感器读取输出轴动作(步骤S608)并回传值(步骤S610)。反之,若机械手臂在进行步骤S604时符合所述命令的作动状态,则判断为***命令不需作动并直接进行步骤S610。
然后,回传值与马达轴传感器和***命令比较(步骤S612),以判断是否发生碰撞(步骤S614)。若在进行步骤S614时判断为未发生碰撞,则判断是否完成命令(步骤S616)。若在进行步骤S616时判断为完成命令,则机械手臂完成动作(步骤S618)。若在进行步骤S616时判断为未完成命令,则回到步骤S606。此外,若在进行步骤S614时判断为发生碰撞,则输入停止命令(步骤S620)且马达停止动作(步骤S622),从而机械手臂停止动作(步骤S624)。
在一实施例中,在机械手臂各关节部分的马达输出轴安装一位置传感器、转速传感器、或电流传感器等至少其中之一,而减速机构输出轴加装一运动传感器(加速度计、陀螺仪、磁力计等),可监控各关节加速度、转速的状况,利用轨迹规划代入机械臂的动力学模型,由马达输出轴安装的传感器输出值,可以推算出减速机构输出轴应有的加速度与转速,或是推算出角加速度。若有不如预期的增加、减少,则判定为阻挡、碰撞、撞击、滑落等突发状况,如碰撞到障碍物,或是有人或动物非预期地靠近与接触机械手臂造成阻挡,马达立即停止运动,并利用蜗杆与蜗轮组动力传递方向不可逆的特性,机械手臂无须外加剎车,即可完成停机的动作。
在一实施例中,在机械手臂各关节部分的马达输出轴安装一位置传感器、转速传感器、或电流传感器等至少其中之一,而减速机构输出轴加装一应变计、荷重计等,可监控各关节受力的状况,利用轨迹规划代入机械臂的动力学模型,由马达输出轴安装的传感器输出值,可以推算出减速机构输出轴应有的受力,或是马达应有的驱动电流。若有不如预期的增加、减少,则判定为阻挡、碰撞、撞击、滑落等突发状况,如碰撞到障碍物,或是有人或动物非预期地靠近与接触机械手臂造成阻挡,马达立即停止运动,并利用蜗杆与蜗轮组动力传递方向不可逆的特性,机械手臂无须外加剎车,即可完成停机的动作。
在一实施例中,在机械手臂各关节部分的马达输出轴安装一位置传感器、转速传感器、或电流传感器等至少其中之一,而减速机构输出轴加装一运动传感器(加速度计、陀螺仪、磁力计等),可监控各关节的减速机构的实际加速度、实际转速的状况。位置传感器则可感测马达的输出以推算出减速机构的预期加速度值与预期转速值,并利用轨迹规划代入机械臂的动力学模型推算出减速机构输出轴应有的预期加速度与预期转速,或是推算出减速机构输出轴应有的角加速度,或是推算出马达应有的驱动电流。当减速机构的实际加速度值及实际转速值不同于减速机构的预期加速度值与预期转速值时,即有不如预期的增加、减少,则判定为阻挡、碰撞、撞击、滑落等突发状况,如碰撞到障碍物,或是有人或动物非预期地靠近与接触机械手臂造成阻挡,可以通过减速机构输出轴加装的各种传感器产生的量测值推断所受到的阻力或障碍物是否解除。若未解除,可通过代入机械臂的动力学模型推算阻力或障碍的作用处,并由作用处推算各关节的马达控制,来降低阻力或障碍的作用,直到消除为止。也即,依据减速机构的实际加速度值及实际转速值调整马达的输出,直到减速机构的实际加速度值及实际转速值相同于或接近于减速机构的预期加速度值与预期转速值。
综上所述,在本发明的机械手臂的各关节中,两马达分别驱动两第一等比伞齿轮转动,以利用两第一等比伞齿轮共同驱动第二等比伞齿轮转动。据此,可通过控制两第一等比伞齿轮的转向为相同或相反来驱动第二等比伞齿轮沿一第一轴转动或沿一第二轴转动,使机械手臂的每一关节如同人体手臂的关节般拥有两个自由度,而可成为具有高灵活度及高工作空间的仿人居家照护型机械手臂。此外,由于机械手臂的每一关节是通过两个马达来共同驱动,故具有高扭矩以提供良好的负重能力。
虽然本发明已以实施例揭示如上,然其并非用以限定本发明,任何所属技术领域中技术人员,在不脱离本发明的精神和范围内,当可作些许的更动与润饰,故本发明的保护范围当视权利要求所界定者为准。
Claims (9)
1.一种机械手臂,包括:
基座、上臂及下臂;以及
多个关节,所述关节连接于所述基座与所述上臂之间,另一所述关节连接于所述上臂与所述下臂之间,又一所述关节连接于所述下臂的末端,
其特征在于:各所述关节包括等比伞齿轮机构,各所述等比伞齿轮机构包括两马达、两第一等比伞齿轮及第二等比伞齿轮,所述两马达分别连接所述两第一等比伞齿轮,所述两第一等比伞齿轮皆连接于所述第二等比伞齿轮,所述两马达适于通过所述两第一等比伞齿轮而驱动所述第二等比伞齿轮沿第一轴转动或沿第二轴转动,以提供各所述关节两个转动自由度。
2.根据权利要求1所述的机械手臂,其特征在于:当所述两马达分别驱动所述两第一等比伞齿轮沿第一轴正转时,所述两第一等比伞齿轮驱动所述第二等比伞齿轮沿所述第一轴正转,当所述两马达分别驱动所述两第一等比伞齿轮沿所述第一轴反转时,所述两第一等比伞齿轮驱动所述第二等比伞齿轮沿所述第一轴反转。
3.根据权利要求1所述的机械手臂,其特征在于:当所述马达驱动对应的所述第一等比伞齿轮沿第一轴正转且另一所述马达驱动对应的所述第一等比伞齿轮沿所述第一轴反转时,所述两第一等比伞齿轮驱动所述第二等比伞齿轮沿第二轴正转或反转。
4.根据权利要求1所述的机械手臂,其特征在于:包括至少一压力传感器,所述压力传感器配置于机械手臂的外部,当所述压力传感器感测到所述机械手臂的外部受外力时,所述机械手臂适于停止作动,当所述压力传感器感测到所述机械手臂的外部持续受所述外力时,所述机械手臂适于沿所述外力的作用方向作动。
5.根据权利要求1所述的机械手臂,其特征在于:各所述关节包括至少一蜗杆、至少一蜗轮及至少一碰撞检测模块,所述蜗杆连接于所述马达与所述蜗轮之间,所述蜗轮连接于所述蜗杆与对应的所述第一伞齿轮之间,所述碰撞检测模块配置于所述蜗轮,当所述碰撞检测模块检测来自所述蜗轮的加速度值不同于预期值时,各所述马达停止作动。
6.根据权利要求5所述的机械手臂,其特征在于:所述马达适于通过所述蜗杆而带动所述蜗轮,且当所述马达停止作动且所述蜗轮受力时,所述蜗杆不被所述蜗轮带动以使所述机械手臂自动锁定。
7.根据权利要求1所述的机械手臂,其特征在于:各所述关节包括位置传感器、运动传感器及减速机构,所述减速机构连接于对应的所述马达,所述位置传感器配置于对应的所述马达,所述运动传感器配置于所述减速机构且适于监控所述减速机构的实际加速度及实际转速,所述位置传感器适于感测所述马达的输出以推算出所述减速机构的预期加速度值与预期转速值,当所述减速机构的实际加速度值及实际转速值不同于所述减速机构的预期加速度值与预期转速值时,依据所述减速机构的实际加速度值及实际转速值调整所述马达的输出,直到所述减速机构的实际加速度值及实际转速值相同于所述减速机构的预期加速度值与预期转速值。
8.根据权利要求7所述的机械手臂,其特征在于:所述运动传感器包括加速度计、陀螺仪或磁力计。
9.根据权利要求1所述的机械手臂,其特征在于:两个所述第一等比伞齿轮分别与所述第二等比伞齿轮相啮合,并且两个所述第一等比伞齿轮的中心线分别与第一轴的轴心线相重合,第二等比伞齿轮的中心线与第二轴的轴心线相重合,所述第一轴的轴心线与所述第二轴的轴心线相空间垂直。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
TW105127448A TWI605919B (zh) | 2016-08-26 | 2016-08-26 | 機械手臂 |
TW105127448 | 2016-08-26 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107775633A true CN107775633A (zh) | 2018-03-09 |
Family
ID=61023294
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710734205.6A Pending CN107775633A (zh) | 2016-08-26 | 2017-08-24 | 高灵活度仿人机械手臂 |
CN201721065488.1U Active CN207593798U (zh) | 2016-08-26 | 2017-08-24 | 高灵活度仿人机械手臂 |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201721065488.1U Active CN207593798U (zh) | 2016-08-26 | 2017-08-24 | 高灵活度仿人机械手臂 |
Country Status (2)
Country | Link |
---|---|
CN (2) | CN107775633A (zh) |
TW (1) | TWI605919B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI605919B (zh) * | 2016-08-26 | 2017-11-21 | 黃榮堂 | 機械手臂 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101602208A (zh) * | 2008-06-11 | 2009-12-16 | 松下电器产业株式会社 | 机械手、机械手的碰撞检测方法以及机械手的控制方法 |
CN102615551A (zh) * | 2011-01-31 | 2012-08-01 | 德克尔马霍普夫龙滕有限公司 | 一种设有碰撞监测装置的机床 |
TWM461525U (zh) * | 2013-04-29 | 2013-09-11 | Univ Lunghwa Sci & Technology | 仿人機械手臂之驅動裝置 |
TW201347934A (zh) * | 2012-05-16 | 2013-12-01 | Jung-Tang Huang | 機械手臂 |
CN105471329A (zh) * | 2015-12-30 | 2016-04-06 | 南京航空航天大学 | 交流同步电机***转矩冲量平衡控制方法 |
CN205459532U (zh) * | 2016-02-01 | 2016-08-17 | 浙江捷昌线性驱动科技股份有限公司 | 一种移位机的升降装置及移位机 |
CN207593798U (zh) * | 2016-08-26 | 2018-07-10 | 冠亿精密工业(昆山)有限公司 | 高灵活度仿人机械手臂 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8606398B2 (en) * | 2008-08-29 | 2013-12-10 | Abb Research Ltd. | Compliant end of arm tooling for a robot |
-
2016
- 2016-08-26 TW TW105127448A patent/TWI605919B/zh not_active IP Right Cessation
-
2017
- 2017-08-24 CN CN201710734205.6A patent/CN107775633A/zh active Pending
- 2017-08-24 CN CN201721065488.1U patent/CN207593798U/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101602208A (zh) * | 2008-06-11 | 2009-12-16 | 松下电器产业株式会社 | 机械手、机械手的碰撞检测方法以及机械手的控制方法 |
CN102615551A (zh) * | 2011-01-31 | 2012-08-01 | 德克尔马霍普夫龙滕有限公司 | 一种设有碰撞监测装置的机床 |
TW201347934A (zh) * | 2012-05-16 | 2013-12-01 | Jung-Tang Huang | 機械手臂 |
TWM461525U (zh) * | 2013-04-29 | 2013-09-11 | Univ Lunghwa Sci & Technology | 仿人機械手臂之驅動裝置 |
CN105471329A (zh) * | 2015-12-30 | 2016-04-06 | 南京航空航天大学 | 交流同步电机***转矩冲量平衡控制方法 |
CN205459532U (zh) * | 2016-02-01 | 2016-08-17 | 浙江捷昌线性驱动科技股份有限公司 | 一种移位机的升降装置及移位机 |
CN207593798U (zh) * | 2016-08-26 | 2018-07-10 | 冠亿精密工业(昆山)有限公司 | 高灵活度仿人机械手臂 |
Also Published As
Publication number | Publication date |
---|---|
TW201806716A (zh) | 2018-03-01 |
CN207593798U (zh) | 2018-07-10 |
TWI605919B (zh) | 2017-11-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Asfour et al. | ARMAR-III: An integrated humanoid platform for sensory-motor control | |
CN205704267U (zh) | 一混联式6自由度力反馈机械臂 | |
Gonzalez-Rodriguez et al. | On the effects of the design of cable-Driven robots on kinematics and dynamics models accuracy | |
CN104786219B (zh) | 360度多自由度仿人气动肌肉机械手 | |
JP2016147351A (ja) | リンク作動装置を用いた多関節ロボット | |
CN103387016A (zh) | 半球差动可伸缩式球形机器人 | |
CN207593798U (zh) | 高灵活度仿人机械手臂 | |
JPS63219490A (ja) | 自律型配管メンテナンスロボツト | |
Soares et al. | A Multi-purpose Rescue Vehicle and a human–robot interface architecture for remote assistance in ITER | |
Lee | Design of a humanoid robot for disaster response | |
CN111360788B (zh) | 七自由度串并混联防死点机械臂 | |
Barua et al. | Motion analysis of a mobile robot with three omni-directional wheels | |
Bruzzone et al. | Whetlhloc: Small-scale hybrid locomotion robot with stair climbing capability | |
Graf et al. | Entertainment robotics: Examples, key technologies and perspectives | |
Gomathy et al. | The gesture controlled robot | |
CN107538471A (zh) | 机器人、机器人控制装置及机器人*** | |
TWI309597B (zh) | ||
Khang et al. | Application of Industrial Robotics in Manufacturing | |
McDonald | Active research topics in human machine interfaces | |
Qian | Design and control of a personal assistant robot | |
JPH0938877A (ja) | ダイレクトティーチング制御装置 | |
Ni et al. | Design of an upper-body humanoid robot platform | |
Liu et al. | Wireless Control of Six-axis Robot Arms by Leap Motion Sensor. | |
Paula | Cobots for the assembly line | |
Achuthan et al. | Design, Development and Testing of an Omnidirectional ISI Device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |