手指机构、机器人手和机器人手控制方法与流程

文档序号:17828860发布日期:2019-06-05 22:52阅读:323来源:国知局
手指机构、机器人手和机器人手控制方法与流程

本申请涉及手指机构、机器人手和机器人手控制方法。



背景技术:

近年来,已经提出了模仿人手抓握物体以对其执行一些工作的功能的机器人手以及具有机器人手的工业机器人(参见日本专利申请公开no.2008-32140,no.2011-245575,no.2015-221469,no.2011-67936和no.2004-42214)。

但是,常规的机器人手和具有机器人手的工业机器人被构造成在抓握物体时或在释放被抓握的物体时打开指尖,这使得难以在包装盒内存储彼此紧密接触的多个物体。



技术实现要素:

本申请是鉴于这种情况而提出的,其目的在于供给一种能够在包装盒内存储彼此紧密接触的多个物体的手指机构、机器人手和机器人手控制方法。

根据一个方面,手指机构包括基部和由基部支撑的多个手指部分,其中每个手指部分包括第一骨构件、可旋转地连接到第一骨构件的一个端部的第二骨构件,以及成对的第三骨构件,所述成对的第三骨构件中的每个骨构件可旋转地连接到第一骨构件的另一个端部和基部,并且成对的第三骨构件在第一骨构件和基部之间形成平行连杆机构。

根据一个方面,机器人手包括如上所述的手指机构、设置在供应路径的中途,以将压缩空气供应到包括在手指机构中的mckibben气动致动器的加压电磁阀和减压电磁阀、以及控制加压电磁阀和减压电磁阀的打开和关闭的控制单元,其中控制单元控制加压电磁阀和减压电磁阀的打开和关闭,并通过调节气动致动器中的气压来控制包括在手指机构中的伸肌和屈肌的收缩程度。

根据一个方面,一种机器人手控制方法,其中所述机器人手包括:如上所述的手指机构、设置在供应路径的中途,以将压缩空气供应到构成手指机构的伸肌和屈肌的mckibben气动致动器的加压电磁阀和减压电磁阀、以及控制加压电磁阀和减压电磁阀的打开和关闭并且控制伸肌和屈肌的收缩程度的控制单元,所述方法包括执行加压电磁阀和减压电磁阀的打开和关闭的控制,以便由控制单元执行以下操作中的至少一个,其中所述操作包括:在抓握物体的操作之前,使包括在手指机构中的伸肌腱和屈肌腱的彼此牵引力拮抗的固定操作、根据物体的形状抓握物体的自适应抓握操作、保持抓握状态的保持操作、释放保持操作的自适应释放操作、以及松弛伸肌和屈肌的松弛操作。

根据本申请,可以在包装盒内存储彼此紧密接触的多个物体。

从以下结合附图的详细描述中,本发明的上述和其它目的和特征将更加明显。

附图说明

图1是图示根据实施例1的机器人手的示意性结构的外视图;

图2是手指机构部分的外视图;

图3是肌腱的横截面图;

图4是图示在抓握物体之前手指的状态的示意性说明图;

图5是图示当抓握物体时手指的状态的示意性说明图;

图6是图示当释放物体时手指的状态的示意性说明图;

图7是根据实施例1的机器人手系统的总体结构的框图;

图8是图示机器人手的控制系统的结构的框图;

图9是图示手指机构部分中的牵引力传递机构的说明图;

图10是图示电磁阀i至iv的控制状态的说明图;

图11是描绘根据实施例1的机器人手的控制方法的流程图;

图12是描绘根据实施例2的机器人手的控制过程的流程图;

图13是描绘围合形成的控制过程的流程图;

图14是描绘抓握操作的控制过程的流程图;

图15a至15d是图示存储状态的说明图;

图16a和16b是图示其中物体被向下移动并存储的状态的示意图;

图17a和17b是图示其中物体被滚动存储装置存储的状态的示意图;

图18是图示滚动存储装置的说明图;

图19是描绘根据实施例3的机器人手的控制过程的流程图;

图20是描绘待由cpu读取的参数的一个示例的概念图;

图21是描绘滚动运动的操作过程的流程图;以及

图22是图示存储顺序的说明图。

具体实施方式

下面将参考描绘实施例的附图具体描述本发明。

(实施例1)

图1是图示根据实施例1的机器人手1000的示意性结构的外视图。根据本实施例的机器人手1000设置有手指机构部分100、前臂骨200、肌腱300、人造肌肉400、法兰500和510、电磁阀600和控制板700。根据本实施例,手指机构部分100包括两个手指(第一手指101和第二手指102)。第一手指101和第二手指102各自被构造成使得根据肌腱300的张力而伸展或屈曲,肌腱300受控制从而通过人造肌肉400膨胀和收缩。本实施例的特征是通过对两种类型的肌腱300(参见后面将要描述的伸肌腱300a和屈肌腱300b,参见图2)执行拮抗性控制,关节角度和力被自主控制以实现对抓握形式、保持力、手指关节的灵活性等的控制(顺应性控制)。如果在以下描述中不需要识别第一手指101和第二手指102,则它们仅被描述为手指101和102。

人造肌肉400被布置在前臂骨200周围。前臂骨200对应于人类前臂骨,并且是对应于从腕关节到臂关节的部分的构件。前臂骨200在其近端处设置有法兰500,并且在其远端处设置有法兰510。人造肌肉400是例如mckibben气动致动器,并且从待由电磁阀600的打开和关闭操作进行控制的歧管650供应空气,以便控制收缩的程度。即,如果空气被供应到人造肌肉400的内部(加压控制),则人造肌肉400通过在其宽度方向上膨胀并在其长度方向上屈曲而收缩。相反,如果空气从人造肌肉400的内部释放(减压控制),则人造肌肉400通过在其宽度方向上屈曲并在其长度方向上伸展而松弛。

电磁阀600由安装在控制板700上的cpu701(参见图8)控制。除了cpu701之外,控制板700可以安装有用于与cpu701进行通信的各种接口的输入侧连接器和输出侧连接器、驱动电磁阀600的线圈的线圈驱动器,以及处理各种信号、电压和电流的诸如运算放大器、比较器、晶体管、二极管、电阻器等的各种类型的电子器件。

人造肌肉400包括连接到肌腱300的其远侧端部,并且包括连接到万向关节502的其近侧端部。万向关节502被构造成在肋501内自由滑动,肋501设置在法兰500的划界区域处。连接到人造肌肉400的肌腱300通过人造肌肉400收缩而伸展并通过人造肌肉400松弛而缩短。

虽然在本实施例中采用mckibben气动致动器用于人造肌肉400,但是可以采用其中通过使用马达和滑轮代替气动致动器来卷起肌腱300的方法。此外,可以采用以下方法等:其中通过使用线性马达使肌腱300直接伸展和屈曲的方法;以及其中通过使用生物金属来伸展和屈曲肌腱300的方法,所述生物金属是通过电流流动而伸展和屈曲的纤维状致动器。

