机器人系统以及机器人系统的控制方法与流程

本发明涉及机器人系统以及机器人系统的控制方法。

背景技术：

以往，公知有主从式机械手及其控制方法。

例如，专利文献1公开了这样的技术：主从式机械手构成为，当由力传感器测量出的反作用力超过预先设定的力目标值时，使从动臂在预先设定好的力控制方向上不以追随主动臂的动作的方式动作。力控制方向是设定为与作业对象物的法线方向大致一致的方向，是向作业对象物去的方向以及离开作业对象物的方向。通过力控制使从动臂以预先设定好的力目标值和由力传感器测量出的反作用力一致的方式动作。

另外，专利文献2公开了这样的技术：主从式机械手具有从动臂，通过操作主动臂，从动臂以与主动臂成为相似形的方式追随主动臂的形状。在主动臂设有触头，该触头与位置限制构件抵接而限制主动臂的动作范围。

专利文献1：日本特开平8－281573号公报

专利文献2：日本特开平7－124876号公报

但是，对于专利文献1所述的主从式机械手，在例如正与较硬的作业对象物接触时等情况下，若操作者试图向与使从动臂朝向作业对象物去的方向相应的方向强行移动主动臂，对主动臂施加过大的负荷，则力传感器或者主动臂有可能会破损。

另外，专利文献2所述的主从式机械手在从动臂接触到工件时无法将该信息传递给操作者。操作者有时难以辨别是从动臂与工件接触而动作受到限制还是触头与位置限制构件抵接而主动臂的动作范围受到限制。

技术实现要素：

本公开的目的在于提供一种能够使操作者知觉主动臂以及从动臂中的至少一方的动作极限的机器人系统以及机器人系统的控制方法。

为了实现上述目的，本公开的一形态的机器人系统具有：从动单元，其包括具有作业端的从动臂、驱动所述从动臂的从动臂驱动部、以及基于规定所述作业端的目标位置的从动动作指令来控制所述从动臂驱动部的从动侧控制部；主动单元，其包括主动臂，该主动臂具有供操作者输入操作内容的操作端；以及系统控制部，其包括从动动作指令生成部，该从动动作指令生成部基于输入到所述操作端的所述操作内容生成所述从动动作指令，其中，在所述操作内容的对应指令是与所述从动臂以及所述主动臂中的至少一方的动作的极限对应的界限当量区域的对应指令的情况下，所述系统控制部进行用于使所述操作者知觉的处理。

发明的效果

根据本公开，能够使操作者知觉主动臂以及从动臂中的至少一方的动作极限。

附图说明

图1是概略地表示实施方式1的机器人系统的构成例的图。

图2是概略地表示图1的机器人系统的控制系统的构成例的框图。

图3是表示图1的机器人系统的动作例的流程图。

图4是概略地表示实施方式1的变形例1的机器人系统的控制系统的构成例的框图。

图5是概略地表示实施方式2的机器人系统的控制系统的构成例的框图。

图6是表示实施方式2的机器人系统的通知区域设定部所设定的动作区域、进入禁止区域以及通知区域的设定例的图。

图7是表示实施方式2的机器人系统的动作例的图。

图8是表示实施方式2的机器人系统的动作例的图。

图9是概略地表示实施方式2的变形例2的机器人系统的控制系统的构成例的框图。

具体实施方式

首先，对本公开的各形态例进行说明。本公开的一形态的机器人系统具有：从动单元，其包括具有作业端的从动臂、驱动所述从动臂的从动臂驱动部、以及基于规定所述作业端的目标位置的从动动作指令来控制所述从动臂驱动部的从动侧控制部；主动单元，其包括主动臂，该主动臂具有供操作者输入操作内容的操作端；以及系统控制部，其包括从动动作指令生成部，该从动动作指令生成部基于输入到所述操作端的所述操作内容生成所述从动动作指令，其中，在所述操作内容的对应指令是与所述从动臂以及所述主动臂中的至少一方的动作的极限对应的界限当量区域的对应指令的情况下，所述系统控制部进行用于使所述操作者知觉的处理。

根据上述形态，机器人系统能够将操作内容的对应指令是界限当量区域的对应指令的情况通过使操作者知觉而报告给操作者。由此，机器人系统能够使操作者知觉主动臂以及从动臂中的至少一方的动作的极限。

在本公开的一形态的机器人系统中，也可以是：所述从动单元还包括从动侧力检测部，该从动侧力检测部检测作用于所述作业端或者作用于被保持在所述作业端的工件的反作用力的方向以及大小，所述主动单元还包括：主动侧力检测部，其检测作为所述操作内容而由所述操作者施加于所述操作端的操作力的方向以及大小；主动臂驱动部，其驱动所述主动臂；以及主动侧控制部，其基于规定所述操作端的目标位置的主动动作指令来控制所述主动臂驱动部，所述系统控制部基于所述操作力以及所述反作用力生成所述从动动作指令以及所述主动动作指令，所述主动动作指令使所述操作端向与该从动动作指令的所述作业端的移动方向对应的移动方向移动，当所述系统控制部判定为所述操作力的大小处于比作为所述界限当量区域的第1阈值大的区域内时，所述系统控制部生成使所述操作端向所述操作力的方向移动这样的所述主动动作指令。

根据上述形态，机器人系统能够将操作力的大小超过规定的第1阈值的情况经由主动臂报告给操作者，能够将主动臂超负荷的情况报告给操作者。另外，机器人系统通过使操作端向操作者的施力方向移动，能够减轻作用于主动臂以及主动侧力检测部的负荷，能够防止主动臂以及主动侧力检测部的破损。结果，能够防止操作者使主动臂破损。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部生成所述主动动作指令，所述主动动作指令随着所述操作力变大而增大所述操作端的移动速度的变化。

根据上述形态，机器人系统能够引导操作者将操作力减弱到什么程度较佳，结果，能够引导操作者适当地减弱操作力。另外，操作力的大小越大，操作端向操作者的施力方向移动越快，因此能够更适当地减轻作用于主动臂以及主动侧力检测部的负荷，能够更适当地防止主动臂以及主动侧力检测部的破损。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部包括：动作模式设定部，其将动作模式设定为包含通常动作模式以及报告动作模式在内的多种动作模式中的一种动作模式；从动动作指令生成部，其基于所述操作力以及所述反作用力生成所述从动动作指令；第1临时主动动作指令生成部，其基于所述操作力以及所述反作用力生成第1临时主动动作指令，该第1临时主动动作指令使所述操作端向与该从动动作指令的所述作业端的移动方向对应的移动方向移动；第2临时主动动作指令生成部，其基于所述操作力生成第2临时主动动作指令；以及主动动作指令设定部，其在所述通常动作模式下将第1临时主动动作指令设定为所述主动动作指令，在所述报告动作模式下将第2临时主动动作指令设定为所述主动动作指令，当所述动作模式设定部判定为所述操作力的大小处于比所述第1阈值大的区域内时，所述动作模式设定部将所述动作模式设定为所述报告动作模式。

根据上述形态，机器人系统能够通过将动作模式从通常动作模式切换为报告动作模式，来经由主动臂适当地进行对操作者的报告。另外，机器人系统不管所设定的动作模式如何，都能够使从动臂停止，并且能够基于检测部检测出的操作力以及反作用力适当地改变从动臂的动作。由此，机器人系统能够防止向操作者报告时的主动臂的动作影响从动臂的动作，能够妥善地进行对操作者的报告。另外，机器人系统能够自动地进行动作模式的切换，因此能够避免用于保护系统的紧急停止。

