自主移动机器人以及自主移动机器人的物品运送方法

摘要

本发明提供自主移动机器人以及自主移动机器人的物品运送方法，使自主移动机器人能够从取得源主动地接受物品，通过抑振控制抑制摇摆并进行运送，可靠地送到目的地。物品的运送使用规定的规格的运送容器。运送容器包括用于图像识别的图形和形状适于把持的把持部分。机器人包括：把持位置识别单元，其从取得源的图像来识别承载要运送的物品的规定规格的运送容器的适于把持的规定位置；把持控制单元，其进行将把持部驱动到运送容器的规定位置，并把持规定位置的控制；以及把持成功与否判定单元，其基于作用于把持部的外力判定把持是否成功。还包括通过在运送中进行抵消作用于把持部的外力的反馈控制的抑振控制而抑制把持部的振动的抑振控制单元。

说明书

技术领域

本发明涉及可自主移动的机器人，更详细地说，本发明涉及使该机器人的手把持物体而进行运送的技术。

背景技术

近年来，进行了各种使可自主移动的机器人运送物品的试验。例如，本申请人已经提出了在机器人从人那里接受物品时能够进行接受动作而不会给人带来不适感的物品运送系统(参照专利文献1)。该系统的机器人包括把持物品的可开闭的把持部、检测作用于把持部的外力的外力检测单元、检测把持部的开度的开度检测单元以及自主移动单元等，能够从人那里接受物品并到达人或放置场所等目的地。在把持部未把持物品的状态下检测出第一规定值以上的外力的情况下，使把持部开始接受动作，在接受动作中，基于检测到的把持部的外力和开度中的至少一个，判定物品的取得动作完毕。

[专利文献1]日本特愿2004-361467号(段落0151～0175，图13～图28)

但是，在以往的专利文献1的系统中，是以机器人从人那里接受物品(以下，称作‘被动接受’)为前提。即，在机器人从人那里接受物品时，需要人将物品的位置与机器人伸出的把持部(相当于人的手)对齐，以某一程度的力来进行按压。因此，给机器人物品的人需要对机器人伸出的把持部付出某一程度的注意力来使其把持物品，所以需要花费工夫，虽然其很少。

此外，在机器人把持所接受的物品移动到目的地时，由于每前进一步，把持部都振动，因此难以运送饮料等液体，特别是难以在没有加盖的状态下进行运送。

考虑到以上的方面，在从人那里给机器人物品时，如果机器人主动地接受被放置在规定的位置的物品或人伸出的物品(暂时称作‘主动接受’)而不需要人伴随注意定位的辅助动作，就很理想了。

此外，如果能够在从取得源到目的地的运送中抑制把持部的振动(暂时称作‘抑振控制’)，则对于液体的运送也是很理想的。

发明内容

从而，本发明的课题在于提供一种能够从取得源主动地接受物品，通过抑振控制来抑制运送中的物品的摇摆并进行运送，而且可靠地将物品送到目的地的机器人。

本发明的课题在于提供一种可自主移动的机器人从取得源主动地(无需人的辅助)接受物品，通过抑振控制来抑制运送中的物品的摇摆并进行运送，而且可靠地将物品送到目的地的物品运送方法。

为了解决上述课题，方案1记载的发明中，自主移动机器人，其包括把持物品的可开闭的把持部、照相机、自主移动单元、以及实现将物品从取得源运送到目的地的控制单元，该自主移动机器人的特征在于，所述控制单元包括：把持位置识别单元，其根据由所述照相机拍摄的所述取得源的图像识别承载了要运送的物品的规定规格的运送容器的适于把持的规定位置；把持控制单元，其进行将所述把持部移动到所述运送容器的所述规定位置，并把持该规定位置的控制；以及把持成功与否判定单元，其基于作用于所述把持部的外力判定所述把持是否成功。

根据该结构，由于识别运送容器的规定位置，将把持部驱动到运送容器的规定位置来把持规定位置，并基于作用于把持部的外力来判定把持是否成功，所以能够可靠地取得运送容器而无需借助人的帮助。

方案2记载的机器人的特征在于，该自主移动机器人还包括抑振控制单元，该抑振控制单元在至所述目的地的运送中进行抵消作用于所述把持部的外力的反馈控制。

根据该结构，由于在运送中抑制把持部的振动，所以能够抑制物品的摆动并进行运送，因此也能够进行液体等的运送。

方案3记载的机器人的特征在于，所述抑振控制单元包括：致动器控制部，其针对使关节活动的每个致动器设置，驱动控制各致动器，所述关节决定所述把持部的动作；提取单元，其根据对所述把持部作用的所述外力来求施加于所述把持部的加速度成分，从所述加速度成分中仅提取所述致动器控制部能响应的成分；以及施加单元，其通过规定的运算将由所述提取单元提取出的成分划分为每个致动器的信号，将所划分的各信号施加到对应的致动器控制部的速度控制环中。

根据该结构得到与方案2同样的效果。

方案4记载的机器人的特征在于，所述加速度成分包含施加于所述把持部的铅直方向的力以及施加于所述把持部的绕机器人的左右方向的轴的力矩中的至少一种。

根据该结构，由于能够减少要处理的成分，所以能够使结构简单。

方案5记载的机器人的特征在于，该自主移动机器人包括：接受/交付高度决定单元，其根据所述目的地的载置所述运送容器的放置场所的高度来决定目标位置；把持部移动单元，其将把持的所述运送容器放到所述目标位置；以及交付完毕判定单元，其基于作用于所述把持部的所述外力，判定所述运送容器的设置是否完毕。

根据该结构，由于根据放置场所的高度决定目标位置，将把持的运送容器放到所述目标位置，基于来自力传感器的检测值判定运送容器的设置是否完毕，所以能够将运送容器放置到放置场所而无需借助人的帮助。

方案6记载的机器人的特征在于，该自主移动机器人还包括设置成功与否判定单元，该设置成功与否判定单元在所述运送容器的设置完成之前，基于所述把持部是否降落到规定的高度来判定是否设置成功。

根据该结构，由于如果在设置完毕前，把持部下降到规定的高度，则判定为设置失败，所以通过将规定的高度设定为接近把持部的可动区域的下限，可以省去无用的动作。

方案7记载的机器人的特征在于，所述控制单元还包括在所述取得源为人的情况下判定所述人的交付的熟练度的熟练度判定单元，所述把持控制单元根据所述熟练度来调整动作速度。

根据该结构，由于根据人的熟练度来调整把持控制的动作速度，所以能够对于被判定为熟练度低的人不会带来不安感，并且对于被判定为熟练度高的人不使其感到麻烦。

进而，方案8记载的发明的物品运送方法，该物品运送方法使自主移动机器人将物品从取得源搬送到目的地，所述自主移动机器人包括把持物品的可开闭的把持部、照相机、以及自主移动单元，该物品运送方法的特征在于，所述物品运送方法包括：把持位置识别步骤，根据由所述照相机拍摄到的所述取得源的图像来识别适于承载要运送的物品的规定规格的运送容器的把持的规定位置；把持控制步骤，进行将所述把持部移动到所述运送容器的所述规定位置，并把持该规定位置的控制；把持成功与否判定步骤，基于作用于所述把持部的外力判定所述把持是否成功；以及抑振控制步骤，在至所述目的地的运送中进行抵消作用于所述把持部的外力的反馈控制。

根据该结构，由于识别运送容器的规定位置，将把持部驱动到运送容器的规定位置来把持规定位置，并基于作用于把持部的外力来判定把持是否成功，所以能够可靠地取得运送容器而无需借助人的帮助。

根据本发明，通过利用图像信息能够从取得源取得运送容器而无需借助人的帮助。此外，通过在运送中抑制把持部的振动而能够抑制物品的摇摆并进行运送，所以也能够进行液体等的运送。

附图说明

图1是表示本发明的实施方式的机器人控制系统的系统结构图。

图2是表示图1的机器人R的外观的侧视图。

图3是示意地表示图1的机器人R的机构上的结构的立体图。

图4是表示图1的机器人R的内部结构的功能方框图。

图5是表示机器人的把持部的立体图，(a)表示手指打开状态，(b)表示手指关闭状态。

图6是表示机器人的把持部、开度检测单元以及外力检测单元的方框图。

图7是表示图4的主控制部以及存储部的方框图。

图8是表示本发明的物品运送所使用的运送容器的图。

图9是表示机器人R把持运送容器M的样子的立体图。

图10是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示取得源为人的情况下的向取得位置的移动的流程图。

图11是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示取得源为场所的情况下的向取得位置的移动的流程图。

图12是表示机器人移动到接受位置(取得源为人的情况)的状态的图。

图13是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示取得源为人的情况下的接受动作的流程图。

图14是表示机器人将把持部伸到接受高度的状态的俯视图。

图15是表示机器人将把持部伸到接受高度的状态的图。

图16是表示机器人开始接受物品的状态的图。

图17是表示机器人完成物品的接受的状态的图。

图18是用于说明判定是否把持成功的图，(a)是表示把持成功状态的图，(b)以及(c)是表示把持失败的状态的图。

图19是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示物品的重新接受准备的流程图。

图20是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为人的情况下的运送移动的流程图。

图21是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为场所的情况下的运送移动的流程图。

图22是表示本发明的一个实施方式的具有把持部71的抑振控制功能的图4的臂部控制部152的结构例的大略方框图。

图23是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为场所的情况下的设置动作的一例的流程图。

图24是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为场所的情况下的设置动作的另一例的流程图。

图25是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示在图20中没有将运送容器M交给人的情况下放置于物品放置处的动作的流程图。

图26是表示本发明的抑振控制的效果的一例的曲线图。

图27是表示图22的电机控制/驱动部401～407的内部结构的一例的框线图。

具体实施方式

以下，通过本发明的实施方式和附图详细地说明本发明。

另外，在多个附图中表示相同的要素的情况下赋予同一参照符号。

(机器人控制系统A的结构)

首先，说明本发明的实施方式的机器人控制系统A。图1是表示本发明的实施方式的机器人控制系统的系统结构图。

如图1所示，机器人控制系统A包括：配置在任务执行区域(机器人运转区域)EA的1台以上(本实施方式中为1台)机器人R；通过无线通信与这些机器人R连接的基站(例如无线LAN)1；通过路由器2连接到基站1的机器人管理装置(例如，服务器)3；以及通过网络4连接到机器人管理装置3的终端5。

机器人R被配置在任务执行区域EA，在任务执行区域EA内进行自主移动，基于执行命令信号来执行物品运送等任务。另外，在该任务执行区域EA内设有放置要运送的物品的物品放置处B1以及一个以上目的地即目的地物品放置处C1～C3。物品放置处B1、C1～C3例如是桌子或柜台等。此外，任务执行区域EA中有佩戴检测用的标签T、进行与机器人R之间的物品交接的人H。机器人R在没能发现交付物品的人H的情况等，例如，可以将物品放置于物品放置处C3。

机器人管理装置3基于从后述的终端5输入的任务数据，使机器人R执行任务，因此生成包含了该任务的内容的执行命令信号并输出给机器人R。该任务数据是与使机器人R执行的任务有关的数据，例如，包括：将物品交给机器人R的人、机器人R交付物品的人、要运送的物品的种类等。

终端5是用于对机器人管理装置3输入任务数据的输入装置，是台式计算机、PHS等。此外，终端5也有用于使人可识别地输出从机器人R传送的行动报告信号(任务完成报告信号)的输出(显示)装置。

(机器人R的结构)

接着，说明本发明的实施方式的机器人R。在以下的说明中，在机器人R的前后方向上取X轴，在左右方向上取Y轴，在上下方向上取Z轴(参照图2)。

本发明的实施方式的机器人R是自主移动型的双足移动机器人。该机器人R基于从机器人管理装置3发送的执行命令信号来执行任务。

图2是表示图1的机器人的外观的示意图。如图2所示，机器人R与人同样通过两个腿部R1(仅图示一个)站立、移动(走路、跑步等)，具有上体部R2、两个臂部R3(仅图示一个)以及头部R4，自主进行移动。此外，机器人R以背负的形式在后背(上体部R2的后部)具有控制装置搭载部R5，该控制装置搭载部R5搭载了用于控制这些腿部R1、上体部R2、臂部R3以及头部R4的动作的控制装置。

(机器人R的驱动结构)

接着说明机器人R的驱动结构。图3是示意地表示图2的机器人的驱动结构的立体图。另外，图3中的关节部通过驱动该关节部的电机来表示。

(腿部R1)

如图3所示，左右各个腿部R1包括6个关节部11R(L)～16R(L)。左右共12个的关节由以下部分构成：胯部(腿部R1和上体部R2的连接部分)的腿部旋转用(围绕Z轴)的胯关节部11R、11L(将右侧设为R，将左侧设为L。此外，有时也不附加R、L。以下相同。)、围绕胯部的仰俯(pitch)轴(Y轴)的胯关节部12R、12L、围绕胯部的摇摆(roll)轴(X轴)的胯关节部13R、13L、围绕膝部的仰俯轴(Y轴)的膝关节部14R、14L、围绕脚踝的仰俯轴(Y轴)的踝关节部15R、15L、以及围绕脚踝的摇摆轴(X轴)的踝关节部16R、16L。而且，在腿部R1下方安装有足部17R、17L。

即，腿部R1包括胯关节部11R(L)、12R(L)、13R(L)，膝关节部14R(L)以及踝关节部15R(L)、16R(L)。胯关节部11R(L)～13R(L)和膝关节部14R(L)由大腿连杆51R、51L连接，膝关节部14R(L)和踝关节部15R(L)、16R(L)由小腿连杆52R、52L连接。

(上体部R2)

如图3所示，上体部R2是机器人R的基体部分，与腿部R1、臂部R3以及头部R4连接。即，上体部R2(上体连杆53)经由胯关节部11R(L)～13R(L)与腿部R1连接。此外，上体部R2经由后述的肩关节部31R(L)～33R(L)与臂部R3连接。此外，上体部R2经由后述的颈关节部41、42与头部R4连接。

此外，上体部R2包括上体旋转用(围绕Z轴)的关节部21。

(臂部R3)

如图3所示，左右各个臂部R3具有7个关节部31R(L)～37R(L)。左右共14个关节部由以下部分构成：围绕肩部(臂部R3和上体部R2的连接部分)的仰俯轴(Y轴)的肩关节部31R、31L、围绕肩部的摇摆轴(X轴)的肩关节部32R、32L、臂部旋转用(围绕Z轴)的肩关节部33R、33L、围绕肘部的仰俯轴(Y轴)的肘关节部34R、34L、手臂旋转用(围绕Z轴)的臂关节部35R、35L、围绕手臂的仰俯轴(Y轴)的手臂关节部36R、36L以及围绕手臂的摇摆轴(X轴)的手臂关节部37R、37L。而且，在臂部R3的前端安装有把持部(手)71R、71L。

即，臂部R3包括肩关节部31R(L)、32R(L)、33R(L)、肘关节部34R(L)、臂关节部35R(L)以及手臂关节部36R(L)、37R(L)。肩关节部31R(L)～33R(L)和肘关节部34R(L)通过上臂连杆54R(L)连接，肘关节部34R(L)和手臂关节部36R(L)、37R(L)通过下臂连杆55R(L)连接。

(头部R4)

如图3所示，头部R4包括围绕颈部(头部R4和上体部R2的连接部分)的Y轴的颈关节部41、围绕颈部的Z轴的颈关节部42。颈关节部41用于设定头部R4的倾斜角，颈关节部42用于设定头部R4的平面。

通过这样的结构，左右的腿部R1提供合计12个自由度，通过以适当的角度驱动移动中的12个关节部11R(L)～16R(L)，可以对腿部R1提供所期望的动作，机器人R能够任意地在三维空间中移动。此外，左右的臂部R3提供合计14个自由度，通过以适当的角度驱动移动中的14个关节部31R(L)～37R(L)，机器人R能够进行所期望的作业。

此外，踝关节部15R(L)、16R(L)和足部17R(L)之间设有公知的6轴力传感器61R(L)。6轴力传感器61R(L)检测从地面对机器人R作用的地面反作用力的三个方向成分Fx、Fy、Fz和力矩的三个方向成分Mx、My、Mz。

此外，手臂关节部36R(L)、37R(L)和把持部71R(L)之间设有公知的6轴力传感器62R(L)。6轴力传感器62R(L)检测作用于对机器人R的把持部71R(L)的反作用力的三个方向成分Fx、Fy、Fz和力矩的三个方向成分Mx、My、Mz。

此外，在上体部R2设有倾斜传感器63。倾斜传感器63检测对于上体部R2的重力轴(Z轴)的斜率及其角速度。

此外，各关节部的电机通过对其输出进行减速、增力的减速器(未图示)使所述大腿连杆51R(L)、小腿连杆52R(L)等相对位移。这些各关节部的角度由关节角度检测单元(例如，回转式编码器)进行检测。

控制装置搭载部R5容纳有后述的自主移动控制部150、把持部控制部160、无线通信部170、主控制部200、电池(未图示)等。各传感器61～63等的检测数据被传送到控制装置搭载部R5内的各控制部。此外，各电机由来自各控制部的驱动指示信号进行驱动。

图4是表示图1的机器人的方框图。如图4所示，机器人R除了腿部R1、臂部R3以及头部R4之外，还包括照相机C、C、扬声器S、传声器MC、MC、图像处理部100、声音处理部110、对象检测部120、自主移动控制部150、把持部控制部160、无线通信部170、主控制部200以及存储部300。另外，自主移动控制部150、把持部控制部160以及主控制部200构成方案的控制单元。

此外，机器人R包括陀螺仪传感器SR1以及GPS接收器SR2。

陀螺仪传感器SR1检测与机器人R的朝向有关的数据(朝向数据)。此外，GPS接收器SR2检测与机器人R的位置有关的数据(位置数据)。陀螺仪传感器SR1以及GPS接收器SR2检测出的数据被输出到主控制部200，用于决定机器人R的行动，同时从主控制部200经由无线通信部170被发送到机器人管理装置3。

[照相机]

照相机C、C可以将图像作为数字数据取入，例如使用彩色CCD(Charge-Coupled Device，电荷耦合装置)照相机。照相机C、C左右平行地排列配置，所拍摄的图像被输出到图像处理部100。该照相机C、C和扬声器S以及传声器MC、MC都配置在头部R4的内部。

[图像处理部]

图像处理部100对照相机C、C拍摄的图像进行处理，根据拍摄的图像掌握机器人R的周围状况，因此是进行周围的障碍物或人物的识别的部分。该图像处理部100包括立体处理部101、移动体提取部102以及脸识别部103。

立体处理部101以左右的照相机C、C拍摄的两个图像的一个作为基准进行图形匹配，计算左右的图像中的对应的各像素的视差而生成视差图像，并对移动体提取部102输出所生成的视差图像以及原来的图像。另外，该视差表示从机器人R到拍摄的物体之间的距离。

移动体提取部102基于从立体处理部101输出的数据，提取拍摄到的图像中的移动体。提取移动的物体(移动体)是为了推定移动的物体为人物而进行人物的识别。

为了进行移动体的提取，移动体提取部102存储过去的多帧(画面)的图像，比较最新的帧(图像)和过去的帧(图像)，进行图形匹配，计算各像素的移动量，并生成移动量图像。然后，根据视差图像和移动量图像，在离照相机C、C规定的距离范围内，在存在移动量多的像素的情况下，推定为在该位置存在人物，作为仅该规定距离范围的视差图像而提取移动体，并对脸识别部103输出移动体的图像。

此外，移动体提取部102计算提取出的移动体的高度即身高，输出到脸识别部103。

即，移动体提取部102可以确定人相对于机器人R的位置，是方案中的‘人位置确定单元’的一例。

此外，移动体提取部102可以计算人的身高。

脸识别部103从提取出的移动体提取肤色的部分，根据其大小、形状等识别脸的位置。另外，同样也根据肤色的区域和大小、形状等来识别手的位置。

识别出的脸的位置作为机器人R移动时的信息且为了取得与该人的通讯而被输出到主控制部200，同时被输出到无线通信部170，经由基站1被发送到机器人管理装置3。

[扬声器]

扬声器S基于由后述的声音合成部111生成的声音数据输出声音。

[传声器]

传声器MC、MC用于收集机器人R的周围的声音。被收集的声音被输出到后述的声音识别部112以及音源定位部113。

[声音处理部]

声音处理部110包括声音合成部111、声音识别部112以及音源定位部113。

声音合成部111是基于主控制部200决定并输出的讲话行动的指令，根据文字信息生成声音数据，并对扬声器S输出声音的部分。声音数据的生成时，利用预先存储的文字信息和声音数据之间的对应关系。

声音识别部112从传声器MC、MC输入声音数据，基于预先存储的声音数据和文字信息之间的对应关系，根据声音数据生成文字信息，并输出到主控制部200。

音源定位部113基于传声器MC、MC之间的声压差以及声音的到达时间差，确定音源的位置(离机器人R的距离以及方向)。

[对象检测部]

对象检测部120检测在机器人R的周围是否存在具有检测用标签T的检测对象H，同时在检测到检测对象H的存在的情况下，确定该检测对象H的位置。关于对象检测部120，在专利文献1中已经详细地进行了说明，这里，由于在此之上详细叙述便会脱离本发明的主旨，所以省略进一步的说明。

[自主移动控制部]

如图4所示，自主移动控制部150包括头部控制部151、臂部控制部152以及腿部控制部153。

头部控制部151按照主控制部200的指示驱动头部R4，臂部控制部152按照主控制部200的指示驱动臂部R3，腿部控制部153按照主控制部200的指示驱动腿部R1。这些自主移动控制部150、头部R4、臂部R3以及腿部R1的组合是方案中的‘自主移动单元(自主移动装置)’的一例。

[把持部控制部]

把持部控制部160按照主控制部200的指示驱动把持部71。

[无线通信部]

无线通信部170是进行与机器人管理装置3之间的数据收发的通信装置。无线通信部170包括公共线路通信装置171以及无线通信装置172。

公共线路通信装置171是利用携带电话线路或PHC(PersonalHandyphone System，个人移动电话系统)线路等公共线路的无线通信单元。另一方面，无线通信装置172是符合IEEE802.11b标准的无线LAN等近距离无线通信的无线通信单元。

无线通信部170按照来自机器人管理装置3的连接要求，选择公共线路通信装置171或无线通信装置172来与机器人管理装置3进行数据通信。

[把持部]

接着，参照图5至图6进一步详细说明机器人R的把持部71R(L)。图5(a)是表示机器人的把持部的立体图，是表示手指打开状态的图。图5(b)是表示机器人的把持部的立体图，是表示手指关闭状态的图。图6是表示机器人的把持部、开度检测单元以及6轴力传感器的方框图。另外，一对把持部71R、71L镜面对称，图5(a)以及图5(b)中示出左侧的把持部71L。以下，根据情况使用略去了R、L的符号进行说明。

如图5所示，把持部71包括掌部72、第一指部73、第二指部74。

掌部72通过手臂关节部36、37连接到下臂连杆55(参照图3)。

第一指部73是相当于人的拇指的部分，通过第一指关节部73a连接到掌部72的基端侧。

第二指部74是相当于人的食指、中指、无名指、小指的部分，经由第二指关节部74a连接到掌部72的前端侧。

此外，掌部72内内置有用于驱动第一指部73的第一指部用电机73b和用于驱动第二指部74的第二指部用电机74b。此外，掌部72中内置有检测第一指部角度α(第一指部73和掌部72的角度)的第一指部角度检测单元83和检测第二指部角度β(第二指部74和掌部72的角度)的第二指部角度检测单元84(参照图6)。

第一指部角度α是第一指部73和掌部72所构成的角度，从手指打开状态向手指关闭状态而增大。该第一指部角度α在图5(a)所示的手指打开状态(把持时全开)为α1，在图5(b)所示的手指关闭状态(把持时全闭)下为α2(α1≤α≤α2)。

第二指部角度β是第二指部74和掌部72所构成的角度，从手指打开状态向手指关闭状态而增大。该第二指部角度β在图5(a)所示的手指打开状态(把持时全开)为β1(＝0)，在图5(b)所示的手指关闭状态(把持时全闭)为β2(0≤β≤β2)。

这里，作为与把持部71的开度有关的数值，将相对于第一指部角度α以及第二指部角度β的把持角度偏差θ如下定义。

θ＝(α2-α)+(β2-β)

即，把持角度偏差θ是表示把持部71相对于全闭状态的打开程度(开度)的数值，在手指关闭状态(把持时全闭)下，最小值为θmin＝0，在手指打开状态(把持时全开)下，最大值为θmax＝α2+β2。

在把持部71把持了物品的状态下，由于成为手指关闭状态之前的状态下各指部73、74停止，所以把持角度偏差θ取正值。把持角度偏差θ具有被把持的物品的厚度越大则其值越大的特征。

此外，本实施方式的机器人控制系统A采用6轴力传感器62作为检测物品作用于把持部71的外力的外力检测单元。该6轴力传感器62也可以检测外力的方向。因此，从物品作用于把持部71的外力中，可分别检测X轴方向的力Fx、Y轴方向的力Fy、Z轴方向的力Fz。从而，即使物品重的情况下，也可以除去物品的重力引起的Z轴方向的力，可检测人要交付或接收物品而引起的外力(在本实施方式中为Fx)。

(主控制部200以及存储部300)

接着，参照图7说明图4的主控制部200以及存储部300。图7是表示图4的主控制部以及存储部的方框图。

(存储部)

如图7所示，存储部300包括人数据存储部310、地图数据存储部320、物品数据存储部330以及讲话数据存储部340。

人数据存储部310将与位于作为任务执行区域EA的办公室内的人有关的数据(人数据)与各个人相关联地进行存储。

作为人数据，包含与人识别号(ID)、姓名、所属、标签识别号、通常所在处、桌子位置、脸图像等有关的数据。

地图数据存储部320存储有与任务执行区域EA的地形(墙壁位置、桌子位置等)有关的数据(地图数据)。

物品数据存储部330将与使机器人R运送的物品有关的数据(物品数据)与各个物品相关联地进行存储。

作为物品数据包含有与物品识别号、物品的名称、大小、重量等有关的数据。

讲话数据存储部340存储有机器人R用于讲话的数据(讲话数据)。

(主存储部)

如图7所示，主存储部200包括行动管理单元210、人确定单元220、移动行动决定单元230、接受/交付行动决定单元240以及计时单元250。

(行动管理单元)

行动管理单元210取得从机器人管理装置3发送的执行命令信号，基于该执行命令信号控制人确定单元220、移动行动决定单元230以及接受/交付行动决定单元240。

此外，行动管理单元210将由陀螺仪传感器SR1检测出的机器人R的朝向数据，由GPS接收器SR2检测到的机器人R的位置数据等输出给机器人管理装置3。

此外，行动管理单元210向机器人管理装置3输出用于报告机器人R的任务执行状况的行动报告信号。

(人确定单元)

人确定单元220基于人数据存储部310中存储的人信息、由对象检测部120取得的标签T的标签识别号，确定由对象检测部检测到的人(检测对象)是谁。由于人数据存储部310中关联地存储有该人的姓名和该人固有的标签T的标签识别号，所以通过参照这些数据和执行命令信号，机器人R附近的人能够判定是否是与任务执行有关系的人。

进而，人确定单元220基于由移动体提取部102提取出的移动体的位置数据和由对象检测部120检测到的检测对象的位置数据，确定照相机C、C拍摄到的移动体是谁。

(移动行动决定单元)

移动行动决定单元230用于决定机器人R的自主移动的内容，包括移动路径决定单元231以及接受/交付位置决定单元232。

移动路径决定单元231基于任务执行命令信号、机器人R的位置数据、机器人R的朝向数据、人数据、地图数据，决定机器人R的移动路径。

接受/交付位置决定单元232基于由移动体提取部102检测出的移动体(人)的位置数据，决定机器人R的接受/交付位置。

接受/交付位置决定单元232决定接受/交付位置时，移动路径决定单元231决定机器人R的移动路径，以便移动到该接受/交付位置。该接受/交付位置是能够在机器人R和人之间良好地进行物品的接受/交付的位置，使用预先设定的距离a1(参照图12)决定。

(接受/交付行动决定单元)

接受/交付行动决定单元240用于决定把持部71伴随物品运送作业的行动(动作)内容，包括：接受方法决定单元241、接受/交付高度决定单元242、接受开始判定单元243、接受动作完成判定单元244、把持成功与否判定单元245、交付开始判定单元246、交付完成判定单元247、运送状态设定单元248以及熟练度判定单元249、把持位置识别单元261、把持控制单元262、把持部移动单元263以及设置成功与否判定单元264。

接受方法决定单元241基于执行命令信号、物品数据存储部330中存储的物品数据决定接受方法。

作为本实施方式的机器人R可选择的接受方法，有一手接受以及双手接受的两种。