图2是手指机构部分100的外视图。根据本实施例的手指机构部分100设置有两个手指,包括第一手指(例如,大拇指或拇指)101和第二手指(例如,食指)102。手指101和102中的每一个从其近侧起设置有掌骨meb、两个近节指骨pp1和pp2、中节指骨mip以及远节指骨dp。这些骨构件中的每一个例如由丙烯腈-丁二烯-苯乙烯(abs)共聚物树脂制成。

掌骨meb被固定到前臂骨200的远侧端部。近节指骨pp1被放置在近节指骨pp2的近侧,并且包括可旋转地连接到掌骨meb的一端以及可旋转地连接到中节指骨mip的另一端。放置在掌骨meb侧的近节指骨pp1的旋转核心构成掌指关节mp1。掌指关节mp1包括弯曲表面部分,其横截面形状为部分圆形或椭圆形,并且例如与近节指骨pp1一体形成。放置在中节指骨mip侧的近节指骨pp1的旋转核心构成近端指间关节pip1。近端指间关节pip1包括弯曲表面部分,其横截面形状为部分圆形或椭圆形,并且例如与近节指骨pp1一体形成。

近节指骨pp2被放置在近节指骨pp1的远侧,并且包括可旋转地连接到掌骨meb的一端以及可旋转地连接到中节指骨mip的另一端。放置在掌骨meb侧的近节指骨pp2的旋转核心构成掌指关节mp2。掌指关节mp2包括弯曲表面部分,其横截面形状为部分圆形或椭圆形,并且例如与近节指骨pp2一体形成。放置在中节指骨mip侧的近节指骨pp2的旋转核心构成近端指间关节pip2。近端指间关节pip2包括弯曲表面部分,其横截面形状部分为圆形或椭圆形,并且例如与近节指骨pp2一体形成。

两个近节指骨pp1和pp2包括基本上相同长度并且在掌骨meb和中节指骨mip之间形成平行连杆机构。因此,在其中近节指骨pp1和pp2相对于掌骨meb向近侧旋转的情况下,中节指骨mip朝近侧和外侧(朝手的背侧)移位而不改变其姿势。在其中近节指骨pp1和pp2相对于掌骨meb朝远侧旋转的情况下,中节指骨mip朝远侧和内侧(朝手的掌侧)移位而不改变其姿势。

远节指骨dp是在长度方向上比中节指骨mip短的骨构件,并且可旋转地连接到中节指骨mip的远侧端部。远节指骨dp的旋转核心构成远端指间关节dip。远端指间关节dip包括弯曲表面部分,其横截面形状为部分圆形或椭圆形,并且例如与中节指骨mip一体形成。

手指101和102中的每一个设置有两个肌腱300和300。两个肌腱300和300中的一个是伸肌腱300a。从作为人造肌肉400之一的伸肌400a延伸的伸肌腱300a由设置在穿过法兰510的通孔内部的肌腱引导件g11引导以延伸到近节指骨pp1,进一步由位于近节指骨ppi的中间的肌腱引导件g12和由设置在中节指骨mip的近侧端部处的肌腱引导件g13引导,以便被放置在中节指骨的外侧(朝手的背侧),并且还沿着中节指骨mip的长度方向延伸到远节指骨dp,同时保持与近端指间关节pip1和pip2以及远端指间关节dip的弯曲表面部分中的每一个接触。

伸肌腱300a的远侧端部被固定在设置在远节指骨dp处的固定端g0处。担心其中伸肌腱300a和远节指骨dp被固定的固定部分可能受到拉伸应力,使得其机械强度可能劣化。为了消除机械强度的劣化,也可以采用这样的构造,即,它们没有被完全固定,而是例如通过系在远节指骨dp的一部分上来附接屈肌腱300a,使得应力被降低。

两个肌腱300和300中的另一个是屈肌腱300。从作为人造肌肉400之一的屈肌400b延伸的屈肌腱300b由设置在穿过法兰510的另一个通孔内部的肌腱引导件g21和由设置在掌骨meb处的肌腱引导件g22引导,以便延伸到近节指骨pp2同时保持与掌指关节mp1和mp2的弯曲表面部分接触,进一步由在近节指骨pp2的中间的肌腱引导件g23和由设置在中节指骨mip处的两个肌腱引导件g24和g25引导,以便被放置在中节指骨mip的内侧(朝手的掌侧),并且沿着中节指骨mip的长度方向延伸到远节指骨dp,同时保持与近端指间关节pip2和远端指间关节dip中的每一个的弯曲表面部分接触。

屈肌腱300b的远侧端部被固定在设置在远节指骨dp处的固定端g0处。担心其中屈肌腱300b和远节指骨dp被固定的固定部分可能受到拉伸应力,使得其机械强度可能劣化。为了消除机械强度的劣化,也可以采用这样的构造,即,它们没有被完全固定,而是例如通过系在远节指骨dp的一部分上来附接屈肌腱300b,使得应力被降低。

注意的是,根据本实施例的手指机构部分100被构造成具有包括第一手指(例如,大拇指或拇指)101和第二手指(例如,食指)102的两个手指,同时它可以被构造成具有三个或更多个手指,包括第三手指(例如,中指)、第四手指(例如,无名指或药用手指)和第五手指(例如,小指)中的至少一个。根据本实施例的手指机构部分100被构造成具有与第一手指101或第二手指102对应的相同的两个或更多个手指。

此外,远节指骨dp和中节指骨mip中的至少一个可以设置有力传感器160,该力传感器160在待被抓握的物体obj被保持在与物体接触的一部分(即,手的掌侧)中时检测保持力(参见图8)。此外,每个关节部分可以设置有角度传感器170,该角度传感器170检测由彼此相互连接的构件形成的角度(关节角度)(参见图8)。这些力传感器160和角度传感器170不是根据本发明的手指机构部分100中的必要部件。但是,在其中先前已知物体(obj)的形状和硬度的情况下,附接这些传感器使得能够自动控制每个手指的操作范围。

图3是肌腱300的横截面图。肌腱300包括由通过人造肌肉400的牵引力弹性变形的核心部分310和保护核心部分310的护套部分320形成的复合结构。对于核心部分310,使用了其杨氏模量的范围例如为从0.5gpa至2gpa的合成树脂纤维,诸如尼龙、聚乙烯等。

护套部分320可以由与核心部分310相同的材料制成。其中诸如乙烯基的树脂合成物被编织成圆柱形形状的护套部分320可以以比核心部分310更小的力延伸。护套部分320的功能是防止核心部分310与诸如关节mp1、mp2、pip1、pip2和dip、肌腱引导件g11至g13和g21至g25等构件接触,并避免由于摩擦等引起的牵引力损失和与核心部分310的磨损。

肌腱300通过人造肌肉400的牵引力伸展,以生成与伸展量对应的内部张力fi。抵抗牵引力的内部张力fi由a×e×ε给出,其使用肌腱300的横截面积a、肌腱300的形变ε和肌腱300的杨氏模量e。这里,使用肌腱300的自由长度l0和肌腱300的伸展量δl,肌腱300的形变ε由ε=δl/l0给出。核心部分310将内部张力fi转换为作用于肌腱拮抗关节的力。作为类似术语肌腱拮抗关节的术语,已知所谓的拮抗肌腱驱动。可以说这些术语基本上相同之处在于,两个肌腱(伸肌腱和屈肌腱)被制成彼此拮抗。但是,肌腱拮抗关节的不同之处在于,重要性放置在适于执行拮抗肌腱驱动的关节的结构。换句话说,也可以说根据本实施例的肌腱拮抗关节是具有合适结构的关节,其中关节的旋转程度可以由彼此拮抗的肌腱唯一地确定。