在本公开的一形态的机器人系统中，也可以是：多种所述动作模式还包含恢复动作模式，所述系统控制部还具备第3临时主动动作指令生成部，该第3临时主动动作指令生成部使所述操作端朝向所述第1临时主动动作指令所规定的所述操作端的所述目标位置移动，所述主动动作指令设定部还在所述恢复动作模式下将所述第3临时主动动作指令设定为所述主动动作指令，在所述动作模式设定为所述报告动作模式的状态下，当所述动作模式设定部判定为所述操作力的大小处于规定的第2阈值以下的区域内时，所述动作模式设定部将所述动作模式设定为所述恢复动作模式。

根据上述形态，机器人系统能够在进行了对操作者的报告之后，使操作端朝向操作端与作业端成为规定的对应关系的位置移动。

在本公开的一形态的机器人系统中，也可以是：在所述动作模式设定为所述恢复动作模式的状态下，当所述动作模式设定部判定为所述操作端位于所述第1临时主动动作指令的所述目标位置时，所述动作模式设定部将所述动作模式设定为所述通常动作模式。

根据上述形态，机器人系统能够恢复操作端与作业端成为规定的对应关系并同步地动作的状态。另外，能够自动地恢复通常动作模式，能够避免作业的中断。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部包括：基于所述操作力以及所述反作用力计算目标速度矢量的换算部、以及基于所述操作力计算临时目标速度矢量的副换算部，所述从动动作指令生成部基于所述目标速度矢量生成所述从动动作指令，所述第1临时主动动作指令生成部基于所述目标速度矢量生成所述第1临时主动动作指令，所述第2临时主动动作指令生成部基于所述临时目标速度矢量生成所述第2临时主动动作指令。

根据上述形态，机器人系统能够在双向控制方式的机器人系统中妥善地进行对操作者的报告。

本公开的一形态的机器人系统也可以是：该机器人系统还具有报告部，该报告部使用能够由所述操作者的知觉感知的感觉信息来进行报告，所述主动单元还包括主动侧力检测部，该主动侧力检测部检测作为所述操作内容而由所述操作者对所述操作端施加的操作力的方向以及大小，当所述系统控制部判定为所述操作力的大小处于比作为所述界限当量区域的第3阈值大的区域内时，所述系统控制部控制所述报告部进行向所述操作者的报告。

根据上述形态，机器人系统能够将操作力的大小超过了规定的第1阈值的情况报告给操作者，能够将主动臂超负荷了的情况报告给操作者。结果，能够防止操作者使主动臂破损。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部以随着所述操作力变大而所述感觉信息的强度变强的方式控制所述报告部。

根据上述形态，机器人系统能够引导操作者将操作力减弱到什么程度较佳，结果，能够引导操作者适当地减弱操作力。

本公开的一形态的机器人系统也可以是：该机器人系统还具有报告部，该报告部使用能够由所述操作者的知觉感知的感觉信息来进行报告，当所述系统控制部判定为所述从动动作指令的所述作业端的目标位置位于作为所述界限当量区域的通知区域时，所述系统控制部控制所述报告部进行向所述操作者的报告，作为所述界限当量区域的所述通知区域是从规定的动作区域的界限向该动作区域侧延展的区域。

根据上述形态，机器人系统能够通过操作者的知觉通知接近作业端的动作区域的界限。由此，操作者能够容易地辨别是作业端正与工件接触还是作业端正接近动作区域的界限或者正位于该界限的附近，能够提高作业效率。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部以随着所述从动动作指令的所述作业端的目标位置与所述动作区域的界限之间的距离变小而所述感觉信息的强度变强的方式控制所述报告部。

根据上述形态，机器人系统能够告知操作者与动作区域的界限的距离。

在本公开的一形态的机器人系统中，也可以是：所述从动单元还包括从动侧力检测部，该从动侧力检测部检测作用于所述作业端或者作用于被保持在所述作业端的工件的反作用力的方向以及大小，所述主动单元还包括：主动侧力检测部，其检测作为所述操作内容而由所述操作者施加于所述操作端的操作力的方向以及大小；主动臂驱动部，其驱动所述主动臂；以及主动侧控制部，其基于主动动作指令来控制所述主动臂驱动部，所述系统控制部在每个规定的控制周期都生成规定所述作业端的目标位置的所述从动动作指令和规定所述操作端的目标位置的所述主动动作指令，以使所述从动动作指令的目标位置与所述主动动作指令的目标位置具有规定的对应关系，当所述系统控制部判定为所述从动动作指令的所述作业端的目标位置位于作为所述界限当量区域的通知区域时，所述系统控制部生成使所述操作端的动作变化这样的所述主动动作指令，作为所述界限当量区域的所述通知区域是从规定的动作区域的界限向该动作区域侧延展的区域。

根据上述形态，机器人系统能够通过操作者的力觉通知接近作业端的动作区域的界限。由此，操作者能够容易地辨别是作业端正与工件接触还是作业端正接近动作区域的界限或者正位于该界限的附近，能够提高作业效率。

在本公开的一形态的机器人系统中，也可以是：当所述系统控制部判定为所述从动动作指令的所述作业端的目标位置位于所述通知区域时，所述系统控制部设定作用于所述作业端的具有离开所述动作区域的界限的方向的排斥力，在接下来的控制周期，所述系统控制部基于所述操作力、所述反作用力以及所述排斥力这三者的合力生成所述主动动作指令。

根据上述形态，机器人系统能够利用排斥力将接近动作区域的界限通知给操作者。另外，机器人系统能够根据排斥力的方向妥善地引导操作者离开所述边界的方向。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部以随着所述从动动作指令的所述作业端的目标位置与所述动作区域的界限之间的距离变小而所述排斥力的大小变大的方式设定所述排斥力。

根据上述形态，机器人系统能够告知操作者与动作区域的界限的距离。

在本公开的一形态的机器人系统中，也可以是：所述系统控制部还包括：通知区域设定部，其设定所述通知区域；排斥力设定部，当判定为所述从动动作指令的所述作业端的目标位置位于所述通知区域时，该排斥力设定部设定所述排斥力；换算部，其基于所述操作力、所述反作用力以及所述排斥力这三者的合力计算目标速度矢量；从动动作指令生成部，其基于所述目标速度矢量生成所述从动动作指令；以及主动动作指令生成部，其基于所述目标速度矢量生成所述主动动作指令。

根据上述形态，机器人系统能够在双向控制方式的机器人系统中将接近动作区域的界限妥善地通知给操作者。

本公开的一形态的机器人系统的控制方法是具备从动臂和主动臂的机器人系统的控制方法，包含：将基于被输入到所述主动臂的操作端的操作内容的、规定所述从动臂的作业端的目标位置的从动动作指令输出到基于所述从动动作指令对所述从动臂的驱动部进行控制的从动侧控制部；以及在与所述操作内容相对应地生成的指令是与所述从动臂以及所述主动臂中的至少一方的动作的极限对应的界限当量区域的对应指令的情况下，进行用于使向所述操作端输入所述操作内容的操作者知觉的处理。根据上述形态，能够获得与本公开的一形态的机器人系统同样的效果。

本公开的一形态的机器人系统的控制方法也可以是：该控制方法还包含：接收对作用于所述作业端或者作用于被保持在所述作业端的工件的反作用力的方向以及大小的检测结果；接收对作为所述操作内容而由所述操作者施加于所述操作端的操作力的方向以及大小的检测结果；基于检测出的所述操作力以及所述反作用力，决定所述作业端的目标位置；基于检测出的所述操作力以及所述反作用力，决定所述操作端的目标位置；以及将规定所述操作端的目标位置的主动动作指令输出到基于所述主动动作指令来对所述主动臂的驱动部进行控制的主动侧控制部，当判定为所述操作力的大小未处于比作为所述界限当量区域的第1阈值大的区域内时，将所述操作端的目标位置决定为与所述作业端的位置对应的位置，当判定为所述操作力的大小处于比所述第1阈值大的区域内时，将所述操作端的目标位置决定为从与所述作业端的位置对应的位置向所述操作力的方向移动了的位置。

在本公开的一形态的机器人系统的控制方法中，也可以是：以随着所述操作力变大而增大所述操作端的移动速度的变化的方式生成所述主动动作指令。

本公开的一形态的机器人系统的控制方法也可以还包含：设定包含通常动作模式以及报告动作模式在内的多种动作模式中的一种动作模式；基于所述操作力以及所述反作用力生成所述从动动作指令；基于所述操作力以及所述反作用力生成第1临时主动动作指令，该第1临时主动动作指令使所述操作端向与该从动动作指令的所述作业端的移动方向对应的移动方向移动；基于所述操作力生成第2临时主动动作指令；在所述通常动作模式下将第1临时主动动作指令设定为所述主动动作指令；在所述报告动作模式下将第2临时主动动作指令设定为所述主动动作指令；在判定为所述操作力的大小处于比所述第1阈值大的区域内时，将所述动作模式设定为所述报告动作模式。

本公开的一形态的机器人系统的控制方法也可以还包含：设定包含所述通常动作模式、所述报告动作模式以及恢复动作模式在内的多种动作模式中的一种动作模式；生成使所述操作端朝向所述第1临时主动动作指令所规定的所述操作端的所述目标位置移动的第3临时主动动作指令；在所述恢复动作模式下将所述第3临时主动动作指令设定为所述主动动作指令；在所述动作模式设定为所述报告动作模式的状态下，当判定为所述操作力的大小处于第2阈值以下的区域内时，将所述动作模式设定为所述恢复动作模式。

本公开的一形态的机器人系统的控制方法也可以还包含：在所述动作模式设定为所述恢复动作模式的状态下，当判定为所述操作端位于所述第1临时主动动作指令的所述目标位置时，将所述动作模式设定为所述通常动作模式。

本公开的一形态的机器人系统的控制方法也可以还包含：基于所述操作力以及所述反作用力计算目标速度矢量；基于所述操作力计算临时目标速度矢量；基于所述目标速度矢量生成所述从动动作指令；基于所述目标速度矢量生成所述第1临时主动动作指令；基于所述临时目标速度矢量生成所述第2临时主动动作指令。

本公开的一形态的机器人系统的控制方法也可以是：该控制方法还包含接收对作为所述操作内容而由所述操作者施加于所述操作端的操作力的方向以及大小的检测结果，当判定为检测出的所述操作力的大小处于比作为所述界限当量区域的第3阈值大的区域内时，输出进行报告的指令，该报告使用了能够由所述操作者的知觉感知的感觉信息。

在本公开的一形态的机器人系统的控制方法中，也可以是：输出进行随着所述操作力变大而所述感觉信息的强度变强这样的报告的指令。

本公开的一形态的机器人系统的控制方法也可以是：该控制方法还包含设定从规定的动作区域的界限向该动作区域侧延展的通知区域来作为所述界限当量区域，当判定为所述从动动作指令的所述作业端的目标位置位于所述通知区域时，输出进行报告的指令，该报告使用了能够由所述操作者的知觉感知的感觉信息。

在本公开的一形态的机器人系统的控制方法中，也可以是：输出进行随着所述从动动作指令的所述作业端的目标位置与所述动作区域的界限之间的距离变小而所述感觉信息的强度变强这样的报告的指令。

本公开的一形态的机器人系统的控制方法也可以是：该控制方法还包含：接收对作用于所述作业端或者作用于被保持在所述作业端的工件的反作用力的方向以及大小的检测结果；接收对作为所述操作内容而由所述操作者施加于所述操作端的操作力的方向以及大小的检测结果；基于检测出的所述操作力以及所述反作用力，决定所述作业端的目标位置；基于检测出的所述操作力以及所述反作用力，决定所述操作端的目标位置；将规定所述操作端的目标位置的主动动作指令输出到基于所述主动动作指令来对所述主动臂的驱动部进行控制的主动侧控制部；以及设定从规定的动作区域的界限向该动作区域侧延展的通知区域来作为所述界限当量区域，在每个规定的控制周期都基于检测出的所述操作力以及所述反作用力的合力来决定所述作业端的目标位置，当判定为所述作业端的目标位置位于所述通知区域时，设定朝向离开所述动作区域的界限的方向作用于所述作业端的排斥力，基于所述操作力、所述反作用力以及所述排斥力这三者的合力决定所述操作端的下一目标位置，输出在接下来的控制周期使所述主动臂的驱动部将所述操作端位于所述下一目标位置的所述主动动作指令。

在本公开的一形态的机器人系统的控制方法中，也可以是：当判定为所述从动动作指令的所述作业端的目标位置位于所述通知区域时，设定作用于所述作业端的具有从所述动作区域的界限离开的方向的排斥力，在接下来的控制周期，基于所述操作力、所述反作用力以及所述排斥力这三者的合力生成所述主动动作指令。

在本公开的一形态的机器人系统的控制方法中，也可以是：以随着所述从动动作指令的所述作业端的目标位置与所述动作区域的界限之间的距离变小而所述排斥力的大小变大的方式设定所述排斥力。

本公开的一形态的机器人系统的控制方法也可以还包含：设定所述通知区域；当判定为所述从动动作指令的所述作业端的目标位置位于所述通知区域时，设定所述排斥力；基于所述操作力、所述反作用力以及所述排斥力这三者的合力计算目标速度矢量；基于所述目标速度矢量生成所述从动动作指令；基于所述目标速度矢量生成所述主动动作指令。

以下，一边参照附图一边说明实施方式。另外，本公开不受本实施方式的限定。另外，以下，在所有图中，对同一或者相当的要素标注同一附图标记，省略对应的重复说明。

(实施方式1)

图1是概略地表示实施方式1的机器人系统100的构成例的图。图2是概略地表示机器人系统100的控制系统的构成例的框图。

如图1及图2所示，机器人系统100是包括从动臂11以模仿主动臂21的动作的方式动作的主从方式机器人的系统。机器人系统100构成为：能够通过位于远离从动臂11的作业区域的位置(作业区域外)的操作者p使主动臂21动作，将动作指令输入机器人系统100，从而从动臂11进行与该动作指令相应的动作，进行部件的组装作业等特定的作业。

并且，机器人系统100是双向控制方式的机器人系统，构成为控制部除了对从动臂11的控制之外，还同步地控制主动臂21的动作，从而将作用于从动臂11的力经由主动臂21提示给操作者p。机器人系统100具备：包括从动臂11的从动单元1、包括主动臂21的主动单元2、以及系统控制部3。

[从动单元的构成例]

如图1及图2所示，从动单元1例如是工业机器人。从动单元1包括基部10、从动臂11、从动侧力检测部12、从动臂驱动部13、以及、从动侧控制部14。

从动臂11例如是垂直多关节型的机器人臂。即，从动臂11具备：沿从基端部朝向前端部去的方向依次连结的多个连杆、以及以相邻的连杆中的一者相对于另一者能够转动的方式进行连结的一个以上的关节。并且，从动臂11的前端部是作业端11a，在作业端11a设有手构件(也称为“末端执行器”)16。基部10例如固定于地板，对从动臂11进行支承。从动臂11例如具有6自由度，能够使作业端11a在三维空间内的动作范围内的任意的位置摆出任意的姿势。

手构件16构成为例如能够进行保持工件w的保持动作和释放对工件w的保持的释放动作，例如实施部件的组装作业。手构件16包括用于进行保持动作以及释放动作的未图示的手构件驱动部。另外，手构件16的构造也可以为与作业目的相应的构造，以能够进行熔接作业、涂装作业。