一手接受是机器人R的一个把持部71R(或71L)接受物品的接受方法。双手接受是机器人R的两个把持部71R、71L接受物品的接受方法。接受方法决定单元241基于物品数据的大小或重量选择这两种类中的一个。例如，考虑在接受A4尺寸的文件等、可双手接受的大小的物品的情况下进行双手接受，在接受不能双手接受的大小的小尺寸的物品的情况下进行一手接受。

(接受/交付高度决定单元)

在接受/交付动作的对象为人的情况下，接受/交付高度决定单元242基于由移动体提取单元102计算出的人的身高，决定把持部71的伸出高度a3(参照图15)。该伸出高度是在机器人R和人之间良好地进行物品的接受/交付的高度，基于计算出的身高选择预先设定的三个级别高度中的某一个。

而且，接受/交付高度决定单元242通过自主移动控制部150将把持部71伸出到高度a3，同时从人到把持部71为止的距离为距离a2，进而，伸出把持部71，使得与由移动体提取部102计算出的人的中心(中心铅直线)一致(参照图14、图15)。

(接受开始判定单元)

接受开始判定单元243判定是否是人将物品伸出到机器人R可接受的位置，并且机器人R可开始接受动作，在判定为可开始接受动作的情况下，使把持部71开始接受动作。

接受开始判定单元243在把持部71未把持物品的状态，详细地说，在后述的等待接受状态下，在6轴力传感器62检测出的X轴方向的力Fx为规定值Fx1(第一规定值)以上的情况下，判定为可开始接受动作，通过把持部控制部160驱动把持部71，进行手指关闭动作。

这是利用了要对机器人R交付物品的人对掌部72按压物品的情况的控制。

(接受动作完成判定单元)

接受动作完成判定单元244在把持部71正在接受物品的状态下，判定接受动作是否完成。

在6轴力传感器62检测的X轴方向的力Fx为规定值Fx2(第二规定值；Fx2≤Fx1)以下的情况下，该接受动作完成判定单元244判定为接受动作完成。

这是利用了要对机器人R交付物品的人判定为机器人R接受了物品而松公手时物品按压到掌部72上的力减少的情况的控制。

此外，在等待接受状态下，在把持部71的开度为规定值以下的情况下，即把持角度偏差θ为规定值θ1(第三规定值)以下的情况下(例如，θ＝0)，接受动作完成判定单元244判定为接受动作完成。

接受动作完成判定单元244在判定为接受动作完成的情况下，通过把持部控制部160驱动把持部71，在手指关闭方向上产生转矩，从而把持物品。

(把持成功与否判定单元)

把持成功与否判定单元245判定物品的把持是否成功。

在本实施方式中，把持成功与否判定单元245在进行双手接受的情况下、通过臂部控制部152使把持部71R、71L接近或远离。而且，基于6轴力传感器62检测的来自物品的反作用力Fy，判定把持部71R、71L两个是否正在把持物品。

在来自物品的反作用力Fy为规定值以上的情况下，该把持成功与否判定单元245判定为把持成功。

(交付开始判定单元)

在机器人R将物品伸出到人能接受的位置的状态下，交付开始判定单元246判定人是否要接受物品，在判定为人要接受物品的情况下，使把持部71开始交付动作。

在后述的等待交付状态下，在6轴力传感器62检测的X轴方向的力Fx为规定值Fx3以上的情况下，交付开始判定单元246判定为可开始交付动作，通过把持部控制部160驱动把持部71，并进行手指打开动作。

这是利用了要从机器人R接受物品的人拉拽物品的情况的控制。

此外，在等待交付状态下，在把持部71的开度为规定值以下的情况下，即把持角度偏差θ为规定值θ2以下的情况下(例如，θ＝0)，交付开始判定单元246判定为可开始接受动作。

这是利用了由于要从机器人R接受物品的人拉拽物品，物品被从把持部71取走，把持部71通过把持转矩而关闭的情况的控制。

(交付完成判定单元)

在后述的交付中状态下，由6轴力传感器62检测的X轴方向的力Fx为规定值Fx4(Fx4≤Fx3)以下的情况下，交付完成判定单元247判定为交付动作完成。

这是利用了由于人完全地接受物品，从而物品对把持部71产生的外力Fx减小的情况的控制。

(运送状态设定单元)

运送状态设定单元248检测把持部71的状态，并进行设定、更新。

作为把持部71的状态有以下的状态。

1：自由...不依赖于物品运送任务的状态

2：等待接受...伸出把持部，等待人交付物品的状态

3：接受中...人交付物品并进行物品的接受的状态

4：接受动作完成...人从物品处松手，物品(认为)被送到机器人侧的状态

5：把持成功与否判定...判定机器人是否成功把持物品的状态

6：接受失败...机器人接受物品失败的状态

7：把持完成...机器人接受物品成功，并把持了物品的状态

8：等待交付...伸出把持部，并等待人接受物品的状态

9：交付中...人接受物品并进行物品的交付的状态

10：交付完成...人完全接受物品，并且物品传送到人侧的状态

11：错误...在搬送中掉下物品的状态等

(熟练度判定单元)

熟练度判定单元249判定与接受/交付动作有关的人的熟练度。

熟练度判定单元249使用作为设置在主控制部200内的时钟的计时部250测定从等待接受状态转移到接受中状态所需的时间或从等待接受状态转移到接受中状态所需的时间。然后，基于所测定的时间的长度判定人的熟练度。这里，从测定时间短的一方起依次判定为熟练度高、熟练度中、熟练度低。

(把持位置识别单元)

把持位置识别单元261为了能进行以图像识别为主的把持动作，根据作为把持对象的物品的图像来识别适于物品的把持的部分。

(把持控制单元)

把持控制单元262进行将把持部71驱动到运送容器的规定的把持位置(规定位置)并把持规定位置的控制。

(把持部移动单元)

把持部移动单元263将所把持的物品或运送容器移动到根据设置场所的高度求得的目标位置。

(设置成功与否判定单元)

设置成功与否判定单元264在物品或运送容器的设置完成之前，判定把持部是否降落到规定的高度。在把持部降落到规定的高度的情况下，判定为设置失败。

把持部控制部160基于该熟练度设定手指关闭、手指打开动作的速度。即，在机器人R对被判定为熟练度低的人进行接受/交付动作的情况下，使把持部71减慢手指关闭、手指打开动作，使得不对人带来不安感。

此外，在机器人R对被判定为熟练度高的人进行接受/交付动作的情况下，接受/交付行动决定单元240使把持部71加速手指关闭、手指打开动作，从而不使人感到烦躁。

此外，接受/交付行动决定单元240根据该熟练度决定讲话行动，基于讲话数据使扬声器S进行讲话。

(机器人的动作例子)

接着，说明本发明的优选的实施方式的机器人R的物品运送动作。这里，以机器人R收到‘从取得源取得容纳了物品的规定规格的运送容器并将运送容器送到目的地’的任务相关的执行命令信号的情况为例进行说明。

根据本发明，物品载置或容纳在托盘等运送容器上来运送。图8是表示本发明的物品运送所使用的运送容器的一例的图，图8(a)是从上面观看运送容器M的图，(b)是从箭头SP的方向观看(a)所示的容器M的图，(c)是从背面观看容器M的图。在图8中，容器M通过具有载置或容纳物品或物品的容器的凹部M1，考虑在运送中物品不会在运送容器M上摆动或滑动。此外，运送容器M优选具有适于机器人R的把持部把持的形状，以使机器人R容易把持规定的位置(或把持部分)M3。例如，在图8的例子中，如(a)所示，运送容器M的表面被加工成使得相当于拇指的第一指部73不滑动，如(c)所示，在背面具有第二指部74容易搭钩的凸形状。

此外，在运送容器M的表面附加规定的图像识别用图形M2以使机器人R容易进行图像识别。在图8的例子中，作为规定的图形M2，贴有本公司的机器人名——‘ASIMO’的标识，但图形M2不限于此，只要是与运送容器M的底色不同的颜色且是任意的颜色的任意的标记或图形，可以是任意的。运送容器M的颜色为了运送容器M的识别，优选与放置运送容器M的放置处B1、C1～C3的表面颜色不同的颜色，进而，为了把持动作而优选与把持部71的颜色也不同的颜色。

进而，运送容器M的把持部分的高度h优选比把持部71的第二指部74的厚度高。图9表示机器人R把持运送容器M的状态的一例。

另外，在以下的说明中，由于作为运送容器M以运送饮料的托盘为例进行说明，也可以代替运送容器M而称作托盘M。

此后，依次说明向运送容器M的取得源移动的取得位置移动动作、从取得处取得运送容器M的取得动作、取得并把持运送容器M并运送到目的地的运送动作、以及将运送容器M放置到目的地的物品放置处的设置动作。

(取得位置移动动作)

图10是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示取得源为人的情况下的向取得位置的移动的流程图。

首先，机器人R在设定于任务执行区域EA的原位置进行等待(步骤S1)。

机器人R接收到从机器人管理装置3发送的执行命令信号时(步骤S2中为“是”)，机器人R开始从原位置向人H1的通常所在处(以下记载为‘通常所在处P1’。)的移动(步骤S3)。到达人H1的通常所在处后(步骤S4中为“是”)，机器人R中止移动，开始人H1的搜索(步骤S5)。

对象检测部120检测人H1的标签识别号(步骤S6中为“是”)，机器人R由照相机C、C取得人H1的图像(步骤S7中为“是”)，如图12所示，向人H1的正面移动(步骤S8)。图12中示出机器人R移动到由接受/交付位置决定单元232决定的接受位置的状态。

另外，对象检测部120在规定的时间内没有检测到人H1的标签识别号的情况下(步骤S9中为“是”)，机器人R生成用于传达行动管理单元210不能执行任务的意思的行动报告信号，并对机器人管理装置3输出，同时移动到原位置(步骤S10)。

此外，图11是表示取得源为场所的情况下的向取得位置的移动的流程图。图11的流程图除了图10的虚线框由步骤S11以及S12取代之外，与图10的流程图相同，所以仅说明不同点。在图11中，接着步骤S4，在步骤S11中，得到目标场所(例如，图1的C1等)的图像，在判定步骤S12中，判定是否有托盘。在有托盘的情况下(“是”的情况)，进至步骤S8，如果没有则进至步骤S10。

(取得动作)

接着说明机器人R的接受动作。作为物品的取得源，可以是桌子等物品放置处(例如图1的B1)、也可以是人。图13是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示取得源为人的情况下的接受动作的流程图。

如图14以及图15所示，移动到取得位置的机器人R将手指打开状态的把持部71(71R、71L)伸出到由接受/交付高度决定单元242决定的接受高度(步骤S21)。

如图14以及图15所示，机器人R将把持部71R、71L伸出到由接受/交付高度决定单元242决定的高度a3，同时将把持部71R、71L伸出为从人H1到把持部71R、71L的距离为距离a2。进而，机器人R使把持部71R、71L的伸出方向与移动体提取部102计算出的人H1的中心(中心铅直线)一致。

把持部71R、71L的伸出完成后，运送状态设定单元248将运送状态设定为‘等待接受’，同时机器人R例如说出‘请交付托盘M’等，从而促使交付运送容器M(步骤S22)。

然后，在步骤S23中，确认运送容器M的位置，在步骤S24中，判定运送容器M的位置的变化是否未到规定值。通过该判定，判定人正在伸出托盘M还是伸出到某一位置而处于大致停止的状态。在步骤S24中，在位置的变化大于规定值的情况下(“否”的情况)，判定为正在伸出，返回步骤S23。在位置的变化小于规定值的情况下(“是”的情况)，判断为人的伸出动作大致完成，并进至步骤S25。

把持位置识别单元261对托盘M的把持部分M3进行图像识别(步骤S25)，把持控制单元262将把持部71向托盘M的把持部分M3移动，在步骤S26中，6轴力传感器62R、62L的检测值Fx或Fy是否大于规定的值Fx1或Fy1。如果不大于规定的值(“否”的情况)，判定为把持部71没碰到托盘M的把持部分M3，并返回步骤S25。在判定步骤S26中为“是”的情况下，判定为把持部71碰到托盘M的把持部分M3，并进至步骤S27，运送状态设定单元248将运送状态设定为‘接受中’，同时机器人R开始关闭把持部71R、71L。图16中示出机器人R开始了托盘M的接受的状态。

然后，在接受中状态下，机器人R做出如下动作：由6轴力传感器62R、62L检测的力Fx为Fx2以下或把持角度偏差θ为θ1以下时(步骤S28中“是”)，运送状态设定单元248将运送状态设定为‘接受动作完成’(步骤S29)，同时如图17所示，把持部71R、71L把持托盘M。

接着，把持成功与否判定单元245判定把持部71R、71L的开度(步骤S30)。

在两个把持部71R、71L的开度，即把持角度偏差θ为规定值θ3(第四规定值)以上(条件D1)的情况下，判定为托盘M厚、两个把持部71R、71L把持了托盘M，运送状态设定单元248将运送状态设定为‘把持完成’(步骤S31)。

在把持部71R、71L的至少一个的把持角度偏差θ小于规定值θ3(条件D2)的情况下，运送状态设定单元248将运送状态设定为‘判定是否把持成功’(步骤S32)，同时把持成功与否判定单元245判定把持的成功与否(步骤S33)。

详细地说，机器人R使把持部71R、71L接近或远离，由6轴力传感器62R、62L检测从托盘M作用的反作用力Fy。在反作用力Fy为规定值Fy1以上的情况下(条件D3)，把持成功与否判定单元245判定为把持成功，运送状态设定单元248将运送状态设定为‘接受动作完成’，同时把持部71R、71L把持托盘M。

此外，在反作用力Fy小于规定值Fy1的情况下(条件D4)，把持成功与否判定单元245判定为把持失败，运送状态设定单元248将运送状态设定为‘接受失败’。

这里，参照图18说明是否把持成功判定。

如图18(a)所示，在两个把持部71R、71L正在把持托盘M的情况下，使把持部71R、71L接近时，产生托盘M引起的反作用力Fy(规定值Fy1以上)(条件D3)。

如图18(b)所示，在仅是把持部71R、71L的一个(这里为把持部71R)正在把持托盘M的情况下，即使让把持部71R、71L接近，托盘M引起的反作用力Fy也是非常小的值(规定值Fy2以上，并且小于规定值Fy1。Fy2≤Fy＜Fy1)(条件D5)。

如图18(c)所示，在两个把持部71R、71L未把持托盘M的情况下，即使让把持部71R、71L接近，也不产生托盘M引起的反作用力Fy(Fy＝0)。

从而，在反作用力Fy为规定值Fy1以上的情况下，把持成功与否判定单元245判定为把持成功，从而能够判定机器人R是否正以双手(把持部71R、71L)把持物品。

另外，这里，说明了取得源为人的情况下的取得动作，但通过省略图13的流程图的虚线部分(步骤S22～S24)，图13的接受流程图也可以应用于取得源为书桌、柜台、桌子等场所的情况。在该情况下，在步骤S21中，机器人R需要将把持部71伸出得比取得源的物品放置处高。

这样，根据本发明，即使取得源为人的情况下，也能够取得托盘M而无需人的辅助。

(重新接受准备)

接着，说明机器人R的重新接受准备。图19是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示物品的重新接受准备的流程图。

把持成功与否判定单元245判定为把持失败时(图13的步骤S33中条件D4)，运送状态设定单元248将把持状态设定为‘接受失败’而成为重新接受状态(步骤S41)，把持成功与否判定单元245判定把持部71R、71L的状态(步骤S42)。在是否把持成功判定动作中，6轴力传感器62R、62L的至少一个检测到规定值Fy2以上的外力Fy的情况下(步骤S42中条件D5)，运送状态设定单元248将运送状态设定为‘交付状态’，机器人R说出‘请接受托盘M并再次交付’(步骤S43)。

然后，机器人R进行如下动作：6轴力传感器62R、62L中正在把持托盘M的一个检测出规定值Fx5以上的外力Fx时(步骤S44中为“是”)，运送状态设定单元248将运送状态设定为‘交付中’，同时把持部71R、71L被打开(步骤S45)。然后，转移到步骤S22并再次执行接受动作。

另外，在步骤S42中，在是否把持成功判定动作中，在把持部71R、71L的把持角度偏差θ为规定值θ4以下的情况下(例如，θ＝0)(条件D6)，机器人R说出‘请再次交付托盘M’，把持部71R、71L被打开(步骤S45)。然后，转移到图13的步骤S22并再次执行接受动作。

(运送动作)

接着，说明机器人R的物品运送移动。图20是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为人的情况下的运送移动的流程图。

在步骤S28(图13)中，物品把持完成后，机器人R将把持部71R、71L移动到偏离了照相机C、C的拍摄区域的位置(死角)(步骤S61)。这是为了防止被把持的托盘M妨碍照相机C、C的视场。

机器人R在移动/把持部抑振控制步骤中，开始从接受位置向人H2的通常所在处(以下记载为‘通常所在处P2’。)的运送(步骤S62)。然后，在到达人H2的通常所在处P2之前(只要步骤S63中还仍为“否”)，继续运送。

根据本发明，机器人R在以把持了物品或托盘M的状态进行移动的情况下(即，物品运送中)，进行用于抑制把持部的振动的抑振控制。因此，在适当的定时(例如，图13的步骤S21等)中，在不把持物品的状态下，将臂部R3设为把持并运送时的姿势，存储6轴力传感器62R、62L的检测值Fx0、Fy0、Fz0、Mx0、My0、Mz0(将这暂时称作‘校准值’)。进而，例如在把持完成的步骤S31中，在把持物品或承载了物品的托盘M而静止的状态下，存储6轴力传感器62R、62L的检测值Fx1、Fy1、Fz1、Mx1、My1、Mz1(将这暂时称作‘物品加重值’)。

图22是表示本发明的一个实施方式的具有把持部71的抑振控制功能的图4的臂部控制部152的结构例的大略方框图。机器人R具有结构相对于左右的臂部相同的臂部控制部152R、152L，而将各臂部控制部简称为臂部控制部152。一般来说，机器人R的左右的各臂部R3具有肩关节(SJ)上3个、肘关节(HJ)上1个以及手臂关节(RJ)上的3个共7个未图示的致动器，即肩关节电机SJM1～SJM3、肘关节电机HJM以及手臂关节电机RJM1～RJM3。在图22中，臂部控制部152包括：对于构成其控制的臂部R3的7个未图示的电机SJM1～SJM3、HJM以及RJM1～RJM3分别设置的控制/驱动部401～407；使6轴力传感器62检测出的6个检测值Fx、Fy、Fz、Mx、My、Mz各自通过的低通滤波器(1/(A·s+1))408(A是任意的时间常数)；对6个低通滤波器408的输出作用本领域技术人员公知的雅可比矩阵(Jacobian Matrix)而得到对于7个电机控制/驱动部401～407的信号的分配部409。各电机控制/驱动部40i(i＝1～7)包括：根据对于对应的电机的力的目标值TVfi(i＝1～7)和位置的目标值TVpi(i＝1～7)进行达标(compliance)控制的达标控制部(未图示)；使用达标控制的输出和来自分配部409的对应的信号进行对应的电机的速度控制以及驱动的速度控制环(未图示)。低通滤波器408优选构成为仅使电机控制/驱动部401～407的未图示的速度控制环能够反应的成分通过。

进而，根据本发明，臂部控制部152具有用于在物品运送中进行把持部71的抑振控制的把持部抑振控制部410。把持部抑振控制部410根据所述存储的校准值Fx0、Fy0、Fz0、Mx0、My0、Mz0以及物品加重值Fx1、Fy1、Fz1、Mx1、My1、Mz1，还有运送中时时刻刻从6轴力传感器62R、62L检测的值Fx、Fy、Fz、Mx、My、Mz，计算对把持部71施加的6个加速度成分

Fx-(Fx1-Fx0)

Fy-(Fy1-Fy0)

Fz-(Fz1-Fz0)

Mx-(Mx1-Mx0)

My-(My1-My0)

Mz-(Mz1-Mz0)。

把持部抑振控制部410包括：仅使各加速度成分中、所述电机控制/驱动部401～407的未图示的速度控制环能够反应的成分通过的低通滤波器(1/(A·s+1))420(A是任意的时间常数)；对该6个低通滤波器输出作用雅可比矩阵而得到对于7个电机控制/驱动部401～407的信号的分配部430；以及将分配部430的输出信号放大为适当的大小的放大器440。放大器440的输出被施加到对应的电机控制/驱动部40i(i＝1～7)的未图示的速度控制环中。仅为参考而在图27中概念性地表示各电机控制/驱动部40i的结构例。在图27中，电机控制/驱动部40i(i＝1～7)由下述部分构成：从所述力的目标值TVfi和位置的目标值TVpi之和减去分配部409的对应的输出的加减法器444；从加减法器444的输出减去来自后级的反馈量Fb1的减法器446；将减法器446的输出放大的放大器448；从把持部抑振控制部410的放大器440的输出和前级的放大器448的输出之和减去来自后级的反馈量Fb2的加减法器450；将加减法器450的输出放大的放大器452；提供将放大器452的输出进行了积分的输出值Fb2的积分元件454；以及提供对积分元件454的输出进行了积分的输出值Fb1的积分元件456。

在图22中，上述的计算加速度成分的部分和低通滤波器420所构成的模块415相当于方案的提取单元。分配部430、运算放大器440以及各电机控制/驱动部40i的加减法器450构成方案的施加单元。

另外，在所述分配部409以及430中，使用了雅可比矩阵，但不限于此，可以使用任意的适当的运算方式。

图26是表示本发明的抑振控制的效果的一例的曲线图。在图26中，(a)表示施加于把持部71的围绕Y轴的角速度的时间变化，(b)表示施加于把持部71的Z轴方向加速度的时间变化。在(a)以及(b)中，细线是不进行抑振控制的情况下的曲线，粗线是进行了抑振控制的情况下的曲线。在进行了抑振控制的情况下，在峰值时具有40％的抑振效果。

这样，根据本发明，通过在物品运送中进行把持部71的抑振控制，能够抑制把持部71、即运送中的物品的振动，并稳定地进行运送。

返回图20，机器人R到达人H2的通常所在处P2时(步骤S63中为“是”的情况)中止移动，并开始人H2的搜索(步骤S64)。

对象检测部120检测到人H2的标签识别号时(步骤S65中为“是”)，机器人R由照相机C、C取得人H2的图像(步骤S66中为“是”)，移动到人H2的正面(步骤S67)。在步骤S67中，也优选进行所述抑振控制。然后，将托盘M交付给人H2(步骤S69)，返回等待状态(图10的步骤S1)。另外，由于步骤S69的对人的交付可通过专利文献1中详细说明的方法进行，因此这里省略。

另外，对象检测部120在规定时间内没能检测到人H2的标签识别号的情况下(步骤S68中为“是”)，控制过渡到图25的步骤S101。图25的说明在后面论述。

以上是目的地为人的情况下的运送动作，而通过图21说明目的地为场所的情况下的运送动作。图21的流程图与图20的共同点很多，所以仅说明不同点。在图21中，在判定步骤S63中判定为到达了目的地的情况下(“是”的情况)，在步骤S74中取入目标场所的图像，在步骤S76中，在决定了物品或运送容器M的放置处之后，执行所述机器人位置对齐/把持部抑振控制步骤S67，进至图23或图24(设置动作流程图)的步骤S120。

(设置动作)

专利文献1中详细地说明了对于人的交付动作，但这里，说明设置处的高度高于机器人R的把持部71的可动范围的下限的情况下的设置动作。换言之，说明能够仅通过机器人R的臂部R3的动作进行设置的情况下的设置动作。图23是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示目的地为场所的情况下的设置动作的一例的流程图。

在图23中，首先移动到设置处中的位置(步骤S120)，在步骤S121中，接受/交付高度决定单元242根据设置处(例如，指定的桌子)的高度Hs来设定目标位置Ht。例如，设定为Ht＝H+w1(w1＞托盘的高度)。设置处的高度Hs也可以从物品数据存储部330得到或还可以根据视觉信息进行推定。在步骤S122中，把持部移动单元263对臂部控制部152发出指令，以将把持部降落到目标位置Ht。在步骤S124中，根据视觉信息来判定把持部的高度Hh是否高于设置处的高度。在把持部的高度Hh高于设置处的高度的情况下(“是”的情况)，在步骤S126中，从当前的把持部的位置向桌子方向施加力，在判定步骤S128中，交付完成判定单元247判定力传感器的值是否为规定的值以上。若如此(“是”的情况)，则由于首尾正确地放置，所以在步骤S130中进行设置报告，在步骤S132中移动到原位置并进入等待状态。

在判定步骤S124中，在把持部的高度Hh与设置处的高度相等的情况下(“否”的情况)，认为作为运送物的托盘已经接触到或放到设置处。因此，在判定步骤S134中，判定传感器的值是否为规定值以上。臂部控制部152由于要将把持部降落到目标位置Ht，所以反复进行判定步骤S134直到力传感器的值超过规定值为止。在力传感器的值超过了规定值的情况下(“是”的情况)，由于首尾正确地放置，所以进至步骤S130并进行所述动作。

另一方面，在判定步骤S128中，在力传感器的值不超过规定值的情况下(“否”的情况)，在进一步的判定步骤S140中，设置成功与否判定单元264判定把持部的移动量是否超过了规定的值。在未超过的情况下(“否”的情况)，返回步骤S126。在判定步骤S140中，在“是”的情况下，由于把持部仅通过臂部的动作就达到下降的界限，所以判定为设置失败。在该情况下，进行适当的失败处理(步骤S141)，移动到原位置(步骤S142)，返回等待状态(步骤S142)。

图24表示另一实施方式的设置动作。图24的流程图除了步骤S128的“否”分支以后的流程之外与图23的流程图相同，因此仅说明不同点。

在判定步骤S128中，在力传感器的值不超过规定的值的情况下(“否”的情况)，在进一步的判定步骤S150中，也有通过设置成功与否判定单元264判定目标值变更次数是否达到了规定值的方法。该方法中，在目标值变更次数未达到规定值的情况下，在步骤S151中，将目标值Ht减少规定的值w2。即，设定为Ht＝Ht-w2，返回步骤S122。在判定步骤S150中，在目标值变更次数达到规定的值的情况下(“是”的情况)，也由于把持部仅通过臂部的动作就达到了下降的界限，所以判定为设置失败。

如上所述，根据本发的一个实施方式的设置动作，如果设置处的高度高于机器人R的把持部71的可动范围的下限，则可以将运送的物品或托盘M放置在设置处。

另外，在运送移动中，在机器人R掉落了托盘M的情况下，运送状态设定单元248将运送状态设定为‘错误’，同时行动管理单元210生成传达运送失败的行动报告信号，并输出给机器人管理装置3。

在本实施方式中，在把持角度偏差θ为规定值θ5以下的情况下(例如，θ＝0)，接受/交付行动决定单元240判定为机器人R掉落了托盘M。

此外，在运送移动中，在6轴力传感器62检测的Fx变化很大的情况下(例如，托盘M撞到障碍物)，机器人R先停止自主移动并等待Fx返回到通常值。

同样，在运送移动中，照相机C、C检测到前方有障碍物的情况下(例如，人在机器人前面横穿)，机器人R也先停止自主移动并等待障碍物从前方消失。

(物品放置处移动)

图25是表示本发明的实施方式的机器人控制系统的物品运送作业的流程图，是表示在图20中没有将运送容器M交给人的情况下放置于物品放置处的动作的流程图。

机器人R在规定时间内未能搜索到人H2的情况下(步骤S68中为“是”)，机器人R进行从人H2的通常所在处P2向物品放置处B1的移动(步骤S101)。在该情况下，也优选进行所述抑振控制。

而且，机器人R通过所述设置动作将托盘M放置到物品放置处B1(步骤S102)，同时生成传达将托盘M放到物品放置处B1的消息的行动报告信号，并输出到机器人管理装置3以及人H2专用的终端5(步骤S103)。然后，机器人R进行从物品放置处B1向原位置的移动(步骤S104)。

以上，只不过是为了说明本发明而举出的实施方式的例子。但是按照本发明的技术思想或原理对所述实施方式进行各种变更、修改或追加对于本领域技术人员来说是很容易的。

例如，在物品运送中，为了判定机器人是否掉落了物品也可以利用6轴力传感器检测出的Z轴方向的外力Fz。这是由于在机器人掉落了物品的情况下6轴力传感器不检测物品的负荷，导致Fz降低的缘故。

此外，机器人的各关节部的数量、配置等也可以适当地进行设计变更。

此外，在本实施方式中，结构为在机器人中组装的各控制部内设置接受/交付行动决定单元、人位置确定单元、接受/交付高度决定单元、身高确定单元、接受/交付高度决定单元以及人确定单元，但也可以是将这些各单元中的至少一个设置在机器人管理装置侧的结构。

图22所示的抑振控制部410中，使用了由6轴力传感器检测的所有成分，但由于6个成分中Fz以及My为重要的要素，所以也可以仅使用包含Fz以及My的成分。