以下描述手指101和102中的每一个的操作状态。

图4是图示在抓握物体obj之前手指101和102的状态的示意性说明图。在本实施例中,在抓握物体obj之前将伸肌400a控制为加压状态。此时,伸肌400a通过在宽度方向上膨胀并且在长度方向上屈曲来拉动伸肌腱300a。通过伸肌腱300a的牵引力,指尖的远节指骨dp相对于中节指骨mip伸展,并且手指101和102中的每一个的近节指骨pp1和pp2一起朝近侧旋转。根据近节指骨pp1和pp2的旋转,手指101和102的中节指骨mip朝近侧和外侧(朝手的背侧)移位。因此,两个手指101和102的中节指骨mip和mip被拉向手腕侧,同时保持基本上平行的关系,并且中节指骨mip和mip之间的空间同时被扩大。

图5是图示当抓握物体obj时手指101和102的状态的示意性说明图。根据本实施例,当抓握物体obj时,屈肌400b被控制为加压状态。此时,屈肌400b通过在宽度方向上膨胀并且在长度方向上屈曲来拉动屈肌腱300b。通过屈肌腱300b的牵引力,指尖的远节指骨dp相对于中节指骨mip屈曲,并且手指101和102中的每一个的近节指骨pp1和pp2一起朝远侧旋转。根据近节指骨pp1和pp2的旋转,手指101和102的中节指骨mip朝远侧和内侧(朝手的掌侧)移位。因此,两个手指101和102的中节指骨mip和mip被送出到指尖侧,同时保持基本上平行的关系,并且中节指骨mip和mip之间的空间同时被缩短。通过这样的操作,可以用手指101和102抓握物体obj。

图6是图示当释放物体obj时手指101和102的状态的示意性说明图。当释放被抓握的物体obj时,伸肌400a和屈肌400b被控制为减压状态以被松弛。此时,伸肌腱300a和屈肌腱300b的张力减小,使得指尖的远节指骨dp和dp可以伸展,同时保持所维持的两个手指101和102的中节指骨mip和mip之间的空间。机器人手1000在这种状态下被抬起,这使得可以在不打开指尖的情况下拉出手指。

图7是图示根据实施例1的机器人手系统的总体结构的框图。根据实施例1的机器人手系统包括上述机器人手1000、安装有机器人手1000的机器人rob、向机器人rob提供各种指令的控制器con,以及对包括物体obj的周围环境进行成像的成像设备cam。

作为所谓的计算机设备的控制器con包括接受各种信息的输入接口、基于经由输入接口接受的信息执行各种类型的算术处理和信息处理的处理电路、将由处理电路生成的信息输出到外部的输出接口(未图示),等等。控制器con接受例如p&p条件(拾取和放置条件)的输入,该条件是用于拾取和放置物体obj的控制条件。p&p条件可以由操作或管理机器人手1000的用户根据物体obj适当地设置。物体obj可以是任何物体。例如,它可以是柔软物体,诸如水果/蔬菜,诸如桃子或番茄,或者食物,诸如炸肉饼或炸鸡块。此外,它可以是具有不定形状的物体,诸如沙拉或即食菜肴。此外,物体obj可以是比较小的物体,诸如玩具。p&p条件可以包括例如诸如物体obj的重量、形状、柔软度、颜色、光泽等条件。

机器人rob,例如n-jiku(申请人的注册商标)被连接到控制器con并且被安装有机器人手1000。包括上述p&p条件的各种条件通过控制器con被输入到机器人rob。机器人rob基于通过控制器con输入的各种条件,根据物体obj(诸如关节角度和抓握力)向机器人手1000提供各种数据和各种操作指令。

当接受关于抓握物体obj的操作指令时,机器人手1000键入抓握物体obj的操作。在抓握操作中,可能需要关于放置物体obj的地方的周围环境的信息。控制器con能够例如通过从成像设备cam获得放置物体obj的周围环境的成像数据并分析所获得的成像数据来获得关于放置物体obj的地方的周围环境的信息。此外,控制器con可以通过分析从成像设备cam获得的成像数据来获得关于物体obj的三维信息,以确定抓握位置、抓握姿势等。控制器con基于与物体obj的周围环境相关的信息和通过分析输入的p&p条件和成像数据而获得的三维信息提供符合物体obj的操作指令。机器人手1000基于从控制器con供应的操作指令对手指机构部分100处的关节角度和力进行自主控制,从而实现对抓握形式、保持力、手指关节的灵活性等的控制(顺应性控制)。

注意的是,在其中可以预先将与物体obj的周围环境相关的信息提供给控制器con的情况下,这消除了对从成像设备cam发送成像数据的需要。因此,成像设备cam不需要被包括在机器人手系统中。

图8是图示机器人手1000的控制系统的结构的框图。图8图示了手指机构部分100的关节、人造肌肉400和肌腱300与构成机器人手1000的电磁阀610和620之间的连接。

第一手指101包括远节指骨dp、中节指骨mip、近节指骨pp1和pp2以及掌骨meb。远节指骨dp和中节指骨mip各自附接有力传感器160。力传感器160检测第一手指101提供给物体obj的接触力。如从上面给出的描述中显而易见,骨构件经由远端指间关节dip、近端指间关节pip1和pip2以及掌指关节mp1和mp2可旋转地连接在一起。远端指间关节dip和掌指关节mp1各自附接有角度传感器170。角度传感器170检测关节角度(即,骨之间的相对倾斜角度),并将其输出到cpu701。

通过向安装在机器人手1000的控制板700上的cpu701提供各种操作指令来执行对第一手指101的基本控制。例如,操作指令可以由图7中所示的控制器con提供。

例如,当经由诸如控制器con等的外部输入装置输入用于抓握物体obj的抓握指令时,cpu701将伸展和屈曲手指101的控制信号发送到电磁阀610和620。已接收到控制信号的电磁阀610和620执行供应和排气控制,使得人造肌肉400伸展和屈曲。供应和排气控制具体而言是用于向人造肌肉400的内部供应空气的加压控制或用于从其排出空气的减压控制。

通过人造肌肉400的伸展和收缩,引起拉动伸肌腱300a和屈肌腱300b的牵引力,由此在伸肌腱300a和屈肌腱300b中的每一个上发生张力。张力成为旋转每个关节的力矩。即,在伸肌腱300a和屈肌腱300b中的每一个上作用的张力充当使远端指间关节dip、近端指间关节pip1和pip2以及掌指关节mp1和mp2旋转的力矩。

第二手指102的结构与第一手指101的结构相同。即,第二手指102包括远节指骨dp、中节指骨mip、近节指骨pp1和pp2以及掌骨meb。远节指骨dp和中节指骨mip各自附接有力传感器160。力传感器160检测第二手指102提供给物体obj的接触力。如从上面给出的描述中显而易见,骨构件经由远端指间关节dip、近端指间关节pip1和pip2以及掌指关节mp1和mp2可旋转地连接在一起。远端指间关节dip和掌指关节mp1各自附接有角度传感器170。角度传感器170检测关节角度(即,骨之间的相对倾斜角度),并将其输出到cpu701。

通过向安装在机器人手1000的控制板700上的cpu701提供各种操作指令来执行对第二指102的基本控制。例如,操作指令可以由图7中所示的控制器con提供。

例如,当经由诸如控制器con等的外部输入装置输入用于抓握物体obj的抓握指令时,cpu701将伸展和屈曲手指102的控制信号发送到电磁阀610和620。已接收到控制信号的电磁阀610和620执行供应和排气控制,使得人造肌肉400伸展和屈曲。供应和排气控制具体而言是用于向人造肌肉400的内部供应空气的加压控制或用于从其排出空气的减压控制。

通过人造肌肉400的伸展和收缩,引起拉动伸肌腱300a和屈肌腱300b的牵引力,由此在伸肌腱300a和屈肌腱300b中的每一个上发生张力。张力成为旋转每个关节的力矩。即,在伸肌腱300a和屈肌腱300b中的每一个上作用的张力充当使远端指间关节dip、近端指间关节pip1和pip2以及掌指关节mp1和mp2旋转的力矩。

附接到第一手指101和第二手指102的力传感器160将关于接触力的传感器值输出到cpu701。此外,附接到第一手指101和第二手指102的关节的角度传感器170将关于关节的关节角度的传感器值输出到cpu701。这些传感器值可以经由控制板700输出到控制器con。机器人手1000的用户可以基于来自力传感器160和角度传感器170的传感器值确定是否维持、改变或修改p&p条件的当前状态。

上述机器人手1000和手指机构部分100的操作和控制是反馈抓握力和关节角度,并根据物体obj的尺寸、形状、柔软度等连续调节和控制控制条件。这是机器人手的顺应性控制。

图9是图示手指机构部分100中的牵引力传递机构的说明图。图9图示了手指机构部分100的关节、人造肌肉、肌腱和电磁阀之间的连接,并且描绘了其中第一手指101和第二手指102位于物体obj附近的状态。

第一手指101和第二手指102各自包括远端指间关节dip、近端指间关节pip1和pip2以及掌指关节mp1和mp2。在每个关节的弯曲表面部分(弧形部分)上,伸肌腱300a和屈肌腱300b悬停,并且从近侧向远侧延伸。伸肌腱300a和屈肌腱300b的一端分别连接到伸肌400a和屈肌400b的一端,并且伸肌400a和屈肌400b的另一端连接到供气嘴/吸气嘴410的一端。供气嘴/吸气嘴410的另一端连接到电磁阀610和620。

现在,将通过使用驱动第一手指的电磁阀610和620作为示例描述其操作的共享、工作等。电磁阀610由电磁阀i和电磁阀ii的两个阀组成。电磁阀i用于对伸肌400a加压,从而使伸肌400a在宽度方向上膨胀。当伸肌400a在宽度方向上膨胀时,伸肌腱300a在伸肌器400a的长度方向上被拉动。提供这种工作的电磁阀i的阀功能在本申请的说明书中被称为“伸肌加压”。

电磁阀ii用于使伸肌400a减压,从而使伸肌400a在宽度方向上屈曲并使其在长度方向上膨胀。当伸肌400a在长度方向上伸展时,伸肌腱300a朝近端指间关节pip1移动。提供这种工作的电磁阀ii的阀功能在本申请的说明书中被称为“伸肌减压”。

电磁阀iii用于对屈肌400b加压以使屈肌400b在宽度方向上膨胀。当屈肌400b在宽度方向上膨胀时,屈肌腱300b在屈肌400b的长度方向上被拉动。提供这种工作的电磁阀iii的阀功能在本申请的说明书中被称为“屈肌加压”。

电磁阀iv用于使屈肌400b减压,从而使屈肌400b在宽度方向上屈曲并在长度方向上伸展。当屈肌400b的纵向方向在长度方向上伸展时,屈肌腱300b朝掌指关节mp1移动。提供这种工作的电磁阀iv的阀功能在本申请的说明书中被称为“屈肌减压”。

如从上面给出的描述中显而易见的,在根据本实施例的机器人手1000中,由于四个电磁阀i至iv用于在旋转第一手指101的关节时控制伸肌腱300a和屈肌腱300b,因此由电磁阀i至iv的开(on)和关(off)的组合可以引起十六种可能的控制状态。这同样适用于第二手指102。即,伸肌腱300a和屈肌腱300b可以通过使用四个电磁阀i至iv来控制,使得可以通过电磁阀i至iv的on和off的组合来为每个手指创建十六种可能的控制状态。

图10是图示电磁阀i至iv的控制状态的说明图。图10描绘了如图9所示的电磁阀i、ii、iii和iv的on和off操作、阀的阀功能和手指机构部分100的操作之间的关系。

电磁阀i的阀功能包括“伸肌加压”。“伸肌加压”是通过供气使伸肌400a加压而使伸肌400a在宽度方向上膨胀使得伸肌腱300a被拉向伸肌400a的操作。

电磁阀ii的阀功能包括“伸肌减压”。“伸肌减压”是通过使伸肌400a减压使伸肌400a在宽度方向上屈曲并使其在长度方向上伸展,即,使伸肌腱300a朝近端指间关节pip1松弛的操作。

电磁阀iii的阀功能包括“屈肌加压”。“屈肌加压”是通过供气使屈肌400b加压而使屈肌400b在宽度方向上膨胀并在长度方向上屈曲使得屈肌腱300b被拉向伸肌400a的操作。

电磁阀iv的阀功能包括“屈肌减压”。“屈肌减压”是通过使屈肌400b减压使屈肌400b在宽度方向上屈曲并使其在长度方向上伸展,即,使屈肌腱300b朝掌指关节mp1松弛的操作。

通过切换电磁阀i至iv的on和off的组合来准备十六种阀状态(控制状态)。阀状态0指示其中电磁阀i至iv全部为off的状态。在阀状态0中,伸肌腱300a和屈肌腱300b处于彼此拮抗的状态。

阀状态1是其中仅电磁阀iv为on而其余三个电磁阀为off的控制状态。

阀状态2是其中仅电磁阀iii为on而其余三个电磁阀i、ii和iv为off的控制状态。当执行所谓的“物体的附加紧固”时使用阀状态2,其中,通过在宽度方向上膨胀屈肌400b,将屈肌腱300b拉向屈肌400b以增加每个关节和物体obj之间的接触的强度。

在阀状态3中,电磁阀i和ii为off而电磁阀iii和iv为on。在阀状态3中,可以组合使用屈肌加压和屈肌减压。通过组合两种类型的压力和控制时间,可以实现对于正常控制不能预期的转变控制。

阀状态4是其中仅电磁阀ii为on而其余三个电磁阀i、iii和iv为off的控制状态。

在阀状态5中,电磁阀ii和iv为on而电磁阀i和iii为off。当执行所谓的手指拉动以将手指从与它们接触的物体obj移开时,采用阀状态5。通过同时执行伸肌减压和屈肌减压,人造肌肉400松弛,这消除了施加到每个关节和每个肌腱300上的不必要的力,从而防止它们劣化。

在阀状态6中,电磁阀ii和iii为on,而电磁阀i和iv为off。当抓握物体obj时采用阀状态6。抓握物体obj时优选的手指姿态是其中与物体obj接触的掌侧上的力增大而手的被侧上的力松弛的状态。因此,在屈肌400b被加压的同时,伸肌400a被减压。

在阀状态7中,电磁阀i为off,而其余电磁阀ii至iv全部为on。在阀状态7中,电磁阀iii和iv的状态与阀状态3的那些状态相同并且都是on。

在阀状态8中,电磁阀i为on,而其余电磁阀全部为off。在阀状态8中,电磁阀的on和off状态与阀状态7的那些状态相反。在阀状态8中,伸肌400(伸肌腱300a)被张紧,并且关节被布置成直线。通过将控制执行为阀状态8,释放对物体obj的加压。

在阀状态9中,电磁阀i和iv为on,而电磁阀ii和iii为off。在阀状态9中,伸肌400a(伸肌腱300a)被张紧,而屈肌400b(屈肌腱300b)松弛,这产生最适合于将手指从物体obj释放的状态。

在阀状态10中,电磁阀i和iii为on,而电磁阀ii和iv为off。在阀状态10中,伸肌400a(伸肌腱300a)和屈肌400b(屈肌腱300b)都被张紧,从而将伸肌400a(伸肌腱300a)和屈肌400b(屈肌腱300b)置于彼此拮抗的状态。当检查每个人造肌肉400的初始化状态时或者当紧固每个关节时,即,关节的灵活性被降低时,采用这种状态。

机器人手1000可以通过电磁阀i至iv的组合采用由阀状态11-15指示的状态。例如,通过将阀状态控制为阀状态11,可以通过减压量值和减压时间的组合对屈肌400b的操作进行各种改变。

在阀状态12-14中,由于伸肌400a(伸肌腱300a)的加压和减压可以同时为on,因此依据减压量值和减压时间以及加压量值和加压时间的组合,可以对伸肌400a的操作进行各种改变。

在阀状态15中,同时打开屈肌400b(屈肌腱300b)的加压和减压以及同时打开伸肌400a(伸肌腱300a)的加压和减压,这使得能够组合操作伸肌400a和屈肌400b。在根据本实施例的手指机构的控制中,通过使用四个电磁阀i至iv和一个手指的两个人造肌肉400(伸肌400a和屈肌400b)旋转每个关节,提供了允许手指执行各种各样的操作的特征。

以下描述机器人手1000的控制方法。

图11是描绘根据实施例1的机器人手1000的控制方法的流程图。当从控制器con接受关于抓握开始的操作指令时,安装在机器人手1000中设置的控制板700上的cpu701执行固定控制(步骤s101)。这里,固定控制是将伸肌腱300a的牵引力和屈肌腱300b的牵引力置于其中它们彼此拮抗的初始化状态。更具体而言,cpu701将电磁阀i至iv的on和off控制为上述阀状态10,并且将伸肌400a和屈肌400b都控制为加压状态。伸肌400a和屈肌400b都在宽度方向上膨胀并且在长度方向上屈曲,这拉动伸肌腱300a和屈肌腱300b,使得其牵引力彼此拮抗。

然后,cpu701将手指机构部分100的控制状态转移到自适应抓握(步骤s102)。自适应抓握是将手指机构部分100的手指沿着物体obj的轮廓放置并使机器人手1000开始抓握物体obj的操作。更具体而言,cpu701将电磁阀i至iv的on和off控制为上述阀状态6,并将伸肌400a控制为减压状态和将屈肌400b控制为加压状态。减小伸肌腱300a的张力使得能够控制手指机构部分100的每个手指沿着物体obj放下。注意的是,从步骤s101处的固定控制到步骤s102处的自适应抓握的转移可以响应于从控制器con接收到操作指令而进行,或者可以在从转移到固定控制以来经过设定的时间之后自动地执行。

然后,cpu701将手指机构部分100的控制状态转移到保持(步骤s103)。保持是保持由机器人手1000抓握的物体obj的操作。更具体而言,cpu701将电磁阀i至iv的on和off控制为上述阀状态0并且执行控制使得伸肌腱300a的张力和屈肌腱300b的张力被保持。注意的是,从步骤s102处的自适应抓握到步骤s103处的保持的转移可以响应于从控制器con接收到操作指令而进行,或者可以在从转移到自适应抓握以来经过设定的时间之后自动地执行。

如果从控制器con接受提供释放抓握操作的指令的操作指令,则cpu701控制手指机构部分100的控制状态为自适应释放(步骤s104)。自适应释放是释放步骤s103处的保持操作的操作。cpu701将电磁阀i至iv的on和off控制为上述阀状态9,并将伸肌400a控制为加压状态和将屈肌400b控制为减压状态。通过增加伸肌腱300a的张力并减小屈肌腱300b的张力,可以释放保持操作。

随后,cpu701确定是否要结束抓握工作(步骤s105)。如果从控制器con接受关于抓握结束指令的操作指令,则cpu701确定要结束抓握工作。如果cpu701确定不结束抓握工作(s105:否),则cpu701将处理返回到步骤s102,以执行从步骤s102到s104的一系列处理,以便抓握另一个物体obj。

同时,如果确定要结束抓握工作(s105:是),则cpu701将手指机构部分100的控制状态控制为松弛(步骤s106)。松弛是用于手指拉动以防止手指机构部分100与物体obj和包含物体obj的盒子、容器等接触的操作,并且是用于保护肌腱300和人造肌肉400的操作。cpu701将电磁阀i至iv的on和off控制为上述阀状态5,并将伸肌400a和屈肌400b两者控制为减压状态。

虽然在本实施例中执行对阀状态0至16中任何一个的控制,但是可以采用其中两个阀状态以时间相依方式交替切换的结构。通过以时间相依方式切换伸肌加压、伸肌减压、屈肌加压和屈肌减压的状态,可以实现对于正常控制不能预期的转变控制。

如上所述,根据实施例1,与关节对应的旋转核心通过伸肌腱300a和屈肌腱300b的张力进行旋转,并且旋转核心在其中伸肌腱300a的张力与屈肌腱300b的张力平衡的状态下自主停止。因此,可以抓握具有不定形状的柔软物体而不会压碎它。此外,根据实施例1,张力可以由伸肌腱300a和屈肌腱300b的物理特性唯一确定。

此外,根据本实施例,掌骨meb、近节指骨pp1和pp2以及中节指骨mip形成平行连杆机构。因此,可以在不打开指尖的情况下抓握物体obj,并且也可以在释放被抓物体obj时在不打开指尖的情况下拉出手指。

(实施例2)

