CN106313039B - 机械臂的操作系统 - Google Patents
机械臂的操作系统 Download PDFInfo
- Publication number
- CN106313039B CN106313039B CN201610498787.8A CN201610498787A CN106313039B CN 106313039 B CN106313039 B CN 106313039B CN 201610498787 A CN201610498787 A CN 201610498787A CN 106313039 B CN106313039 B CN 106313039B
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- reaction force
- boundary
- moving area
- work box
- 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.)
- Active
Links
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/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/02—Hand grip control means
- B25J13/025—Hand grip control means comprising haptic means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J21/00—Chambers provided with manipulation devices
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J3/00—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
- B25J3/04—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements involving servo mechanisms
-
- 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/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
- B25J9/1689—Teleoperation
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39324—Force as function of distance from boundary, border of grinding area
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40132—Haptic joystick with force feedback based on accelerometer included in joystick
Abstract
一种机械臂(5)的操作系统包括:设置在工作箱(20)中的机械臂,所述工作箱是密封的;操作设备(1),所述操作设备设置在所述工作箱外部并且包括操作装置(2),所述操作装置由操作者操作以输入所述机械臂的操作命令;控制设备(6),所述控制设备基于来自所述操作设备的操作命令移动所述机械臂;以及反作用力控制器(50)。基于表示所述机械臂在所述工作箱中的可移动区域的可移动区域信息,随着所述机械臂接近所述可移动区域的界限,所述反作用力控制器使对抗所述操作者在接近所述可移动区域的界限的方向上移动所述操作装置的力的反作用力增大。
Description
技术领域
本发明涉及从工作箱外部操作设置在密封的工作箱中的机械臂(robot arm)的系统。
背景技术
近年来,机器人被应用于与医学或医疗相关的工作。用于与医疗等相关的工作的机器人需要具有耐消毒性和卫生性。经过表面处理以便响应这种需求的一些机器人已被推向市场。
在与医疗等相关的工作中,例如,提出了在密封工作箱中执行的细胞培养。在这种情况下,需要机械臂设置在工作箱中并且操作者从工作箱外部给出机械臂的操作命令的工作模式。常规地,所谓的主从式机器人的远程控制系统应用于这种工作模式(例如,参见JP08-318479A和JP08-90461A)。
当应用远程控制系统时,在工作箱外操作操作设备的一侧成为主动部(master),并且在工作箱中的与该操作关联地移动的机械臂为从动部(slave)。
然而,因为用于与医疗等相关的工作的工作箱需要极高的密封性,并且除机械臂之外的各种设备和工作对象也设置在工作箱中,所以目前的从动部的机械臂的可移动区域极为有限。此外,当操作主动部时,由于工作箱具有高密封性,所以操作者难以知道从动部的机械臂实际上多么接近对象。
此外,操作机械臂的许多医务人员可能具有较少的机器人操作经验。因此,如果意外地操作操作设备,机械臂可能移动超出可移动区域。因此,例如,工作箱的内壁或工作箱内的设备可能受损,或者机械臂本身可能受损。
发明内容
本发明的目的是提供一种机械臂的操作系统,其中,甚至具有较少操作经验的操作者也可以从工作箱外部容易且安全地执行设置在工作箱中的机械臂的操作。
根据本发明的一方面的机械臂的操作系统包括机械臂、操作设备、控制设备和反作用力控制器。所述机械臂设置在工作箱中,所述工作箱是密封的并且从外部可看到其内部。所述操作设备设置在所述工作箱外部并且包括操作装置,所述操作装置由操作者操作以输入所述机械臂的操作命令。所述控制设备基于来自所述操作设备的操作命令移动所述机械臂。基于表示所述机械臂在所述工作箱中的可移动区域的可移动区域信息,随着所述机械臂接近所述可移动区域的界限(limit),所述反作用力控制器使对抗所述操作者在接近所述可移动区域的界限的方向上移动所述操作装置的力的反作用力增大。
根据上述配置,随着机械臂接近可移动区域的界限,当操作者在接近界限的方向上移动操作装置时,操作者通过逐渐增大的反作用力受到阻力并且操作感觉变得沉重。因此,由于阻力,操作者可以在机械臂到达界限之前在感觉上认识到机械臂接近可移动区域的界限,并且操作者可以自发地限制在接近可移动区域的界限的方向上的臂操作。因此,甚至当具有较少的机器人操作经验的操作者在无法密切观察内部的工作箱中的极为有限的可移动区域内操作机械臂时,可以容易地防止机械臂与工作箱的内壁或其他设备碰撞。
附图说明
当结合附图时,从下文的详细描述将更容易明白本发明的另外的目的和优点。在附图中:
图1是示出了根据第一实施例的远程控制系统的整体配置的示意图;
图2是示出了根据第一实施例的主动部和从动部的系统配置的功能框图;
图3A是示出了在主动部中执行的处理的流程图;
图3B是示出了在从动部中执行的处理的流程图;
图4是示出了根据从动臂的手部末端(hand tip)到障碍物的距离产生的反作用力的相对值的示例的示意图;
图5是示出了从动臂的虚拟反作用力(virtual reaction force)模型的示意图;
图6A是解释图5所示的关系的示意图;
图6B是示出了根据与障碍物的距离的反作用力控制的示例的示意图;
图6C是示出了根据从动臂的手部末端的行进速度的反作用力控制的示例的示意图;
图6D是示出了根据距离和速度产生的反作用力值的相关图的示例的示意图;并且
图7是示出了根据第二实施例的主动部和从动部的系统配置的功能框图。
具体实施方式
(第一实施例)
以下描述本发明的第一实施例。在示出了整体配置的示意性外观的图1中,作为操作设备的主动部1包括作为操作装置的主动臂2以及控制器3。作为工作设备的从动部4包括从动臂5和控制器6。控制器6对应于控制设备。控制器3、6经由通信电缆7连接。
在主动部1中,主动臂2设置在操纵台(console)10上,并且包括在端部的柄11。柄11可通过三个关节机构(joint mechanism)旋转,并且还可在围绕每个关节机构的轴的方向上旋转。也就是说,柄11可以相对于操纵台10以三个平移自由度和三个旋转自由度操作。因此,操作者A可以使柄11在预定的可移动范围内具有合适的位置姿态。
主动臂2还包括力检测器12,该力检测器在操作者A操作柄11时检测柄11受到的力。力检测器12检测柄11的移动受到的力作为在主动臂2的正交坐标系中的x、y、z轴方向上的平移力的力感测数据(force sense data)以及围绕每个坐标轴的旋转力的力感测数据,并且将检测的数据经由电缆13发送(transmit)到控制器3。
主动臂2配备有包括作为驱动部分的电动机的驱动机构(未示出)。驱动机构基于来自控制器3的控制信号驱动柄11。主动臂2还包括位置检测器(编码器)16,该位置检测器16检测形成每个驱动机构的电动机的旋转位置。
控制器3执行力感测数据的算法处理(arithmetic processing),并且将处理的数据经由通信电缆7发送到从动部4。控制器3还发送位置检测器16检测的位置信息。此外,控制器3基于来自力检测器12的力感测数据以及从动部4发送的力数据和虚拟反作用力数据驱动主动臂2。下文将描述“虚拟反作用力”的含义。此外,主动臂2包括用于命令从动臂5的手部(hand)14抓住工作对象的开关。该开关可以设置在柄11上或者与柄11分开设置。
在从动部4中,从动臂5设置在工作箱20中。工作箱20用于医疗工作,例如,细胞培养,并且工作箱20的内部是密封空间。从动臂5经由电缆15与工作箱20外部的控制器6连接。电缆15从外部进入工作箱20的部分被密封以便防止细菌泄漏到内部和外部。
从动臂5可旋转地安装在工作箱20的底板21上,并且包括在端部的手部14。手部14可通过三个关节机构旋转,并且还可在围绕每个关节机构的轴的方向上旋转。因此,手部14可以以三个平移自由度和三个旋转自由度操作(垂直6轴结构)。因此,手部14可以在预定的可移动范围内具有合适的位置姿态。手部14形成为以便可抓握工作对象,并且基于来自主动部1的控制内容执行抓握动作。
从动臂5配备有力检测器22,该力检测器在手部14被驱动时检测受到的力(参见图2)。力检测器22检测手部14的移动受到的力作为在从动臂5的正交坐标系中的x、y、z轴方向上的平移力的力感测数据以及围绕每个坐标轴的旋转力的力感测数据,并且将检测的数据经由电缆15发送到控制器6。
从动臂5配备有包括作为驱动部分的电动机的驱动机构(未示出)。驱动机构根据来自控制器6的控制信号驱动手部14。从动臂5还包括位置检测器(编码器)17,该位置检测器17检测形成每个驱动机构的电动机的旋转位置(参见图2)。
控制器6执行力感测数据的算法处理,并且将处理的数据经由通信控制器23发送到主动部1。控制器6还发送位置检测器16检测的位置信息。此外,控制器6基于来自力检测器22的力感测数据以及来自主动部1的力感测数据驱动从动臂5。
工作箱20具有大致长方体的盒子形状。对象25-30设置在工作箱20内。对象25设置在从动臂5之外并且与工作箱20的顶板24的整个下表面接触。对象27具有长方体形状并且与对象25的下表面的一部分以及工作箱20的内壁26接触。对象28具有长方体形状并且设置在距离对象27的预定距离处以便与底板21的一部分以及内壁26接触。对象29、30设置在底板21上以便使从动臂5夹在两者之间。
例如,对象28、29的上表面充当从动臂5在上面工作的工作台。对象的至少一部分包括工作仪器(instrument)。与对象28、30接触的工作箱20的壁具有放入和取出仪器的门31。在门31关闭的状态下,工作箱20的内部处于密封状态。
因为工作箱20的内部布局被设计为如上所述,所以从动臂5的可移动空间(可移动区域)非常有限。也就是说,除基于从动臂5的结构的部分之外,从动臂5仅可以在对象25下方不存在对象27-30的空间中工作。在工作箱20中,至少与对象29、30接触的前壁表面以及与对象28、29接触的侧壁表面由透明玻璃或树脂制成,使得操作者A可以在从工作箱20外部观察从动臂5的移动的同时操作主动臂2。也就是说,从外部可看到工作箱20的内部。
接下来,以下参照图2描述控制器3、6的模块配置。主动部1中的控制器3包括通信控制器32、坐标变换器33、加法器(adder)34、滤波运算部35、轨迹计划部36、加法器37、逆变换器38和伺服部(servo section)39。通信控制器32与从动部4中的通信控制器23通信。坐标变换器33将力检测器12检测的力感测数据变换为标准坐标。坐标变换器33被设置以便甚至当从动部4的尺度(scale)或类型不同时在主动部1与从动部4之间建立一致性。换句话讲,坐标变换器33使得能够灵活地应对主动臂2与从动臂5之间的尺度或类型的差异。坐标变换器33将变换的力感测数据发送到通信控制器32和加法器34。
加法器34经由坐标变换器33接收变换的力感测数据并且经由通信控制器32接收从动部4发送的力感测数据和虚拟反作用力数据。以下,力感测数据与虚拟反作用力数据的组合被称为“施加的力的数据”。加法器34将通过将上述数据相加获得的值发送到滤波运算部35。当新的施加的力的数据的值不同于当前输出的施加的力的数据的值时,滤波运算部35具有在逐渐改变量的同时发送与差异对应的施加的力的数据的低通滤波器功能。
轨迹计划部36当主动臂2基于控制程序被操作时根据经过的时间产生轨迹数据,即,位置数据。逆变换器38经由加法器37接收与施加的力的数据相对应的轨迹数据和位置数据的额外的值作为目标位置数据。逆变换器38将目标位置数据逆向地变换为实际上与主动臂2对应的关节角度目标数据(joint angle target data),并且将关节角度目标数据发送到伺服部39。
伺服部39驱动主动臂2中的柄11。当施加的力的数据包括虚拟反作用力数据时,伺服部39基于虚拟反作用力数据产生与柄11的运行方向相反的反作用力(反转矩、阻力矩)。通信控制器32包括存储器,并且在存储器中的每个预定地址存储坐标变换器33发送的力感测数据以及通信控制器23发送的施加的力的数据。
从动部4中的控制器6包括坐标变换器41、加法器42、滤波运算部43、轨迹计划部44、加法器45、逆变换器46、伺服部47、设备模型48、距离计算部49和虚拟反作用力计算部50。坐标变换器41将从动臂5中的力检测器22检测的力感测数据变换为标准坐标,并且以类似于主动臂2中的坐标变换器33的方式工作。坐标变换器41将变换的力感测数据发送到通信控制器23。加法器42接收来自坐标变换器41的变换的力感测数据,并且经由通信控制器32接收主动部1发送的力感测数据。
设备模型48存储表示从动臂5的可移动区域的三维坐标信息,这基于工作箱20中的对象25、27-30的布局来确定。当操作从动臂5时,应当防止从动臂5与工作箱20中的内壁或对象25、27-30接触或碰撞的情形。因此,设备模型48设置具有预定的裕度(margin)的可移动区域的界限位置,使得从动臂5不与内壁或对象25、27-30接触。
距离计算部49计算位置检测器17发送的从动臂5的当前位置与设备模型48发送的从动臂5的可移动区域的界限位置之间的距离,并且将此距离发送到虚拟反作用力计算部50。虚拟反作用力计算部50基于发送的距离和从动臂5的手部末端的行进速度计算施加到从动臂5和主动臂2的虚拟反作用力,并且将虚拟反作用力数据发送到通信控制器23和加法器42。虚拟反作用力计算部50从位置检测器17检测的位置变化量获取行进速度。虚拟反作用力计算部50对应于反作用力控制器。
加法器42接收力感测数据和虚拟反作用力数据,并且将通过将力感测数据和虚拟反作用力数据相加获得的值发送到滤波运算部43。滤波运算部43按照与主动部1中的滤波运算部35类似的方式工作。轨迹计划部44按照与主动部1中的轨迹计划部36类似的方式工作。加法器45和逆变换器46分别按照与主动部1中的加法器37和逆变换器38类似的方式工作。
伺服部47驱动从动臂5的手部14。通信控制器23包括存储器,并且在存储器中的每个预定地址存储坐标变换器41和通信控制器32发送的力感测数据以及虚拟反作用力计算部50发送的虚拟反作用力数据。
接下来,以下描述本实施例的操作。基于力感测数据的传递的驱动控制的原理类似于JP08-318479A。基本上,从动臂5与操作者A用手抓握并操作的主动臂2的移动关联地移动。在本实施例中,当从动臂5在从动部4中移动时,虚拟反作用力数据通过设备模型48、距离计算部49和虚拟反作用力计算部50的操作产生。然后,虚拟反作用力数据被发送到主动部1,并且影响操作者A对主动臂2的操作感觉。
如图3A所示,当操作者A操作主动臂2时,主动臂2的每个轴向位置被检测,并且手部末端坐标被计算(M1)。然后,手部末端坐标的信息被发送到从动部4(M2)。如图3B所示,在从动部4中,当主动部1发送的手部末端坐标被接收(S1;是)时,控制器6使从动臂5的手部末端(手部14)移动到与接收的手部末端坐标相对应的位置(S2)。
控制器6在操作期间计算从动臂5的手部末端坐标(S3),并且确定手部末端坐标是否超过了从动臂5的可移动区域中设置的反作用力产生边界(S4)。反作用力产生边界是被设置为具有预定裕度的可移动区域的界限附近的三维边界。反作用力产生边界与可移动区域的界限之间的区域是反作用力产生区域。当手部末端坐标未超过反作用力产生边界时,即,当手部末端坐标在反作用力产生边界以内时(S4;否),反作用力值为0(S7)。
另一方面,当手部末端坐标超过反作用力产生边界时(S4;是),虚拟反作用力计算部50基于手部末端的位置与可移动区域的界限之间的距离计算反作用力值(S5),虚拟反作用力计算部50将计算的反作用力值发送到主动部1(S6)。当主动部1接收到反作用力值(M3;是)时,控制器3中的伺服部39在相应的轴的电动机处产生阻力矩,以便在与操作者A在该点操作主动臂2的方向相反的方向上施加反作用力。
例如,如图4所示,当从动臂5的手部末端的位置与可移动区域的界限之间的距离,即,从动臂5的手部末端到工作箱20中的诸如对象25、27-30的障碍物的距离从100mm到50mm到1mm减小时,反作用力的相对值从1到50到99逐渐增大。反作用力值与电动机的重量对应,并且是抵消操作者A的力的力矩的量。至少99的反作用力被设置为操作者A基本上无法对抗反作用力操作主动臂2的力。当距离为0mm时,“软限制(soft limiting)”发挥作用,并且主动臂2完全停止移动,在所述“软限制”中,控制器3通过单独的控制程序限制操作。
图5是从动臂5的虚拟反作用力产生模型,并且从动臂5的手部末端与障碍物(对象25、27-30)经由虚拟弹簧及虚拟阻尼器连接。如图6A所示,当从动臂5的手部末端未超过反作用力产生边界时,反作用力值为0,并且操作者A可以在不受到特定阻力的情况下根据施加的操作力来操作主动臂2。
当从动臂5的手部末端超过反作用力产生边界时,主动臂2的驱动机构中产生反作用力,并且操作者A在主动臂2的操作感觉方面受到阻力。此时,根据与作为可移动区域的界限的障碍物的距离的反作用力控制(与虚拟弹簧对应),以及根据主动臂2的手部末端的行进速度的反作用力控制(与虚拟阻尼器对应)被并行地执行。
在根据距离的反作用力控制中,如图6B所示,反作用力值随着与可移动区域的界限的距离的减小而增大。在图6B中,作为示例,反作用力值被图示为线性地变化。可替代地,反作用力值可以以二次曲线的方式变化。在根据速度的反作用力控制中,如图6C所示,反作用力值随着主动臂2的手部末端的行进速度的增大而增大。同样在图6C中,作为示例,反作用力值被图示为线性地变化。可替代地,反作用力值可以以二次曲线的方式变化。
施加到主动臂2的反作用力值是根据距离施加的反作用力值与根据行进速度施加的反作用力值的总和。图6D示出了根据距离和进行速度产生的反作用力值的相关图的示例。
在图6A至图6D中所示的图形中,参数被设置为使得反作用力值刚好在距离达到可移动区域的界限之前变为最大值,或者当在反作用力产生区域内的行进速度变为最高时变为最大值。因此,施加的反作用力趋向于很大,并且必定可以防止从动臂5的碰撞。此外,可以在比反作用力产生区域更小的区域中设置反作用力值。根据单个设计,反作用力值可以被设置为使得反作用力值刚好在距离达到可移动区域的界限之前并且当在反作用力产生区域内的行进速度变为最高时变为最大值。在上述情形中,施加的反作用力通常趋向于很小,并且对操作者A的操作感觉的影响很小,并且操作者A可以感觉到主动臂2容易移动。然而,需要设置较大的反作用力产生区域。
在上述示例中,当从动臂5的手部末端超过反作用力产生边界时产生反作用力。然而,在不限于手部末端的情况下,当从动臂5的任何部分超过反作用力产生边界时产生反作用力。在从动臂5的手部14工作的区域附近的反作用力产生边界处,反作用力值被设置为以便不影响工作。
根据本实施例,从动臂5设置在密封的工作箱20中,并且主动臂2作为用于通过操作者A输入从动臂5的操作命令的操作设备设置在工作箱20的外部。基于表示从动臂5在工作箱20中的可移动区域的可移动区域信息,随着从动臂5接近可移动区域的界限,虚拟反作用力计算部50使对抗操作者A在接近可移动区域的界限的方向上移动主动臂2的力的反作用力增大。
因此,随着从动臂5接近可移动区域的界限,当操作者A继续在相同方向上移动主动臂2时,操作者A受到逐渐增大的阻力,并且操作感觉变得沉重。因此,由于阻力,操作者A可以在感觉上认识到从动臂5接近可移动区域的界限,并且可以自发地限制在接近界限的方向上的臂操作。因此,即使当具有较少的机器人操作经验的操作者在非常有限的可移动区域内操作工作箱20中的从动臂5时,也可以容易地限制从动臂5与工作箱20的内壁或对象25、27-30的碰撞。
操作设备中的操作装置是具有与从动臂5相同的轴结构(axial structure)的主动臂2。因此,甚至具有较少的机器人操作经验的操作者可以通过操作具有与从动臂5类似的外观的主动臂2来给出操作命令,同时通过主动臂2受到的反作用力直观地控制工作箱20中的从动臂5的移动。
此外,虚拟反作用力计算部50设置达到可移动区域的界限之前(即,在可移动区域的界限前)的反作用力产生边界。虚拟反作用力计算部50在从动臂5在反作用力产生边界内时不产生反作用力,并且在从动臂5超过反作用力产生边界时产生反作用力。因此,因为当从动臂5移动超过反作用力产生边界时突然产生了反作用力,所以操作者A在操作中感到不适。然后,由于不适的感觉,操作者A可以容易识别从动臂5接近可移动区域的界限。
此外,因为虚拟反作用力计算部50在从动臂5移动超过反作用力产生边界时随着手部末端的进行速度的增大而增大反作用力,虚拟反作用力计算部50可以根据距离和行进速度的参数控制反作用力的强度。
虚拟反作用力计算部50设置在从动部4的控制器6中,随着从动臂5接近可移动区域的界限,反作用力的增大命令被发送到主动部1,并且主动部1的控制器3基于接收的增大命令使施加到主动臂2的反作用力增大。也就是说,从动部4的控制器6需要限制使得从动臂5的移动不超出可移动区域,而不管来自主动部1的操作命令。因此,应当理解,控制器6保持并管理关于可移动区域的信息,并且根据上述配置,控制器3不需要执行复杂的计算过程。
(第二实施例)
与第一实施例的相应的部件基本上相同的第二实施例的部件由相同的附图标记表示,并且可以省略这些部件的描述。将主要描述与第一实施例不同的第二实施例的部件。
如图7所示,设置在第一实施例的从动部4的控制器6中的设备模型48、距离计算部49和虚拟反作用力计算部50设置在第二实施例的主动部1的控制器3中。在这种情况下,虚拟反作用力计算部50发送的虚拟反作用力数据被输入到加法器34中。另外,在具有上述配置的第二实施例中,可以获得与第一实施例类似的效果。此外,可以减少从动部4到主动部1的通信数据量。
本发明不仅仅限于上文描述的或者附图中描述的实施例,并且以下修改或扩展是可能的。在工作箱20中执行的工作不限于与医疗相关的工作,并且可以是适合于在密封空间中执行的任何工作。成像设备,如照相机,可以设置在从动臂5上,工作箱20的内部可以被三维地扫描以根据内部布局生成关于可移动区域的信息,并且该信息可以最初被设置为设备模型48。操作设备中的操作装置并非总是需要具有与机械臂相同的轴结构。例如,操作设备可以是示教盒(teaching pendant)。
Claims (11)
1.一种机械臂(5)的操作系统,包括:
所述机械臂,所述机械臂设置在工作箱(20)中,所述工作箱是密封的并且从外部可看到其内部;
操作设备(1),所述操作设备设置在所述工作箱外部并且包括操作装置(2),所述操作装置由操作者操作以输入所述机械臂的操作命令;
控制设备(6),所述控制设备基于来自所述操作设备的所述操作命令移动所述机械臂;以及
反作用力控制器(50),所述反作用力控制器基于所述机械臂的当前位置与所述机械臂在所述工作箱中的可移动区域的界限之间的距离并且还基于所述机械臂的行进速度,计算施加到所述操作装置的反作用力,其中,
基于表示所述机械臂在所述工作箱中的所述可移动区域的可移动区域信息,随着所述机械臂接近所述可移动区域的所述界限,所述反作用力控制器使对抗所述操作者在接近所述可移动区域的所述界限的方向上移动所述操作装置的力的所述反作用力增大,
对抗所述操作者移动所述操作装置的所述力的所述反作用力是与所述操作者操作所述操作装置的方向相反的方向上的力。
2.根据权利要求1所述的机械臂的操作系统,其中,
所述操作设备的所述操作装置具有与所述机械臂相同的轴结构。
3.根据权利要求1所述的机械臂的操作系统,其中,
所述反作用力控制器设置达到所述可移动区域的所述界限之前的反作用力产生边界,并且
所述反作用力控制器在所述机械臂在所述反作用力产生边界内时不产生所述反作用力,并在所述机械臂超过所述反作用力产生边界时产生所述反作用力。
4.根据权利要求3所述的机械臂的操作系统,其中,
所述反作用力控制器在所述机械臂移动超过所述反作用力产生边界时随着所述机械臂的所述行进速度的增大而增大所述反作用力。
5.根据权利要求1至4中的任意一项所述的机械臂的操作系统,其中,
所述反作用力控制器设置在所述控制设备中,
所述反作用力控制器随着所述机械臂接近所述可移动区域的所述界限向所述操作设备发送所述反作用力的增大命令,并且
所述操作设备基于所述增大命令增大所述反作用力。
6.根据权利要求1所述的机械臂的操作系统,其中,
所述机械臂的所述可移动区域的所述界限设置有预定的裕度,使得所述机械臂不与所述工作箱的内壁或所述工作箱中的另一个对象接触。
7.根据权利要求1所述的机械臂的操作系统,其中,所述工作箱是用于医疗工作的工作箱。
8.根据权利要求1所述的机械臂的操作系统,其中,
所述反作用力控制器并行地执行根据所述机械臂的所述当前位置与所述可移动区域的所述界限之间的所述距离的第一反作用力控制、以及根据所述机械臂的所述行进速度的第二反作用力控制。
9.根据权利要求1所述的机械臂的操作系统,还包括:
设备模型,根据放置在所述工作箱中的对象的布局来确定所述设备模型,并且所述设备模型存储关于所述机械臂的所述可移动区域的所述可移动区域信息。
10.根据权利要求1所述的机械臂的操作系统,其中,
在所述操作装置中产生的所述反作用力是根据距所述可移动区域的所述界限的距离施加的反作用力与根据所述操作装置的行进速度施加的反作用力的总和。
11.根据权利要求1所述的机械臂的操作系统,其中,
所述可移动区域设定反作用力产生边界;
当所述机械臂超过所述反作用力产生边界并且接近所述可移动区域的所述界限时,所述反作用力施加于所述操作装置;并且
直至所述机械臂位于更靠近所述反作用力产生边界的位置为止,所述反作用力未施加于所述操作装置。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015131119A JP6520478B2 (ja) | 2015-06-30 | 2015-06-30 | ロボットアームの操作システム |
JP2015-131119 | 2015-06-30 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106313039A CN106313039A (zh) | 2017-01-11 |
CN106313039B true CN106313039B (zh) | 2019-11-12 |
Family
ID=57682938
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610498787.8A Active CN106313039B (zh) | 2015-06-30 | 2016-06-29 | 机械臂的操作系统 |
Country Status (3)
Country | Link |
---|---|
US (1) | US9925666B2 (zh) |
JP (1) | JP6520478B2 (zh) |
CN (1) | CN106313039B (zh) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017033352A1 (ja) * | 2015-08-25 | 2017-03-02 | 川崎重工業株式会社 | 産業用遠隔操作ロボットシステム |
US10926454B2 (en) * | 2016-05-20 | 2021-02-23 | Sartorius Stedim Biotech Gmbh | Dispensing device and system for biological products |
JP6959762B2 (ja) * | 2017-05-19 | 2021-11-05 | 川崎重工業株式会社 | 遠隔操作ロボットシステム |
JP6960242B2 (ja) * | 2017-05-19 | 2021-11-05 | 川崎重工業株式会社 | ロボットシステム及びロボットシステムの制御方法 |
JP6948516B2 (ja) * | 2017-07-14 | 2021-10-13 | パナソニックIpマネジメント株式会社 | 食器処理機 |
JP7068059B2 (ja) * | 2018-06-15 | 2022-05-16 | 株式会社東芝 | 遠隔操作方法及び遠隔操作システム |
JP7126276B2 (ja) * | 2018-08-24 | 2022-08-26 | 国立大学法人 東京大学 | ロボット支援装置及びロボット支援システム。 |
JP2020099968A (ja) * | 2018-12-21 | 2020-07-02 | 川崎重工業株式会社 | ロボットシステム及びロボットシステムの制御方法 |
WO2020130091A1 (ja) * | 2018-12-21 | 2020-06-25 | 川崎重工業株式会社 | ロボットシステム及びロボットシステムの制御方法 |
JP7161394B2 (ja) * | 2018-12-21 | 2022-10-26 | 川崎重工業株式会社 | ロボットシステム及びロボットシステムの制御方法 |
DE102019118260B3 (de) * | 2019-07-05 | 2020-08-20 | Franka Emika Gmbh | Taktile Rückmeldung eines Endeffektors eines Robotermanipulators über verschiedene Orientierungsbereiche |
KR102251025B1 (ko) * | 2019-08-12 | 2021-05-14 | 한국로봇융합연구원 | 재난 구조 로봇 제어시스템 및 방법 |
CN114829076A (zh) * | 2019-12-13 | 2022-07-29 | 川崎重工业株式会社 | 主从系统以及控制方法 |
JP7453000B2 (ja) | 2020-01-20 | 2024-03-19 | ファナック株式会社 | ロボットシステムおよび制御装置 |
JP7415590B2 (ja) | 2020-01-24 | 2024-01-17 | 株式会社デンソーウェーブ | 主従ロボットの制御装置 |
CN113558773A (zh) * | 2020-04-28 | 2021-10-29 | 川崎重工业株式会社 | 手术辅助机器人 |
US11548150B2 (en) | 2020-05-29 | 2023-01-10 | Mitsubishi Electric Research Laboratories, Inc. | Apparatus and method for planning contact-interaction trajectories |
CN111730598B (zh) * | 2020-07-06 | 2022-01-04 | 武汉联影智融医疗科技有限公司 | 一种机器人力位连锁控制方法、装置及系统 |
JP7457628B2 (ja) | 2020-10-13 | 2024-03-28 | 住友重機械工業株式会社 | 動作方法、ロボットシステム、制御装置、教示方法及びプログラム |
US20230302650A1 (en) * | 2020-10-15 | 2023-09-28 | Intuitive Surgical Operations, Inc. | Detection and mitigation of predicted collisions of objects with user control system |
CN113858181A (zh) * | 2021-11-19 | 2021-12-31 | 国家电网有限公司 | 一种基于人机交互混合现实的输电线路操作空中机器人 |
IT202200002306A1 (it) * | 2022-02-08 | 2023-08-08 | Idea Prototipi Srl | Organo di manovra rimovibile per il movimento di un dispositivo operatore automatico |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01183379A (ja) * | 1988-01-12 | 1989-07-21 | Meidensha Corp | マスター・スレーブマニプレータの制御方式 |
CN103207566A (zh) * | 2013-01-18 | 2013-07-17 | 西北工业大学 | 一种速度型虚拟力反馈动态辅助的空间遥操作方法 |
Family Cites Families (31)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3422965A (en) * | 1967-02-13 | 1969-01-21 | Westinghouse Electric Corp | Manipulator apparatus |
JPS59156793U (ja) * | 1983-04-06 | 1984-10-20 | 株式会社小松製作所 | マニプレ−タのマスタ装置 |
DE3401278A1 (de) * | 1984-01-16 | 1985-07-18 | Kraftwerk Union AG, 4330 Mülheim | Reparatur- und montage-wagen fuer kerntechnische anlagen |
JPS632686A (ja) * | 1986-06-18 | 1988-01-07 | 日本電信電話株式会社 | ロボツトの遠隔制御方法 |
JPH0794112B2 (ja) * | 1986-09-22 | 1995-10-11 | 株式会社日立製作所 | マスタ・スレーブマニピュレータ |
JPS63139689A (ja) * | 1986-11-28 | 1988-06-11 | 株式会社日立製作所 | 遠隔マニピユレ−シヨン・システムの画像表示装置 |
JPS63150173A (ja) * | 1986-12-12 | 1988-06-22 | 株式会社明電舎 | マニピユレ−タの動作制御方法 |
DD260463A1 (de) * | 1987-05-13 | 1988-09-28 | Bauakademie Ddr | Ueberlastschutzvorrichtung fuer frei programmierbare und master-slave oder manuell gesteuerte manipulatoren |
US4762455A (en) * | 1987-06-01 | 1988-08-09 | Remote Technology Corporation | Remote manipulator |
JPS6438274U (zh) * | 1987-08-31 | 1989-03-07 | ||
JPH04354680A (ja) * | 1991-05-30 | 1992-12-09 | Agency Of Ind Science & Technol | 同構造型マスタスレーブアームロボット |
JP2567198B2 (ja) * | 1993-10-29 | 1996-12-25 | 株式会社明電舎 | マスタスレーブ形マニプレータ |
JPH0890461A (ja) | 1994-09-21 | 1996-04-09 | Nippondenso Co Ltd | ロボットの制御装置及び制御方法 |
JPH0890468A (ja) * | 1994-09-27 | 1996-04-09 | Nissan Motor Co Ltd | ロボットのティーチング装置 |
JPH08300277A (ja) * | 1995-04-28 | 1996-11-19 | Tokyo Electric Power Co Inc:The | 遠隔操作形マニピュレータの制御装置 |
JPH08318479A (ja) | 1995-05-19 | 1996-12-03 | Nippondenso Co Ltd | 遠隔操縦システム |
JP3504507B2 (ja) * | 1998-09-17 | 2004-03-08 | トヨタ自動車株式会社 | 適切反力付与型作業補助装置 |
US20070112458A1 (en) * | 2003-06-25 | 2007-05-17 | Honda Motor Co., Ltd. | Assist transportation method and its device |
JP4293856B2 (ja) * | 2003-07-10 | 2009-07-08 | 本田技研工業株式会社 | 搬送部位置復帰方法 |
JP2005014133A (ja) * | 2003-06-25 | 2005-01-20 | Honda Motor Co Ltd | アシスト搬送方法及びその装置 |
JP4465470B2 (ja) * | 2005-04-04 | 2010-05-19 | 国立大学法人 東京大学 | 操作装置及びそれにおける操作方法 |
JP2006321027A (ja) * | 2005-05-20 | 2006-11-30 | Hitachi Ltd | マスタ・スレーブ式マニピュレータシステム及びその操作入力装置 |
JP2007038315A (ja) * | 2005-08-01 | 2007-02-15 | Toyota Motor Corp | 操作装置と操作子の動作調節方法とそのためのプログラム |
CN101811163B (zh) * | 2005-12-05 | 2013-12-25 | 本田技研工业株式会社 | 折边加工方法和折边加工设备 |
WO2007111749A2 (en) * | 2005-12-20 | 2007-10-04 | Intuitive Surgical, Inc. | Method for handling an operator command exceeding a medical device state limitation in a medical robotic system |
US7689320B2 (en) * | 2005-12-20 | 2010-03-30 | Intuitive Surgical Operations, Inc. | Robotic surgical system with joint motion controller adapted to reduce instrument tip vibrations |
WO2009151206A1 (ko) * | 2008-06-09 | 2009-12-17 | (주)미래컴퍼니 | 수술용 로봇의 마스터 인터페이스 및 구동방법 |
US20120071752A1 (en) * | 2010-09-17 | 2012-03-22 | Sewell Christopher M | User interface and method for operating a robotic medical system |
US9314922B2 (en) * | 2014-02-07 | 2016-04-19 | Control Interfaces LLC | Remotely operated manipulator and ROV control systems and methods |
US20150224639A1 (en) * | 2014-02-07 | 2015-08-13 | Control Interfaces LLC | Remotely operated manipulator and rov control systems and methods |
JP6521707B2 (ja) * | 2014-07-10 | 2019-05-29 | キヤノン株式会社 | 穿刺プランニング装置及び穿刺システム |
-
2015
- 2015-06-30 JP JP2015131119A patent/JP6520478B2/ja active Active
-
2016
- 2016-06-10 US US15/179,419 patent/US9925666B2/en active Active
- 2016-06-29 CN CN201610498787.8A patent/CN106313039B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH01183379A (ja) * | 1988-01-12 | 1989-07-21 | Meidensha Corp | マスター・スレーブマニプレータの制御方式 |
CN103207566A (zh) * | 2013-01-18 | 2013-07-17 | 西北工业大学 | 一种速度型虚拟力反馈动态辅助的空间遥操作方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2017013167A (ja) | 2017-01-19 |
US20170001301A1 (en) | 2017-01-05 |
US9925666B2 (en) | 2018-03-27 |
JP6520478B2 (ja) | 2019-05-29 |
CN106313039A (zh) | 2017-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106313039B (zh) | 机械臂的操作系统 | |
KR102353178B1 (ko) | 로봇을 지시하는 시스템 및 방법 | |
Krupke et al. | Comparison of multimodal heading and pointing gestures for co-located mixed reality human-robot interaction | |
US9643318B2 (en) | Teleoperation of machines having at least one actuated mechanism | |
US20210023702A1 (en) | Systems and methods for determining a type of grasp for a robotic end-effector | |
Smith et al. | A predictor for operator input for time-delayed teleoperation | |
CN102085663A (zh) | 遥操作系统及方法 | |
Lin | Design of an intelligent robotic precise assembly system for rapid teaching and admittance control | |
Hernansanz et al. | A multi-robot cooperation strategy for dexterous task oriented teleoperation | |
Chotiprayanakul et al. | Workspace mapping and force control for small haptic device based robot teleoperation | |
Pepe et al. | A hybrid teleoperation control scheme for a single-arm mobile manipulator with omnidirectional wheels | |
Comparetti et al. | Event-based device-behavior switching in surgical human-robot interaction | |
Ang et al. | Multipoint haptic mediator interface for robotic teleoperation | |
Campeau-Lecours et al. | An anticipative kinematic limitation avoidance algorithm for collaborative robots: Two-dimensional case | |
Pham et al. | Control allocation for mobile manipulators with on-board cameras | |
Cheung et al. | Cooperative control of a multi-arm system using semi-autonomous telemanipulation and adaptive impedance | |
JP2016221653A (ja) | ロボット制御装置およびロボットシステム | |
Sylari et al. | Hand gesture-based on-line programming of industrial robot manipulators | |
Wrock et al. | An automatic switching approach to teleoperation of mobile-manipulator systems using virtual fixtures | |
KR101321984B1 (ko) | 협업기반 밸브 조작을 위한 로봇의 경로보상 방법 및 그 시스템 | |
CN116077089B (zh) | 面向超声扫描机器人的多模态安全交互方法和装置 | |
Arioui et al. | Force feedback stabilization for remote control of an assistive mobile robot | |
Mima et al. | Telemanipulation with a humanoid robot hand/arm between USA and Japan | |
Zhang et al. | A combined approach for master-slave robotic surgery system control based on Jacobian and PD algorithm | |
Yildirim et al. | Development of a Collaborative Wheeled Mobile Robot: Design Considerations, Drive Unit Torque Control, and Preliminary Result |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |