机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序及机器人手臂控制用...的制作方法

文档序号:2353290阅读:211来源:国知局
专利名称:机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序及机器人手臂控制用 ...的制作方法
技术领域
本发明涉及用于生成、示教机器人手臂的动作的机器人手臂的控制装置及控制方法、具有机器人手臂的控制装置的机器人、机器人手臂的控制程序及机器人手臂的控制用集成电路。
背景技术
近年来,看护机器人或家务支援机器人等家庭用机器人在被积极研发。家庭机器人与工业用机器人不同,由于是家庭的外行来操作,所以有必要能够简单地示教动作。进而,机器人作业时的动作环境也根据家庭而多种多样,所以有必要灵活地与家庭环境相对应。作为机器人装置的示教方法的一例,在机器人的手腕等上安装力传感器,示教者直接把持在力传感器前安装的手柄,将机器人向示教点引导,进行机器人的位置的示教 (参考专利文献1)。现有技术文献专利文献1 日本特开昭59-157715号公报但是,在专利文献1中,示教者有必要对所有的示教点进行示教,所以示教比较耗费时间,非常麻烦。进而,在工业用领域,在对已示教的运动的一部分进行修正的情况下,通过称之为示教器(teaching pendant)的远程装置,必须由编程来进行修正,或者,从一开始示教所有的动作,效率差。特别是,就家庭用机器人而言,有必要尽可能缩短示教的时间。进而,关于利用示教器等远程装置的编程的并用,操作步骤增大,需要学会编程语言,这对于家庭中的外行而言比较困难。另外,如专利文献1所述,在工业机器人中,明确分成对机器人的动作进行示教的示教作业和机器人实际作业的正式作业,但在家庭中,在执行示教后的作业的情况下,与进行了示教的环境不同的环境频繁发生变动,所以即便直接执行示教作业,也会有机器人因环境变动而停止或进行错误作业的情形。在这里,环境变动是指机器人进行动作时的周边的物的位置或状态的变动、和人或机器人直接作用于周边环境所致的物的位置或状态的变动。例如,在家庭环境中,家中物的配置或形状多种多样,例如,在烹调作业的烹调前和烹调后,发生物的形或状态发生变化等环境的变动。进而,在工业用途中,单元生产时的柔性基板等柔软物的形状发生变化或布线时的连接器的位置频繁变动。另外,在再循环工场中,拆卸的家电制品的形式多种多样,进而,由于如图37B (从上看图37A的螺钉73的头部73a得到的图)所示的螺钉的破损部分92、或如图37C所示的污渍部分93、如图37D所示的生锈部分94等随时间变化而形状多种多样。难以事先估计到这些环境变动的全部而进行示教。进而,在装配作业等的制造现场,型号(产品)改变频繁发生,所以示教作业也频繁发生。因此,不会每当环境变动或型号改变时都从一开始示教全部的动作,对于动作中的机器人,人进行状况的辨别,如果有环境变化,人每次都向机器人传达,由此可以使示教无意识地操作。另外,即便在示教时发生预料不到的环境变动的情况下,每次都可以通过人进行示教而使机器人动作。但是,在这种方法中,每当环境发生变动时,人必须每次都进行操作,所以比较麻烦。

发明内容
本发明就是鉴于这样的课题而完成的,其目的在于提供可以实现即便有无法预料的环境变动而作业者也能在短时间内简单进行机器人手臂的示教这样的机器人控制的、机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序及机器人手臂控制用集成电路。用于解决课题的技术手段为了实现上述目的,本发明如下所示构成。根据本发明的第一方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备动作信息获得部,其从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息,矫正动作信息获得部,其在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息,环境信息获得部,其对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息,位置控制部,其以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动,动作矫正部,其在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正,和控制规则生成部,其对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第二方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备动作信息获得部,其从作为与上述动作对应的、上述机器人手臂对对象物施加的力的时间序列的动作信息加以存储的动作信息数据库,获得上述动作信息,
矫正动作信息获得部,其在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息相关联且与上述机器人手臂所施加的力有关的矫正动作信息,环境信息获得部,其对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的上述对象物有关的信息的环境信息,控制部,其以力控制模式对上述机器人手臂进行控制,以便上述机器人手臂以由上述动作信息获得部获得的在上述动作信息中设定的力对上述对象物进行力控制,动作矫正部,在正通过上述控制部对上述机器人手臂以上述力控制模式进行控制期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正,和控制规则生成部,其对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;边参照由上述环境信息获得部获得的上述环境信息,边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第十二方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制方法,其中,用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动;用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;和一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第十三方式,提供一种机器人,其中,具备上述机器人手臂、和对上述机器人手臂进行控制的第一 第十一方式中任一方式记载的上述机器人手臂的控制装置。根据本发明的第十四方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制程序,其中,用于执行下述步骤用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息的步骤;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息的步骤;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息的步骤;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动的步骤;用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正的步骤;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则的步骤;一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制的步骤。根据本发明的第十五方式,提供一种对机器人手臂的动作进行控制的机器人手臂控制用集成电路,其中,用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动;用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;和一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。发明效果如上所述,本发明在周边环境发生变化时,人操作机器人手臂而对动作进行矫正, 在下一次相同环境的情况下,一边参照由环境信息获得部获得的环境信息,一边根据由控制规则生成部生成的控制规则,使机器人手臂自觉地进行动作。