从动侧力检测部12是传感器，其检测作用于相互正交的三个轴向的力的大小以及围绕所述三个轴作用的力的力矩，其配置于从动臂11的作业端11a。从动侧力检测部12由6轴力传感器构成，能够进行作用于相互正交的三个轴向以及围绕该轴的分力的检测。由此，从动侧力检测部12检测在从动臂11的作业端11a保持的工件w接触到要组装的对象物t时、作用于作业端11a或者被保持于作业端11a的工件w的反作用力fs的方向以及大小。检测出的反作用力fs被输出到系统控制部3。

从动臂驱动部13对从动臂11进行驱动。即，从动臂驱动部13包括在从动臂11的各关节设置的致动器，利用致动器的驱动来使各关节动作，从而使从动臂11的前端部(作业端11a)以及手构件16相对于基端部在规定的动作区域内移动。在本实施方式中，例如，从动臂11的各关节为转动关节，致动器为具备减速器的伺服马达。

从动侧控制部14基于规定作业端11a的目标位置的位置指令即从动动作指令xs来控制从动臂驱动部13，使从动臂11动作。从动动作指令xs是从动座标系的位置指令。从动侧控制部14基于从动动作指令xs，计算各关节的伺服马达的输出轴的旋转角度，控制向从动臂11的各关节的伺服马达供给的电流而控制伺服马达的动作，变更从动臂11的姿势，由此，使作业端11a位于目标位置。从动臂11的姿势的控制利用反馈控制来进行，该反馈控制基于从设于从动臂11的未图示的编码器输出的关节角度。

[主动单元的构成例]

如图1及图2所示，主动单元2配置于作业区域外，对从动臂11的动作进行远程控制。主动单元2包括主动臂21、主动侧力检测部22、主动臂驱动部23以及主动侧控制部24。

主动臂21是操作者p接触操作的、供操作者p输入对从动臂11的动作指令的装置。主动臂21具有例如6自由度，能够使操作端21a在三维空间内的动作范围内的任意的位置摆出任意的姿势。操作者p接触操作的部位构成操作端21a，操作者p对操作端21a施加力，而输入对从动臂11的动作指令。

主动侧力检测部22是传感器，其检测作用于相互正交的三个轴向的力的大小以及沿所述三个轴的周向作用的力的力矩，其配置于主动臂21的操作端21a。主动侧力检测部22由6轴力传感器构成，能够进行作用于相互正交的三个轴向以及该轴的周向的分力的检测。由此，主动侧力检测部22检知操作者p向操作端21a的操作输入，检测操作者p对从动臂11的动作指令、即操作者p对主动臂21的操作端21a施加的操作力fm的方向以及大小。检测出的操作力fm被输出到系统控制部3。

主动臂驱动部23对主动臂21进行驱动。即，主动臂驱动部23包括在主动臂21的各关节设置的致动器，利用致动器的驱动来使各关节动作，从而使主动臂21的操作端21a移动。在本实施方式中，例如，致动器是具备减速器的伺服马达。

主动侧控制部24基于规定操作端21a的目标位置的位置指令即主动动作指令xm来控制主动臂驱动部23，使主动臂21动作。主动动作指令xm是主动座标系的位置指令。主动座标系和从动座标系具有对应关系，能够通过座标转换来根据一方的位置指令值计算另一方的位置指令值。主动侧控制部24基于主动动作指令xm，计算主动臂21的各关节的伺服马达的输出轴的旋转角度，控制向主动臂21的各关节的伺服马达供给的电流而控制各关节的伺服马达的动作，变更主动臂21的姿势，由此，使操作端21a位于目标位置。主动臂21的姿势的控制通过反馈控制来进行，该反馈控制基于从设于主动臂21的未图示的编码器输出的关节角度。

[系统控制部的构成例]

系统控制部3通过并行双向控制方式控制从动单元1以及主动单元2。即，系统控制部3基于由主动侧力检测部22检测出的操作力fm和由从动侧力检测部12检测出的反作用力fs，生成作为位置指令的从动动作指令xs和作为位置指令的主动动作指令xm。

系统控制部3包括：换算部31、副换算部32、从动动作指令生成部51、第1临时主动动作指令生成部52、第2临时主动动作指令生成部53、第3临时主动动作指令生成部54、主动动作指令设定部36、以及动作模式设定部37。所述换算部31、副换算部32、从动动作指令生成部51、第1临时主动动作指令生成部52、第2临时主动动作指令生成部53、第3临时主动动作指令生成部54、主动动作指令设定部36、以及动作模式设定部37是通过未图示的运算部执行规定的控制程序来实现的功能模块。另外，从动侧控制部14以及主动侧控制部24的功能也是通过未图示的运算部执行规定的控制程序来实现的。

从动侧控制部14、主动侧控制部24以及系统控制部3的上述的运算部由例如微控制器、cpu(centralprocessingunit)、asic(专用集成电路：applicationspecificintegratedcircuit)、fpga(现场可编程门阵列：fieldprogrammablegatearray)等的可编程逻辑器件(pld：programmablelogicdevice)等的运算器构成。运算部可以由集中控制的单独的控制器构成，也可以由相互配合的分散控制的多个控制器构成。另外，运算器的功能的一部分或者全部可以通过由cpu等处理器、ram(randomaccessmemory)等易失性存储器以及rom(read-onlymemory)等非易失性存储器等构成的计算机系统来实现，也可以通过电子电路或者集成电路等专用的硬件电路来实现，还可以通过上述计算机系统以及硬件电路的组合来实现。

另外，系统控制部3具备：存储各种程序以及数据的存储装置(未图示)。存储装置的例子有易失性存储器以及非易失性存储器等半导体存储器、硬盘以及ssd(固态硬盘：solidstatedrive)等。另外，系统控制部3可以由包含从动侧控制部14以及主动侧控制部24的单独的控制器构成，也可以由相互配合的分散控制的多个控制器构成。

换算部31基于由主动侧力检测部22检测出的操作力fm和由从动侧力检测部12检测出的反作用力fs的合力来计算目标速度矢量vd。该目标速度矢量vd如后述那样用于计算作业端11a以及操作端21a的移动方向以及移动量的大小。更具体而言，换算部31根据操作力fm与反作用力fs之差，例如基于以下的式(1)来计算规定作业端11a以及操作端21a的移动方向以及移动速度的目标速度矢量vd。

【数式1】

其中，

m为规定的质量值

cv为规定的粘性系数

如式(1)所示，换算部31通过计算操作力fm与反作用力fs之差，从而将操作力fm和反作用力fs联系起来，将反作用力fs当作操作力fm的反作用力处理。于是，目标速度矢量vd是与操作力fm和反作用力fs之差相应的值，因与对象物t的接触而反作用力fs不为零的情况下，通常，目标速度矢量vd成为朝向与操作力fm的方向不同的方向的矢量。

副换算部32基于由主动侧力检测部22检测出的操作力fm来计算临时目标速度矢量vdt，临时目标速度矢量vdt用于计算操作端21a的移动方向以及移动量的大小。更具体而言，副换算部32基于操作力fm，例如基于以下的式(2)来计算规定操作端21a的移动方向以及移动速度的临时目标速度矢量vdt。

【数式2】

如式(2)所示，临时目标速度矢量vdt是与操作力fm相应的值，临时目标速度矢量vdt实质上是朝向与操作力fm相同的方向的矢量。另外，也可以是副换算部32将反作用力fs乘以规定的系数而设定比反作用力fs小的临时反作用力，基于该临时反作用力和操作力fm来计算临时目标速度矢量vdt。

从动动作指令生成部51基于目标速度矢量vd生成从动动作指令xs，以使作业端11a以与目标速度矢量vd的值相应的速度移动。从动动作指令xs如上述那样是规定作业端11a的目标位置的位置指令。如对目标速度矢量vd的描述那样，在反作用力fs实质上不为零的情况下，该目标位置通常设定在与操作力fm的方向不同的方向。从动动作指令xs被输出到从动侧控制部14，从动侧控制部14基于该从动动作指令xs控制从动臂驱动部13，从动臂11的作业端11a以模仿主动臂21的操作端21a的动作的方式同步地移动。