在实施例2中,描述了基于从包括在手指机构部分100中的角度传感器和力传感器的输出执行的反馈控制。

图12是描述根据实施例2的机器人手1000的控制过程的流程图。当从控制器con接受关于抓握开始的操作指令时,安装在机器人手1000中设置的控制板700上的cpu701执行固定控制(步骤s201)。这里,固定控制是将伸肌腱300a的牵引力和屈肌腱300b的牵引力置于其中它们彼此拮抗的初始化状态。更具体而言,cpu701将电磁阀i至iv的on和off控制为上述阀状态10,并且将伸肌400a和屈肌400b两者都控制为加压状态。伸肌400a和屈肌400b两者都在宽度方向上膨胀并且在长度方向上屈曲,这拉动伸肌腱300a和屈肌腱300b,使得其牵引力彼此拮抗。

随后,cpu701将手指机构部分100的控制状态转移到围合形成(步骤s202)。围合形成是当机器人手1000被安装在机器人rob上以抓握和释放物体obj时将确定可允许的操作范围和可允许的操作区域。机器人手1000需要根据物体obj的尺寸和形状以及其中放置物体obj的周围环境的条件和其中存储物体obj的周围环境的条件来行动。例如,当将桃子放入盒子中或从盒子中取出桃子时,由于手指机构的角度必须在盒子的末端和中间之间不同,因此围合形成鉴于这种情况进行设定。鉴于这种情况,设定围合形成。注意的是,将参考图13中的流程图详细描述围合形成的控制过程。

然后,cpu701将手指机构部分100的控制状态转移为抓握(步骤s203)。该抓握与实施例1中描述的自适应抓握基本上相同,并且是根据物体obj的形状沿着物体obj放置手指机构部分100的手指并使机器人手1000开始抓握物体obj的操作。注意的是,将参考图14中所示的流程图详细描述抓握的控制过程。

然后,cpu701将手指机构部分100的控制状态转移为保持(步骤s204)。保持是保持由机器人手1000抓握的物体obj的操作。更具体而言,cpu701将电磁阀i至iv的on和off控制为上述阀状态0并且执行控制,使得伸肌腱300a的张力和屈肌腱300b的张力被保持。注意的是,从步骤s203处的抓握到步骤s204处的保持的转移可以响应于从控制器con接收到操作指令而进行,或者可以在从转移到保持状态以来经过设定的时间之后自动地执行。

如果从控制器con接受提供释放抓握操作的指令的操作指令,则cpu701控制手指机构部分100的控制状态为自适应释放(步骤s205)。自适应释放是释放步骤s204处的保持操作的操作。cpu701将电磁阀i至iv的on和off控制为上述阀状态9,并将伸肌400a控制为加压状态和将屈肌400b控制为减压状态。通过增加伸肌腱300a的张力并减小屈肌腱300b的张力,可以释放保持操作。

随后,cpu701确定是否要结束抓握工作(步骤s206)。如果从控制器con接受关于抓握结束指令的操作指令,则cpu701确定要结束抓握工作。如果cpu701确定不结束抓握工作(s206:否),则cpu701将处理返回到步骤s202,以执行从步骤s202到s205的一系列处理,以便抓握另一个物体obj。

另一方面,如果确定要结束抓握工作(s206:是),则cpu701将手指机构部分100的控制状态控制为松弛(步骤s207)。松弛是用于手指拉动以防止手指机构部分100与物体obj和包含物体obj的盒子、容器等接触的操作,并且是用于保护肌腱300和人造肌肉400的操作。cpu701将电磁阀i至iv的on和off控制为上述阀状态5,并且将伸肌400a和屈肌400b两者都控制为减压状态。

图13是描绘围合形成的控制过程的流程图。安装在包括在机器人手1000中的控制板700上的cpu701经由控制器con接受关节角度的目标角度和接触力的设定值(步骤s211)。

如果从每个传感器获得传感器输出(步骤s212),则cpu701确定来自力传感器160的传感器值是否大于设定值(步骤s213)。如果来自力传感器160的传感器值大于设定值(s213:是),则cpu701通知控制器con完成(步骤s215)并结束该流程图中的处理。

如果确定来自力传感器160的传感器值等于或小于设定值(s213:否),则cpu701确定由角度传感器170测量的关节角度是否基本上等于目标角度(步骤s214)。如果确定由角度传感器170测量的关节角度基本上等于目标角度(s214:是),则cpu701在步骤s215处提供完成通知并且结束该流程图中的处理。

如果确定来自角度传感器170的传感器值指示的关节角度与目标角度基本上不同(s214:否),则cpu701确定由角度传感器170测量的关节角度是否大于目标角度(步骤s216)。

如果确定由角度传感器170测量的关节角度大于目标角度(s216:是),则cpu701控制电磁阀i至iv的on和off,并且将屈肌400b和432控制为减压状态和将伸肌400a控制为加压状态(步骤s217)。步骤s217处的处理相当于图10所绘出的阀状态9,并且对应于自适应释放的操作。即,角度传感器值高于目标值意味着相对的骨之间的距离小于目标值,导致在稍微增加距离的方向上执行控制。在控制到上述控制状态之后,cpu701将处理返回到步骤s212。

另一方面,如果确定由角度传感器170测量的关节角度等于或小于目标角度(s216:否),则cpu701控制电磁阀i至iv的on和off,并将屈肌400b和432控制为加压状态和将伸肌400a和422控制为减压状态(步骤s218)。步骤s218的处理相当于图10所绘出的阀状态6,并且对应于“自适应抓握”的操作。即,角度传感器值低于目标值意味着相对的骨之间的距离大于目标值,导致在稍微减小距离的方向上执行控制。在控制到上述控制状态之后,cpu701将处理返回到步骤s212。

图14是描绘抓握操作的控制过程的流程图。安装在包括在机器人手1000中的控制板700上的cpu701经由控制器con接受关节角度的目标角度和接触力的设定值(步骤s221)。

如果从每个传感器获得传感器输出(步骤s222),则cpu701确定由角度传感器170测量的关节角度是否大于目标角度(步骤s223)。如果确定由角度传感器170测量的关节角度大于目标角度(s223:是),则cpu701向控制器con通知完成(步骤s225),并且结束该流程图中的处理。

如果确定由角度传感器170测量的关节角度等于或小于目标角度(s223:否),则cpu701确定来自力传感器160的传感器值(即,抓握力)是否基本上等于设定值(步骤s224)。如果确定来自力传感器160的传感器值基本上等于设定值(s224:是),则cpu701在步骤s225处提供完成通知,并结束该流程图中的处理。

如果确定来自力传感器160的传感器值基本上不同于设定值(s224:否),则cpu701确定来自力传感器160的传感器值是否大于设定值(步骤s226)。如果确定来自力传感器160的传感器值大于设定值(s226:是),则cpu701控制电磁阀i至iv的on和off,并将屈肌400b控制为减压状态和将伸肌400a控制为加压状态(步骤s227)。步骤s227处的处理相当于图10所绘出的阀状态9,并且对应于自适应释放的操作。即,传感器值高于目标值意味着抓握力大,导致在减小抓握力的方向上执行控制。在控制到上述控制状态之后,cpu701将处理返回到步骤s222。