本发明的这些和其它目的和特征,由有关附图的优选实施方式的下列记述而明确。其附图如下所示图IA是表示本发明的第一实施方式中的、具备机器人手臂及其控制装置的机器人的构成的简图;图IB是表示本发明的上述第一实施方式中的上述机器人及其周边环境的简图;图IC是表示本发明的上述第一实施方式中的上述机器人及其周边环境的简图;图2是表示构成本发明的上述第一实施方式中的机器人的上述控制装置和作为控制对象的上述机器人手臂的详细构成的图;图3A是本发明的上述第一实施方式中的与坐标系有关的图;图;3B是本发明的上述第一实施方式中的与坐标系有关的图;图3C是本发明的上述第一实施方式中的与坐标系有关的图;图4是表示本发明的上述第一实施方式中的上述控制装置的控制部的构成的框图;图5A是对作为上述控制装置的动作信息数据库的数据的动作信息进行说明的图;图5B是对作为上述控制装置的上述动作信息数据库的数据的动作信息进行说明的图;图5C是对作为上述控制装置的上述动作信息数据库的数据的动作信息进行说明的图;图6是对上述控制装置的上述动作信息数据库的标志的信息进行说明的图;图7是对上述控制装置的上述动作信息数据库的与矫正参数标志有关的信息进行说明的图;图8是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图9A是对上述控制装置的环境信息数据库的环境信息的一览表进行说明的图;图9B是对上述控制装置的上述环境信息数据库的标志的信息进行说明的图;图IOA是对上述控制装置的控制规则数据库的控制规则的一览表进行说明的图;图IOB是对上述控制装置的上述控制规则数据库的控制规则的一览表进行说明的图;图IlA是对上述控制装置的检测部选择规则数据库的检测部选择规则的一览表进行说明的图;图IlB是对上述控制装置的上述检测部选择规则数据库的与检测部选择规则的环境信息的类别有关的信息进行说明的图;图12是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图13A是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图1 是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图13C是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图13D是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图13E是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图14是表示本发明的上述第一实施方式中的环境信息的图像的例子的图;图15是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图16是表示本发明的上述第一实施方式中的上述控制部的动作步骤的流程图;图17A是表示本发明的上述第一实施方式中的动作指令部的动作步骤的流程图;图17B是表示本发明的上述第一实施方式中的动作矫正部、动作指令部、控制规则生成部、环境信息获得部和控制参数管理部的动作步骤的流程图;图18A是表示本发明的第二实施方式中的机器人手臂的控制装置的动作及人的操作状态的图;图18B是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图19A是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作状态的图;图19B是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图19C是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作状态的侧视图;图19D是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作状态的俯视图;图19E是表示本发明的上述第二实施方式中的上述机器人手臂的控制装置的动作状态的俯视图;图20是表示本发明的上述第二实施方式中的环境信息的图像的例子的图;图21是表示本发明的第三实施方式中的机器人的简图;图22A是对上述第三实施方式中的机器人的机器人手臂的控制装置的动作信息数据库的动作信息的一览表进行说明的图;图22B是对上述第三实施方式中的机器人的机器人手臂的控制装置的上述动作信息数据库的动作信息的一览表进行说明的图;图23是对上述第三实施方式中的机器人的机器人手臂的控制装置的上述动作信息数据库的标志的信息进行说明的图;图24A是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作状态的图;图24B是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作状态的图;图25是表示本发明的上述第三实施方式中的环境信息的图像的例子的图;图26A是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图26B是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图26C是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图26D是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图27是表示本发明的上述第三实施方式中的上述机器人手臂的控制装置的环境信息的图像的例子的图;图28A是表示本发明的上述第三实施方式中的机器人手臂的控制装置的动作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图28B是表示本发明的上述第三实施方式中的机器人手臂的控制装置的动作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图28C是表示本发明的上述第三实施方式中的机器人手臂的控制装置的动作状态的图(其中,为了使图简化,以省略电动驱动器具而用手部直接把持螺钉的状态示出。);图四是表示本发明的上述第一实施方式中的动作指令部的动作步骤的流程图;图30A是表示上述第一实施方式中的人施加的力和其时刻的关系的图;图30B是表示上述第一实施方式中的人施加的力和其时刻的关系的图;图31是表示本发明的第四实施方式中的机器人手臂的控制装置的构成的简图;图32A是对上述第四实施方式中的动作信息数据库的动作信息的一览表进行说明的图;图32B是对上述第四实施方式中的上述动作信息数据库的动作信息的一览表进行说明的图;图33A是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图3 是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图33C是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图34是表示本发明的上述第四实施方式中的环境信息的图像的例子的图;图35A是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图35B是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图35C是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图35D是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作及人的操作状态的图;图35E是表示本发明的上述第四实施方式中的上述机器人手臂的控制装置的动作状态的图;图36A是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36B是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36C是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36D是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36E是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36F是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图36G是表示本发明的上述第一实施方式中的上述机器人手臂的控制装置的动作状态的图;图37A是以往的螺钉的斜视图;图37B是以往的有破损部分的螺钉的头部的俯视图;图37C是以往的有污渍部分的螺钉的头部的俯视图;图37D是以往的有生锈部分的螺钉的头部的俯视图。
具体实施例方式以下,根据附图对本发明涉及的实施方式进行详细说明。以下,在参照附图对本发明中的实施方式进行详细说明之前,对本发明的各种方式进行说明。
根据本发明的第一方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备动作信息获得部,其从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息,矫正动作信息获得部,其在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息,环境信息获得部,其对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息,位置控制部,其以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动,动作矫正部,其在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正,和控制规则生成部,其对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第二方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备动作信息获得部,其从作为与上述动作对应的、上述机器人手臂对对象物施加的力的时间序列的动作信息加以存储的动作信息数据库,获得上述动作信息,矫正动作信息获得部,其在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息相关联且与上述机器人手臂所施加的力有关的矫正动作信息,环境信息获得部,其对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的上述对象物有关的信息的环境信息,控制部,其以力控制模式对上述机器人手臂进行控制,以便上述机器人手臂以由上述动作信息获得部获得的在上述动作信息中设定的力对上述对象物进行力控制,动作矫正部,在正通过上述控制部对上述机器人手臂以上述力控制模式进行控制期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正,和控制规则生成部,其对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第三方式,在第一或第二方式记载的机器人手臂的控制装置的基础上,其中,上述环境信息获得部具备对施加给上述机器人手臂的上述人的力进行检测的力检测部,对应于由上述力检测部检测出的上述人的力和其检测时间,检测出上述人对上述机器人手臂进行了操作,由上述矫正动作信息获得部获得与对上述机器人手臂的上述动作进行矫正时上述机器人手臂所施加的力有关的上述矫正动作信息。根据本发明的第四方式,在第一方式记载的机器人手臂的控制装置的基础上,其中,上述环境信息获得部具备能对上述机器人手臂及上述机器人手臂进行上述动作的周边环境进行摄像的多个图像摄像装置,上述控制规则生成部,对应于上述人对上述机器人手臂操作时上述机器人手臂的上述位置控制模式,从由上述环境信息获得部的上述多个图像摄像装置获得的多个环境信息中,对生成控制规则时的环境信息的类别进行决定。根据本发明的第五方式,在第二方式记载的机器人手臂的控制装置的基础上,其中,上述环境信息获得部具备对施加给上述机器人手臂的上述人的力进行检测的力检测部,上述控制规则生成部,对应于上述人对上述机器人手臂操作时上述机器人手臂的上述力控制模式,在生成控制规则时使用由上述力检测部获得的环境信息。根据本发明的第六方式,在第一 第五方式中任一方式记载的机器人手臂的控制装置的基础上,其中,上述控制规则生成部决定对应于上述人向上述机器人手臂的环境变化通知操作而获得的环境信息。根据本发明的第七方式,在第六方式记载的机器人手臂的控制装置的基础上,其中,上述环境信息具有从多种检测方向进行检测而获得的环境信息,上述控制规则生成部,决定对应于上述机器人手臂的上述人的操作而获得的上述环境信息的检测方向。根据本发明的第八方式,在第一 第七方式中任一方式记载的机器人手臂的控制装置的基础上,其中,还具备动作算出部,其从由上述控制规则生成部生成的控制规则当中的多个动作信息,参照由上述环境信息获得部获得的上述环境信息,算出1个动作信息。根据本发明的第九方式,在第一 第七方式中任一方式记载的机器人手臂的控制装置的基础上,其中,上述人操作上述机器人手臂而对上述机器人手臂的上述动作矫正,由上述矫正动作信息获得部获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息,然后,
在由上述环境信息获得部获得的上述环境信息与上述矫正的操作时的上述环境信息相同时,根据由上述控制规则生成部生成的上述控制规则,按照基于由上述矫正动作信息获得部获得的上述矫正动作信息进行矫正的方式,对上述机器人手臂的上述动作进行控制。根据本发明的第十方式,在第一方式记载的机器人手臂的控制装置的基础上,其中,上述环境信息获得部具备能对上述机器人手臂及上述机器人手臂进行上述动作的周边环境进行摄像的多个图像摄像装置,在上述机器人手臂的前端,具备能以可装卸的方式把持能旋转螺钉的作业用工具的手部,上述作业用工具是上述对象物,一边参照由上述多个图像摄像装置获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,在用上述机器人手臂的上述手部所把持的上述作业用工具进行上述螺钉的紧固或拧下作业时,对上述机器人手臂的上述动作进行控制。根据本发明的第十一方式,在第二方式记载的机器人手臂的控制装置的基础上, 其中,上述环境信息获得部具备能对上述机器人手臂及上述机器人手臂进行上述动作的周边环境进行摄像的多个图像摄像装置,在上述机器人手臂的前端,具备能以可装卸的方式把持柔性基板的手部,上述柔性基板是上述对象物,边参照由上述多个图像摄像装置获得的上述环境信息,边根据由上述控制规则生成部生成的上述控制规则,在将上述机器人手臂的上述手部所把持的上述柔性基板安装于设备上的作业时,对上述机器人手臂的上述动作进行控制。根据本发明的第十二方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制方法,其中,用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动;用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;和一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。根据本发明的第十三方式,提供一种机器人,其中,具备上述机器人手臂、和对上述机器人手臂进行控制的第一 第十一方式中任一方式记载的上述机器人手臂的控制装置。根据本发明的第十四方式,提供一种对机器人手臂的动作进行控制的机器人手臂的控制程序,其中,用于执行下述步骤用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息的步骤;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息的步骤;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息的步骤;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动的步骤;用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正的步骤;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则的步骤;和一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制的步骤。根据本发明的第十五方式,提供一种对机器人手臂的动作进行控制的机器人手臂控制用集成电路,其中,用动作信息获得部,从以时间序列存储与上述动作对应的、上述机器人手臂的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库,获得上述动作信息;用矫正动作信息获得部,在人操作上述机器人手臂而对上述机器人手臂的上述动作进行矫正时,获得与由上述动作信息获得部获得的上述动作信息当中的至少1个以上上述动作信息对应的矫正动作信息;用环境信息获得部,对应于上述人向上述机器人手臂的环境变化通知操作,获得作为与上述机器人手臂所作用的对象物有关的信息的环境信息;用位置控制部,以位置控制模式对上述机器人手臂进行控制,以便使上述机器人手臂根据由上述动作信息获得部获得的上述动作信息进行移动;
用动作矫正部,在上述机器人手臂正通过上述位置控制部的控制而以上述位置控制模式进行移动期间,对应于由上述矫正动作信息获得部获得的在各时间的上述矫正动作信息,对上述动作信息进行矫正;用控制规则生成部,对应于上述机器人手臂的上述人的上述环境变化通知操作, 对由上述环境信息获得部获得的上述环境信息进行决定,且使由上述动作矫正部矫正过的上述动作信息和由上述环境信息获得部获得的上述环境信息建立对应,由此生成用于上述机器人手臂自动进行动作的控制规则;和一边参照由上述环境信息获得部获得的上述环境信息,一边根据由上述控制规则生成部生成的上述控制规则,对上述机器人手臂的上述动作进行控制。以下,使用附图详细说明本发明的实施方式。(第一实施方式)对本发明的第一实施方式中的具备机器人手臂及其控制装置的机器人1的构成进行说明。图IA示出发明的第一实施方式中的具备机器人手臂5和对其机器人手臂5进行驱动控制的控制装置70的机器人1的概要。图IB是从上方看机器人手臂5进行作业的图 IA的作业台7得到的图,图IC是从正面看图IA的作业台7及锅3得到的图。(装置构成)如图IA所示,机器人1的机器人手臂5,例如设置在家庭内的厨房或桌子等的作业台7的壁面7a上。机器人手臂5的基端5a,以能相对于在壁面7a固定的导轨8移动的状态被加以支承,机器人手臂5可以通过人4A的手4的力沿着导轨8上横向(例如水平方向)移动。机器人手臂5的基端的固定场所不限于作业台7的壁面7a,也可以是顶棚等。作为后述的环境信息获得部19的一例的、摄像头等第一及第二图像摄像装置1 及15b,可以对机器人手臂5及机器人手臂5的进行动作的周边环境加以摄像而获得环境信息。在本第一实施方式中,如图IC所示,第一图像摄像装置15a,按照能从顶棚7b对整个作业台7进行摄像的方式从顶棚7b向下安装,如图1B、图IC所示,第二图像摄像装置15b,与作业台7的上面7d平行地安装于作业台7的侧面7c,能从横向对作业台7的上面附近进行摄像。对机器人1的操作进行指示的操作盘13,作为数据输入IM6的一例发挥功能,配置在IH烹调电炉或煤气炉等烹调装置6的前侧侧面。操作盘13设置有用于输入基于使用者的操作指示的操作按钮13a或声音输入装置等。在机器人手臂5的前端设置手部30,手部30以可装卸的方式把持作业用工具 9 (例如勺子等烹调用具或擦拭清洁用抹布等、或电动驱动器具72等)。作为手部30,例如可以使用机械卡盘等公知的能装卸的安装机构。作为显示单元的一例的显示部95,例如是设置于作业台7的显示装置,将后述的机器人的动作等显示于显示部95。S卩,显示部95根据需要将所需要的信息显示于显示部 95,以便顺利地进行本发明的各种动作。需要说明的是,导轨8配置在作业台7的壁面7a,但在没有壁面的岛式厨房的情况下,可以设置在顶棚面或岛式厨房的面板6a的侧面等适于作业的场所。进而,作为数据输入IM6的一例的操作盘13,固定于烹调装置6的侧面,但代替操作盘13,也可以是能进行远程操作的遥控。机器人1例如在家庭内由机器人手臂5和人4A协作而进行下述作业使用机器人手臂5搅拌锅3中的食材的作业、或擦去厨房的污渍的作业(图19B等所示的在有污渍的部分91的擦拭清洁作业)等。以下,作为一例,首先,使用图1A,对通过机器人手臂5进行搅拌作业时的动作进行简单说明。首先,人4A直接把持机器人1的机器人手臂5,人4A用手4向机器人手臂5施加力。此外,通过从人4A向机器人手臂5施加的力,机器人手臂5沿着导轨8移动,将机器人手臂5引导至例如锅等烹调器具3的附近。接着,人4A用手4向机器人手臂5的前端的手部30安装用于进行搅拌作业的勺子等烹调用具9作为作业用工具9的一例。接着,在人4A用手4从操作盘13向机器人手臂5输入动作开始指令时,机器人手臂5进行工作,使预先选择的作业即搅拌作业开始。机器人手臂5通过勺子9在锅3中进行搅拌时,人4A对搅拌中的食材的状态进行确认,通过人4A直接把持机器人手臂5,在想要矫正的方向上对机器人手臂5施加力,对机器人手臂5的动作进行矫正。在烹调结束后,人4A使机器人手臂5从作为烹调器具的一例的锅3内向锅3的外部移动,移行至下一个作业。接着,对本第一实施方式的机器人1的详细内容进行说明。图2是机器人手臂5、 和机器人手臂5的控制装置70的详细构成图。机器人手臂5的控制装置70如图2所示, 具备控制装置主体部11、生成机器人手臂5的动作的动作生成装置12和周边装置14。《机器人手臂》第一实施方式的机器人手臂5,作为一例,为由6自由度的多联杆机械手构成的多关节机器人手臂。机器人手臂5具备手部30、在前端3 具有安装手部30的手腕部31的前臂联杆32、前端33a以能旋转的方式与前臂联杆32的基端32b连结的上臂联杆33、和以能旋转的方式连结支承上臂联杆33的基端33b的台座部34。台座部34与能移动的导轨8 连结,但也可以被固定在恒定位置。手腕部31具有第四关节部38、第五关节部39、第六关节部40三个旋转轴,可以使手部30相对于前臂联杆32的相对姿势(朝向)发生变化。艮口, 在图2中,第四关节部38可以使手部30相对于手腕部31绕横轴(Ψ)的相对姿势发生变化。第五关节部39可以使手部30相对于手腕部31绕与第四关节部38的横轴正交的纵轴 (Φ)的相对姿势发生变化。第六关节部40可以使手部30相对于手腕部31绕与第四关节部38的横轴(V)及第五关节部39的纵轴(Φ)分别正交的横轴(θ )的相对姿势发生变化。前臂联杆32的另一端,可以相对于上臂联杆33的前端绕第三关节部37、即绕与第四关节部38的横轴平行的横轴旋转。上臂联杆33的另一端可以相对于台座部34绕第二关节部36、即绕与第四关节部38的横轴平行的横轴旋转。进而,台座部34的上侧可动部34a, 可以相对于台座部34的下侧固定部34b,绕第一关节部35、即绕与第五关节部39的纵轴平行的纵轴旋转。其结果,机器人手臂5可以绕总计6个轴旋转而构成上述6自由度的多联杆机械手。
在构成各轴的旋转部分的各关节部(具体而言为第一关节部35 第六关节部 40),作为一例,具备电机43之类的旋转驱动装置、和检测电机43的旋转轴的旋转相位角 (即关节角)的编码器44。该第一实施方式的电机43配设在机器人手臂5的各关节部的内部。就电机43而言,在构成各关节部的两个联杆构件(例如,转动侧构件和对该转动侧构件进行支承的支承侧构件)中的一个联杆构件上具备,且通过在该一个联杆构件上具备的后述电机驱动器 25驱动控制电机43。在各关节部的上述一个联杆构件的关节部的附近部分具备的电机43 的旋转轴,与另一个联杆构件的关节部的附近部分连结,使上述旋转轴正反旋转,由此可以使上述另一个联杆构件相对于上述一个联杆构件分别绕第一关节部35 第六关节部40的各轴旋转。另外,编码器44是为了检测电机43的旋转轴的旋转相位角(即关节角)而由一个联杆构件所具备(实际上,配设在机器人手臂5的各关节部的一个联杆构件的内部)。41是相对于台座部34的下侧固定部34b而相对位置关系被固定的绝对坐标系, 42是相对于手部30而相对位置关系被固定的手尖坐标系。将从绝对坐标系41看到的手尖坐标系42的原点位置Oe (X,y,ζ)定义为机器人手臂5的手尖位置(手部30的位置),将从绝对坐标系41看到的手尖坐标系42的姿势用滚动角(roll)、俯仰角(pitch)和偏航角 (yaw)来表现(Φ,θ,ψ)而定义为机器人手臂5的手尖姿势,将手尖位置及姿势矢量定义为矢量r=[x,y,ζ, φ, θ,ψ]。图3示出本发明的第一实施方式中的机器人手臂5的坐标系。在该第一实施方式中,考虑以绝对坐标系35的Z轴为旋转轴、使坐标系旋转角度 φ的坐标系(参照图3Α),将此时的坐标轴定义为[X',V,Ζ]。接着,使该坐标系以Y'为旋转轴旋转角度θ (参照图;3Β),将此时的坐标轴定义为[χ〃 ,Y',ζ〃 ]。最后,使该坐标系以X"为旋转轴绕X"轴旋转角度Ψ (参照图3C),将此时的坐标轴定义为[X"、r “、V “]。将此时的坐标系的姿势定义为滚动角φ、俯仰角Θ、偏航角 Ψ,此时的姿势矢量成为(φ,θ,ψ)。在姿势(φ,θ,ψ)的坐标系在使原点位置平行于手尖坐标系42的原点位置Oe(X,y,ζ)移动得到的坐标系与手尖坐标系42 —致的情况下, 手尖坐标系的姿势矢量为(φ,θ,ψ)。在对机器人手臂5的手尖位置及姿势进行控制的情况下,使手尖位置及姿势矢量 r随动于由后述的目标轨道生成部55生成的手尖位置及姿势目标矢量rd。机器人手臂5,通过具备后述的动作生成装置12、控制装置主体部11、周边装置14 的机器人手臂的控制装置,被如下所述加以动作控制。机器人手臂5的各关节部的、通过后述的编码器44输出的各关节角度信息,通过输入输出IF(接口) 的计数卡被控制装置主体部11取入。根据所取入的各关节角度信息,由控制装置主体部11算出各关节部的旋转动作下的控制指令值。由控制装置主体部11 算出的各控制指令值,通过输入输出IFM的D/A板,被提供给用于对机器人手臂5的各关节部进行驱动控制的电机驱动器25。按照从电机驱动器25送来的上述各控制指令值,机器人手臂5的各关节部的电机43被独立地正反旋转驱动。另外,作为通过电机驱动器25进行驱动控制的手部用驱动装置的一例,手部30具备手部开闭驱动用的电机62、和对手部开闭驱动用的电机62的旋转轴的旋转相位角进行检测的编码器61。由编码器61检测出的电机62的旋转轴的旋转角度信息,通过输入输出IFM的计数卡被控制装置主体部11取入。基于被控制装置主体部11取入的旋转角度信息,通过控制装置主体部11的控制部22的手部控制部54(示于图4)算出手部30开闭动作时的控制指令值。算出的控制指令值,通过输入输出IFM的D/A板被提供给也进行手部30开闭驱动的电机驱动器25。按照从电机驱动器25送来的上述各控制指令值,对电机62的旋转进行驱动控制,手部开闭驱动用的电机62的旋转轴进行正反旋转,使手部30开闭。例如可以构成为通过使电机62的旋转轴正向旋转,而打开手部30,可以用人4A的手4安装作业用工具9 (例如勺子或抹布等),另一方面,通过使电机62的旋转轴反向旋转,而闭合手部30, 对安装于手部30的作业用工具9 (例如勺子或抹布等)进行固定。控制装置主体部11、动作生成装置12及周边装置14,作为一例,分别由一般的个人计算机构成。《周边装置14》周边装置14具有数据输入IF(接口)26、输入输出IF(接口)24、和电机驱动器 25。输入输出IFM具有与个人计算机的PCI总线等扩展槽相连接的、例如D/A板、A/ D板和计数卡等。输入输出IFM获得由机器人手臂5的各关节部的编码器44输出的各关节角度信息、和由手部30的编码器61输出的角度信息,向控制部22输入。另一方面,输入输出IFM从控制部22输入控制信号等控制信息,且向电机驱动器25输出控制指令值等控制信息。电机驱动器25,对机器人手臂5的各关节部的电机43及手部30的电机62输出控制指令值等控制信息。关于数据输入IF (接口)26,是人4A使用键盘、鼠标或话筒等外部输入装置^a, 经由数据输入IM6和数据库输入输出部观,对作业信息(例如作业ID)、或动作矫正操作指令信息、基于机器人手臂5的关节角速度信息的环境变化通知操作的指令、动作矫正操作的指令、或动作信息进行输入或变更的接口。由此,数据输入IM6与外部输入装置^a、 数据库输入输出部观、动作指令部27 (动作算出部2、、控制部22的力检测部53、控制参数管理部21、显示部95连接。另外,数据输入IM6,可以使用作为数据输入IM6的一例的图IA所示的操作盘 13的按钮13a等输入装置,接受由人4A向动作指令部27的控制动作开始及结束的指令。 按钮13a,例如可以作为钮子开关由1个按钮分别输入控制动作开始及控制动作结束,也可以控制动作开始按钮和控制动作结束按钮分开设置。或者代替按钮,是使用键盘、鼠标或话筒等输入装置而向机器人1输入控制动作开始及控制动作结束等的指令的接口。《动作生成装置12》动作生成装置12包括动作信息数据库17、环境信息数据库18、控制规则数据库 16、检测部选择规则数据库四、动作指令部27 (动作算出部2)、动作矫正部20、控制规则生成部23、环境信息获得部19、和数据库输入输出部观。在动作矫正部20和控制参数管理部21之间,机器人手臂5的手尖位置及姿势、人 4A施加的力的信息、动作指令等被输入输出。从控制参数管理部21向动作矫正部20输出机器人手臂5的手尖位置及姿势、人4A所施加的力的信息等。需要说明的是,关于动作生成装置12中的各控制模式[(i)位置控制模式、(ii)阻抗控制模式、(iii)混合阻抗控制模式、(ν)力混合阻抗控制模式]的详细内容,在控制装置主体部11的控制参数管理部21部分再加以描述。-动作信息数据库_动作信息数据库17中,存储有规定时间的机器人手臂5的手尖位置及姿势等与机器人手臂5的动作有关的信息(以下称为动作信息)。动作信息可以预先设定,也可以经由控制规则生成部23由数据库输入输出部观向动作信息数据库17输入而存储。图5Α(图5Β、图5C也一样)示出作为动作信息数据库17的数据的动作信息。图6示出动作信息数据库17的标志的信息。图7示出动作信息数据库17的与矫正参数标志有关的信息。作为动作信息的具体例,参照图5Α并如以下所示。(1)在动作信息数据库17中存储的动作信息的“动作ID栏”,示出对用于让机器人手臂5执行作业的机器人手臂5的各运动进行识别的动作ID号。(2)动作信息的“关键(key)动作ID”栏,示出识别对机器人手臂5进行动作控制的控制程序中的各动作(关键动作)(命令、command)的关键动作ID号。(3)动作信息的“位置姿势”栏,示出与1个动作中的机器人手臂5的手尖位置及姿势有关的信息。需要说明的是,在本第一实施方式中,作为一例,以米(m)单位系统表示手尖位置及姿势的坐标。(4)动作信息的“力”栏,示出在机器人手臂5进行作业时与对成为作业对象的物体(作业对象物,例如作业用工具9、46、72或柔性基板74)施加的力有关的信息。需要说明的是,在本第一实施方式中,作为一例,以牛顿(N)单位系统示出。(5)动作信息的“标志”栏,示出与表示机器人手臂5的手尖位置、姿势及力的参数当中的任意信息是否有效的标志有关的信息。(6)动作信息的“手部”栏,示出表示手部30是开还是闭的手部开闭状态的信息。(7)动作信息的“时间”栏,示出与用于执行机器人手臂5的各关键动作的时间有关的信息。需要说明的是,在本第一实施方式中,作为一例,以秒(sec)单位示出。(8)动作信息的“矫正参数标志”栏,示出与使用后述的动作矫正部20对动作信息数据库17的动作信息进行矫正时的、应矫正的参数的类别有关的信息。在这里,“作业”例如是指搅拌作业或擦拭清洁作业等按照一定的顺序由机器人手臂5执行的工作。另外,“动作”例如是指搅拌作业或擦拭清洁作业等用于让机器人手臂5执行作业的机器人手臂5的运动。通过执行1个以上的“动作”,可以使上述让机器人手臂5执行作业。另外,“关键动作”,是指在对机器人手臂5进行动作控制的控制程序上,用于使机器人手臂5在某时刻进行某“动作”的命令(指令),由多个关键动作(命令)构成上述动作,按照用上述控制装置以时间序列执行多个关键动作(命令)的方式进行控制,由此可以实现机器人手臂5的上述“动作”。图5A的动作信息数据库17的“位置姿势”、即与机器人手臂5的手尖位置及姿势有关的信息,表示前述的机器人手臂5的手尖位置及姿势,根据原点位置Oe和姿势表示为(χ、y、ζ、φ、θ、ψ)。与力有关的信息,表示在机器人手臂5进行作业时与对成为作业对象的物体(作业对象物)施加的力有关的信息,将力的x、y、z、cp、θ、Ψ方向的分量表示为(fx、fy、fz、fcp、 f0、fv)。例如,在& = 5[ 的情况下,表示在ζ轴方向上施加5[N]的力进行作业。具体而言,在对IH烹调电炉6等的面板6a进行擦拭清洁作业时,是在沿着面板6a的表面的方向上施加力而擦拭等时使用。图5A的动作信息数据库17的与“标志”有关的信息,是表示基于各“关键动作ID” 所示的动作信息的机器人手臂5的手尖位置、姿势及力中的任意信息是否有效的值,具体而言,图6由图5A所示的32位(bit)的数值表示,各位数和位置姿势和力的参数被建立对应。在图6中,就各自的位而言,将手尖位置、姿势及力各自的值有效的情况设为“ 1 ”,将手尖位置、姿势及力各自的值无效的情况设为“0”。例如,就第0位而言,将机器人手臂5的手尖位置的χ坐标的值有效的情况设为“1”,将无效的情况设为“0”。另外,就第1位而言, 将机器人手臂5的手尖位置的y坐标的值有效的情况设为“1”,将无效的情况设为“0”。另外,就第2位而言,将机器人手臂5的手尖位置的ζ坐标的值有效的情况设为“ 1,,,将无效的情况设为“0”。以后,依次地,就第3、4、5位而言,表示姿势的φ、θ、ψ的有效性(即,将有效的情况设为“1”,将无效的情况设为“0”)。进而,就第6位 第11位而言,表示力的各分量是有效还是无效(即,将有效的情况设为“1”,将无效的情况设为“0”)。另外,与标志有关的信息为了将来可以扩展而准备多位(32位),在该例中,不使用第12位 第31位,所以事先放入“0”,但也可以为仅能储存12位的变量。图6示出图5Α的动作信息数据库17的 “关键动作ID”的“1”的关键动作的标志。第0位 第1位、第3位 第5位、及第8位成为“1”,所以表示动作信息的手尖位置及姿势信息当中x、y、9、θ、Ψ信息有效,力信息当中仅fz有效。其结果,在动作信息当中,第2位、第6 7位、及第9 11位成为“0”,所以对于z、fx、fy、fcp、f0、f ψ的值,无论存储什么样的值都是无效的。图5Α的与“手部”有关的信息,作为表示动作中的手部30有无开闭的标志,在手部30打开的情况下记载为“0”,在手部30闭合的情况下记载为“1”。图5Α的动作信息数据库17的与“时间”有关的信息,是用于执行机器人手臂5的各关键动作的时间,即,表示机器人手臂5花费作为与对应的“时间”有关的信息而存储的时间进行在“关键动作ID”中存储的动作。即,该“时间”不是表示绝对时刻,而是表示自先前的动作起的相对时间。即,表示机器人手臂5的手部30向“关键动作ID”所示的“位置姿势”移动的时间或达到“关键动作ID”所示的“力”的时间。图5A的动作信息数据库17的与“矫正参数标志”有关的信息,是表示后述的动作矫正部20对哪一参数进行矫正的信息。具体用图7所示的32位的数值表示。在图7中, 就各自的位而言,将能对手尖位置、姿势及力的各自的值进行矫正的情况设为“1”,将不能对手尖位置、姿势及力的各自的值进行矫正的情况设为“0”。例如,就第0位而言,将能对手尖位置的χ坐标的值进行矫正的情况设为“1”,将不能对手尖位置的χ坐标的值进行矫正的情况设为“0”。另外,就第一位而言,将能对手尖位置的y坐标的值进行矫正的情况设为 “ 1 ”,将不能对手尖位置的y坐标的值进行矫正的情况设为“0”。另外,就第二位而言,将能对手尖位置的ζ坐标的值进行矫正的情况设为“ 1 ”,将不能对手尖位置的ζ坐标的值进行矫正的情况设为“0”。以后,依次地第3、4、5位表示姿势的φ、θ、ψ的矫正可能性(即,将能矫正的情况设为“1”,将不能矫正的情况设为“0”)。进而,就第6位 第11位而言,表示力的各分量的矫正可能性(即,将能矫正的情况设为“1”,将不能矫正的情况设为“0”)。另外,与标志有关的信息为了将来可以扩展而准备多位(32位),在该例中,由于不使用第12 位 第31位,所以事先放入“0”,但也可以为仅能储存12位的变量。动作信息数据库17的信息,被预先设定而数据库化,但机器人手臂5的手尖的位置姿势、力的输入及更新,也可以进行使用了机器人手臂5的示教,以下进行说明。图8示出使用了本发明的上述第一实施方式中的机器人手臂5的基于人4A的示教的状态。机器人手臂5的手尖的位置姿势及时间的信息如下所示而作成。即,例如图8所示,人4A用手4直接把持机器人手臂5,以后述的阻抗控制模式使机器人手臂5移动。此时,在每某恒定时间(例如每0. 2msec)借助控制部22及控制参数管理部21由数据库输入输出部观获得机器人手臂5的手尖位置及姿势的信息。所获得的机器人手臂5的手尖位置及姿势的信息与时间一起通过数据库输入输出部观存储在动作信息数据库17中。如此可以在动作信息数据库17作成机器人手臂5的手尖的位置姿势及时间的信息。进而,动作信息数据库17的力的信息,使用数据输入1旧6且经由数据库输入输出部观将想要施加的力的值向动作信息数据库17输入,由此而作成。需要说明的是,在该例中,连续作成了机器人手臂5的手尖的位置姿势及时间的信息,但也可以由人4A使用键盘、鼠标、或话筒等外部输入装置^a,分开输入各自的位置姿势及时间的信息。-环境信息数据库_环境信息数据库18中,存储有机器人手臂5进行动作时与机器人手臂5周边的物体的位置及状态有关的信息、和与人4A及机器人手臂5直接作用于周边环境所致的物体的位置及状态有关的信息(以下将这些信息称为环境信息。)。环境信息由后述的环境信息获得部19获得,从环境信息获得部19经由数据库输入输出部观存储在环境信息数据库18 中。接着,详细说明环境信息数据库18。图9A表示作为环境信息数据库18的数据的环境信息。图9B表示环境信息数据库18的标志的信息。(1)在环境信息数据库18中存储的环境信息的“环境ID”栏,示出对各环境信息进行识别的环境ID号。(2)环境信息的“图像ID”栏,示出对作为环境信息获得部19的一例发挥功能的第一及第二图像摄像装置1 及1 进行摄像得到的图像加以识别的图像ID号。在这里, 使用文件名。(3)环境信息的“图像摄像装置ID”栏,是对用2个图像摄像装置15a及15b当中的哪一图像摄像装置进行了摄像加以识别的ID号。在该例中,在由第一图像摄像装置1 进行摄像的情况下示为“1”,在由第二图像摄像装置1 进行了摄像的情况下示为“2”。(4)环境信息的“力”栏,示出与由力检测部53检测出的力有关的信息(力的信
息)ο与力有关的信息,表示与由机器人手臂5的力检测部53检测出的力有关的信息,将力的x、y、z、cp、θ、Ψ方向的分量表示为(fx、fy、fz、fcp、f0、fv)。(5)环境信息的“标志”栏,示出与表示环境信息的力及图像的参数当中的任意信息是否有效的标志有关的信息。图9A的环境信息数据库18的与“标志”有关的信息,是表示各环境ID所示的环境信息的图像及力的信息是否有效的值。具体而言,用图9B所示的32位的数值表示。在图 9B中,就各位而言,将图像及力的值分别有效的情况设为“ 1”,将图像及力的值分别无效的情况设为“0”。在本第一实施方式中,第0位 第5位表示力的信息,第6位表示图像的信息。例如,就第0位而言,将力的χ坐标的值有效的情况设为“1”,将无效的情况设为“0”。 另外,就第1位而言,将力的y坐标的值有效的情况设为“1”,将无效的情况设为“0”。另外, 就第2位而言,将力的ζ坐标的值有效的情况设为“1”,将无效的情况设为“0”。以后,依次地第3、4、5位表示力的φ、θ、ψ的有效性。S卩,将有效的情况设为“1”,将无效的情况设为 “0”。进而,在第6位,表示由第一或第二图像摄像装置1 或1 进行摄像得到的图像是有效还是无效(即,将有效的情况设为“1”,将无效的情况设为“0”)。与标志有关的信息为了将来可以扩展而准备多位(32位),在该例中,由于不使用第7位 第31位,所以事先放入“0”,但也可以为仅能储存6位的变量。在图9B中,第0 位 第5位成为“0”,第6位成为“1”,所以表示仅仅环境信息的图像信息是有效的。-控制规则数据库_控制规则数据库16中,存储有机器人手臂5进行工作时与机器人手臂5的控制规则有关的信息(以下称为控制规则信息)。控制规则信息由后述的控制规则生成部23生成,通过数据库输入输出部观,在控制规则生成部23和控制规则数据库16之间输入输出所生成的信息或生成所需要的信息等。另外,通过数据库输入输出部观,在控制规则生成部 23和其他数据库18、17、四之间输入输出生成所需要的信息等。接着,使用图IOA及图IOB详细说明控制规则数据库16。图IOA和图IOB示出控制规则数据库16的控制规则的一例。(1)在控制规则数据库16中存储的控制规则的“作业ID”栏,示出对与作业有关的信息进行识别的作业ID号。(2)控制规则的“环境ID”栏,是表示对各环境信息进行识别的环境ID号,可以参照环境信息数据库18的环境ID的值。在不能参照环境信息数据库18的环境ID的值的情况下,作为“-1”加以存储。(3)控制规则的“动作ID”栏,示出对作业的中的机器人手臂5的动作进行识别的动作ID号,可以参照动作信息数据库17的动作ID。(4)控制规则的“进程信息”栏,示出机器人手臂5的规定动作是否在动作中,将在动作中的情况设为“1”,将不在动作中的情况设为“0”,通过数据库输入输出部观存储在控制规则数据库16中。具体而言,在通过动作指令部27开始作业时,关于机器人手臂5的在当前动作(执行)中的动作,通过数据库输入输出部观在控制规则数据库16中存储“1”, 关于并非在当前动作(执行)中的动作,通过数据库输入输出部观在控制规则数据库16 中存储“0”。-检测部选择规则数据库-检测部选择规则数据库四中,存储有在操作机器人手臂5而获得环境信息时、用于通过机器人手臂5的控制模式选择从多个环境信息中优先获得的环境信息的类别的规则(检测部选择规则)。检测部选择规则数据库四在机器人1中被预先准备,通过数据库输入输出部观被输入输出检测部选择规则的信息。接着,使用图11A、图IlB详细说明检测部选择规则数据库四。图IlA示出检测部选择规则数据库四的检测部选择规则。图IlB示出与检测部选择规则数据库四的检测部选择规则的环境信息的类别有关的信息。(1)在检测部选择规则数据库四中存储的检测部选择规则的“控制模式”栏,示出与机器人手臂5的控制模式有关的信息。具体而言,与控制装置主体部11的控制参数管理部21相关联而如后所述。(2)检测部选择规则的“环境信息的类别ID”栏,示出对环境信息的类别进行识别的识别ID。环境信息的识别ID是用于对由作为检测部的环境信息获得部19、例如机器人手臂5所搭载的各种传感器(例如力检测部5 或机器人1的各种传感器(例如第一或第二图像摄像装置1 或15b)获得的环境信息的类别进行识别的ID。图IlA的“环境信息类别ID”用图IlB进行定义。具体而言,作为检测部选择规则,如图IlB所示,在“环境信息的类别ID”为“1”的情况下,表示由作为检测部的一例的第一或第二图像摄像装置1 或 15b进行摄像得到的图像,在“环境信息的类别ID”为“2”的情况下,表示由作为检测部的其他例子的力检测部53检测出的力。-数据库输入输出部_数据库输入输出部观,进行各数据库组(动作信息数据库17、环境信息数据库18、 控制规则数据库16、检测部选择规则数据库29)、动作指令部27、控制规则生成部^、环境信息获得部19、及动作矫正部20之间的数据的输入输出。由此,数据库输入输出部观,能作为动作信息获得部及矫正动作信息获得部的一例发挥功能。即,数据库输入输出部观可以作为如下的动作信息获得部发挥功能,即从以时间序列存储与机器人手臂5的动作对应的、机器人手臂5的位置、姿势、及速度的至少1个以上作为动作信息的动作信息数据库17 获得上述动作信息的动作信息获得部;或从作为与机器人手臂5的动作对应的、机器人手臂5施加给作业对象物9、46、72、74的力的时间序列的动作信息而加以存储的动作信息数据库17获得上述动作信息的动作信息获得部。另外,数据库输入输出部观,可以在人4A操作机器人手臂5而对机器人手臂5的上述动作进行矫正时,作为获得与由动作信息获得部获得的动作信息当中至少1个以上上述动作信息对应的矫正动作信息的矫正动作信息获得部发挥功能,或者可以在人4A操作机器人手臂5而对机器人手臂5的动作进行矫正时, 作为获得与动作信息获得部获得的动作信息相关联且与机器人手臂5施加的力有关的矫正动作信息的矫正动作信息获得部发挥功能。当然,也可以将数据库输入输出部观分割成进行动作信息的输入输出的动作信息获得部、进行矫正动作信息的输入输出的矫正动作信息获得部、和进行其他信息的输入输出的其他信息获得部。-环境信息获得部_环境信息获得部19,获得与机器人手臂5所作用的作业对象物9、46、72、74有关的信息的环境信息、即与机器人手臂5进行动作时的机器人手臂5的周边物体的位置及状态有关的信息、和与人4A及机器人手臂5直接作用于周边环境所致的物体的位置及状态有关的信息。具体而言,获得由第一或第二图像摄像装置1 或1 进行摄像得到的图像和由力检测部53检测出的力的信息,从环境信息获得部19向控制规则生成部23及动作指令部 27输出由第一或第二图像摄像装置1 或1 获得的图像及由力检测部53检测出的力的信息。由此,第一及第二图像摄像装置1 和1 及力检测部53,分别作为环境信息获得部 19的一例发挥功能。-动作指令部_人4A通过数据输入IM6指定的“作业ID”的作业的动作开始的指令,从数据输入 IF26向动作指令部27输入。动作指令部27,接受被指定的“作业ID”的作业的动作开始的指令,借助数据库输入输出部观参照控制规则数据库16的被指定的“作业ID”,对控制参数管理部21作出指令,以便使该作业ID的作业开始。以下,对动作指令部27的功能进行说明。 人4A通过数据输入IM6,使用由显示部95对作业等进行显示后的显示图像,同时从控制规则数据库16的作业中的与“作业ID”有关的作业中选择想使机器人手臂5执行的作业,向动作指令部27输入所选择的作业信息而加以指定。动作指令部27,借助数据库输入输出部观而参照控制规则数据库16,执行与所指定的“作业ID”对应的“动作ID”的动作。在这里,所谓执行“动作ID”的动作,是指动作指令部27借助数据库输入输出部观而参照动作信息数据库17,向控制参数管理部21作出指令,以便基于对应的关键动作(具体而言,位置信息、姿势信息、时间信息、及力信息)并依照标志(表示是有效还是无效的标志)设定控制模式而使机器人手臂5进行动作。动作指令部27借助数据库输入输出部观而参照控制规则数据库16时,在由动作指令部27判断为在与1个“作业ID”有关的作业中有多个“环境ID”的环境信息存在的情况下,或在由动作指令部27判断为有多个“动作ID”的动作存在的情况下,按控制规则数据库16从上到下依次执行各自的环境信息或动作。在这里,在“环境ID”为值“_1”的情况下,是指未参照环境信息数据库18的“环境ID”的值。由此,不论机器人手臂5进行动作的周边环境如何,动作指令部27借助数据库输入输出部观,从动作信息数据库17参照与在“动作ID”中记述的ID相同的“动作ID” 的动作。以下说明的是人4A通过数据输入IM6选择了 “作业ID”的“1”的情况和选择了 “作业ID”的“2”的情况。(选择J“作业ID,,的“ 1,,的情况)具体而言,当选择了图IOA的“作业ID”为“1”的作业时,在“作业ID”为“1”的作业的“环境ID”是值“_1”的情况下,此时的“动作ID”是“1”的动作。因此,动作指令部 27,为了使机器人手臂5与环境无关地执行动作,借助数据库输入输出部观而参照动作信息数据库17的“动作ID”。在该例中,在控制规则数据库16的“动作ID”中存储为“1”,动作指令部27借助数据库输入输出部观,依次参照图5A的动作信息数据库17的“动作ID” 为“ 1”的动作的“关键动作ID ”的“ 1,,、“ 2,,、“ 3,,、“ 4,,、“ 5,,、“ 6,,、“ 7,,、“ 8,,的关键动作(命令)。在动作信息数据库17的“关键动作ID”为“1”的关键动作(命令)的情况下,就“标志”而言,第0、1、3、4、5、8位为“1”,所以表示机器人手臂5的手尖位置的x、y、(p、θ、ψ 的值、及力的ζ坐标的值有效。由此,从动作指令部27经由数据库输入输出部观对控制参数管理部21作出指令(与力混合阻抗控制的指令等同),以便使χ轴、y轴、φ轴、θ轴、ψ 轴以位置控制模式进行动作、使ζ轴以力控制模式进行动作。同样地,关于“关键动作ID” 为“2” “8”的关键动作(命令),从动作指令部27经由数据库输入输出部观对控制参数管理部21作出指令,以便使其以力混合阻抗控制模式进行动作。(选择J“作业ID,,的“2,,的情况)同样地,在选择了图IOA的“作业ID”为“2”的作业的情况下,“作业ID”为“2”的作业的“环境ID”是值“_1”,是此时的“动作ID”为“2”的动作。因此,动作指令部27,为了使机器人手臂5与环境无关地执行动作,借助数据库输入输出部观而参照动作信息数据库 17的“动作ID”。在该例中,在控制规则数据库16的“动作ID”中存储为“2”,动作指令部 27借助数据库输入输出部观,依次参照图5A的动作信息数据库17的“动作ID”为“2”的动作的“关键动作 ID” 是 “ 10,,、“ 11,,、“ 12”、“ 13”、“ 14”、“ 15”、“ 16,,、“ 17” 的关键动作(命令)。此时,在“关键动作ID”为“10”的关键动作(命令)的情况下,就“标志”而言,第 0 5位为“1”,对于χ轴、y轴、ζ轴、φ轴、θ轴、Ψ轴的所有轴,从动作指令部27经由数据库输入输出部观对控制参数管理部21作出指令,以便以位置控制模式进行动作。在由外部输入装置^a输入而执行动作时,动作指令部27借助数据库输入输出部观,对控制规则数据库16的动作中的“动作ID”的“进程信息”设定“1”,将动作中的“动作 ID”的“进程信息”为“ 1,,的信息,通过数据库输入输出部观存储在控制规则数据库16中。 关于其他“动作ID”的“进程信息”,由动作指令部27设定“0”,将其他“动作ID”的“进程信息”为“0”的信息,通过数据库输入输出部观存储在控制规则数据库16中。在这里,对具体的作业例进行说明。在由人4A使用数据输入IM6选择控制规则数据库16的作业中的“作业ID”为 “1”的作业的情况下,动作指令部27借助数据库输入输出部28对控制参数管理部21作出指令,以便使ζ轴方向以力控制模式进行作业,使其他轴方向以位置控制模式进行作业。其结果,控制参数管理部21对控制部22发出指令,以便如后所述使机器人手臂5依照上述控制模式进行动作,在利用控制部22的控制下,如图12所示,机器人手臂5开始对IH烹调电炉等烹调装置6的面板6a的擦拭清洁作业。在由人4A使用数据输入IM6选择控制规则数据库16的作业中的“作业ID”为 “2”的作业的情况下,动作指令部27借助数据库输入输出部28对控制参数管理部21作出指令,以便以位置控制模式进行搅拌动作。其结果,控制参数管理部21对控制部22发出指令,以便如后所述使机器人手臂5依照上述控制模式进行动作,在利用控制部22的控制下, 如图13A所示,机器人手臂5开始搅拌动作。另一方面,在图IOA的“作业ID”为“1”的作业的情况下且在“作业ID”为“1”的作业的“环境ID”不是值“_1”的情况下,动作指令部27借助数据库输入输出部观,从环境信息数据库18参照与在“环境ID”中存储的ID相同的“环境ID”的环境信息。仅在由动作指令部27,通过与“环境ID”相同的“环境ID”的环境信息(具体而言,图像的信息和力的信息)当中的标志,判断为有效的环境信息与由后述的环境信息获得部19获得的环境信息吻合的情况下,用动作指令部27执行“动作ID”的动作。关于详细情况,与控制规则生成部23相关联而如后所述。另外,在所选择的“作业ID”中存在多个“环境ID”和“动作ID”的情况下,通过各自的“环境ID”和各自的“动作ID”的标志(这里的标志,是指动作指令部27以“动作ID” 而借助数据库输入输出部观参照动作信息数据库17、由此而存储的标志。),通过动作指令部27的动作算出部2算出应最终执行的动作信息。关于动作算出部2的详细内容,与控制规则生成部23相关联而如后所述。-动作矫正部-动作矫正部20,可以在正由控制装置主体部11以力控制模式对机器人手臂5进行控制期间或在通过控制部22的位置控制部59的控制使机器人手臂5以位置控制模式进行移动期间,对应于由作为矫正动作信息获得部的一例的数据库输入输出部观获得的在各时间下的矫正动作信息,对动作信息进行矫正。即,动作矫正部20在机器人手臂5的控制动作过程中,从数据输入IM6借助动作指令部27接受动作矫正操作的开始指令。动作矫正部20借助数据库输入输出部观,根据动作信息数据库18的矫正参数标志,对机器人手臂 5的控制参数进行切换,由此以矫正后的动作(矫正动作)使机器人手臂5进行动作,由人 4A对机器人手臂5施加力,由此借助数据库输入输出部观对控制规则数据库16的机器人手臂5的控制规则进行修正。在这里,上述机器人手臂5的控制动作,表示以后述的(i)位置控制模式、(iii)力控制模式、或(ν)按方向的不同将它们组合后的力混合阻抗控制模式当中的任意模式进行动作。另外,上述机器人手臂5的矫正动作,是通过由人4A向机器人手臂5施加的力对机器人手臂5的动作进行矫正的动作,表示以后述的(ii)阻抗控制模式、(vi)高刚性位置控制模式、或(ν)按方向的不同将它们组合后的力混合阻抗控制模式当中的任意模式进行动作。以下,对动作矫正进行说明。人4A通过数据输入IF26,从控制规则数据库16的与“作业ID”有关的作业中选择想使机器人手臂5执行的作业,通过动作指令部27来执行动作。此时,在选择了图IOA的“作业ID”为“2”的作业的情况下,动作指令部27对控制参数管理部21作出指令,以便以位置控制模式进行搅拌动作。由此,如图13A所示,机器人手臂5开始搅拌动作。在这里,在“作业ID”为“2”的作业的情况下,“环境ID”是值 “-1” (参照图10A),因此不论机器人手臂5进行动作的环境信息如何,都以在“动作ID”中存储的动作进行动作(具体而言,以“动作ID”为“2”的动作进行动作)。接着,在人4A从数据输入IM6经由动作指令部27向接受动作矫正部20作出动作矫正操作开始的指示时,动作矫正部20移入动作矫正的处理。图13是对本发明的上述第一实施方式中的机器人手臂5的矫正动作进行说明的图。在本第一实施方式中,对以下的情况进行说明,即,将勺子9保持在手部30的机器人手臂5,中止图13A所示的锅3a的搅拌,如图13E所示,进行在锅的直径比锅3a大的锅北中搅拌的动作。在这里,在不进行动作矫正的情况下,“作业ID”为“2”的作业,“环境ID”为值“_1”,与锅的大小无关而执行在“动作ID”中记述的动作,因此即便将锅3a更换为直径大的锅北,也会如图13B所示进行直径小的搅拌。为此,发生锅北中的食材未很好搅拌的问题。因此,人4A确认锅北的大小,为了如图13E所示与锅北的直径配合地用勺子9 大幅度进行搅拌,对机器人手臂5的搅拌动作进行矫正。为此,人4A进行以下的2个输入操作。第一输入操作是通知作业环境发生变化的操作(以下,称为环境变化通知操作。)。该操作在本第一实施方式中,是向机器人手臂5通知搅拌动作对象的锅3a变成直径大的锅北的操作。第二输入操作是用于对实际的机器人手臂5的动作进行矫正的操作(以下,称为动作矫正操作。)。在本第一实施方式中,在开始了环境变化通知操作的时点,机器人手臂5的搅拌动作停止,接着,环境变化通知操作结束,重新开始机器人手臂5的搅拌动作,所述环境变化通知操作是用于对动作进行矫正以便如图13E所示大幅度进行搅拌动作的操作。人4A 在机器人手臂5正进行搅拌动作期间,进行动作矫正操作。人4A通过数据输入IF26,向动作指令部27输入环境变化通知操作的开始指令。 向动作指令部27输入环境变化通知操作的开始命令时,通过动作指令部27使机器人手臂5 的动作停止。此外,在通过人4A的环境变化通知操作结束的时点,接着,人4A通过数据输入IM6向动作指令部27输入动作矫正操作的开始指令。在动作指令部27借助数据输入 IF26接收动作矫正操作的开始指令时,动作指令部27判断为环境变化通知操作已结束,为了开始动作矫正操作而重新开始机器人手臂5的动作。此时,人4A对机器人手臂5的动作进行动作矫正操作。动作指令部27借助数据输入IM6接受环境变化通知操作的指令或动作矫正操作的指令时,向动作矫正部20及后述的控制规则生成部23输出各自的环境变化通知操作的开始信息或动作矫正操作的开始信息输出。就上述操作的具体指令而言,在机器人手臂5正以位置控制模式执行搅拌动作期间,人4A用手4把持机器人手臂5,对机器人手臂5在想要矫正的方向上施加力。此时,如图30A所示,在人4A对机器人手臂5施加的力(由后述的力检测部53检测出的力)为某阈值(图30A的值。以上且该状态持续某恒定时间(图30A的时间timel)以上的情况(后述的、由控制参数管理部21的计时器21a检测出的时间持续上述某恒定时间以上的情况) 下,动作指令部27判断为输入了环境变化通知操作的开始指令。换言之,如图30B所示,在人4A对机器人手臂5施加的力低于上述某阈值(图30B的值t2)的情况下,或在即便为上述某阈值(图30B的值t2)以上,该状态为低于上述某恒定时间(图30A的时间timel)的时间(图30B的时间time2)的情况下,动作指令部27也判断为未输入环境变化通知操作的开始指令。在由动作指令部27判断为已输入通过人4A的环境变化通知操作的开始指令时,动作指令部27向动作矫正部20输入环境变化通知操作的开始信息。在动作指令部27判断为已被输入环境变化通知操作的开始指令时,通过动作指令部27停止搅拌动作。通过该搅拌动作的停止动作,人4A知晓机器人1已判断为环境变化通知操作开始了。需要说明的是,如后所述,构成为由力检测部53检测出的力的信息被输入到控制参数管理部21,上述力的信息和由计时器21a检测出的时间的信息,从控制参数管理部21被输入到动作指令部27,能由动作指令部27执行上述判断。接着,在人4A进行了上述环境变化通知操作之后,在由动作指令部27判断为人4A 对机器人手臂5施加的力小于上述阈值(图30A的值、)的情况下,通过动作指令部27判断为环境变化通知操作结束了,通过动作指令部27使位置控制模式下的搅拌动作重新开始。通过使搅拌动作重新开始,人4A知晓机器人1已判断为环境变化通知操作结束了。接着,在如前所述人4A知晓机器人1已判断为环境变化通知操作结束了之后,人 4A用手4把持机器人手臂5,在想要对机器人手臂5的动作进行矫正的方向上,对机器人手臂5施加力。如图30A所示,在由动作指令部27判断为对机器人手臂5施加的力为上述某阈值(图30A的值、)以上且该状态持续了上述某恒定时间(图30A的时间timel)以上的情况下,由动作指令部27判断为基于人4A的动作矫正操作的开始指令已被输入。换言之,如图30B所示,在人4A对机器人手臂5施加的力低于上述某阈值(图30B的值t2)的情况下,或在即便为上述某阈值(图30B的值t2)以上,但该状态也低于上述某恒定时间(图 30A的时间timel)的时间(图30B的时间time2)的情况下,动作指令部27判断为动作矫正操作的开始指令未被输入。由动作指令部27判断为基于人4A的动作矫正操作的开始指令已被输入时,动作指令部27向动作矫正部20输入动作矫正操作的开始信息。需要说明的是,在即便经过恒定时间而动作矫正操作也不开始的情况下,使环境变化通知操作为无效, 使搅拌动作重新开始。由动作指令部27判断为动作矫正操作的开始指令已被输入时,通过动作指令部 27的指令,机器人手臂5的搅拌动作的速度减慢(例如,动作矫正操作开始前的通常的搅拌动作时的速度的一半速度),人4A知晓机器人1已判断为已输入动作矫正操作的开始指令。 进而,搅拌动作的速度减慢,人4A容易对动作中的机器人手臂5的动作进行矫正。在人4A 对机器人手臂5的动作进行矫正期间,该矫正动作的信息如后所述被动作矫正部20获得。 在人4A对机器人手臂5的动作进行了矫正之后,在动作指令部27判断人4A施加的力小于上述阈值(图30A的值、)的情况下,通过动作指令部27结束动作矫正操作,通过动作指令部27使机器人手臂5的速度恢复成矫正前的速度,进而,通过动作指令部27及动作矫正部20,执行矫正后的动作。在由动作指令部27判断为动作矫正操作结束了时,通过动作指令部27的指令,机器人手臂5的搅拌动作的速度增快(例如,动作矫正操作时的搅拌动作时的速度的二倍速度),人4A知晓机器人1已判断为动作矫正操作结束了。需要说明的是,在该例中,通过人4A施加的力,动作指令部27自动判断环境变化通知操作及动作矫正操作的开始及结束并自动进行了切换,但也可以通过人4A对按钮按压等方式使用数据输入IM6,手动切换环境变化通知操作及动作矫正操作的开始及结束。 进而,通过各自的操作停止或减慢机器人手臂5的动作,由此向人4A通知在进行何种操作, 例如,可以在设置于作业台7的壁面7a等处的作为显示部95的一例的监视器等上,显示在进行环境变化通知操作或动作矫正操作的哪一操作。另一方面,动作矫正部20在从动作指令部27接受到环境变化通知操作的开始信息时,获得从人4A借助机器人手臂5输入的环境变化通知操作的信息,因此关于想要矫正的“作业ID”的“动作ID”,向控制参数管理部21输出指令,以便按照动作信息数据库17的 “动作ID”的标志设定控制模式而进行动作。
具体而言,对与图IOA的“作业ID”为“2”的作业的“动作ID”为“2”的动作对应的、动作信息数据库18的“关键动作ID”为“10” “17”的关键动作(命令)进行说明。 在图5A中,就各“关键动作ID”的标志而言,仅第0 5位为“ 1 ”,其他为“0”,因此在机器人手臂5的动作当中,仅仅χ轴、y轴、ζ轴、φ轴、θ轴、Ψ轴的数据是有效的。因此,可以使用人4Α施加的力,对机器人手臂5的χ轴、y轴、ζ轴、φ轴、θ轴、ψ轴进行动作矫正操作。此外,关于机器人手臂5的χ轴、y轴、ζ轴、φ轴、θ轴、ψ轴,动作矫正部20向控制参数管理部21发出指令,以便从位置控制模式以阻抗控制模式(在探测出人4Α的力的方向上使机器人手臂5移动的模式)进行动作。由从位置控制模式向阻抗控制模式切换,在未施加人4Α的力的状态下,机器人手臂5停止,在人4Α施加力时,可以在人4Α施加的力的方向上使机器人手臂5移动。接着,在开始环境变化通知操作之后,如图13C所示,由人4Α进行向机器人手臂5 通知锅3a变成直径大的锅北的操作(环境变化通知操作)。具体而言,如图13C所示,人 4A用手4直接把持机器人手臂5的手部30或手部30附近的前腕联杆32,与锅北的锅底面平行(x_y平面)地施加力时,通过阻抗控制模式,用力检测部53探测出人4A的力,在人 4A对机器人手臂5施加力的方向(箭头AX方向)上使机器人手臂5移动。在该例中,通过人4A使机器人手臂5在该箭头AX方向上移动的操作,是环境变化通知操作。接着,在环境变化通知操作之后,由动作矫正部20获得人4A施加力使其移动后的矫正动作的信息,所以由动作矫正部20获得来自控制参数管理部21的机器人手臂5的手尖位置,从动作矫正部20向后述的控制规则生成部23输出。接着,动作矫正部20从数据输入IM6借助动作指令部27接受动作矫正操作的开始指令,从动作矫正部20对控制参数管理部21发出指令,以便按照动作信息数据库17的矫正参数标志,设定控制模式而进行动作。具体而言,对与图IOA的“作业ID”为“2”的作业的“动作ID”为“2”的动作对应的、动作信息数据库18的“关键动作ID”为“10” “17” 的关键动作(命令)进行说明。在图5A中,就各“关键动作ID”的矫正参数标志而言,仅仅第0、1、2位为“ 1”,其他为“0”,所以在机器人手臂5的动作当中,可以只进行χ轴、y轴、ζ 轴的矫正。因此,可以使用人4A施加的力对机器人手臂5的χ轴、y轴、ζ轴进行矫正。此外,关于机器人手臂5的χ轴、y轴、ζ轴,动作矫正部20对控制参数管理部21作出指令,以便从位置控制模式以混合阻抗控制模式(边以位置控制模式进行移动、边在已探测出人4A 的力的方向上以阻抗控制使其移动的模式)进行动作。此外,如图13D所示,人4A直接把持机器人手臂5而在沿着锅北的底面的方向上施加力,以便与锅北的直径配合地大幅度进行混合时,机器人手臂5如前述所示进行混合阻抗控制模式。其结果,机器人手臂5执行(1)基于位置控制模式的机器人手臂5的移动、 和( 基于阻抗控制模式的、在人4A施加力的方向上机器人手臂5向χ轴方向、或y轴方向、或χ轴方向及y轴方向的移动。人4A想要在x-y平面上在锅北内按照与锅3a的情况相比画圆的形式大幅度搅拌的方式进行矫正,人4A如图13D所示与锅底面平行地对机器人手臂5施加力而使机器人手臂5移动。由动作矫正部20获得通过人4A施加力而移动后的机器人手臂5的动作,所以由动作矫正部20在每规定的恒定时间(例如每0.2秒)获得手尖位置及时间作为来自控制参数管理部21的机器人手臂5的动作矫正操作的信息,从动作矫正部20向后述的控制规则生成部23输出所获得的手尖位置及时间。机器人手臂5的手尖位置借助编码器44由控制参数管理部21获得。进而,时间信息由控制参数管理部21所具备的计时器21a获得。另外,也向控制参数管理部21输入由力检测部53检测出的力的信息,所以从控制参数管理部21向动作指令部37输入由该力检测部53检测出的力的信息和基于计时器21a的时间信息,例如可以如前所述进行矫正动作的环境变化通知操作及动作矫正操作的开始及结束的判断。需要说明的是,与该时间有关的信息,成为将人4A选择作业并借助数据输入IM6 向动作指令部27发出了开始指令的时点设为“0”的相对时间。-控制规则生成部_控制规则生成部23,通过将由动作矫正部20矫正后的动作信息和由环境信息获得部19获得的环境信息建立对应,能够生成用于机器人手臂5自动动作的控制规则。艮口, 控制规则生成部23,在后述的机器人手臂5的控制动作过程中,从数据输入IM6借助动作指令部27,与动作矫正部20 —样接受动作矫正操作的开始指令。控制规则生成部^,根据由动作矫正部20矫正后的动作信息和由环境信息获得部19获得的环境信息,生成控制规则,存储在控制规则数据库16中。在这里,机器人手臂5的控制动作,是(ii)阻抗控制模式、(i)位置控制模式、(iv)力控制模式、或(ν)按方向的不同将它们组合后的力混合控制模式当中的任意模式。在控制规则生成部23,接受环境变化通知操作的开始指令,从动作矫正部20输入通过来自人4A的环境变化通知操作生成的机器人手臂5的手尖位置及时间。另外,通过环境变化通知操作,借助数据库输入输出部观向控制规则生成部23输入由环境信息获得部 19获得的环境信息。即,环境信息对应于人向机器人手臂5的环境变化通知操作而由环境信息获得部19获得,借助数据库输入输出部观向控制规则生成部23输入。另外,在控制规则生成部23,从动作信息数据库17借助数据库输入输出部观参照环境变化通知操作开始时的动作中的“动作ID”,从与该“动作ID”的“关键动作ID”的标志有关的信息获得与机器人手臂5的控制模式有关的信息。作为具体例,关于图IOA的“作业ID”为“2”的作业且动作中的“动作ID”为“2” 的动作的“关键动作ID”为“ 10” “ 17”的关键动作,控制规则生成部23借助数据库输入输出部观参照动作信息数据库18。关于各关键动作ID的标志,在图5A中,仅第0 5位为“1”,其他为“0”,所以能由动作指令部27判断为机器人手臂5的动作当中χ轴、y轴、ζ 轴、Φ轴、θ轴、Ψ轴的数据是有效的。因此,成为阻抗控制模式,以便能用人4Α施加的力对机器人手臂5的χ轴、y轴、ζ轴、φ轴、θ轴、ψ轴进行矫正。控制规则生成部23,根据环境变化通知操作时的(1)机器人手臂5的移动方向的控制模式和(2)检测部选择规则数据库四的信息,从多个环境信息中选择用于生成控制规则的环境信息的类别。具体而言,在图IOA的“作业ID”为“2”的作业的环境变化通知操作的开始时间点,如图13C所示,在χ轴方向及y轴方向进行环境变化通知操作。χ轴及y轴以阻抗控制模式进行矫正,因此根据示出检测部选择规则数据库四的检测部选择规则的一例的图11A,“控制模式”为“阻抗控制模式”时的“环境信息的类别ID”成为“ 1 ”,根据图 11B,在“环境信息的类另Ij ID”为“1”时,由控制规则生成部23选择“图像”。进而,在图13C 中,在χ轴方向及y轴方向上进行环境变化通知操作,通过环境变化通知操作的方向由环境信息获得部19获得利用可对χ-y平面进行摄像的第一图像摄像装置1 得到的图像,并用控制规则生成部23加以选择,由控制规则生成部23获得来自第一图像摄像装置15a的图像。需要说明的是,在可对x_y平面进行摄像的第一图像摄像装置1 存在多个的情况下, 在这些多个第一图像摄像装置1 中,用控制规则生成部23选择对图像在环境变化通知操作前后发生最大变化的图像进行了摄像的第一图像摄像装置15a。图14示出通过第一图像摄像装置15a从锅3的上方获得的图像。通过第一图像摄像装置15a由控制规则生成部23获得的图像,借助数据库输入输出部观存储在环境信息数据库18中。需要说明的是,在该例中,在χ-y平面中进行了环境变化通知操作,所以用控制规则生成部23选择了第一图像摄像装置15a的图像,但当在y-z平面及χ-z平面中进行了环境变化通知操作时,由控制规则生成部23选择第二图像摄像装置15b的图像。由控制规则生成部23选择的图像,通过控制规则生成部23借助数据库输入输出部观存储在环境信息数据库18中。进而,作为变形例,如图36C和图36D所示,在x-y平面的环境变化通知(锅 3的开口尺寸的变化通知)之后,在通知了 y-z平面及x-z平面的环境变化(锅3的深度尺寸的变化通知)的情况下,控制规则生成部23选择第一图像摄像装置1 和第二图像摄像装置1 双方的图像。在上述例中,当在x-y平面中进行了环境变化通知操作时,具体而言,如图9A的 “环境ID”为“10”所示,通过控制规则生成部23,对新的“环境ID”赋予“10”,对于该“环境ID”的“图像ID”,控制规则生成部23将所选择的图像的文件名(在该例中为“图像3”) 存储在环境信息数据库18中。进而,标志仅为图像,所以通过控制规则生成部23,在环境信息数据库18中仅将第6位存储为“1”,将其他位存储为“0”。需要说明的是,在上述变形例中,如图36C和图36D所示,在x-y平面的环境变化通知之后,在通知了 y-z平面及χ-ζ平面的环境变化的情况下,如“环境ID”为“33”的环境信息所示,可以通过控制规则生成部23将多个图像(在该例中为“图像8”和“图像9”)存储在环境信息数据库18中。接着,接受动作矫正操作的开始指令,通过控制参数管理部21,由控制规则生成部 23获得人4A对机器人手臂5施加力以使机器人手臂5移动而进行了矫正后的机器人手臂 5的动作信息(机器人手臂5的手尖位置和时间)。控制规则生成部23将所获得的动作信息借助数据库输入输出部观而存储在动作信息数据库17中。具体而言,如图5B所示,通过控制规则生成部23,对图5B的动作信息数据库17重新赋予“动作ID”(在该例中为“3”),进而,以所获得的手尖位置的数量赋予“20” “31” 作为“关键动作ID”,将由动作矫正部20矫正后的动作信息(手尖信息、时间)存储在动作信息数据库17的各“关键动作ID”中。关于动作信息的时间,将人4A选择作业而发出开始指令的时点设为“0”的相对时间,通过控制规则生成部23向动作信息数据库17输入。为此,关于动作信息数据库17的时间数据栏,作为追加的最初的关键动作(在该例中为“20”)的时间,将从全部动作各自的时间施以减法运算的值,通过控制规则生成部23存储在动作信息数据库17中。关于标志的数据栏,通过控制规则生成部23按各分量分别对动作矫正操作前的标志为“1”的动作信息的分量当中矫正前和矫正后中的关键动作的位置姿势和力的值进行比较,仅仅是通过控制规则生成部23判断为有阈值以上的差时的分量存储在动作信息
34数据库17中,以便将图6所示的标志的各分量设为“1”,将低于阈值时的标志的分量设为 “0”。需要说明的是,在这里比较的动作矫正操作前后的“关键动作”,通过控制规则生成部23仅对动作矫正操作前和动作矫正操作后的各“动作ID”的最前头的关键动作进行比较。具体而言,就矫正前的“动作ID”为“2”的动作的“关键动作ID”为“10”的关键动作的标志而言,第0 5位为“1”,其他为“0”,所以通过控制规则生成部23仅对矫正前的动作和矫正后的动作的位置姿势、力的值当中的位置姿势分量进行比较。在这里,通过控制规则生成部23,成为矫正前的“关键动作ID”是“10”的关键动作、矫正后的“关键动作ID”是“ 20,,的关键动作。在“关键动作ID”为“10”的关键动作和“关键动作ID”为“20”的关键动作中, 在位置姿势(X、1、Ζ、φ、Θ、Ψ)的分量当中,Ζ、φ、θ、Ψ相同,χ坐标、y坐标的差分别为 (0. 2,0. 2)。在使上述差的阈值为0. 1时,由控制规则生成部23判断为仅仅χ分量及y分量为阈值以上。因此,就标志而言,第0、1位为“1”,其他为“0”,通过控制规则生成部23存储在动作信息数据库17中。矫正参数标志存储矫正前的动作(在该例中为“10” “17”)的值。需要说明的是,如图36E所示,在作为从锅的侧面朝向锅的底面进行搅拌之类的动作加以矫正后的情况,如图36F所示,可以在时刻、、时刻t2、时刻t3和随着时间的经过, 按照使机器人手臂5的姿势分量发生变化的方式进行矫正。接着,控制规则生成部23,根据所获得的环境信息和通过动作矫正部20的动作矫正操作矫正后的动作,在控制规则数据库16中生成新的控制规则并存储。具体而言,为了在以控制规则数据库16的“作业ID”为“2”的作业进行动作过程中对动作进行矫正,通过控制规则生成部23对“作业ID”为“2”的作业追加1行,按照追加通过动作矫正操作而新追加的“动作ID”为“3”的动作的方式,在控制规则数据库16中加以存储。接着,由控制规则生成部23选择的环境信息的环境ID,通过控制规则生成部23存储在控制规则数据库16中。以上,人4A进行环境变化通知操作及动作矫正操作而由控制规则生成部23生成新的控制规则,存储在控制规则数据库16中,即便未事先准备考虑了锅的大小的动作,仅通过在当场由人4A进行机器人手臂5的操作而进行环境变化通知,对机器人手臂5的动作进行矫正,就可以将该操作及矫正动作存储在控制规则数据库16,在下一次遇到相同环境的情况下,基于控制规则数据库16的信息(换言之,边参照由环境信息获得部19获得的环境信息,边根据由控制规则生成部23生成的控制规则),机器人手臂5可以自觉地进行动作。-动作指令部(动作算出部)_在该例中,如图IOB所示,在“作业ID”为“2”的作业中,多个“动作ID” ( “2”、 “3”)存储在控制规则数据库16中,对此时的动作指令部27的功能进行说明。图IOB的“作业ID”为“2”的作业中,“动作ID”为“2”的动作表示用于进行图13A
的动作的动作信息,“动作ID”为“3”的动作表示用于进行图13E的动作的动作信息。
人4A将图13E的锅北设置于作业台7,人4A借助数据输入IM6对动作指令部 27作出“作业ID”为“2”的作业开始指令。动作指令部27接受所指定的“作业ID”的作业的作业开始的指令,借助数据库输入输出部观参照控制规则数据库16的被指定的“作业 ID”,按照使该“作业ID”的作业开始的方式对控制参数管理部21作出指令。在存在多个动作的情况下,对应于“环境ID”,通过动作指令部27选择进行动作的动作信息。具体而言,仅在通过动作指令部27判断为在控制规则数据库中存储的各“动作 ID”的“环境ID”中借助数据库输入输出部观参照了环境信息数据库18的环境信息,与机器人手臂5的动作中的“环境ID”吻合的情况下,从动作指令部27对控制参数管理部21作出指令,以便执行该“动作ID”的动作。具体而言,在图IOB的“作业ID”为“ 2 ”的作业中,有“动作ID,,为“ 2 ”和“ 3,,的动作,“动作ID”为“2”的动作是“环境ID”为值“_1”,所以不论机器人手臂5的周边环境如何,机器人手臂5都进行动作,因此作为应执行的动作而通过动作指令部27加以选择。接着,成为“动作ID”为“3”的动作的“环境ID”为“10”的环境信息,不是“-1” 的值,通过动作指令部27,借助数据库输入输出部观参照环境信息数据库18的“环境ID” 为“10”的环境信息。就图9A的“环境ID”为“10”的环境信息的标志而言,仅仅第6位为 “1”,其以外的为“0”,所以由动作指令部27判断为图像有效。因此,根据图像ID,动作指令部27借助数据库输入输出部观获得在环境信息数据库18中存储的图像信息。接着,通过环境信息获得部19,由动作指令部27获得当前的图像信息,通过图像匹配,由动作指令部27对上述获得的2个图像进行比较。在由动作指令部27判断为2个图像已吻合的情况下,由动作指令部27选择以“动作ID”为“3”的动作中加以存储的动作作为应执行的动作。在由动作指令部27选择的动作存在多个的情况(在该例中,是“动作ID”为“2” 的动作和为“3”的动作)下,按照所选择的多个动作在控制规则数据库16中存储的顺序, 对应于各动作信息的标志,通过动作指令部27的动作算出部2算出最终应执行的动作。在该例中,由动作指令部27选择“动作ID”为“2”的动作和为“3”的动作,在图 IOB的控制规则数据库16的“动作ID”中以“2”的动作、“3”的动作的顺序加以存储。因此,就“动作ID”为“2”的动作的动作信息的标志而言,根据图5C,第0 5位为“1”,所以由动作指令部27获得“动作ID”为“2”的动作的动作信息当中的位置姿势信息(X、y、z、cp、 θ、Ψ)0接着,就“动作ID”为“3”的动作的标志而言,仅仅第0、1位为“1”,所以在“动作 ID”为“2”的动作的位置姿势信息(x、y、z、cp、θ、ψ)当中,仅仅(x、y)分量置换为“动作 ID”为“3”的动作的值,由动作指令部27算出。例如,“关键动作ID”为“10”的关键动作的位置姿势,是(0. 1,0. 1、0.4、0、0、0),“动作ID”为“3”的动作的“关键动作ID”为“20”的关键动作的位置姿势,是(0. 3,0. 3,0. 4、0、0、0),因此,对“关键动作ID”为“10”的关键动作的位置姿势为(0. 1、0. 1、0.4、0、0、0)的仅χ分量及y分量,由动作指令部27对“关键动作”为“20”的关键动作的位置姿势(0.3、0.3、0.4、0、0、0)进行置换,最终的位置姿势成为 (0. 3,0. 3,0. 4、0、0、0)。同样地,在“关键动作ID”为“21”的关键动作中由动作指令部27 对“关键动作ID”为“11”的关键动作的χ分量及y分量进行置换,以后,由动作指令部27 依次算出直到关键动作ID的结束。通过动作指令部27,关于标志,在“动作ID”为“2”的动作和为“3”的动作的各位中,在某一位为“ 1,,的情况下,将算出后的标志的位设为“ 1 ”,在双方均为“0”的情况下,设为“0”。不过,位置和力各自的分量仅某一个为“1”(仅以位置控制模式或力控制模式的某一个种模式进行工作),所以在位置和力双方成为“1”的情况下,使力优先。由此,就“动作 ID”为“2”的动作的标志而言,第0 5位为“1”,就“动作ID”为“3”的动作而言,第0、1 位为“1”,所以第0 5位为“1”。“动作ID”为“2”的动作和为“3”的动作的动作参数标志,双方的第0、1、2位均为“1”,所以算出后的动作参数标志,其第0、1、2位也为“1”,其他为 “0”。关于算出后的动作信息,由动作指令部27对应于标志对控制模式进行切换,从动作指令部27向控制参数管理部21输出动作信息,由此可以由控制部22执行已算出的动作。(控制装置主体部11)控制装置主体部11具有控制参数管理部21和控制部22。在控制部22和控制参数管理部21之间,进行机器人手臂5的手尖位置或力的信息等的输入输出。该控制装置主体部11,可以作为以力控制模式对机器人手臂5进行控制的力控制部发挥功能,所述力控制部以由作为动作信息获得部的一例的数据库输入输出部观获得的动作信息中设定的力由机器人手臂5对作业对象物进行力控制。-控制参数管理部-控制参数管理部21,根据动作矫正部20或动作指令部27的指示,对控制部22发出指令,在基于控制部22的控制下使机器人手臂5进行动作,以便使机器人手臂5按照设定的控制模式进行动作。进而,控制参数管理部21从控制部22获得机器人手臂5的手尖位置或力的信息等,并向动作矫正部20输出。对控制参数管理部21的详细内容进行说明。控制参数管理部21,根据动作矫正部20或动作指令部27的指示,输出对机器人手臂5的控制模式进行切换的设定信号。关于各控制模式,通过动作矫正部20或动作指令部27,根据动作信息数据库的标志加以决定,向控制参数管理部21输出对控制模式进行切换的设定信号。控制模式是(i)位置控制模式、(ii)阻抗控制模式、(iii)混合阻抗控制模式、 (iv)力控制模式、(V)力混合阻抗控制模式、和(Vi)高刚性位置控制模式当中的任意控制方法的模式。另外,控制参数管理部21进行(iii)阻抗控制模式、(iv)混合阻抗控制模式、及 (ν)力混合阻抗控制模式中的机械阻抗设定值的设定。另外,控制参数管理部21,进行由后述的阻抗计算部51输出的手尖位置、姿势目标矫正输出rd,的设定、及向目标轨道生成部 55的动作信息的设定。-控制模式的切替动作_对各控制模式进行说明。(i)位置控制模式位置控制模式,是使机器人手臂5根据后述的目标轨道生成部55的与手尖位置和姿势和时间有关的信息进行工作的模式。该位置控制模式,是对机器人手臂5的动作进行控制以便即使人4A对机器人手臂5施加力而机器人手臂5也不会移动的模式。例如,是在机器人手臂5进行动作以便进行搅拌作业或擦拭清洁作业等作业的情况下使用的模式。不过,在柔软结构的机器人手臂5的情况下,是机械性柔软的机构,所以即便设定为位置控制模式,也会有机器人手臂5因人4A 对机器人手臂5施加的力而有些许移动的情况,对此,后述的高刚性位置控制模式,是机器人手臂5绝对不会因人4A对机器人手臂5施加的力而运动的模式。(ii)阻抗控制模式阻抗控制模式,是对应于从人4A等施加给机器人手臂5的力(具体而言是由力检测部53检测出的力),对机器人手臂5的动作进行控制以便机器人手臂5进行工作的模式。 例如,如图8所示,是在人4A用手4直接把持机器人手臂5而对机器人手臂5的手尖的位置姿势进行示教的情况下使用的模式。(iii)混合阻抗控制模式混合阻抗控制模式,是机器人手臂5在以位置控制模式进行动作时,对应于由力检测部53检测出的力,按照使机器人手臂5进行工作的方式对机器人手臂5的动作进行控制的模式。例如,如图13A所示,是在机器人手臂5以位置控制模式进行搅拌作业时,在想要对机器人手臂5的动作进行矫正以便人4A对锅3a中的底侧的部分进行搅拌的情况下使用的模式。通过进行混合阻抗控制模式,如图13D所示,人4A把持机器人手臂5,在沿着锅 3b的底面的方向上施加力,由此可以矫正为在水平方向上大幅度搅拌的动作。(iv)力控制模式力控制模式,是如下的模式,即以从动作矫正部20向控制参数管理部21设定的力,使用机器人手臂5,按照边将作业对象物(作业用工具,例如勺子9或擦拭清洁用抹布或海绵46、或电动驱动器具72、或柔性基板74)按向作业对象面(例如锅底、或清洁对象面、 或在器具71的螺纹孔71a安装螺钉73时的作业对象面)边进行搅拌动作或擦拭清洁动作或螺钉转动动作等的方式对机器人手臂5的动作进行控制的模式。图12示出进行本第一实施方式中的厨房的擦拭清洁动作的机器人。例如,是在如图12所示对IH烹调电炉6等的面板6a的表面施加力而进行擦拭清洁或在如图15所示通过勺子9对锅3底的部分施加力而进行搅拌作业时等情况下,在边施加力边进行控制的方向上使用的控制模式。(ν)力混合阻抗控制模式力混合阻抗控制模式,按照机器人手臂5的六个轴方向(χ轴、y轴、ζ轴、φ轴、θ 轴、Ψ轴的方向)的不同,对(iii)混合阻抗控制模式、(ii)阻抗控制模式、(i)位置控制模式进行切换且以使所指定的力发挥作用而进行动作的(iii)力控制模式进行控制的模式。需要说明的是,力控制模式和阻抗控制模式是排他的关系,所以无法在设定了力控制模式的方向上设定阻抗控制模式。该力混合阻抗控制模式,例如是在如下的情况下使用的模式,即如图12所示,使利用机器人手臂5的前端的手部30支承的作业用工具9、例如擦拭清洁用抹布相对于IH烹调电炉6等的面板6a的清洁面平行地以画圆的方式移动,同时对该清洁面施加垂直向下的指定的力而进行擦拭清洁的情况下所使用的模式。具体而言,对于(x、y、z、(p、θ、ψ)6轴的每个,设定以下的控制模式。即,是(χ、y)分量以混合阻抗控制模式进行动作、(Φ、θ、 Ψ)分量以阻抗控制模式进行动作、ζ轴分量以力控制模式进行动作的力混合阻抗控制模式。如此与清洁面水平的方向是混合阻抗控制模式,由此在正以位置控制模式进行动作期间,能对应于从人4A等向机器人手臂5施加的力,使机器人手臂5进行移动。进而,通过将 (φ、θ、ψ)分量设为阻抗控制模式,在机器人手臂5停止动作的状态下,对应于从人4Α等向机器人手臂5施加的力,可以对机器人手臂5的姿势进行变更。另外,通过将ζ轴分量设成力控制模式,能边以指定的力将擦拭清洁用抹布按压向清洁面边使机器人手臂5进行动作。或者,力混合阻抗控制模式,也可以是(x、y、z、(p、θ、ψ)的6轴当中ζ轴分量以力控制模式进行动作、其他轴以位置控制模式进行动作的控制模式。在该情况下,即便碰撞等不经意的力施加给机器人手臂5,也不会使位置控制分量错误移动。(vi)高刚性位置控制模式高刚性位置控制模式是使机器人手臂5的动作中的位置控制模式进而为高刚性的控制模式。具体而言,通过增大后述的位置误差补偿部56的增益而得以实现,即便人4Α 对机器人手臂5施加力,高刚性位置控制模式无法使机器人手臂5容易地移动,机器人手臂 5不受到来自接触面的抗力的影响,可以准确检测出人4Α对机器人手臂5施加的力。这些控制模式(i) (vi),可以在机器人手臂5动作时,按照机器人手臂5的方向及姿势的不同分别设定合适的控制模式使其动作。进而,在机器人手臂5以(iii)混合阻抗控制模式或(ν)力混合阻抗模式进行动作过程中,对应于要矫正的参数,通过控制参数管理部21对机械阻抗设定值或由阻抗计算部51输出的手尖位置及姿势目标矫正输出rdA的设定进行变更。作为机械阻抗设定值的设定参数,有惯性M、粘滞性D和刚性K。机械阻抗设定值的各参数的设定使用矫正值,根据以下的评价式进行。M = KMX (矫正值)· · · ·式(3)D = KDX (矫正值)· · · ·式(4)K = KKX (矫正值)· · · ·式(5)上述式(3) 式(5)中的KM、KD、KK分别是增益,分别为某常数值。控制参数管理部21向控制部22输出根据上述式(;3) 式( 计算出的机械阻抗参数的惯性M、粘滞性D和刚性K。通过上述式C3) 式(5),在机器人手臂5的χ轴及y轴以外的位置分量及姿势分量简单运动时,机器人手臂5的动作的矫正作业变得难以进行。因此,控制参数管理部21, 仅对机器人手臂5的χ轴及y轴以外的位置分量及姿势分量,将上述的矫正值设定得较高 (具体而言,上述矫正值的约10倍),由此设成机器人手臂5的粘滞性D及刚性K增大,其结果,机器人手臂5的运动产生抵抗感或生硬感,关于χ轴和y轴以外的位置分量及姿势分量,机器人手臂5变得难以运动。例如图13D所示,在使用人4A用机器人手臂5的手部30 把持的勺子9,对动作进行矫正以便与锅北的尺寸配合地大幅度搅拌的情况下,可以使用这样的设定。或者,作为其他方法,有通过控制参数管理部21使从阻抗计算部51输出的手尖位置及姿势目标矫正输出的各分量中χ轴和y轴以外的值全部为0的方法。由此,χ轴和 y轴以外,机器人手臂5无法通过人4A的力进行移动,所以可以防止错误操作。控制参数管理部21有必要向动作矫正部20,输出机器人手臂5的手尖位置及姿势、和人4A对机器人手臂5施加的力的信息(与作用于机器人手臂5的人4A的力有关的信息),此外,在控制参数管理部21从控制部22接受机器人手臂5的手尖位置及力的信息时,控制参数管理部21向动作矫正部20输出。另外,从动作矫正部20及动作指令部27向控制参数管理部21输入的、位置及姿势和时间等的动作信息,从控制参数管理部21向控制部22输出。-控制部-接着,关于控制部22的详细内容,使用图4进行说明。图4示出本第一实施方式的机器人手臂的控制装置70的控制部22的详细内容。控制部22具有目标轨道生成部55、 手部控制部M、作为力检测单元的一例的力检测部53、阻抗计算部51、位置控制部59、和位置误差计算部80。位置控制部59具有位置误差补偿部56、近似逆运动学计算部57、和正运动学计算部58,能以位置控制模式对机器人手臂5进行控制,以便使机器人手臂5根据由作为动作信息获得部的一例的数据库输入输出部观获得的动作信息进行移动。力检测部 53在图4中作为控制部22的一部分而图示出,但也可以为控制部22之外的构成。控制部22以由控制参数管理部21设定的控制模式进行动作,进而对应于控制模式,将机器人手臂5的机械阻抗的值控制成根据惯性M、粘滞性D和刚性K的设定值所设定的机器人手臂5的机械阻抗设定值。控制部22借助输入输出IF2进行与机器人手臂5的控制信号等信号互换,在图4 中,是作为控制部22和机器人手臂5的数据信号的互换而简化后的图。输出由在机器人手臂5的各关节部设置的各关节轴的编码器44所测量的关节角的当前值(关节角度矢量)矢量q= [qi、q2、q3、q4、q5、q6]T,通过输入输出IFM被取入到控制部22。在这里,qi、q2、q3、q4、q5、q6,分别是第一关节部35、第二关节部36、第三关节部 37、第四关节部38、第五关节部39、第六关节部40的关节角度。目标轨道生成部55,根据从控制参数管理部21输入的动作信息(具体而言,机器人手臂5的手尖位置、姿势、时间),生成机器人手臂5的成为目标的手尖位置及姿势目标矢量rd。目标轨道生成部55向位置误差计算部80输出所生成的手尖位置及姿势目标矢量
rd°具体而言,目标轨道生成部55,根据来自控制参数管理部21的控制模式设定信号及动作信息,生成成为动作目标的手尖的位置及姿势目标矢量rd和力目标矢量fd,以便以各控制模式使机器人手臂5进行动作。具体而言,成为目标的机器人手臂5的动作,对应于目的作业,从动作指令部27提供以各自的时间(t = 0、t =、、t = t2、…)计的各点的位置及姿势(rdQ、rdl、rd2、…)的信息、和力(fdQ、fdl、fd2、…)的信息。目标轨道生成部55使用多项式插值,对上述各点间的轨道进行插值,生成手尖位置及姿势目标矢量rd、和力矢量fd。目标轨道生成部55,按照以(i)位置控制模式、(iii)阻抗控制模式、(iv)混合阻抗控制模式、(ν)力混合阻抗控制模式、或(vi)高刚性位置控制模式使机器人手臂5进行动作的方式,生成动作目标的手尖的位置及姿势目标矢量rd。目标轨道生成部55,将生成的成为目标的用于实现机器人手臂5的动作的手尖位置及姿势目标矢量rd和力目标矢量fd和按各自的不同方向表示哪一参数为有效的标志,从目标轨道生成部55向位置误差计算部80输出。目标轨道生成部55,根据动作信息所含的“手部”的开闭标志,对后述的手部控制部讨发出手部30的开闭指令。手部控制部M,根据从目标轨道生成部55输入的开闭标志,按照对手部开闭驱动用的电机62进行驱动而使手部30开闭的方式,借助输入输出IFM向机器人手臂5的手部开闭驱动用的电机62发出指令。力检测部53作为力检测单元的一例发挥功能,检测出通过人4A等和机器人手臂5 的接触而对机器人手臂5施加的外力Frat,将所检测出的力的信息向阻抗计算部51、环境信息获得部19和控制参数管理部21 (借助控制参数管理部21向动作指令部27)输出。不过, 在机器人手臂5的手尖(手部30)把持或安装质量m的物体(例如,作业用工具9)而进行作业的情况下,用力检测部53预先从力检测部53所检测的Fext减去mg。在这里,g是重力加速度。把持物体(例如作业用工具9)的重量m的值,可以在对物体进行把持(例如作业用工具9)之前,由人4A借助数据输入IM6从外部输入装置26a输入到力检测部53 (参照图4)。另外,也可以将作为把持物体(例如作业用工具9、46、72或柔性基板74等)的作业对象物的识别号、质量、形状、尺寸、及颜色等物品信息存储在物品数据库(未图示)中,物品辨别装置(未图示),读取作业对象物所具备的标签等识别信息,基于读取的识别信息, 参照在物品数据库中存储的信息,获得对应的作业对象物的质量。力检测部53借助输入输出IFM而获得由电机驱动器25的电流传感器测量的在对机器人手臂5的各关节部进行驱动的电机43流过的电流值i = [ipi2、i3、i4、i5、i6]T。 另外,力检测部53借助输入输出IF24取入由各编码器44测量的关节角的当前值q,且取入来自后述的近似逆运动学计算部57的关节角度误差补偿输出u#。力检测部53作为观测器发挥功能,根据上述电流值i、关节角的当前值q和关节角度误差补偿输出U-算出因施加给机器人手臂5的外力而在各关节部发生的转矩τ Τ。此外,力检测部53通过式Fext = Jv(q)_T τ ext_
Τ换算成机器人手臂5的手尖中的等效手尖外力Frat,将该等效手尖外力Frait向阻抗计算部51输出。在这里,Jv(q)是满足下式的雅可比矩阵。v = Jv(q)q其中,ν= [vx、vy、vz、ωχ、coy、ωζ]τ,(vx、vy、vz)是手尖坐标系 42 的机器人手臂 5 的手尖的平移速度,(ωχ、coy、ωζ)是手尖坐标系42的机器人手臂5的手尖的角速度。另外,m是用手部30把持的把持物体(或在手部30安装的作业用工具9)的重量,g是重力加速度。另外,也可以通过机器人手臂5的手部30实际进行物体的把持或安装,根据此时的力检测部53的等效手尖外力Fext的推断结果,算出把持物体(或在手部30安装的作业用工具9)的质量m的值。在未把持物体的情况下,算出为m = 0。阻抗计算部51,从控制参数管理部21接收控制模式的设定信号及机械阻抗设定值,将机器人手臂5的机械阻抗值控制成上述机械阻抗设定值。在阻抗计算部51从控制参数管理部21接收到(i)位置控制模式的设定信号的情况下,作为机械阻抗值,从阻抗计算部51向位置误差计算部80输出“0”。在阻抗计算部51从控制参数管理部21接收到(iii) 阻抗控制模式及(iv)混合阻抗控制模式的设定信号的情况下,根据由控制参数管理部21 设定的作为机械阻抗设定值的惯性M和粘滞性D和刚性K、由编码器44测量得到的关节角的当前值q、和由力检测部53检测出的外力Frait,阻抗计算部51通过以下的式(6)计算机器人手臂5用于实现机械阻抗设定值的控制的手尖位置及姿势目标矫正输出rd,。阻抗计算部51,将计算求得的手尖位置及姿势目标矫正输出向位置误差计算部80输出。在阻抗计算部51从控制参数管理部21接收到(ν)力混合阻抗控制模式或(ii) 力控制模式的设定信号的情况下,在有以动作控制的“标志”指定的力分量存在的情况下, 根据由控制参数管理部21设定的作为机械阻抗设定值的惯性M和粘滞性D和刚性K、由编码器44测量得到的关节角的当前值q、力检测部53的外力Fext、和从目标轨道生成部55输出的力fd,阻抗计算部51通过以下的式(10)计算机器人手臂5用于实现机械阻抗设定值的控制的手尖位置及姿势目标矫正输出rd,。阻抗计算部51,将计算求得的手尖位置及姿势目标矫正输出向位置误差计算部80输出。位置误差计算部80,对从阻抗计算部51输出的手尖位置及姿势目标矫正输出 、和从目标轨道生成部55输出的手尖的位置姿势目标矢量rd施以加法运算,生成手尖位
置及姿势矫正目标矢量i^。其中,在混合阻抗控制模式时,在对应于矫正参数而对机器人手臂5的动作进行约束的情况下,例如,为了使机器人手臂5仅在ζ轴上运动,由阻抗计算部51将手尖位置及姿势目标矫正输出的ζ分量以外的分量设成0,向位置误差计算部 80输出。
权利要求
1.一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备动作信息获得部,其从将与所述动作对应的、所述机器人手臂的位置、姿势及速度中的至少1个以上作为动作信息以时间序列加以存储的动作信息数据库,获得所述动作信息;矫正动作信息获得部,其在人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正时,获得与由所述动作信息获得部获得的所述动作信息当中的至少1个以上所述动作信息对应的矫正动作信息;环境信息获得部,其对应于所述人向所述机器人手臂的环境变化通知操作,获得作为与所述机器人手臂所作用的对象物有关的信息的环境信息;位置控制部,其以位置控制模式对所述机器人手臂进行控制,以便使所述机器人手臂根据由所述动作信息获得部获得的所述动作信息进行移动;动作矫正部,其在所述机器人手臂正通过所述位置控制部的控制而以所述位置控制模式进行移动的期间,对应于由所述矫正动作信息获得部获得的在各时间的所述矫正动作信息,对所述动作信息进行矫正;和控制规则生成部,其对应于所述人向所述机器人手臂的所述环境变化通知操作,决定由所述环境信息获得部获得的所述环境信息,且使由所述动作矫正部矫正过的所述动作信息和由所述环境信息获得部获得的所述环境信息建立对应,由此生成用于所述机器人手臂自动进行动作的控制规则,一边参照由所述环境信息获得部获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作进行控制。
2.一种对机器人手臂的动作进行控制的机器人手臂的控制装置,其中,具备 动作信息获得部,其从将作为与所述动作对应的、所述机器人手臂对对象物施加的力的时间序列的动作信息加以存储的动作信息数据库,获得所述动作信息;矫正动作信息获得部,其在人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正时,获得与由所述动作信息获得部获得的所述动作信息相关联且与所述机器人手臂所施加的力有关的矫正动作信息;环境信息获得部,其对应于所述人向所述机器人手臂的环境变化通知操作,获得作为与所述机器人手臂所作用的所述对象物有关的信息的环境信息;控制部,其以力控制模式对所述机器人手臂进行控制,以便所述机器人手臂以由所述动作信息获得部获得的在所述动作信息中设定的力对所述对象物进行力控制;动作矫正部,在正通过所述控制部对所述机器人手臂以所述力控制模式进行控制的期间,对应于由所述矫正动作信息获得部获得的在各时间的所述矫正动作信息,对所述动作信息进行矫正;和控制规则生成部,其对应于所述人向所述机器人手臂的所述环境变化通知操作,决定由所述环境信息获得部获得的所述环境信息,且使由所述动作矫正部矫正过的所述动作信息和由所述环境信息获得部获得的所述环境信息建立对应,由此生成用于所述机器人手臂自动进行动作的控制规则,一边参照由所述环境信息获得部获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作进行控制。
3.如权利要求1或者2所述的机器人手臂的控制装置,其中,所述环境信息获得部具备对施加给所述机器人手臂的所述人的力进行检测的力检测部,对应于由所述力检测部检测出的所述人的力和其检测时间,检测出所述人对所述机器人手臂进行了操作,由所述矫正动作信息获得部获得与对所述机器人手臂的所述动作进行矫正时所述机器人手臂所施加的力有关的所述矫正动作信息。
4.如权利要求1所述的机器人手臂的控制装置,其中,所述环境信息获得部具备能对所述机器人手臂及所述机器人手臂进行所述动作的周边环境进行摄像的多个图像摄像装置,所述控制规则生成部,对应于所述人对所述机器人手臂操作时所述机器人手臂的所述位置控制模式,从由所述环境信息获得部的所述多个图像摄像装置获得的多个环境信息中,决定生成控制规则时的环境信息的类别。
5.如权利要求2所述的机器人手臂的控制装置,其中,所述环境信息获得部具备对施加给所述机器人手臂的所述人的力进行检测的力检测部,所述控制规则生成部,对应于所述人对所述机器人手臂操作时所述机器人手臂的所述力控制模式,在生成控制规则时使用由所述力检测部获得的环境信息。
6.如权利要求1或者2所述的机器人手臂的控制装置,其中,在所述环境变化通知操作、和所述人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正的动作矫正操作为相同操作的情况下,代替所述动作矫正操作而使用所述环境变化通知操作。
7.如权利要求6所述的机器人手臂的控制装置,其中,所述环境信息具有从多种检测方向进行检测而获得的环境信息, 所述控制规则生成部,决定对应于所述人对所述机器人手臂的操作而获得的所述环境信息的检测方向。
8.如权利要求1或者2所述的机器人手臂的控制装置,其中,还具备动作算出部,其从由所述控制规则生成部生成的控制规则当中的多个动作信息,参照由所述环境信息获得部获得的所述环境信息,算出1个动作信息。
9.如权利要求1或者2所述的机器人手臂的控制装置,其中,所述人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正,由所述矫正动作信息获得部获得与由所述动作信息获得部获得的所述动作信息当中的至少1个以上所述动作信息对应的矫正动作信息,然后,在由所述环境信息获得部获得的所述环境信息与所述矫正的操作时的所述环境信息相同时,根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作按照基于由所述矫正动作信息获得部获得的所述矫正动作信息进行矫正的方式进行控制。
10.如权利要求1所述的机器人手臂的控制装置,其中,所述环境信息获得部具备能对所述机器人手臂及所述机器人手臂进行所述动作的周边环境进行摄像的多个图像摄像装置,在所述机器人手臂的前端,具备能以可装卸的方式把持作业用工具的手部,所述作业用工具能旋转螺钉,所述作业用工具是所述对象物,一边参照由所述多个图像摄像装置获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,在用所述机器人手臂的所述手部所把持的所述作业用工具进行所述螺钉的紧固或拧下作业时,对所述机器人手臂的所述动作进行控制。
11.如权利要求2所述的机器人手臂的控制装置,其中,所述环境信息获得部具备能对所述机器人手臂及所述机器人手臂进行所述动作的周边环境进行摄像的多个图像摄像装置,在所述机器人手臂的前端,具备能以可装卸的方式把持柔性基板的手部,所述柔性基板是所述对象物,一边参照由所述多个图像摄像装置获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,在将所述机器人手臂的所述手部所把持的所述柔性基板安装于设备上的作业时,对所述机器人手臂的所述动作进行控制。
12.—种对机器人手臂的动作进行控制的机器人手臂的控制方法,其中,由动作信息获得部,从将与所述动作对应的、所述机器人手臂的位置、姿势及速度中的至少1个以上作为动作信息以时间序列加以存储的动作信息数据库,获得所述动作信息,由矫正动作信息获得部,在人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正时,获得与由所述动作信息获得部获得的所述动作信息当中的至少1个以上所述动作信息对应的矫正动作信息,由环境信息获得部,对应于所述人向所述机器人手臂的环境变化通知操作,获得作为与所述机器人手臂所作用的对象物有关的信息的环境信息,由位置控制部,以位置控制模式对所述机器人手臂进行控制,以便使所述机器人手臂根据由所述动作信息获得部获得的所述动作信息进行移动,由动作矫正部,在所述机器人手臂正通过所述位置控制部的控制而以所述位置控制模式进行移动的期间,对应于由所述矫正动作信息获得部获得的在各时间的所述矫正动作信息,对所述动作信息进行矫正,由控制规则生成部,对应于所述人向所述机器人手臂的所述环境变化通知操作,决定由所述环境信息获得部获得的所述环境信息,且使由所述动作矫正部矫正过的所述动作信息和由所述环境信息获得部获得的所述环境信息建立对应,由此生成用于所述机器人手臂自动进行动作的控制规则,一边参照由所述环境信息获得部获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作进行控制。
13.一种机器人,其中,具备 所述机器人手臂、和对所述机器人手臂进行控制的权利要求1或2所述的所述机器人手臂的控制装置。
14.一种对机器人手臂的动作进行控制的机器人手臂的控制程序,其中,用于执行下述步骤由动作信息获得部,从将与所述动作对应的、所述机器人手臂的位置、姿势及速度中的至少1个以上作为动作信息以时间序列加以存储的动作信息数据库,获得所述动作信息的步骤;由矫正动作信息获得部,在人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正时,获得与由所述动作信息获得部获得的所述动作信息当中的至少1个以上所述动作信息对应的矫正动作信息的步骤;由环境信息获得部,对应于所述人向所述机器人手臂的环境变化通知操作,获得作为与所述机器人手臂所作用的对象物有关的信息的环境信息的步骤;由位置控制部,以位置控制模式对所述机器人手臂进行控制,以便使所述机器人手臂根据由所述动作信息获得部获得的所述动作信息进行移动的步骤;由动作矫正部,在所述机器人手臂正通过所述位置控制部的控制而以所述位置控制模式进行移动的期间,对应于由所述矫正动作信息获得部获得的在各时间的所述矫正动作信息,对所述动作信息进行矫正的步骤;由控制规则生成部,对应于所述人向所述机器人手臂的所述环境变化通知操作,决定由所述环境信息获得部获得的所述环境信息,且使由所述动作矫正部矫正过的所述动作信息和由所述环境信息获得部获得的所述环境信息建立对应,由此生成用于所述机器人手臂自动进行动作的控制规则的步骤;和一边参照由所述环境信息获得部获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作进行控制的步骤。
15. 一种对机器人手臂的动作进行控制的机器人手臂控制用集成电路,其中, 由动作信息获得部,从将与所述动作对应的、所述机器人手臂的位置、姿势及速度中的至少1个以上作为动作信息以时间序列加以存储的动作信息数据库,获得所述动作信息;由矫正动作信息获得部,在人操作所述机器人手臂而对所述机器人手臂的所述动作进行矫正时,获得与由所述动作信息获得部获得的所述动作信息当中的至少1个以上所述动作信息对应的矫正动作信息;由环境信息获得部,对应于所述人向所述机器人手臂的环境变化通知操作,获得作为与所述机器人手臂所作用的对象物有关的信息的环境信息;由位置控制部,以位置控制模式对所述机器人手臂进行控制,以便使所述机器人手臂根据由所述动作信息获得部获得的所述动作信息进行移动;由动作矫正部,在所述机器人手臂正通过所述位置控制部的控制而以所述位置控制模式进行移动的期间,对应于由所述矫正动作信息获得部获得的在各时间的所述矫正动作信息,对所述动作信息进行矫正;由控制规则生成部,对应于所述人向所述机器人手臂的所述环境变化通知操作,决定由所述环境信息获得部获得的所述环境信息,且使由所述动作矫正部矫正过的所述动作信息和由所述环境信息获得部获得的所述环境信息建立对应,由此生成用于所述机器人手臂自动进行动作的控制规则;一边参照由所述环境信息获得部获得的所述环境信息,一边根据由所述控制规则生成部生成的所述控制规则,对所述机器人手臂的所述动作进行控制。
全文摘要
获得在动作信息数据库(17)中存储的机器人手臂(5)的动作信息,人(4A)对机器人手臂进行操作,获得其动作矫正时的矫正动作信息,用获得部(19)获得环境信息,在机器人手臂进行动作的过程中,用动作矫正部(20)对动作信息进行矫正,根据矫正后的动作信息和获得的环境信息,由控制规则生成部(23)生成用于机器人手臂自动进行动作的控制规则,根据生成的控制规则,对机器人手臂的动作进行控制。
文档编号B25J13/00GK102300679SQ20108000592
公开日2011年12月28日 申请日期2010年9月21日 优先权日2009年9月28日
发明者津坂优子 申请人:松下电器产业株式会社
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1