第1临时主动动作指令生成部52基于目标速度矢量vd生成第1临时主动动作指令xmt1，以使操作端21a以与目标速度矢量vd的值相应的速度移动。第1临时主动动作指令xmt1是使操作端21a向与从动动作指令xs的作业端11a的移动方向对应的移动方向移动的动作指令，是规定操作端21a的目标位置的位置指令。与从动动作指令xs同样地，在反作用力fs实质上不为零的情况下，该目标位置通常设定在与操作力fm的方向不同的方向。

在本实施方式中，第1临时主动动作指令xmt1是使操作端21a向与从动动作指令xs的作业端11a的移动方向对应的移动方向移动的动作指令，因此，与从动动作指令xs同样地，基于目标速度矢量vd生成第1临时主动动作指令xmt1。并且，以由操作者p来看、从动动作指令xs的作业端11a的移动方向与第1临时主动动作指令xm1的操作端21a的移动方向成为相同的方向(相互一致)的方式生成第1临时主动动作指令xmt1。

第2临时主动动作指令生成部53基于临时目标速度矢量vdt生成第2临时主动动作指令xmt2，以使操作端21a以与临时目标速度矢量vdt的值相应的速度移动。第2临时主动动作指令xmt2是规定操作端21a的目标位置的位置指令。如对临时目标速度矢量vdt进行的描述那样，该目标位置设定在与操作力fm相同的方向。

第3临时主动动作指令生成部54生成第3临时主动动作指令xmt3，第3临时主动动作指令xmt3使操作端21a朝向第1临时主动动作指令xmt1所规定的操作端21a的目标位置移动。第3临时主动动作指令xmt3是规定操作端21a的目标位置的位置指令。如对临时目标速度矢量vdt进行的描述那样，该目标位置设定在与操作力fm相同的方向。

主动动作指令设定部36在通常动作模式下将第1临时主动动作指令xmt1设定为主动动作指令xm，在报告动作模式下将第2临时主动动作指令xmt2设定为主动动作指令xm，在恢复动作模式下将第3临时主动动作指令xmt3设定为主动动作指令xm。主动动作指令xm被输出到主动侧控制部24。

动作模式设定部37将动作模式设定为包含通常动作模式、报告动作模式、以及恢复动作模式在内的多种动作模式中的一种动作模式。

因而，主动动作指令设定部36在通常动作模式下将第1临时主动动作指令xmt1设定为主动动作指令xm，主动侧控制部24基于第1临时主动动作指令xmt1控制主动臂驱动部23，以在主动臂21的操作端21a对抗操作力fm的方式使操作端21a动作，从而将作用于从动臂11的作业端11a的力经由操作端21a提示给操作者p。因而，操作者p能够识别作业端11a接触到环境时的力觉地进行作业。

另外，主动动作指令设定部36在报告动作模式下将第2临时主动动作指令xmt2设定为主动动作指令xm，主动侧控制部24基于第2临时主动动作指令xmt2控制主动臂驱动部23，使操作端21a向操作者p所施加的操作力fm的方向移动。

此外，主动动作指令设定部36在恢复动作模式下将第3临时主动动作指令xmt3设定为主动动作指令xm，主动侧控制部24基于第3临时主动动作指令xmt3控制主动臂驱动部23，使操作端21a移动，以恢复与作业端11a的对应关系。

另外，从动动作指令生成部51、第1临时主动动作指令生成部52、第2临时主动动作指令生成部53、以及第3临时主动动作指令生成部54不管当前所动作设定的动作模式如何都生成动作指令。

[动作例]

接着，对机器人系统100的动作例进行说明。图3是表示机器人系统100的动作例的流程图。在本动作例中，如图1所示，操作者p使用机器人系统100来进行下述作业：使形成为圆筒形且具有贯通孔wa的工件w与作为沿上下方向延伸的圆柱状的销且形成为能够与贯通孔wa嵌合的对象物t嵌合，将工件w组装于对象物t。工件w被从动臂11的手构件16把持，对象物t例如位于生产线上。

首先，动作模式设定部37对操作力fm的大小是否处于比规定的第1阈值flim1大的区域内进行判定(步骤s1)。大于第1阈值flim1的区域是界限当量区域的一个例子。第1阈值flim1是基于主动臂21容许的负荷而预先设定的值，是基于例如主动侧力检测部22能够检测的最大负荷、主动侧力检测部22不会破损的负荷、主动臂21的关节不会损伤的负荷、以及主动臂21的连杆不会弯曲的负荷等而设定的值。在主动臂21没有被施加操作力fm的初始状态下，操作力fm为零，因此动作模式设定部37判定为操作力fm的大小未处于比第1阈值flim1大的区域内、即不大于第1阈值flim1(步骤s1中的否)，将动作模式设定为通常动作模式(步骤s2)。

并且，在该初始状态下，若从动臂11没有与对象物t等环境接触，则反作用力fs也为零，操作力fm与反作用力fs之差也为零。因而，由换算部31算出的目标速度矢量vd成为零矢量，由从动动作指令生成部51基于目标速度矢量vd生成的从动动作指令xs的位置指令值不变化。因此，从动侧控制部14维持从动臂11的当前姿势。另外，第1临时主动动作指令xm1的位置指令值也不变化，在通常动作模式下，主动侧控制部24基于第1临时主动动作指令xmt1维持主动臂21的当前姿势。并且，动作模式设定部37再次执行步骤s1的判定。

接着，当操作者p施加使工件w靠近对象物t的方向的操作力fm、即对主动臂21的操作端21a施加朝向下方的操作力fm时，换算部31根据式(1)计算具有与操作力fm相应的大小且朝向下方的目标速度矢量vd。另外，在工件w未与对象物t接触的状态下，反作用力fs为零。

接着，从动动作指令生成部51基于目标速度矢量vd生成从动动作指令xs，将从动臂11的作业端11a的目标位置设定在当前位置的下方。从动侧控制部14基于从动动作指令xs使从动臂11的姿势变化，以使作业端11a向下方移动。

另外，第1临时主动动作指令生成部52基于目标速度矢量vd生成第1临时主动动作指令xmt1，将主动臂21的操作端21a的目标位置更新为当前位置的下方的位置。操作力fm的大小未处于比第1阈值flim1大的区域内时，维持动作模式设定为通常动作模式的状态，主动侧控制部24基于第1临时主动动作指令xmt1使主动臂21的姿势变化，以使操作端21a朝向目标位置向下方移动。

这样，构成为：在操作力fm的大小未处于比规定的第1阈值flim1大的区域内时，从动臂11的作业端11a以及主动臂21的操作端21a同时地向相同的方向移动。由此，操作者p会产生这样的感觉：操作者p操纵主动臂21的操作端21a，从而从动臂11的作业端11a模仿主动臂21的操作端21a的动作地进行动作。

并且，从动臂11的作业端11a向下方移动，从而工件w与对象物t的上端接触，工件w被推压于对象物t，此时，由从动侧力检测部12检测与推压力的大小相应的反作用力fs。并且，即使从该状态起操作者p对操作端21a向下方施加较大的操作力fm，反作用力fs也会与操作力fm成正比地增大，操作力fm与反作用力fs之差实质上为零，换算部31算出的目标速度矢量vd为零矢量。

此时，从动动作指令生成部51不管所设定的动作模式如何，都基于作为零矢量的目标速度矢量vd生成从动动作指令xs，将从动臂11的作业端11a的目标位置设定为与当前位置实质上相同的位置。从动侧控制部14基于从动动作指令xs维持从动臂11的当前姿势。

另外，第1临时主动动作指令生成部52也基于作为零矢量的目标速度矢量vd生成第1临时主动动作指令xmt1，将主动臂21的操作端21a的目标位置设定为与当前位置实质上相同的位置。并且，在通常动作模式下，主动侧控制部24基于第1临时主动动作指令xmt1维持主动臂21的当前姿势，以在主动臂21的操作端21a对抗操作力fm的方式使操作端21a动作。由此，能够将作用于从动臂11的作业端11a的反作用力fs经由操作端21a提示给操作者p。因而，构成为：操作者p能够一边在作业端11a接触到环境时通过操作者p的力觉识别反作用力fs一边进行作业。该作业例如是一边将工件w推压于对象物t一边使工件w沿与反作用力的作用方向正交的方向移动、探寻贯通孔wa与对象物t嵌合的位置的作业。操作者p能够通过识别反作用力fs的作用方向来识别探寻对象物t的嵌合位置的方向、即与反作用力fs正交的方向，能够高效地进行作业。

此时，当因操作者p强行对主动臂21的操作端21a施加朝向下方的操作力fm等操作而动作模式设定部37判定为操作力fm的大小处于比第1阈值flim1大的区域内、即大于第1阈值flim1时(步骤s1中的是)，动作模式设定部37将动作模式设定为报告动作模式(步骤s3)。由此，主动动作指令设定部36将第2临时主动动作指令xmt2设定为主动动作指令xm，生成使操作端21a向操作力fm的方向移动这样的主动动作指令xm。

如上所述，第2临时主动动作指令生成部53基于由副换算部32算出的临时目标速度矢量vdt生成第2临时主动动作指令xmt2。因而，在动作模式设定为报告动作模式的状态下，主动侧控制部24基于第2临时主动动作指令xmt2使主动臂21的姿势变化，以使主动臂21的操作端21a朝向目标位置向下方移动的方式。

另外，如上所述，临时目标速度矢量vdt是具有与主动侧力检测部22所检测出的操作力fm相应的大小和方向的速度矢量。因此，在操作者p对操作端21a朝向下方施加了较大的操作力fm的状态下，临时目标速度矢量vdt为大小较大且向下的矢量。因此，第2临时主动动作指令xmt2的目标位置为向当前位置的下方离开较远的位置。因而，主动侧控制部24构成为：在操作力fm的大小大于第1阈值flim1之前，不移动操作端21a，然后，当操作力fm的大小处于比第1阈值flim1大的区域内时，突然使操作端21a向下方移动。即，构成为操作端21a的动作突然地变化。由此，能够将操作力fm的大小大于了第1阈值flim1的情况报告给操作者p。另外，操作端21a向操作者p的施力方向移动，从而能够减轻作用于主动臂21以及主动侧力检测部22的负荷，能够防止主动臂21以及主动侧力检测部22的破损。

此外，构成为操作端21a突然向操作者p的施力方向移动、操作端21a的动作突然变化，因此能够给予操作者p震惊，结果，能够引导操作者p减弱操作力fm。

另外，随着操作力fm的大小(或者超过操作力fm的第1阈值flim1的超过量)变大，临时目标速度矢量vdt的大小变大，结果，操作端21a的移动速度的变化变大，以这样的方式生成主动动作指令xm。因此，能够引导操作者p将操作力fm减弱到什么程度较佳。另外，能够给予操作者p与过大的操作力fm的大小相应的震惊。结果，能够引导操作者p适当减弱操作力fm。另外，操作力fm的大小越大，操作端21a向操作者p的施力方向移动越快。因而，能够更适当地减轻作用于主动臂21以及主动侧力检测部22的负荷，能够更适当地防止主动臂21以及主动侧力检测部22的破损。另外，能够自动进行从通常动作模式向报告动作模式的切换，因此能够避免实施用于保护机器人系统100的紧急停止。

另外，在本实施方式中，构成为以随着操作力fm的大小变大而增大操作端21a的移动速度的方式生成主动动作指令xm，但不限于此。也可以替代上述方式而构成为以随着每单位时间的操作力大小的变化量变大而增大操作端21a的移动速度的方式生成主动动作指令xm。

另外，从动侧控制部14构成为不管所设定的动作模式如何，都基于操作力fm以及反作用力fs控制从动臂11。例如，当操作者p减弱操作力fm时，目标速度矢量vd基于式(1)而变成朝向上方的矢量，从动侧控制部14以缓解将从动臂11向对象物t推压的推压力的方式进行控制。另外，在动作模式设定为通常动作模式以外的动作模式时，从动侧控制部14也可以使从动臂11的动作停止。

此外，当动作模式设定部37在步骤s3将动作模式设定为报告动作模式时，接着，动作模式设定部37对操作力fm的大小是否处于第2阈值flim2以下的区域内进行判定(步骤s4)。第2阈值flim2是预先设定为第1阈值flim1以下的值的值。

并且，在动作模式设定部37判定为操作力fm的大小未处于第2阈值flim2以下的区域内、即大于第2阈值flim2的期间(步骤s4中的否)，动作模式设定部37反复进行操作力fm的大小是否处于第2阈值flim2以下的区域内的判定。

然后，当操作者p减弱操作力fm而使得操作力fm的大小成为第2阈值flim2以下时，动作模式设定部37判定为操作力fm的大小处于第2阈值flim2以下的区域内(步骤s4中的是)，将动作模式设定为恢复动作模式(步骤s5)。

如上所述，第3临时主动动作指令生成部54基于操作端21a的当前位置和由第1临时主动动作指令生成部52生成的第1临时主动动作指令xmt1，生成第3临时主动动作指令xmt3。因而，在动作模式设定为恢复动作模式的状态下，主动侧控制部24基于第3临时主动动作指令xmt3使主动臂21的操作端21a向第1临时主动动作指令xm1的目标位置移动。

接着，动作模式设定部37进行操作端21a是否位于即已经到达基于由第1临时主动动作指令生成部52生成的第1临时主动动作指令xm1形成的目标位置的判定(步骤s6)。该判定通过操作端21a的当前位置与第1临时主动动作指令xm1的目标位置是否一致来进行。然后，当动作模式设定部37判定为操作端21a没有位于第1临时主动动作指令xm1所规定的目标位置时(步骤s6中的否)，再次执行步骤s5，维持设定为恢复动作模式的状态。

然后，当动作模式设定部37判定为操作端21a位于第1临时主动动作指令xm1所规定的目标位置时，执行步骤s2，将动作模式设定为通常动作模式，而使动作模式恢复为通常动作模式。由此，再次构成为从动臂11的作业端11a以及主动臂21的操作端21a同时地向相同的方向移动。另外，能够自动地恢复为通常动作模式，能够避免作业的中断。

如以上所说明的那样，对于机器人系统100，当由动作模式设定部37判定为操作力fm的大小处于比第1阈值flim1大的区域内时，将动作模式设定为报告动作模式，以使操作端21a向操作力fm的方向移动的方式生成主动动作指令xm。因此，机器人系统100能够将主动臂21超负荷的情况报告给操作者p。并且，机器人系统100能够使主动臂21以散去作用于主动臂21的负荷的方式动作。由此，能够防止主动臂21的破损。

(实施方式1的变形例1)

以下，关于实施方式的变形例1的构成以及动作，以其与实施方式1的不同之处为中心进行说明。图4是概略地表示实施方式1的变形例1的机器人系统200的控制系统的构成例的框图。

在本变形例中，机器人系统200还具备使用能够由操作者p的知觉感知的感觉信息来进行报告的报告部204。操作者p的知觉是指例如触觉、力觉、听觉、嗅觉、以及视觉中的至少一种感觉。另外，作为报告部204，可例示出振动器、扬声器、显示器、或者信号灯。另外，在本变形例中，系统控制部3还包括报告部控制部231。报告部控制部231是由未图示的运算部执行规定的控制程序来实现的功能模块。另外，在图4中，没有图示出副换算部32、第2临时主动动作指令生成部53、以及第3临时主动动作指令生成部54，也可以包含这些功能模块。

在报告动作模式下，报告部控制部231控制报告部204进行向操作者p的报告。由此，能够将操作力fm的大小超过第1阈值flim1的情况报告给操作者p。

另外，报告部控制部231以随着操作力fm变大而感觉信息的强度增强的方式控制报告部204。以感觉信息的强度增强的方式控制报告部204是指例如增大音量、改变音高、改变音色、增大给予操作端21a的振动、增大亮度、增大显示部中的显示区域等。由此，将与过大的操作力fm的大小相应的震惊给予操作者p，结果，能够引导操作者p适当减弱操作力fm。

(实施方式2)

对实施方式2的机器人系统100a进行说明。以下，关于实施方式2，以与实施方式1以及变形例1的不同之处为中心进行说明，适当省略与实施方式1以及变形例1的相同之处的说明。

图5是概略地表示实施方式2的机器人系统100a的控制系统的构成例的框图。如图5所示，机器人系统100a具备从动单元1、主动单元2、以及系统控制部3a。

系统控制部3a基于在每个规定的控制周期由主动侧力检测部22检测出的操作力fm和由从动侧力检测部12检测出的反作用力fs生成从动动作指令xs以及主动动作指令xm。另外，系统控制部3a以从动动作指令xs的目标位置与主动动作指令xm的目标位置具有规定的对应关系的方式生成各指令。

系统控制部3包括换算部310、从动动作指令生成部320、主动动作指令生成部330、通知区域设定部340、以及排斥力设定部350。所述换算部310、从动动作指令生成部320、主动动作指令生成部330、通知区域设定部340、以及排斥力设定部350是由未图示的运算部执行规定的控制程序来实现的功能模块。

换算部310基于由主动侧力检测部22检测出的操作力fm、由从动侧力检测部12检测出的反作用力fs以及由排斥力设定部350设定好的排斥力fr这三者的合力来计算目标速度矢量vd。更具体而言，换算部310根据操作力fm和反作用力fs之差再加上排斥力fr而得到的合力，例如基于以下的式(3)来计算规定作业端11a以及操作端21a的移动方向以及移动速度的目标速度矢量vd。

【数式3】

其中，

m为规定的质量值

cv，为规定的粘性系数

如式(3)所示，换算部310通过计算操作力fm和反作用力fs之差，从而将操作力fm和反作用力fs联系起来，将反作用力fs当作操作力fm的反作用力处理。

从动动作指令生成部320的功能与实施方式1中的从动动作指令生成部51的功能相同。

主动动作指令生成部330以使操作端21a以与目标速度矢量vd的值相应的速度移动的方式基于目标速度矢量vd生成主动动作指令xm，并将其输出向主动侧控制部24。主动侧控制部24基于主动动作指令xm控制主动臂驱动部23，以在主动臂21的操作端21a对抗操作力fm的方式使操作端21a动作，从而将作用于从动臂11的作业端11a的反作用力fs和由排斥力设定部350设定的排斥力fr提示给操作者p。因而，操作者p能够在作业端11a接触到环境时通过操作者p的力觉识别反作用力fs地进行作业。另外，操作者p能够在作业端11a进入到通知区域a3时通过操作者p的力觉识别排斥力fr地进行作业。通知区域a3是界限当量区域的一个例子。

图6是表示实施方式2的机器人系统100a的通知区域设定部340所设定的动作区域a1、进入禁止区域a2以及通知区域a3的设定例的图。

如图6所示，通知区域设定部340设定通知区域a3，通知区域a3从规定的动作区域a1的界限、即边界b(图6中用单点划线表示)朝向动作区域a1侧、即动作区域a1的内侧延展。具体而言，通知区域设定部340设定：规定的动作区域a1、动作区域a1以外的进入禁止区域a2、以及从规定的动作区域a1的界限、即动作区域a1与进入禁止区域a2的边界b向动作区域a1侧延展规定距离的通知区域a3。即，通知区域a3是被动作区域a1包含在内的区域，被设定为重叠在动作区域a1上。所述动作区域a1、进入禁止区域a2、以及通知区域a3的设定内容预先储存于未图示的存储部。通知区域设定部340从存储部读取所述区域a1～a3的内容，从而设定所述区域a1～a3。存储部的功能由上述的存储装置实现。将例如存在障碍物的空间、以及远离对象物t的空间等无法实施作业的空间除去地设定动作区域a1。

如图5所示，排斥力设定部350在判定为从动动作指令xs的作业端11a的目标位置位于通知区域a3时，设定具有离开动作区域a1的界限的方向且作用于作业端11a的排斥力fr。在本实施方式中，排斥力设定部350首先计算从动动作指令xs的目标位置与边界b之间的在边界b的法线方向上的距离d。然后，排斥力设定部350例如基于以下的式(4)计算排斥力fr。

【数式4】

fr＝(-kd+a)i…(4)

其中，

k为规定的系数

a为在作业端位于边界上时作用于作业端的排斥力

i为边界b的朝向动作区域侧的单位法线矢量

如该式(4)所示，排斥力设定部350以随着从动动作指令xs的作业端11a的目标位置与动作区域a1的界限之间的距离变小、而排斥力fr的大小变大的方式计算排斥力fr。另外，式(4)的系数k为以成为操作者p喜好的排斥力fr的方式设定的值。

[动作例]

接着，对机器人系统100a的动作例进行说明。图7及图8是表示实施方式2的机器人系统100a的动作例的图。例如，如图7及图8所示，在本动作例中，操作者p使用机器人系统100a进行将工件w组装于对象物t的作业。

首先，如图6所示，通知区域设定部340设定通知区域a3。

接着，换算部310在每个规定的控制周期都计算目标速度矢量vd。在作业端11a位于通知区域a3以外的动作区域a1内、主动臂21未被操作且从动臂11没有接触到对象物t等环境的状态下，操作力fm、反作用力fs、以及排斥力fr皆为零，操作力fm、反作用力fs、以及排斥力fr的合力为零。因而，由换算部310算出的目标速度矢量vd为零矢量，从动动作指令生成部320基于该目标速度矢量vd将从动动作指令xs的下一目标位置设定为与当前位置相同的位置。然后，在接下来的控制周期，从动侧控制部14基于从动动作指令xs维持从动臂11的当前姿势。另外，与从动动作指令生成部320同样地，主动动作指令生成部330设定下一目标位置，与从动侧控制部14同样地，主动侧控制部24维持主动臂21的当前姿势。

接着，如图7所示，当操作者p施加使工件w靠近对象物t的方向的操作力fm、即对主动臂21的操作端21a施加朝向下方的操作力fm时，换算部310基于式(3)计算具有与操作力fm相应的大小且向下的目标速度矢量vd。另外，在工件w没有接触到对象物t的状态下，反作用力fs为零。然后，从动动作指令生成部320以使作业端11a以与该向下的目标速度矢量vd相应的速度向下方移动的方式，将从动动作指令xs的作业端11a的下一目标位置设定在当前位置的下方。然后，在接下来的控制周期，从动侧控制部14基于从动动作指令xs以使作业端11a向下方移动的方式改变从动臂11的姿势。同样地，主动侧控制部24基于主动动作指令xm以使操作端21a向下方移动的方式改变主动臂21的姿势。

这样，构成为从动臂11的作业端11a以及主动臂21的操作端21a同时地向相同的方向移动。由此，操作者p会产生这样的感觉：操作者p操纵主动臂21的操作端21a，从而从动臂11的作业端11a模仿主动臂21的操作端21a的动作地动作。