如果确定来自力传感器160的传感器值等于或小于设定值(s226:否),则cpu701控制电磁阀i至iv的on和off,并将屈肌400b和432控制为加压状态和将伸肌400a和422控制为减压状态(步骤s228)。步骤s228处的处理相当于图10所绘出的阀状态6,并且对应于“自适应抓握”的操作。即,力传感器值低于目标值意味着抓握力小,导致在增加抓握力的方向上的控制。在控制到上述控制状态之后,cpu701将处理返回到步骤s222。

如上所述,可以基于来自实施例2中的力传感器160和角度传感器170的传感器输出来执行反馈控制,这使得能够进行自主地控制抓握物体obj的抓握形式、保持力、手指关节的灵活性等的顺应性控制。

(实施例3)

根据实施例3,将描述通过使用实施例1和2中描述的机器人手1000抓握物体obj并与矩形存储箱sb中的其它物体紧密接触地存储该物体的操作。在本实施例中,物体obj被认为是诸如水果等的球形物体。

图15a至15d是图示存储状态的说明图。图15a图示了其中十六个物体在矩形存储箱sb中彼此紧密接触地存储的状态。在其中已经完成存储物体obj的状态中,当物体obj被其它物体obj包围时,产生由s1至s6指示的六个空间。此外,对于与存储箱sb相邻的待抓握物体,产生由s0指示的三个或四个空间。

类似地,图15b、图15c和图15d分别图示了其中十五、十三和十二个物体obj彼此紧密接触地存储的状态,并且描绘了在物体obj周围产生三到六个空间。

机器人手1000通过用两个手指101和102在与空间位置对应的部分处抓握物体obj、将其移动到存储位置、将物体obj推入到该位置中,然后从物体obj释放和移开手指101和102来执行紧密接触存储。

根据本实施例的机器人手1000可以在不打开指尖的情况下抓握物体obj并且在不打开指尖的情况下将手指从被抓物体obj释放。因此,如图15a至图15d所示,在其中在物体之间或物体与存储箱sb之间产生空间的情况下,机器人手1000可以通过在与空间对应的部分处抓握物体obj并将其移动到存储箱sb中来与其它物体obj紧密接触地存储物体obj。

但是,在其中作为物体obj的诸如水果的物体被缓冲材料csn包围的情况下,当物体obj被紧密接触地存储时,用于相邻物体obj的缓冲材料csn可能容易脱落。

图16a和16b是图示其中物体obj向下移动并存储的状态的示意图。图16a图示了其中第n-1个物体obj已经被存储在存储箱sb中,并且第n个物体obj将要被存储在第n-1个物体obj与存储箱sb之间形成的空间中的状态。图16b图示了其中已经完成第n个物体obj的存储的状态。缓冲材料csn具有这样的结构,使得例如圆柱形弹性材料在中间折叠,并且被附接以便从折叠的方向在物体obj之间挤压。因此,如果从上方向折叠部分施加力,则缓冲材料csn容易滑落,如图16b所描绘的。

图17a和图17b是图示其中通过滚动存储来存储物体obj的状态的示意图。图17a图示了其中第n-1个物体obj已经被存储在存储箱sb中,并且第n个物体obj将要被存储在第n-1个物体obj与存储箱sb之间形成的空间中的状态。图17b图示了其中已经存储第n个物体obj的状态。根据本实施例,在其中第n个物体obj被存储在上述空间中的情况下,通过围绕第n-1个物体obj而不滑过它(滚动存储)以滚动方式存储第n个物体,防止了缓冲材料csn脱落。

在完成存储物体之后,在其中机器人手的指尖在从物体obj移开时被释放并打开的情况下,由于缓冲材料csn或存储箱sb与机器人手之间的干扰、摩擦等而发生缓冲材料csn的滑动和存储物体obj的提升。但是,由于根据本实施例的机器人手1000可以在不打开指尖的情况下从物体移开手指101和102,因此可以防止当手指101和102从存储箱sb中拉出时发生缓冲材料csn的滑动和存储物体obj的提升。

以下描述滚动存储。

图18是图示滚动存储的说明图。图18图示了其中另一个物体obj-b被存储为与存储物体obj-a紧密接触的状态。注意的是,在图18中,为了简单起见,用圆圈描绘了物体obj-a和物体obj-b,两者都附接有缓冲材料csn。如图18所示,在其中物体obj-b从其在点p处与物体obj-a紧密接触的状态沿着物体obj-a滚动的情况下,防止了缓冲材料csn的滑动,这防止了缓冲材料csn脱落。

假设物体obj-a是具有其中心oa的固定圆,并且物体obj-b是具有其中心ob的可移动圆,那么物体obj-b沿着图18中所示的轨迹移动。即,当物体obj-b从其在点p处与物体obj-a紧密接触的状态沿着物体obj-a滚动而不被滑动时,物体obj-b上的点p移动到点pb1,其轨迹形成外摆线曲线。假设物体obj-a的圆的半径是ra,并且物体obj-b的圆的半径是rb,那么可以获得以下关系表达式。

αθ=(ra+rb)cosθ-rbcos((ra+rb)/rb)θ,

zθ=(ra+rb)sinθ-rbsin((ra+rb)/rb)θ.

通过将从上述关系表达式评估的坐标结合到用于机器人手1000的控制的坐标计算中并且执行将向量ob-p移动到向量ob1-pb1的控制,可以实现滚动存储。这里,ob-p被称为滚动向量,并且rb被称为滚动半径。

图19是描绘根据实施例3的机器人手1000的控制过程的流程图。控制器con接受量的设定值(步骤s301)。这里,量是待被存储在存储箱sb中的物体obj的最大数量。在步骤s301中设置的量的值被定义为n。

接下来,控制器con执行物体obj的存储位置和关于滚动存储的参数的读取(步骤s302)。图20是图示待由cpu701读取的参数的一个示例的概念图。取决于待被存储在存储箱sb中的物体obj的量n,每个物体obj在存储箱sb中的存储位置和滚动参数可以被设定。无论量n如何,夹持位置的坐标(x0,y0,z0)都是固定的。这里,物体obj的存储位置可以被描述为关于作为原点的特定位置的三维正交坐标系中的三维坐标。此外,滚动参数中的α表示当存储物体obj时平面上的角度。ra和rb两者分别表示上述固定圆和可移动圆的半径,并且θ表示当存储物体obj时垂直平面上的角度(在图18中由线段p-oa和线段ob1-oa形成的角度)。这些参数被预先存储在诸如控制器con中包括的存储器的存储设备(未示出)中。

控制器con将指示存储物体的数量的计数器的值i递增1(步骤s303)。例如,指示存储物体的数量的计数器的初始值是0。

随后,控制器con通过向机器人rob提供控制条件使机器人rob向机器人手1000输出关于释放的操作指令,从而使包含在机器人手1000中的手指101和102被释放(步骤s304)。此时,包含在机器人手1000中的cpu701对伸肌400a执行加压控制并对屈肌400b执行减压控制,从而使手指101和102中的每一个都被释放。

接下来,控制器con通过向机器人rob提供控制条件来控制包括在机器人rob中的臂部的操作,从而使机器人手1000移动到抓握位置(步骤s305)。注意的是,可以采用众所周知的控制方法来控制臂部的操作,以将机器人手1000移动到抓握位置。

然后,控制器con通过向机器人rob提供控制条件使机器人rob向机器人手1000输出关于抓握的操作指令,从而使包含在机器人手1000中的手指101和102抓握物体obj(步骤s306)。此时,包含在机器人手1000中的cpu701对伸肌400a执行减压控制并对屈肌400b执行加压控制,从而使手指101和102中的每一个都抓握物体obj。

随后,控制器con然后通过向机器人rob提供控制条件使机器人rob输出关于保持的操作指令,从而使包含在机器人手1000中的手指101和102保持物体obj(步骤s307)。此时,包含在机器人手1000中的cpu701将伸肌400a和屈肌400b控制为off,以使手指101和102中的每一个都保持物体obj。

接下来,控制器con通过向机器人rob提供控制条件来控制包含在机器人rob中的臂部的操作,并且将机器人手1000移动到滚动的起始点(步骤s308)。注意的是,可以采用已知的控制方法来控制臂部的操作,以将机器人手1000移动到滚动的起始点。通过步骤s308处的操作,可以使由机器人手1000抓握的物体obj以由滚动参数设定的角度θ与存储物体obj接触。

然后,控制器con通过向机器人rob提供控制条件使机器人rob向机器人手1000输出关于紧固的操作指令,从而使设置在机器人手1000中的手指101和102额外地紧固物体obj(步骤s309)。此时,包含在机器人手1000中的cpu701将伸肌400a控制为off并且对屈肌400b执行加压控制,从而使手指101和102额外地坚固物体obj。

接下来,控制器con通过向机器人rob提供控制条件来控制包含在机器人rob中的臂部的操作,从而使其执行被抓物体obj的滚动运动(步骤s310)。稍后将描述滚动运动的操作过程。

在其中完成滚动运动之后被抓物体obj被存储在预定存储位置中的情况下,控制器con通过向机器人rob提供控制条件使机器人rob向机器人手1000输出关于松弛的操作指令,从而松弛包含在机器人手1000中的手指101和102(步骤s311)。此时,设置在机器人手1000中的cpu701对伸肌400a和屈肌400b执行减压控制以松弛手指101和102中的每一个。

接下来,控制器con通过向机器人rob提供控制条件来控制包含在机器人rob中的臂部的操作,从而向上移动机器人手100(步骤s312)。根据本实施例,由于机器人手1000在其中手指101和102松弛的状态下向上移动,因此可以防止缓冲材料csn的滑动和存储物体obj的提升。

随后,控制器con确定计数器值i是否等于量n(步骤s313)。如果计数器值i不等于量n(s313:否),则控制器con将处理返回到步骤s303,以连续地执行将剩余物体obj存储在存储箱sb中的操作。另一方面,如果计数器值i等于量n(s313:是),则控制器con结束该流程图中的处理。

图21是描绘滚动运动的操作过程的流程图。控制器con从待被存储的物体obj的垂直平面上的角度θ中减去δθ(步骤s321)。注意的是,δθ是可以取决于物体obj而适当地设置的角度的变化量,并且被假设为之前被存储在诸如存储器等的存储设备(未示出)中。

接下来,控制器con计算物体obj的目标位置(步骤s322)。在其中当计数器值为i时物体obj的三维坐标为(xi,yi,zi)的情况下,控制器con可以例如根据以下算法表达式计算目标位置的坐标(x,y,z)。

x=xi+((rai+rbi)×cosθi-rbi×cos((rai+rbi)/rbi)×θi)×cosαi,

y=yi+((rai+rbi)×cosθi-rbi×cos((rai+rbi)/rbi)×θi)×sinαi,

z=zi+((rai+rbi)×sinθi-rbi×sin((rai+rbi)/rbi)×θi).

然后,控制器con通过向机器人rob提供控制条件来控制包含在机器人rob中的臂部的操作,并且移动机器人手1000使得被抓物体obj的中心坐标与坐标(x,y,z)匹配(步骤s323)。注意的是,可以采用已知的控制方法对臂部进行操作控制,以将机器人手1000移动到特定位置。

随后,控制器con确定物体obj的垂直平面上的角度θ是否等于或小于0(步骤s324)。如果物体obj的垂直平面上的角度θ大于0(s324:否),则控制器con将处理返回到步骤s321并继续移动物体obj,因为它确定存储尚未完成。此外,如果物体obj的垂直平面上的角度θ等于或小于0(s324:是),则控制器con结束该流程图中的处理,因为它确定存储已经完成。

注意的是,在图19所示的流程图中,滚动存储被配置为应用到待被存储在存储箱sb中的所有物体,但是如果在存储箱sb内确保了足够的空间,则可以通过平移机器人手1000将物体obj存储在预定的存储位置中。

图22是图示存储顺序的说明图。当十五个物体obj1-obj15被存储在存储箱sb中时,假设是按以下顺序,即,连续存储物体obj1、物体obj2、物体obj3、...、物体obj15的过程。当物体obj1被存储在存储箱sb中时,由于存储箱sb中不存在其它物体obj2-obj15,因此可以确保足够的空间。在这种情况下,例如,通过在不应用滚动存储的情况下在附图中的空心箭头所指示的方向上在存储箱sb内部平移机器人手1000,可以将物体obj1存储在预定的存储位置。这也适用于物体obj2-obj4和obj6-obj9中的每一个,并且这些物体中的每一个可以仅通过平移机器人手1000而被存储在预定的存储位置中。

同时,在其中物体obj5或物体obj10-obj15中的每一个被存储在存储箱sb中的情况下,不能确保允许平移的足够的空间,因此需要滚动存储。例如,在其中在已经存储物体obj1-obj12的状态下新存储物体obj13的情况下,物体obj13在附图中所示的空心箭头指示的方向上移动,并且在其中物体obj13在接触点s8和r12处与物体obj8和obj12接触的状态下执行滚动存储。这里,在其中连接物体obj1的中心o1和物体obj2的中心o2的水平面上的线段被视为x轴,并且连接物体obj1的中心o1和物体obj6的中心o6的水平面上的线段被视为y轴的情况下,垂直于x轴和y轴的轴是z轴,连接物体obj1的中心o1和物体obj13的中心o13的水平面上的线段是α轴,并且由x轴和α轴形成的角度在上述算术表达式中是α。

这也适用于其中物体obj11-obj12和obj14-obj15中的每一个被存储在存储箱sb中的情况,并且在其中使物体obj与另一个存储物体obj在两个点(或一个点)处接触的状态下执行滚动存储,由此每个物体可以被存储在存储箱sb中,同时防止缓冲材料csn脱落。

应该理解的是,这里公开的实施例在所有方面都是说明性的而不是限制性的。本发明的范围由所附权利要求限定,并且落入权利要求的含义和界限内的所有变化,或这些含义和界限的等同物旨在被权利要求所包含。

当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1