并且，从动臂11的作业端11a向下方移动，从而工件w与对象物t的上端接触，工件w被推压于对象物t，此时，由从动侧力检测部12检测出与推压力的大小相应的反作用力fs。并且，即使从该状态起操作者p对操作端21a向下方施加较大的操作力fm，反作用力fs也会与操作力fm成正比地增大，操作力fm与反作用力fs之差实质上为零，换算部310算出的目标速度矢量vd为零矢量。因而，从动动作指令生成部320基于该目标速度矢量vd将基于从动动作指令xs规定的下一目标位置设定为与当前位置相同的位置。然后，在接下来的控制周期，从动侧控制部14基于从动动作指令xs维持从动臂11的当前姿势。与从动动作指令生成部320同样地，主动动作指令生成部330设定下一目标位置，与从动侧控制部14同样地，主动侧控制部24维持主动臂21的当前姿势。

这样，当工件w被推压于对象物t时，主动侧控制部24基于主动动作指令xm维持主动臂21的当前姿势，以在主动臂21的操作端21a对抗操作力fm的方式使操作端21a动作，使操作端21a的动作变化。由此，能够将作用于从动臂11的作业端11a的反作用力fs经由主动臂21的操作端21a提示给操作者p。因而，操作者p能够在作业端11a接触到环境时通过操作者p的力觉识别反作用力fs地进行作业。该作业例如是在图7所示的状态下、一边将工件w推压于对象物t一边使工件w沿与反作用力的作用方向正交的方向移动、探寻贯通孔wa与对象物t嵌合的位置的作业，操作者p能够通过识别反作用力fs的作用方向来识别探寻对象物t的嵌合位置的方向、即与反作用力fs正交的方向，能够高效地进行作业。

然而，如图8所示，操作者p使从动臂11的作业端11a在俯视下不存在对象物t的区域向下方移动，工件w没有被推压于对象物t而是进入通知区域a3，此时，排斥力设定部350判定为从动动作指令xs的作业端11a的目标位置位于通知区域a3内，基于式(4)计算排斥力fr。并且，换算部310基于式(3)，计算具有与操作力fm以及排斥力fr的合力相应的大小的目标速度矢量vd。另外，在工件w没有与对象物t接触的图8所示的状态下，反作用力fs为零。

此时，在图8中，对于排斥力fr以及操作力fm的边界b的法线方向分量，排斥力fr的法线方向分量朝向与操作力fm的法线方向分量的方向相反的一侧(符号相反)。因此，对于排斥力fr与操作力fm合成而得到的合力，该合力的朝向边界b的分量变小，目标速度矢量vd的朝向边界b的分量(目标速度矢量vd的在边界b的法线方向上的分量)也变小。

并且，从动动作指令生成部320基于该目标速度矢量vd，以使作业端11a以比进入通知区域a3前的速度低的速度向下方移动的方式将从动动作指令xs的作业端11a的下一目标位置设定为当前位置的下方的位置。然后，在接下来的控制周期，从动侧控制部14基于从动动作指令xs以使作业端11a向下方移动的方式使从动臂11的姿势变化。与从动动作指令生成部320同样地，主动动作指令生成部330设定下一目标位置，与从动侧控制部14同样地，主动侧控制部24基于主动动作指令xm以使操作端21a向下方移动的方式使主动臂21的姿势变化。由此，系统控制部3a能够给予操作者p作业端11a以及操作端21a的动作变重这样的感觉，能够向操作者p通知接近动作区域a1的界限。

另外，随着从动动作指令xs的作业端11a的目标位置与动作区域a1的界限之间的距离变小，由排斥力设定部350设定的排斥力fr的大小变大，目标速度矢量vd变小，作业端11a以及操作端21a的速度降低。进而，当排斥力fr超过操作力fm时，目标速度矢量vd的符号反转，作业端11a以及操作端21a以被推回的方式移动。这样，排斥力fr的方向朝向离开动作区域a1的界限的方向，另外，排斥力fr的大小随着从动动作指令xs的作业端11a的目标位置与动作区域a1的界限之间的距离变小而变大，因此能够将离开边界b的方向容易理解地告知操作者p。

并且，从动动作指令生成部320在作业端11a的下一目标位置到达边界b时限制作业端11a向进入禁止区域a2的进入。

这样，当工件w接触到对象物t时，操作者p不能使操作端21a突然向与朝向对象物t推压工件w的方向相应的方向移动。与此相对的，当作业端11a进入到通知区域a3时，操作者p会知觉随着接近动作区域a1的界限而操作端21a的动作缓缓变重。由此，操作者p能够容易地辨别是作业端11a正与工件w接触还是作业端11a正接近动作区域a1的界限。由此，能够防止这样情况，例如即便作业端11a到达动作区域a1的界限，作业端11a以及操作端21a的动作处于被限制的状态，操作者p也误认为是作业端11a正与工件w接触而进行误操作(在错误区域进行的组装作业)，能够提高作业效率。

(实施方式2的变形例2)

以下，关于实施方式2的变形例2的构成以及动作，以与实施方式2的不同之处为中心进行说明。图9是概略地表示实施方式2的变形例2的机器人系统200a的控制系统的构成例的框图。

在本变形例中，与实施方式1的变形例1同样地，机器人系统200a还具备报告部204。另外，在本变形例中，与实施方式1的变形例1同样地，系统控制部3a还包括报告部控制部2310。另外，在图9中，排斥力设定部350未被图示出来，也可以作为功能模块而被包含在内。

当报告部控制部2310判定为从动动作指令xs的作业端11a的目标位置位于通知区域a3时，报告部控制部2310控制报告部204进行对操作者p的报告。由此，能够向操作者p通知接近动作区域a1的界限、即边界b。

另外，报告部控制部2310以随着从动动作指令xs的作业端11a的目标位置与边界b之间的距离变小而感觉信息的强度变强的方式控制报告部204。由此，能够将离开边界b的方向容易理解地告知操作者p。

另外，在实施方式2以及变形例2中，动作区域a1是针对作业端11a而设定的，是作为容许作业端11a在该区域内的动作的范围而设定的。但不限于此，也可以是替代上述方式，动作区域a1针对操作端21a而设定，设定为操作端21a在该区域内的动作的容许范围。在该情况下，系统控制部3a以将操作端21a正接近动作区域a1的界限的情况报告给操作者p的方式控制系统。

另外，也可以针对作业端11a以及操作端21a分别设定动作区域。在该情况下，系统控制部3a也可以将系统控制为将作业端11a正接近该动作区域的界限的情况以及操作端21a正接近动作区域的界限的情况中的至少一者报告给操作者p。

另外，在实施方式2以及变形例2中，换算部310根据操作力fm、反作用力fs、以及排斥力fr的合力并基于式(3)计算目标速度矢量vd。但不限于此，也可以替代该方式，在合力中不包含排斥力fr，换算部310使式(3)的粘性系数cv的大小以随着从动动作指令xs的作业端11a的目标位置与动作区域a1的界限之间的距离变小而变大的方式变化。

结合上述说明，对本领域技术人员而言，本公开的许多改进、其他实施方式是显而易见的。因而，应理解为上述说明仅作为示例，上述说明是出于将执行本公开的最佳形态教给本领域技术人员的目的而提供的。能够在不脱离本公开的前提下，能够对其构造以及/或者功能的详细内容进行实质性变更。

附图标记说明

w…工件；t…对象物；p…操作者；1…从动单元；2…主动单元；3，3a…系统控制部；11a…作业端；11…从动臂；12…从动侧力检测部；13…从动臂驱动部；14…从动侧控制部；21…主动臂；21a…操作端；22…主动侧力检测部；23…主动臂驱动部；24…主动侧控制部；100、100a、200、200a…机器人系统。