CN101687321B - 机器人手臂的控制装置及控制方法、机器人及控制程序 - Google Patents
机器人手臂的控制装置及控制方法、机器人及控制程序 Download PDFInfo
- Publication number
- CN101687321B CN101687321B CN2008800040942A CN200880004094A CN101687321B CN 101687321 B CN101687321 B CN 101687321B CN 2008800040942 A CN2008800040942 A CN 2008800040942A CN 200880004094 A CN200880004094 A CN 200880004094A CN 101687321 B CN101687321 B CN 101687321B
- Authority
- CN
- China
- Prior art keywords
- robot arm
- control
- information
- people
- family
- 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
Images
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/0003—Home robots, i.e. small robots for domestic use
-
- 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/0084—Programme-controlled manipulators comprising a plurality of manipulators
-
- 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/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages
-
- 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/40411—Robot assists human in non-industrial environment like home or office
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供一种机器人手臂的控制装置,该机器人手臂的控制装置基于采集家庭内作业的顺序信息的作业顺序信息采集机构(20、23)、管理所述作业的进度信息的进度管理机构(29)、基于作业顺序信息与进度信息设定机器人手臂的控制参数的控制参数设定机构(21)、以及控制参数设定机构(21)的控制参数,控制机器人手臂的动作。
Description
技术领域
本发明涉及人和机器人协作进行家庭内作业(例如,烹调作业)时的机器人手臂的控制装置及控制方法、具有机器人手臂的控制装置的机器人、及机器人手臂的控制程序、集成电路。
背景技术
近年来,正在积极地开发看护机器人或家事援助机器人等家庭用机器人。家庭机器人和工业用机器人不同,为了非机器人操作的专家且居家的家庭主妇操作,需要能够简单地操作。另外,机器人作业时的工作环境也随家庭而各式各样,因此需要灵活地适应家庭环境。
作为机器人装置之一例,提案有如下关于退避控制的技术(参照专利文献1):在使机器人手臂移动到停止作业时预定的待机位置时,为了防止和工件的干扰,向规定的方向进行规定量地退避移动后,再使其移动到所述待机位置。
专利文献1:日本特开2000-343478号公报
但是,上述那种现有技术中,存在如下课题:在机器人装置退避移动时,由于只是防止和工件的干扰,因此不能改变机器人装置实施的作业的进度信息、或对应于工件的状态的待机方法。另外,不能通过操作的人的作业状态来改变待机方法。
发明内容
本发明是鉴于这种课题而开发的,其目的在于,提供一种机器人手臂的控制装置及控制方法、具有机器人手臂的控制装置的机器人、及机器人手臂的控制程序、集成电路,其能够实现机器人控制,该机器人控制根据包括和机器人手臂协作的工序的家庭内作业的顺序信息及进度信息,可以改变机器人手臂的动作的控制方法。
为了实现所述目的,本发明如下构成:
根据本发明第一方面,提供一种机器人手臂的控制装置,其具有:
作业顺序信息采集机构,其采集包括人和所述机器人手臂协作的多道工序的家庭内作业的顺序信息;
进度管理机构,其基于由所述作业顺序信息采集机构采集到的所述家庭内作业的顺序信息,管理所述家庭内作业的进度信息;
控制参数设定机构,其基于所述家庭内作业的顺序信息和所述家庭内作业的进度信息,设定所述机器人手臂的控制参数;
控制机构,其基于由所述控制参数设定机构所设定的所述控制参数,控制所述机器人手臂的动作。
根据本发明第十五方面,提供一种机器人手臂的控制方法,其中,
由作业顺序信息采集包括人和所述机器人手臂协作的多道工序的家庭内作业的顺序信息,进而由进度管理机构管理所述家庭内作业的进度信息,
由控制参数设定机构基于所述家庭内作业的顺序信息和所述家庭内作业的进度信息设定所述机器人手臂的控制参数,
由控制装置基于所述所设定的控制参数控制所述机器人手臂的动作。
本发明第十七方面提供一种机器人手臂的控制程序,该机器人手臂的控制程序能够通过计算机来执行,其具有:
采集包括人和所述机器人手臂协作的多道工序的家庭内作业的顺序信息的步骤;
管理所述家庭内作业的进度信息的步骤;
基于所述家庭内作业的顺序信息和所述家庭内作业的进度信息,设定所述机器人手臂的控制参数的步骤;
基于所述所设定的控制参数,控制所述机器人手臂的动作的步骤。
本发明第十八方面提供一种控制机器人手臂的集成电路,其具有:
作业顺序信息采集机构,其采集包括人和所述机器人手臂协作的多道工序的家庭内作业的顺序信息;
进度管理机构,其基于所述家庭内作业的顺序信息,管理所述家庭内作业的进度信息;
控制参数设定机构,其基于所述家庭内作业的顺序信息和所述家庭内作业的进度信息,设定所述机器人手臂的控制参数;
控制机构,其基于由所述控制参数设定机构所设定的所述控制参数,控制所述机器人手臂的动作。
如上所述,根据本发明的机器人手臂的控制装置及具有机器人手臂的控制装置的机器人,通过具有作业顺序信息采集机构、进度管理机构、控制参数设定机构、控制机构,可以成为如下机器人控制:根据家庭内作业的顺序信息和进度信息,切换位置控制模式和使所述机器人手臂随着所述人的力而移动的控制模式,或由于可适当地设定机器人手臂的机械阻抗设定值,因此,在停止位置控制模式下动作的机器人手臂时,人可以简单地使机器人手臂退避到不碍事的位置,另外,在使其退避时,没有因人失误而压坏柔软的原材料或使热汤等落下的危险性,可以安全且简单地操作。
另外,根据本发明的机器人手臂的控制方法及控制程序,可以成为如下机器人控制:基于所述家庭内作业的顺序信息和关于所述家庭内作业的进度信息,切换位置控制模式和所述机器人手臂随着所述人的力而移动的控制模式,或由于可适当地设定机器人手臂的机械阻抗设定值,因此,在将以位置控制模式动作的机器人手臂停止时,人可以简单地使机器人手臂退避到不碍事的位置,另外,在使其退避时,没有因人失误而压坏柔软的原材料或使热汤等落下的危险性,可以安全且简单地操作。
另外,烹调等家庭内作业为食品的准备、或使用锅或煎锅等的烹调作业、或收拾整理等多道作业工序的集中,不将各工序在中途停止在细作上,需要使其连续地执行。与之相对,根据本发明,基于由作业顺序信息采集机构采集且包括多道工序的家庭内作业的顺序信息、和由进度管理机构管理的家庭内作业的进度信息,由控制参数设定机构设定机器人手臂的控制参数,基于所设定的所述控制参数,由控制机构控制所述机器人手臂的动作,因此,不会将各工序在中途停止在细作上,可以使其连续地执行。
另外,参与烹调的人的状态各种各样,例如,利手各不同,或大人和孩子等对家庭内作业的技能存在差别。与之相对,根据本发明,通过所述构成,将参与烹调的人的各种各样的状态、例如利手各不同或大人和孩子等对家庭内作业的技能的差别等信息设定为作业状态信息,并由作业顺序信息采集机构采集,基于作业状态信息、家庭内作业的顺序信息、以及由进度管理机构管理的家庭内作业的进度信息,由控制参数设定机构设定机器人手臂的控制参数,基于所设定的所述控制参数,由控制机构控制所述机器人手臂的动作,因此,也能够适应参与烹调的人的各种各样的状态。
另外,操作机器人的人不是机器人操作的专家,而是居家的家庭主妇,请求简单的操作。对此,根据本发明,当根据家庭内作业的顺序信息和进度信息从位置控制模式切换到机器人手臂随人的力而移动的控制模式时,即使是家庭主妇,也可以简单地使机器人手臂随人的力而移动。
附图说明
本发明的这些和其他的目的和特征从关于附图的优选的实施方式的下述中可以明白。该图中:
图1A是表示本发明第一实施方式的机器人控制装置的构成及和人的协作状态的概要的图;
图1B是表示本发明第一实施方式的机器人控制装置的构成及和人的协作状态的概要的图;
图2是表示构成本发明第一实施方式的机器人系统的机器人手臂的控制装置和控制对象即机器人手臂的详细构成的图;
图3是以表形式表示上述机器人手臂的控制装置的作业数据库的作业顺序信息、进度信息、烹调设备信息之例的图;
图4是以表形式表示与上述机器人手臂的控制装置的作业数据库的人的作业状态相关的信息之例的图;
图5是表示本发明第一实施方式的上述机器人手臂的控制装置的作业信息收集部、作业数据库、控制参数设定部以及进度管理部的动作步骤的流程图;
图6是表示本发明第一实施方式的上述机器人手臂的控制装置的控制部的构成的方框图;
图7是表示本发明第一实施方式的上述机器人手臂的控制装置的控制部的动作步骤的流程图;
图8是表示构成本发明第二实施方式的机器人系统的上述机器人手臂的控制装置和控制对象即机器人手臂的详细构成的图;
图9A是表示本发明第一实施方式的上述机器人手臂的控制装置的操作状态的图;
图9B是表示本发明第一实施方式的上述机器人手臂的控制装置的操作状态的图;
图10A是表示本发明第二实施方式的上述机器人手臂的控制装置的操作状态的图;
图10B是表示本发明第二实施方式的上述机器人手臂的控制装置的操作状态的图;
图11是表示构成本发明第三实施方式的机器人系统的控制装置和控制对象即机器人手臂的详细构成的图;
图12是以表形式表示上述第三实施方式的机器人手臂的控制装置的作业数据库的人操作的操作状况相关的信息之例的图;
图13是以表形式表示上述第一实施方式的机器人手臂的控制装置的作业数据库的作业时刻和等级相关的信息之例的图;
图14A是表示本发明第二实施方式的机器人手臂的控制装置的操作状态的图;
图14B是表示本发明第二实施方式的机器人手臂的控制装置的操作状态的图;
图14C是表示图14B的本发明第二实施方式的机器人手臂的控制装置的操作状态的俯视图;
图15A是表示本发明第二实施方式的机器人手臂的控制装置的操作状态的图;
图15B是表示本发明第二实施方式的机器人手臂的控制装置的操作状态的图;
图15C是表示图15B的本发明第二实施方式的机器人手臂的控制装置的操作状态的俯视图;
图16A是表示作为使用上述第一实施方式的机器人手臂的控制装置进行的作业之一例的烹调方法中一道作业工序的状态的图;
图16B是表示继续图16A的作业工序的状态的图;
图16C是表示继续图16B的作业工序的状态的图;
图16D是表示继续图16C的作业工序的状态的图;
图17是表示构成本发明第四实施方式的机器人系统的机器人手臂的控制装置和控制对象即机器人手臂的详细构成的图;
图18是以表形式表示第四实施方式的上述机器人手臂的控制装置的作业数据库的作业顺序信息之例的图;
图19A是表示第四实施方式的上述机器人手臂的控制装置的作业工序的状态的图;
图19B是表示第四实施方式的上述机器人手臂的控制装置的作业工序的状态的图;
具体实施方式
下面,使用附图对本发明的实施方式进行详细地说明。
以下,在参照附图对本发明的实施方式进行详细地说明之前,先对本发明的各种方式进行说明。
根据本发明的第一方式,提供一种机器人手臂的控制装置,其具有:
作业顺序信息采集机构,其采集包括人和上述机器人手臂协作的多道工序的家庭内作业的顺序信息;
进度管理机构,其基于由上述作业顺序信息采集机构采集到的上述家庭内作业的顺序信息,管理上述家庭内作业的进度信息;
控制参数设定机构,其基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息,设定上述机器人手臂的控制参数;
控制机构,其基于由上述控制参数设定机构所设定的上述控制参数,控制上述机器人手臂的动作。
根据这样的构成,可以基于作业顺序信息和进度信息,设定控制参数,且进行控制。
本发明第二方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,上述控制参数设定机构基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息设定上述机器人手臂的控制参数,以基于上述家庭内作业的顺序信息和上述进度信息,将上述机器人手臂的控制模式在位置控制模式、和使上述机器人手臂随着上述人的力而移动的模式之间进行切换。
本发明第三方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,上述家庭内作业的顺序信息是包括上述人和上述机器人手臂协作的烹调作业工序的烹调作业的顺序信息,
上述控制参数设定机构基于上述顺序信息的进度信息设定上述机器人手臂的控制参数,以将上述机器人手臂的控制模式在位置控制模式、和使上述机器人手臂随着上述人的力而移动的模式之间进行切换。
根据这样的构成,可以基于烹调作业的顺序信息的进度信息切换位置控制模式、和使所述机器人手臂随着所述人的力而移动的控制模式。
本发明第四方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,上述家庭内作业的顺序信息包括:上述烹调作业的顺序信息、处于上述机器人手臂的控制装置的周边且在上述烹调作业的顺序信息中使用的上述烹调装置的识别信息和动作信息。
根据这样的构成,可以基于处于所述机器人手臂的控制装置周边的烹调装置的信息和其进度信息,设定控制参数,且进行控制。
本发明第五方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,上述控制参数设定机构基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息,设定上述机器人手臂的机械阻抗设定值,
上述控制机构将上述机器人手臂的机械阻抗的值控制为上述控制参数设定机构所设定的上述机械阻抗设定值,来控制上述机器人手臂的动作。
根据这样的构成,可基于作业顺序信息和进度信息设定机器人手臂的机械阻抗设定值,且所述控制部可将所述机器人手臂的机械阻抗的值控制为所述控制参数设定机构所设定的所述机械阻抗设定值。
本发明第六方面在第五方面的基础上,提供一种机器人手臂的控制装置,其中,上述控制参数设定机构基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息,独立地设定上述机器人手臂的手指的平移方向及旋转方向的六维方向的机械阻抗设定值。
根据这样的构成,可基于作业顺序信息和进度信息,在六维方向分别设定并控制机械阻抗设定值。
本发明第七方面在第六方面的基础上,提供一种机器人手臂的控制装置,其中,上述家庭内作业的顺序信息为记述有烹调方法的烹调作业的顺序信息,包括烹调方法的顺序信息和成为上述烹调方法的烹调作业的对象的食品信息,
上述控制参数设定机构基于上述烹调作业的进度信息,使将成为上述烹调作业的对象的上述食品信息设定为易碎或具有粘性时的上述机器人手臂的机械阻抗的值、与将成为上述烹调作业的对象的上述食品信息设定为不易碎或粘性少时的上述机器人手臂的机械阻抗的值相比,分别高地设定粘性及刚性。
根据这样的构成,可基于食品信息设定控制参数。
本发明第八方面在第六方面的基础上,提供一种机器人手臂的控制装置,其中,通过上述控制参数设定机构和上述控制装置控制有别于上述机器人手臂的机器人手臂的动作,且独立于上述机器人手臂进行控制,
上述烹调作业的顺序信息还具有上述多个机器人手臂各自有无操作对象的信息,
上述控制参数设定机构将未成为上述操作对象的机器人手臂的机械阻抗的值设定为,与成为上述操作对象的机器人手臂的机械阻抗的值相比粘性及刚性升高。
根据这样的构成,可根据机器人手臂的工作状况设定控制参数。
本发明第九方面在第六方面的基础上,提供一种机器人手臂的控制装置,其中,上述烹调作业的顺序信息的进度信息还具有上述顺序信息中包含的多道烹调工序的经过时间信息,上述控制参数设定机构分别与上述经过时间的合计值的大小成比例地设定上述机器人手臂的机械阻抗的值的粘性及刚性的大小。
根据这样的构成,可根据各烹调工序的经过时间设定控制参数。
本发明第十方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,上述作业顺序信息采集机构除采集上述家庭内作业的顺序信息和上述家庭内作业的进度信息以外,还采集和上述机器人手臂协作的上述人的家庭内作业状态的信息即作业状态信息,
上述控制参数设定机构基于上述家庭内作业的顺序信息、上述家庭内作业的进度信息以及上述作业状态信息,设定上述控制参数。
根据这样的构成,可根据作业状态信息、作业顺序信息和进度信息设定控制参数,并进行控制。
本发明第十一方面在第十方面的基础上,提供机器人手臂的控制装置,其中,上述作业状态信息包括关于上述人的位置的信息、或关于上述人的利手的信息、或上述人的利手的手指的把持状态、或关于上述人的履行家庭内作业时的能力即技能信息的信息。
根据这样的构成,可基于关于人的位置或人的利手的信息、进而基于关于人的手指的把持状态的信息和作业顺序信息和进度信息设定控制参数,并进行控制。
本发明第十二方面在第十方面的基础上,提供一种机器人手臂的控制装置,其中,上述作业状态信息包括关于上述人和上述机器人手臂协作进行上述家庭内作业时施加的力的信息、和根据其力而移动的上述机器人手臂的手指位置。
根据这样的构成,可基于人操作机器人手臂时施加的力的信息和此时的机器人手臂的手指位置和作业顺序信息和进度信息设定控制参数,并进行控制。
本发明第十三方面在第十二方面的基础上,提供一种机器人手臂的控制装置,其中,还具有比较机构,该比较机构将关于上述力的信息及上述机器人手臂的上述手指位置、和当前的上述人的力的信息及上述机器人手臂的上述手指位置按时间序列进行比较,在由上述比较机构比较为两者一致的情况下,由上述控制参数设定部,将上述机器人手臂的控制模式从上述机器人手臂随着上述人的力而移动的控制模式切换到位置控制模式。
根据这样的构成,可在当前的力信息和手指位置与通过所述作业顺序信息采集机构采集的力信息和手指位置的信息一致的情况下,从使所述机器人手臂随着所述人的力而移动的控制模式变更为位置控制模式。
本发明第十四方面在第一方面的基础上,提供一种机器人手臂的控制装置,其中,还具有显示上述家庭内作业的顺序信息及上述家庭内作业的进度信息的显示机构。
根据这样的构成,可显示作业状态信息和进度信息。
本发明第十五方面提供一种机器人手臂的控制方法,其中,
由作业顺序信息采集机构采集包括人和上述机器人手臂协作的多道工序的家庭内作业的顺序信息,进而由进度管理机构管理上述家庭内作业的进度信息,
由控制参数设定机构基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息设定上述机器人手臂的控制参数,
由控制装置基于上述所设定的控制参数控制上述机器人手臂的动作。
本发明第十六方面提供一种机器人,其具有:上述机器人手臂、控制上述机器人手臂的动作的记载于第一~第十四方面中任一方面的机器人手臂的控制装置。
本发明第十七方面提供一种机器人手臂的控制程序,该机器人手臂的控制程序能够通过计算机来执行,其具有:
采集包括人和上述机器人手臂协作的多道工序的家庭内作业的顺序信息的步骤;
管理上述家庭内作业的进度信息的步骤;
基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息,设定上述机器人手臂的控制参数的步骤;
基于上述所设定的控制参数,控制上述机器人手臂的动作的步骤。
本发明第十八方面提供一种控制机器人手臂的集成电路,其具有:
作业顺序信息采集机构,其采集包括人和上述机器人手臂协作的多道工序的家庭内作业的顺序信息;
进度管理机构,其基于上述家庭内作业的顺序信息,管理上述家庭内作业的进度信息;
控制参数设定机构,其基于上述家庭内作业的顺序信息和上述家庭内作业的进度信息,设定上述机器人手臂的控制参数;
控制机构,其基于由上述控制参数设定机构所设定的上述控制参数,控制上述机器人手臂的动作。
根据这样的构成,可基于作业顺序信息和进度信息设定控制参数,并进行控制。
下面,用附图对本发明的实施方式进行详细地说明。
(第一实施方式)
首先,对具备本发明第一实施方式的机器人手臂的控制装置的机器人系统100的构成进行说明。图1A是表示本发明第一实施方式的机器人系统100的构成的概要的图。
如图1A所示,具备本发明第一实施方式的机器人手臂5及其控制装置105的机器人系统100的构成为具备第一机器人系统1和第二机器人系统2,两个机器人系统1、2各自的第一及第二机器人手臂5-1、5-2(在以下的说明中,在不需要分别区别第一及第二机器人手臂5-1、5-2的情况下,代表性地表示为“机器人手臂5”。)设置在厨房或工作台等作业台7的壁面7a上,第一及第二机器人手臂5-1、5-2的基端分别可移动地支承在固定于壁面7a的导轨8上,第一及第二机器人手臂5-1、5-2分别可在导轨8上沿导轨8横向例如水平方向地独立地移动。
如图1B所示,第一机器人系统1使用第一机器人手臂5-1,在家庭内,例如,是和人4协作搬运作为对象物体之一例的沉重的锅等器具3的机器人系统,在第一机器人系统1的第一机器人手臂5-1的前端具有手部30,保持例如把持器具3的一对把手中一把手,和第一机器人手臂5-1协作的人4可把持器具3的另一把手。在第一机器人手臂5-1的前端的手部30把持器具3的一把手、且人4把持器具3的另一把手的状态下,通过人对器具3向希望搬运的方向施力,可以使第一机器人系统1工作,使第一机器人手臂5-1沿着导轨8移动,第一机器人手臂5-1和人4协作搬运器具3。
第二机器人系统2使用第二机器人手臂5-2,为主要进行家庭内的器具3的搬运作业以外的第二机器人手臂5-2和人4协作的家庭内作业(包括多道工序,且在来自人4的命令或监视下,第二机器人手臂5-2进行规定的动作的作业)的机器人系统,例如,将作为器具3之一例的锅3A中的食品进行搅和的作业,或擦去厨房的作业台7的污垢的作业。
另外,根据需要,第一机器人系统1和第二机器人系统2可以轮班作业。
作为显示机构之一例的显示部9为显示器,显示烹调的食谱信息(包括人和机器人手臂协作的烹调作业工序的烹调作业的顺序信息)等家庭内作业的顺序信息或家庭内作业的进度信息。作为第二机器人系统2的锅的搅和或擦拭扫除的操作顺序之一例,如图1A所示,首先,人4按照显示于显示部9的作业顺序,人4直接把持第二机器人系统2的第二机器人手臂5-2,人4对第二机器人手臂5-2施力,由此第二机器人系统2工作,通过使第二机器人手臂5-2沿着导轨8移动,可将第二机器人手臂5-2引导到器具3的附近。接着,人4将勺子等烹调器具10安装在第二机器人系统2的第二机器人手臂5-2的前端的手部30。接着,在烹调设备例如作业台7的IH烹调电炉或煤气炉等厨柜即烹调装置6的侧面配置第一机器人系统1及第二机器人系统2的操作盘13,通过人4分别按压操作盘13的按钮,可以使第一机器人系统1工作,开始器具3的搬运作业,并且第二机器人系统2工作,开始搅和作业或擦拭扫除。
操作盘13例如:具备第一机器人系统驱动开始及停止用按钮、和第二机器人系统驱动开始及停止用按钮,分别构成为:一次按压时,将驱动开始信号输入数据输入IF26,再次按压时,将驱动停止信号输入数据输入IF26。但是,并不限于这种构成,也可以由驱动开始及停止用按钮、第一机器人系统和第二机器人系统切换用按钮构成等,只要可以分别独立地将第一机器人系统1和第二机器人系统2驱动开始及停止,就可以通过其他任意的结构来构成。在此所言的驱动开始的意思,除指由各自的机器人系统使机器人手臂5成为可开始驱动的状态之外,也可以指机器人手臂5因作业而开始驱动。
本发明第一实施方式的器具3的概念为除单纯地锅或餐具自身以外,也包括加有水或食品的锅或餐具等重量物,为第一机器人手臂5-1或第二机器人手臂5-2中至少其一和人4协作可以搬运的对象物体。
在本发明第一实施方式中,导轨8配置在作业台7的壁面7a,但在没有壁面的岛式厨房的情况下,导轨8设置在适合进行天花板面或岛式厨房的顶板侧面等作业的场所。
另外,在本发明第一实施方式中,操作盘13固定在烹调装置6的侧面,但也可以为可遥控操作的遥控器。
图2是表示机器人系统100的详细构成的图,作为代表例,图示有构成第二机器人系统2且作为控制对象的第二机器人手臂5-2、和其控制装置105(控制装置主体部11和周边装置14)的构成。图2中对第二机器人系统2进行了说明,但第一机器人系统1也采用同样的构成,因此,在此省略其说明。
构成上述机器人手臂5的控制装置105的控制装置主体部11及周边装置14作为一例分别由通常的个人计算机构成。
控制装置主体部11的构成具备:作为控制参数设定机构之一例的控制参数设定部21、作为控制机构之一例的控制部22。周边装置14的构成具备:作业数据库20、作业信息收集部23、数据输入IF(接口)26、输入输出IF(接口)24、作为关节部驱动控制机构(关节部驱动控制部)之一例的电动机驱动器25、作为信息输出机构(信息输出部)或显示机构之例的显示部9、作为进度管理机构之一例的进度管理部29。由作业数据库20或由作业数据库20和作业信息收集部23构成作业信息采集机构之一例。
输入输出IF24的构成具备:连接在个人计算机的PCI总线等扩充槽上的例如D/A转换器、A/D转换器、逆转换器等。
通过执行控制第二机器人手臂5-2的动作的控制装置主体部11及周边装置14,使由第二机器人手臂5-2的各关节部的后述的编码器44输出的各关节角度信息通过输入输出IF24的逆转换器存取于控制装置主体部11,由控制装置主体部11基于所存取的各关节角度信息,算出各关节部的旋转动作的控制指令值。所算出的各控制指令值通过输入输出IF24的D/A转换器被赋予用于驱动控制第二机器人手臂5-2的各关节部的电动机驱动器25,按照从电动机驱动器25送来的各控制指令值,驱动第二机器人手臂5-2的各关节部的电动机43。另外,作为由电动机驱动器25驱动控制的手部驱动装置之一例,手部30还具备手部驱动用的电动机62、检测手部驱动用的电动机62的旋转轴的旋转相位角的编码器61,基于由编码器61检测的旋转角度,利用来自控制装置主体部11的控制部22的控制信号,经由电动机驱动器25,驱动控制电动机62的旋转,通过使手部驱动用的电动机62的旋转轴正反旋转来开闭手部30。
第二机器人手臂5-2作为一例为多关节机器人手臂,为六个自由度的多连杆机械手,其具备:上述手部30、前端具有安装有手部30的手腕部31的前腕连杆32、前端可旋转地与前腕连杆32的基端连结的上腕连杆33、可旋转地连结支承上腕连杆33的基端的台部34。台部34与可移动的导轨8连结,但也可以固定在规定位置。手腕部31具有第四关节部38、第五关节部39、第六关节部40的三个旋转轴,可以改变手部30相对于前腕连杆32的相对姿势(朝向)。即,在图2中,第四关节部38可以改变手部30相对于手腕部31的绕横轴的相对姿势。第五关节部39可以改变手部30相对于手腕部31的、绕与第四关节部38的横轴正交的纵轴的相对姿势。第六关节部40可以改变手部30相对于手腕部31的、绕分别与第四关节部38的横轴及第五关节部39的纵轴正交的横轴的相对姿势。前腕连杆32的另一端相对于上腕连杆33的前端可绕第三关节部37、即绕与第四关节部38的横轴平行的横轴旋转。上腕连杆33的另一端相对于台部34可绕第二关节部36、即绕与第四关节部38的横轴平行的横轴旋转,台部34的上侧可动部相对于台部34的下侧固定部可绕第一关节部35、即绕与第五关节部39的纵轴平行的纵轴旋转。其结果是,第二机器人手臂5-2可绕合计六个轴旋转,从而构成上述六个自由度的多连杆机械手。
在构成各轴的旋转部分的各关节部具备:装设在构成各关节部的一对部件(例如,转动侧部件、支承该转动侧部件的支承侧部件)中一部件上且由后述的电动机驱动器25驱动控制的作为旋转驱动装置之一例的电动机43(实际上,配设在第二机器人手臂5-2的各关节部的内部)、检测电动机43的旋转轴的旋转相位角(即关节角)的编码器44(实际上,配设在第二机器人手臂5-2的各关节部的内部),装设在各关节部的一部件上的电动机43的旋转轴通过与各关节部的另一部件连结而使上述旋转轴正反旋转,可以使另一部件相对于一部件围绕各轴旋转。
41为相对于台部34的下侧固定部而相对位置关系被固定的绝对座标系,42为相对于手部30而相对位置关系被固定的手指座标系。以从绝对座标系41看到的手指座标系42的原点位置Oe(x、y、z)为第二机器人手臂5-2的手指位置,以从绝对座标系41看到的手指座标系42的姿势为由侧滚角和倾斜角和偏转角(φ、θ、ψ)表示的第二机器人手臂5-2的手指姿势,将手指位置及姿势矢量定义为矢量r=[x、y、z、φ、θ、ψ]T。
因此,作为一例,优选第一关节部35的纵轴与绝对座标系41的z轴平行,第二关节部36的横轴与x轴平行。另外,优选第六关节部40的横轴与手指座标系42的x轴平行,第四关节部38的横轴与y轴平行,第五关节部39的纵轴与z轴平行。另外,设相对于手指座标系42的x轴的旋转角为偏转角ψ,设相对于y轴的旋转角为倾斜角θ,设相对于z轴的旋转角为侧滚角φ。在控制第二机器人手臂5-2的手指位置及姿势的情况下,使手指位置及姿势矢量r追随由后述的目标轨道生成部55生成的手指位置及姿势目标矢量rd。
以上的第二机器人手臂5-2的构成及作用对于第一机器人手臂5-1来说也同样。
作业信息收集部23通过互联网28从位于外部的网络服务器的信息数据库16收集作业自身及该家庭内作业的顺序信息,例如,作为作业之一例的烹调作业的食谱信息等家庭内作业的顺序信息,更新输入并存储在作业数据库20的作业顺序信息数据库17。另外,收集电子灶或灶台的IH烹调电炉等烹调装置(图1中,作为一例,具有IH烹调电炉的灶台)6的识别信息、动作信息(例如,烹调时间或火加减(火力的强度))等信息,更新输入并存储在作业数据库20的烹调设备信息数据库18。总之,作业信息收集部23主要收集人4和机器人手臂5协作作业时必要的信息,换言之,主要从可存取协作作业信息的网络或数据库或设备等收集。
29为进度管理部,管理存储于作业数据库20的进度数据库19的作业的进度信息。具体而言,如图3所示,进度管理部29从作业数据库20读出当前的工序的识别信息例如工序ID,计测各工序需要的时间和其时的时刻,并存储在进度管理部29。另外,当从连接有后述的数据输入IF26作为来自数据输入IF26的输入之一例的话筒等语音输入装置以人4发出例如“下一工序”的语音来输入指示时,进度管理部29识别通过语音识别来进入下一工序的情况,将表示是否当前进行的工序的标志存储在进度信息数据库19。另外,也可以使用后述的数据输入IF26,人4使机器人手臂5的作业进入下一工序,或使机器人手臂5的作业工序停止。
26为数据输入IF(接口),为人4使用按钮、或键盘、或鼠标、或话筒等输入装置输入变更作业的进度或作业信息等,或用于使用例如上述操作盘13的按钮等输入装置,来接收来自人4的作业开始及作业终止的指令的接口。
9为显示部,由设置于例如机器人手臂5或作业台7的侧面的显示装置显示作业顺序信息或当前的进度信息。
接着,对作业数据库20的详细进行说明。
作业数据库20的构成例如具备:图3所示的第二机器人手臂5-2和人4的家庭内的协作作业的顺序信息即作业顺序信息数据库17、上述协作作业的进度信息即进度信息数据库19、关于在第二机器人手臂5-2的周边工作的IH烹调电炉或电子灶等烹调装置6的状况的信息(烹调设备信息、即烹调装置6的识别信息和动作信息等)即烹调设备信息数据库18。
存储于作业顺序信息数据库17的家庭内作业的顺序信息作为一例如图3所示,构成具有:识别上述协作作业的作业ID号码等作业ID信息、识别其作业的各工序的工序ID号码等工序ID信息、有关相当于工序ID号码的工序的信息、关于其工序的对象物的对象物信息、进行其工序的操作信息、其工序需要的预计的时间即预测时间、其工序中烹调的材料或水或调料等分量的分量信息。上述对象物信息具体地是指:其工序中处理的对象物的信息,例如,其工序中使用的食品等信息。上述操作信息具体地是指:表示人4、第一机器人系统1、第二机器人系统2中任一个进行其工序的信息,对人4、第一机器人系统1、第二机器人系统2分别记录有“1”或“0”。“1”表示进行其工序的作业的情况,“0”表示未进行作业的情况。例如,在图3的工序ID0002中,由于“请向锅中加入1升水”这种作业(“向锅中加水的作业”)为只有人4进行的作业,因此,在该例中,以(人、机器人1、机器人2)的顺序存储为(1、0、0)。
另外,图16A~图16D关于图3的主要工序而表示人4和第一机器人手臂5-1和第二机器人手臂5-2分别作业的状态。
例如,工序ID0001中,由于具有“请将第一机器人手臂5-1安装在锅的把手上”,因此成为图16A的状态,具体而言,如后述较小地设定第一机器人手臂5-1的粘性D及刚性K,使第一机器人手臂5-1的手部30以夹住器具之一例即锅3A的一对把手中一把手的方式定位后,成为由手部30把持上述一把手的状态。
工序ID0002中,由于具有“请向锅中加入1升水”,因此成为图16B的状态,具体而言,如后述,在较大地设定第一机器人手臂5-1的粘性D及刚性K、且由第一机器人手臂5-1的手部30把持锅3A的一把手的状态下,由人4从水龙头89将1升水加入锅3A内。
接着,工序0003的“请将锅引导到灶台上”为图16C那种状态,具体而言,如后述,在较大地设定第一机器人手臂5-1的粘性D及刚性K、且由第一机器人手臂5-1的手部30把持锅3A的一把手的同时人4把持锅3A的另一把手的状态下,通过人4向灶台6施力,则其力经由锅3A作用于第一机器人手臂5-1,如后述,使第一机器人系统1工作,第一机器人手臂5-1沿着导轨8从水龙头89附近的位置移动到灶台6上,第一机器人手臂5-1和人4协作将锅3A搬运。至此的三个工序中,第二机器人手臂5-2什么动作也没有,因此较大地设定第二机器人手臂5-2的粘性D及刚性K,使其静止在不妨碍上述工序的位置例如水槽侧的位置。
接着,工序0007的“请将勺子安装在第二机器人手臂5-2上”为图16D那种状态,具体而言,在将锅3A载置在灶台6上、且较大地设定第一机器人手臂5-1的粘性D及刚性K、并由第一机器人手臂5-1的手部30把持锅3A的一把手的状态下,人4移动到第二机器人手臂5-2静止的位置。接着,通过人4对第二机器人手臂5-2向灶台6施力,则第二机器人系统2工作,第二机器人手臂5-2沿着导轨8移动,并移动到灶台6的锅3A附近。接着,如后述,较小地设定第二机器人手臂5-2的粘性D及刚性K,将勺子10安装在第二机器人手臂5-2的手部30,并将勺子10放入锅3A中。
其后,未进行详细说明,但进行了工序0008~工序0029后,在工序0030“终止”中终止作业ID0001的作业,按压操作盘13的按钮等,分别终止第一机器人手臂5-1及第二机器人手臂5-2的动作。
在显示部9按工序ID号码的序号显示家庭内作业的顺序信息,人4或第一及第二机器人手臂5-1、5-2按其工序ID号码的序号进行作业。
存储于进度信息数据库19的进度信息作为一例,如图3所示,构成具备:分别相当于作业ID号码等作业ID信息的多道工序ID号码等工序ID信息的工序中实际需要的时间即经过时间、用于区别是不是当前进行的作业的信息即“1”或“0”标志信息(例如,标志“1”的意思是当前进行的作业,标志“0”的意思是当前未进行的作业)、时刻的信息。当人4终止显示于显示部9的工序时,进度管理部29等待由数据输入IF26将因人4的语音等而进入下一工序的指示输入。当将进入下一工序的指示输入进度管理部29并通过进度管理部29使当前的工序转移到下一工序时,由进度管理部29将是或不是当前的工序存储在进度数据库19。例如,在图3的工序ID0003中,通过将表示是当前的工序的标志“1”存储在进度数据库19来表示是当前的工序。这时,反之,在另一工序中,通过将表示不是当前的工序的标志“0”存储在进度数据库19来表示不是当前的工序。当进度管理部29指示工序终止时,测定其工序所需要的时间,并存储在作业数据库20的进度数据库19。具体而言,进度管理部29在图3的当前的工序中计测存储有标志“1”期间的时间,并将作业经过时间存储在进度数据库19。另外,在后述的烹调装置6工作的情况下,在烹调装置6已停止的时刻,由进度管理部29接收自烹调装置6将停止信号输入的信息,也可以通过进度管理部29使当前的工序自动地进入下一工序。
关于存储于烹调设备信息数据库18的烹调装置6的状况的信息(烹调设备信息)作为一例,如图3所示,构成具有:分别相当于作业ID号码等作业ID信息的多道工序ID号码等工序ID信息的工序中识别工作着的烹调装置6的ID信息之一例即设备ID号码等设备ID信息、关于表示该设备ID号码的烹调装置6的动作状态的控制ID号码的信息。例如,图3所示的设备ID号码的“1”表示IH烹调电炉,设备ID号码的“2”表示电子炉,控制ID信息之一例即控制ID号码的“1001”表示“加热到100度”,控制ID号码的“2001”表示“在半解冻下10分钟”,由作业信息收集部23通过互联网28,从位于外部的网络服务器的信息数据库16收集,并存储在作业数据库20的烹调设备信息数据库18。
另外,家庭内作业的顺序信息或烹调设备信息等其他的信息也可以根据需要,由作业信息收集部23通过互联网28从位于外部的网络服务器的信息数据库16收集,并分别存储在作业数据库20的作业顺序信息数据库17及烹调设备信息数据库18。这在例如新设置有烹调设备时、或将已有的烹调设备更换成另外的烹调设备时、或进行新的作业时等有效。
接着,对控制参数设定部21的详细进行说明。
控制参数设定部21基于作业顺序信息、进度信息、关于烹调装置6的状况的信息(烹调设备信息),进行在位置控制模式和阻抗控制模式(使机器人手臂随人的力而移动的控制模式之一例)之间切换第一及第二机器人手臂5-1、5-2各自的控制模式的设定、及阻抗控制模式时的机械阻抗设定值的设定。
第一及第二机器人手臂5-1、5-2各自的位置控制模式为第一及第二机器人手臂5-1、5-2分别基于后述的目标轨道生成部55的手部30的手指位置及姿势目标矢量指令而动作的模式,具体地为进行搅和作业或擦拭扫除等作业时动作的模式。
第一及第二机器人手臂5-1、5-2各自的阻抗控制模式为第一及第二机器人手臂5-1、5-2分别根据由人4等分别施加于第一及第二机器人手臂5-1、5-2的力而动作的模式,例如,如图1B所示,在人4和第一及第二机器人手臂5-1、5-2中任一方或双方协作进行搬运的作业的情况下,或如图1A所示,在人4直接拿着第一或第二机器人手臂5-1或5-2将第一或第二机器人手臂5-1或5-2引导到作业场所时而使其动作的模式。
在人4和第一机器人手臂5-1和第二机器人5-2协作进行例如图3所示的烹调作业的情况下,如工序ID0008的指示,第二机器人手臂5-2的手部30为位置控制模式,如图9A所示,在锅3A中进行搅和作业时,在人4品尝锅3A中的料理的口味的情况下,或为了向锅3A中新投入食品,人4有时中止锅3A中的第二机器人手臂5-2的手部30的搅和作业。在那种情况下,通过操作盘13的按钮的操作等,将中止搅和作业的信号经由数据输入IF26从进度管理部29输入作业数据库20,并且输入控制参数设定部21。于是,控制参数设定部21在作业停止时,将从位置控制模式切换到阻抗控制模式的指令向控制部22输出。
其结果是,在由中止命令停止的第二机器人手臂5-2把持的烹调器具10在品尝锅3A中的料理的口味或向锅3A中投入食品时等碍事时,通过变更控制参数设定部21的设定并由控制部22将第二机器人手臂5-2的控制模式切换为阻抗控制模式,则如图9B所示,只是人4直接把持第二机器人手臂5-2并使其移动,就可以简单地使第二机器人手臂5-2退避。
另外,在和人4协作且第二机器人手臂5-2以阻抗控制模式进行作业时,根据作业顺序信息和进度信息,由控制参数设定部21变更修正第二机器人手臂5-2的机械阻抗参数的修正值。
作为机械阻抗设定值的设定参数(机械阻抗参数),具有惯性M、粘性D、刚性K。机械阻抗设定值的各参数的设定使用修正值并由控制参数设定部21基于以下的评价式来进行。
(数1)
M=KM×(修正值)…式(1)
(数2)
D=KD×(修正值)…式(2)
(数3)
K=KK×(修正值)…式(3)
上述式(1)~(3)中的KM、KD、KK为放大项,分别为某常数值。
控制参数设定部21将基于上述式(1)~(3)计算的机械阻抗参数的惯性M、粘性D、刚性K向控制部22输出。
按照上述式(1)~(3),通过由控制参数设定部21适当地设定修正值等,可以使机器人手臂5适当地动作。例如,由式(2)及式(3)可知,由控制参数设定部21将机器人手臂5的机械阻抗参数的粘性D及刚性K以增大的方式设定,由此,在机器人手臂5的行动上产生阻力感或生硬,且难以行动,另一方面,由式(2)及式(3)可知,由控制参数设定部21将机器人手臂5的机械阻抗参数的粘性D及刚性K以减小的方式设定,由此,在机器人手臂5的行动上无阻力感或生硬,可以平稳地移动。另外,由式(1)可知,由控制参数设定部21将机器人手臂5的机械阻抗参数的惯性M以增大的方式设定,由此,在使机器人手臂5移动方面需要大的力,即使以小的人力推动机器人手臂5也不会动,另一方面,由式(1)可知,由控制参数设定部21将机器人手臂5的机械阻抗参数的惯性M以减小的方式设定,由此,以小的力足以使机器人手臂5移动,仅以一点点人力推动机器人手臂5,就可以平稳地移动。
因此,由上述式(1)~(3)可知,例如,如图3的工序ID0009所示,在人4中止了搅和作业时,在投入食品之际使碍事的第二机器人手臂5-2退避的情况(具体而言,在人4利用操作盘13将停止第二机器人手臂5-2的搅和作业的指令从数据输入IF26输入进度管理部29的情况)下,将该停止指令从进度管理部29输入控制参数设定部21,由控制参数设定部21从作业数据库20中提取当前实施中的工序ID号码,用所提取的工序ID号码提取成为对象的食品(对象信息)。在由控制参数设定部21判断为食品是像豆腐那样易碎的原材料,或是水或肉羹汁那种具有粘性的食品时,需要人4使第二机器人手臂5-2迅速地退避,以防止因失误而使安装于第二机器人手臂5-2的手部30的烹调器具10压坏食品,或使水或肉羹汁飞溅在锅3A的外面而污染锅3A的周边。因此,由控制参数设定部21较高地设定第二机器人手臂5-2的机械阻抗参数的上述的修正值,从而将第二机器人手臂5-2的机械阻抗参数的粘性D及刚性K以增大的方式设定,在第二机器人手臂5-2的行动上产生阻力感或生硬,且难以行动。其后,如果人4对第二机器人手臂5-2向希望使其退避的方向施力,则通过人4继续推动,可以使第二机器人手臂5-2慢慢地向希望使其退避的方向移动,不会因失误而压坏食品,或使水或肉羹汁飞溅在锅3A的外面而污染锅3A的周边,可以使第二机器人手臂5-2退避。
另外,在分量多的情况下,为了搅和而需要人4的力(即,在分量多的状态下,与分量少的情况相比,作用于机器人手臂5的阻力大,因此在人4使机器人手臂5退避的情况下,需要力),因此,通过较低地设定机械阻抗参数的修正值,可以将第二机器人手臂5-2的机械阻抗参数的粘性D及刚性K以减小的方式设定,可以使第二机器人手臂5-2平稳地移动。
另外,在相当于工序的进度信息的操作信息中,在未成为操作对象的机器人手臂5中较高地设定机械阻抗参数的修正值。具体而言,例如,在图3的工序ID0003中,在从第一机器人系统1的第一机器人手臂5-1以阻抗控制模式和人4协作搬运锅3A的工序到搬运结束的状态即在工序ID0004进行作业的工序的情况下,在工序ID0004中,第一机器人系统1不成为顺序的操作对象,因此,较高地设定第一机器人系统1的第一机器人手臂5-1的机械阻抗参数的修正值。由此,从工序ID0003那种锅3A的搬运中到把持工序ID0004的锅3A同时待机的情况下,通过较大地设定第一机器人手臂5-1的机械阻抗参数的惯性M,则在工序ID0004中,在使待机中的第一机器人手臂5-1移动上需要大的力,即使以小的人力推动第一机器人手臂5-1也不会动。由此,在第一机器人手臂5-1把持锅3A的把手的状态且待机的情况下,第一机器人手臂5-1可以使锅3A牢固地固定,以使其即使在人4因失误而要移动锅3A的情况下也不容易移动。
另外,随着作业进行,因人4疲劳而误操作或误动作增大。因此,随着由进度管理部29求出、并输入控制参数设定部21的各工序的经过时间之和增加,由控制参数设定部21将机械阻抗参数的修正值以增高的方式设定。由此,较大地设定第一机器人手臂5-1的机械阻抗参数的刚性K,或根据需要,除第一机器人手臂5-1之外,也较大地设定第二机器人手臂5-2的机械阻抗参数的刚性K,因此,可以使第一机器人手臂5-1或第一机器人手臂5-1和第二机器人手臂5-2不易移动,在长时间作业的情况下,可以防止人4误动作而使锅3A等搬送物落下等的危险性。
另外,搬运装有烹调的结果即沸腾的汤或食品的锅3A比搬运装有水的锅3A更易误操作,搬送物落下时的危险性增大,因此,控制参数设定部21利用存取于作业数据库20而采集的关于烹调装置6的状况的信息的设备ID号码和控制ID号码,根据例如IH烹调电炉的加减火的信息和其工作时间,由控制参数设定部21来推定加装入锅中的食品是不是热汤,另外,利用作业顺序信息,根据什么样的食品装锅中,由控制参数设定部21较高地设定机械阻抗参数的修正值,由此,将第一或第二机器人手臂5-1或5-2的机械阻抗参数的粘性D及刚性K以增大的方式设定,在第一或第二机器人手臂5-1或5-2的行动上产生阻力感或生硬,且难以移动。
另外,在需要如早晨或傍晚的时间带那样在时间内迅速地准备饭食的情况下,如图13所示,与预存储于作业数据库20的、根据时刻设定有等级的等级成比例,并由控制参数设定部21设定机械阻抗参数的修正值。由此,例如,早晨或傍晚的时间带通过较低地设定等级,可以较低地设定机器人手臂5-1或5-2的机械阻抗参数的修正值,可以减少在机器人手臂5-1或5-2的行动上产生阻力感或生硬,可以平稳地进行操作。
基于图5的流程图对以上的作业信息收集部23、作业数据库20、进度管理部29、控制参数设定部21的动作步骤进行说明。
作业信息收集部23通过互联网28,从位于外部的网络服务器的信息数据库16,收集烹调作业的食谱信息等家庭内作业的顺序信息,存储在作业数据库20的作业顺序信息数据库17(步骤S20)。
接着,数据输入IF26从显示于显示部9的作业一览接收由人4选择作业的指令,在作业数据库20设定当前的作业。具体而言,人4从烹调菜单一览选择想烹调的菜单,由数据输入IF26将选择指令输入作业数据库20,在作业数据库20设定作为当前的作业之一例的烹调菜单(步骤S21)。
接着,数据输入IF26按照显示于显示部9的作业顺序即作业的工序,接收来自人4的作业开始的指令。具体而言,由数据输入IF26接收来自人4的搅和作业开始的指示,将作业开始的指示输入进度管理部29(步骤S22)。
接着,由进度管理部29管理关于步骤S22的作业的进度信息,且存储在作业数据库20的进度信息数据库19。具体而言,为了将搅和工序设定成“当前的作业”,既由进度管理部29将标志“1”存储在进度信息数据库19(步骤S23),又接着,由进度管理部29计测在“当前的作业”中存储有“1”的时间,作为搅和作业的经过时间,由进度管理部29计测,并存储在进度信息数据库19(步骤S24)。
接着,控制参数设定部21判断从数据输入IF26经由作业数据库20由人4输入有停止命令与否(步骤S25)。
如果在控制参数设定部21未从数据输入IF26经由作业数据库20或从数据输入IF26经由进度管理部29接收到停止输入的情况下,则为了进行搅和作业,将控制模式设定为位置控制模式,并向控制部22输出(步骤S26)。
如果在步骤S25中,为了按照作业信息投入另外的食品,在由数据输入IF26接收到由人4进行作业停止的输入的情况下,则从数据输入IF26经由作业数据库20或从数据输入IF26经由进度管理部29将停止信号输入控制参数设定部21,控制参数设定部21将控制模式设定为阻抗控制模式(步骤S27)。
接着,控制参数设定部21从作业数据库20中提取当前的作业,还基于其作业中使用的食品的状况或经过时间、其工序中工作着的其他烹调装置6的烹调设备信息,由上述式(1)~(3)算出机械阻抗参数的惯性M、粘性D、刚性K,并向控制部22输出(步骤828)。
另外,根据步骤S25的作业停止的输入信息的有无,由控制参数设定部21设定成位置控制模式、或阻抗控制模式,但在未根据食谱信息的预测时间信息或其他烹调装置的状况设定时间等的情况下,控制参数设定部21也可以基于来自进度管理部29及作业数据库20的信息,自动地切换为阻抗控制模式、或位置控制模式。
图6是表示控制部22的阻抗控制模式时的方框图。控制部22将机器人手臂5-1、5-2各自的机械阻抗参数的值控制为由控制参数设定部21基于所设定的机械阻抗参数的惯性M、粘性D、刚性K的设定值而设定的机器人手臂5-1、5-2各自的机械阻抗参数设定值。
下面,利用图6对控制部22的详细进行说明。分别从机器人手臂5-1、5-2将由各自的关节轴的编码器44计测的关节角的当前值(关节角度矢量)矢量q=[q1、q2、q3、q4、q5、q6]T输出,通过输入输出IF24的逆转换器存取于控制部22。其中,q1、q2、q3、q4、q5、q6分别为第一关节部35、第二关节部36、第三关节部37、第四关节部38、第五关节部39、第六关节部40的关节角度。
55为目标轨道生成部,接收来自控制参数设定部21的输入,并将用于实现作为目标的机器人手臂5的动作的手指位置及姿势目标矢量rd输出。作为目标的机器人手臂5的动作事先根据作为目标的作业赋予各时间(t=0、t=t1、t=t2、…)下的每一测点的位置(rd0、rd1、rd2、…),目标轨道生成部55使用多项式插入法补足各测点间的轨道,生成手指位置及姿势目标矢量rd。
53为力推定机构(力推定部),推定通过人4等和机器人手臂5的接触而施加在机器人手臂5的力。经由输入输出IF24的A/D转换器将由电动机驱动器27的电流传感器计测的、流过驱动机器人手臂5的各关节部的电动机43的电流值i=[i1、i2、i3、i4、i5、i6]T存取于力推定机构53,另外,经由输入输出IF24的逆转换器取入关节角的当前值q,并且取入来自后述的近似逆运动学计算部57的关节角度误差补偿输出uqe。力推定机构53作为观测器发挥功能,根据以上的电流值i、关节角的当前值q、关节角度误差补偿输出uqe,且根据施加在机器人手臂5的外力,算出发生在各关节部的转矩τext。而且,由 换算为机器人手臂5的手指的等效手指外力Fext。在此,Jv(q)为满足
(数4)
的雅可比矩阵。其中,v=[vx、vy、vz、ωx、ωy、ωz]T,(vx、vy、vz)为手指座标系42的机器人手臂5的手指的并进速度,(ωx、ωy、ωz)为手指座标系42的机器人手臂5的手指的角速度。另外,m为把持的物体的重量,g为把持的物体的重力加速度。把持物体的重量m的值可以在把持之前,人将其输入,或由作业收集部23收集信息并将其输入。另外,实际上由机器人手臂5进行把持,也可以由其时的力推定机构53的等效手指外力Fext的推定结果,算出把持物体的重量m的值。
阻抗计算机构(阻抗计算部)51为在机器人手臂5上发挥如下功能的部分,该功能为实现上述机器人手臂5的机械阻抗的值向机械阻抗设定值的控制,由控制参数设定部21在切换为位置控制模式时将“0”输出。另一方面,在阻抗控制模式时,由以下的公式(4),根据由控制参数设定部21设定的阻抗参数即惯性M、粘性D、刚性K、和关节角的当前值q、和力推定部53推定的外力Fext,计算在机器人手臂5上用于实现上述机器人手臂5的机械阻抗的值向机械阻抗设定值的控制的手指位置及姿势目标修正输出rdΔ且将其输出。将手指位置及姿势目标修正输出rdΔ与目标轨道生成部55输出的手指位置及姿势目标矢量rd进行加法运算,生成手指位置及姿势修正目标矢量rdm。
(数5)
其中,
(数6)
(数7)
(数8)
S为拉普拉斯运算符。
58为经由输入输出IF24的逆转换器将由来自机器人手臂5的各自的关节轴的编码器44计测的关节角的当前值q即关节角度矢量q输入的正运动学计算部,进行从机器人手臂5的关节角度矢量q向手指位置及姿势矢量r转换的几何学计算。
56为位置误差补偿部,将根据机器人手臂5中计测的关节角度矢量q由正运动学计算部58计算的手指位置及姿势矢量r、和手指位置及姿势修正目标矢量rdm的误差re输入,将位置误差补偿输出ure向近似逆运动学计算部57输出。
在近似逆运动学计算部57中,通过近似式uout=Jr(q)-1uin进行逆运动学的近似计算。其中,Jr(q)为满足
(数9)
关系的雅可比矩阵,uin为向近似逆运动学计算部57的输入,uout为来自近似逆运动学计算部57的输出,如果设输入uin为关节角度误差qe,则如qe=Jr(q)-1re,成为从手指位置及姿势误差re向关节角度误差qe的转换式。因此,当将位置误差补偿输出uin输入近似逆运动学计算部57时,作为其输出,将用于补偿关节角度误差qe的关节角度误差补偿输出uqe从近似逆运动学计算部57输出。
关节角度误差补偿输出uqe经由输入输出IF24的D/A转换器作为电压指令值被赋予电动机驱动器25,通过各电动机43正反旋转来驱动各关节轴而使机器人手臂5动作。
关于如上构成的控制部22,对机器人手臂5的阻抗控制动作的原理进行说明。
阻抗控制动作的基础为位置误差补偿部56的手指位置及姿势误差re的反馈控制(位置控制),图6的虚线包围的部分为位置控制系统59。作为位置误差补偿部56,例如,如果使用PID补偿器,则以手指位置及姿势误差re收敛为0的方式进行控制,可以实现作为目标的机器人手臂5的阻抗控制动作。
在由控制参数设定部21切换成阻抗控制模式的情况下,由阻抗计算机构51将手指位置及姿势目标修正输出rdΔ与上述说明的位置控制系统59进行加法运算,进行手指位置及姿势的目标值的修正。因此,上述的位置控制系统59使手指位置及姿势的目标值微小地偏离本来的值,其结果是,实现将上述机器人手臂5的机械阻抗的值控制为上述适当设定的设定值的动作。由于手指位置及姿势目标修正输出rdΔ可由式(4)算出,因此,可实现将上述机器人手臂5的惯性M、粘性D、刚性K的机械阻抗的值控制为上述适当设定的设定值的动作。
下面,基于图7的流程图对基于以上原理的控制程序的实际动作步骤进行说明。
将由各关节部的编码器44计测的关节角度数据(关节变量矢量或关节角度矢量q)取入控制装置主体部11(步骤S1)。
接着,由逆运动学计算部57进行机器人手臂5的运动学计算所需要的雅可比矩阵Jr等的计算(步骤S2)。
接着,由正运动学计算部58根据来自机器人手臂5的关节角度数据(关节角度矢量q),计算机器人手臂5的当前的手指位置及姿势矢量r(步骤S3)。
接着,目标轨道计算部55基于事先存储于控制装置主体部11的存储器(未图示)的机器人手臂5的动作程序,计算机器人手臂5的手指位置及姿势目标矢量rd(步骤S4)。
接着,力推定部53根据电动机43的驱动电流值i、关节角度数据(关节角度矢量q)、关节角度误差补偿输出uqe,计算机器人手臂5的手指的等效手指外力Fext(步骤S5)。
接着,在步骤S6中,在控制参数设定部21中设定位置控制模式或阻抗控制模式,在位置控制模式的情况下,进入步骤S7,在阻抗控制模式时,向步骤S8进行处理。
接着,在步骤S7(阻抗计算部51的处理)中,在控制参数设定部21中设定成位置控制模式的情况下,由阻抗计算部51将手指位置及姿势目标修正输出rdΔ作成0矢量。其后,进入步骤S9。
在步骤S6中,在控制参数设定部21中设定成阻抗控制模式的情况下,在阻抗计算部51中,根据控制参数设定部21中设定的机械阻抗参数的惯性M、粘性D、刚性K、和关节角度数据(关节角度矢量q)、和由力推定机构53计算的施加在机器人手臂5的等效手指外力Fext,由阻抗计算部51计算手指位置及姿势目标修正输出rdΔ(步骤S8)。
接着,在位置误差补偿部56中,计算手指位置及姿势目标矢量rd与手指位置及姿势目标修正输出rdΔ的和即手指位置及姿势修正目标矢量rdm、和当前的手指位置及姿势矢量r的差即手指位置及姿势的误差re(步骤S9)。作为位置误差补偿部56的具体例,考虑PID补偿器。通过适当调整常数的对角矩阵即比例、微分、积分的三个放大项,则以位置误差收敛为0的方式进行控制。
接着,在近似逆运动学计算部57中,通过由近似逆运动学计算部57将步骤S2中计算的雅可比矩阵Jr的逆矩阵进行乘法运算,则由近似逆运动学计算部57将位置误差补偿输出ure从关于手指位置及姿势的误差的值变换为关于关节角度的误差的值即关节角度误差补偿输出uqe(步骤S10)。
接着,将角度误差补偿输出uqe从近似逆运动学计算部57通过输入输出IF24的D/A转换器赋予电动机驱动器25,通过使流过各自的电动机43的电流量变化来发生机器人手臂5的各关节轴的旋转运动(步骤S11)。
通过将以上的步骤S1~步骤S11重复执行成控制的计算环路,可以实现机器人手臂5的动作的控制,即可以实现将机器人手臂5的机械阻抗的值控制为上述适当设定的设定值的动作。
通过以上的动作步骤S20~步骤S28及步骤S1~步骤S11,根据作业顺序信息和其作业的进度信息,另外,根据其作业的工序中在机器人手臂5的周边动作的烹调装置6的状况,设定控制参数,根据其参数,实现机器人手臂5的作业。
如上所述,具备作业数据库20、控制参数设定部21、进度管理部29、控制部22,由此在人4操纵机器人手臂5的情况下,在人4希望机器人手臂5移动的情况下,可以迅速地使其移动,另外,基于作业中的食品等的状况,从刚性低的阻抗控制的状态过渡到刚性高的阻抗控制的状态,由此既可以防止人4造成的因机器人手臂5的失误动作而压坏食品,又可以防止食品飞溅到锅的外面。
另外,人4因作业时间长而疲劳,在机器人手臂5上,失误动作的可能性增大,因此,根据经过时间,从刚性低的阻抗控制的状态过渡到刚性高的阻抗控制的状态,由此可以防止疲劳造成的机器人手臂5的失误动作。
(第二实施方式)
本发明第二实施方式的机器人手臂5的控制装置105的基本构成和第一实施方式的情况同样,因此省略共同部分的说明,以下,只对不同的部分进行详细地说明。
图8是表示构成第一机器人系统1或第二机器人系统2的控制装置105和控制对象即机器人手臂5(第一或第二机器人手臂5-1或5-2)的详细构成的图。
输入输出IF24、电动机驱动器25、机器人手臂5、控制部22、进度管理部29、显示部9和第一实施方式的情况同样,因此省略其说明。
由作业信息收集部23的数据输入IF26,将关于和机器人手臂5协作的人4的利手等的人4的特性的信息(例如,关于作业特性的信息)输入,并存储在作业数据库20的作业状态信息数据库45。
另外,由作业信息收集部23的图像识别部27,从用于拍摄人4和机器人手臂5协作作业的状态的摄像机等图像拍摄装置12的图像数据中,进行图像识别,收集操作机器人手臂5的人4的位置信息,或收集人4的手指上把持有烹调器具10等与否的信息,向作业数据库20的作业状态信息数据库45输出。
下面,对作业数据库20的详细进行说明。
作业数据库20的构成具备:图3所示的机器人手臂5和人4的作业顺序信息数据库17、进度信息数据库19、预存储有关于操纵图4所示的机器人系统1或2的人4的协作作业状态的信息的作业状态信息数据库45。图3和第一实施方式的情况同样,因此省略其说明。
关于人4的作业状态的信息如图4所示,作为一例,构成具有:作为识别人4的人识别信息之一例的ID号码、关于相当于ID号码的人4的年龄或性别、及姓名的信息,此外还有表示人4的利手的手指位置、人4用利手把持有烹调器具10等与否的信息、关于人4的利手的信息、表示人4履行作业时的能力的技能信息。这些信息进行预测、评价,且作成数据库,并储存在作业数据库20。
人4的识别可以在人4上装设RF标签,将识别号码作成ID号码而提取,也可以由人4在作业前将识别号码(ID号码)从数据输入IF26输入作业数据库20。另外,关于人4的利手的信息也可以由人4从数据输入IF26在作业前输入作业数据库20。另外,在摄像机等图像拍摄装置12的图像数据和预先记录的人4的手的图像数据之间,在图像识别部27,由图像识别部27进行模型匹配处理,由图像识别部27提取人4的手指的位置,另外,在把持的物体上装设RFID标签,并由图像识别部27算出把持物体的位置,在把持物体的位置与手指的位置重合的情况下,由图像识别部27判断为已把持。
人4的技能信息由作业ID号码和技能等级构成,将履行显示作业ID号码的作业时的能力表示成5个级别。“等级1”表示技能最低,“等级5”表示技能最高。例如,图4中,ID号码2为10岁的孩子,以作业ID0001即烹调作业为等级1,表示烹调作业的能力低。技能信息由人4在作业前从数据输入IF26输入作业数据库20。
控制参数设定部21基于作业顺序信息和进度信息和人4的作业状态,设定机器人手臂5的控制参数。作为一例,在人4进行图3所示的烹调作业的情况下,如工序ID0008的指示,在第二机器人手臂5-2以位置控制模式进行搅和作业时,在人4品尝锅3A中的料理的口味的情况下,或为了向锅3A中新投入食品,有时中止搅和作业。在其情况下,从数据输入IF26输入停止命令,当将其停止命令经由进度管理部29及作业数据库20或从进度管理部29直接输入控制参数设定部21时,从控制参数设定部21经由控制部22使第二机器人手臂5-2的作业停止,并且控制参数设定部21在停止作业时,基于后述的人4的作业状态,设定用于使第二机器人手臂5-2退避到适当的位置的参数。
具体而言,在图10A的位置(由第二机器人手臂5-2的手部30把持的烹调器具10位于锅3A的中央部的状态),将来自人4的停止命令输入数据输入IF26,从数据输入IF26经由进度管理部29将上述停止命令输入控制参数设定部21,从控制参数设定部21经由控制部22使第二机器人手臂5-2的搅和停止,在这种情况下,在图10A的位置,第二机器人手臂5-2或安装于其上的勺子等烹调器具10成为人4的品尝口味等作业的障碍。因此,控制参数设定部21由从进度管理部29及作业数据库20得到的作业顺序信息得知,通过上述停止命令而中止了搅和作业,因此,以从图像识别部27经由作业数据库20得到的图像识别结果的信息为基础,从图4的人4的手指位置推定人4的位置,如图10B所示,设定用于使第二机器人手臂5-2向无人4的方向退避的退避位置(例如,由第二机器人手臂5-2的手部30把持的烹调器具10在锅3A的周边且位于壁面7a侧的状态的退避位置)的目标轨道。目标轨道和第一实施方式同样,为各时间(t=0、t=t1、t=t2、…)下的每一测点的位置(rd0、rd1、rd2、…)信息,根据人4的位置由控制参数设定部21算出,并向控制部22输出。在控制部22中,基于来自控制参数设定部21的算出数据,通过位置控制模式,使第二机器人手臂5-2退避到规定的位置。
另外,控制参数设定部21可以根据图4的人4的利手信息和作业顺序信息,设定用于使第二机器人手臂5-2退避到更适当的位置的参数。
具体而言,例如,在中止搅和作业时,在图14A的位置,第二机器人手臂5-2或安装于其手部30的勺子等烹调器具10成为人4的品尝口味等作业的障碍。在其情况下,如图14B及图14C所示,在人4使用右利手的情况(人4的利手为右手的情况)下,可以按照便于进行下面的工序的方式,设定用于使安装于第二机器人手臂5-2的手部30的烹调器具10退避到从人4看相对于锅3A的中央的虚线在右侧的退避位置的目标轨道(参照图14C的实线圆)。反之,在人4使用左利手的情况(人4的利手为左手的情况)下,可以按照便于进行下面的工序的方式,设定用于使安装于第二机器人手臂5-2的手部30的烹调器具10退避到从人4看相对于锅3A的中央的虚线在左侧的退避位置的目标轨道(参照图14C的虚线圆)。
另外,也可以根据人4的手的把持状态的信息,设定用于使第二机器人手臂5-2退避到更适当的位置的参数。
具体而言,例如,在中止搅和作业时,在图15A的位置,第二机器人手臂5-2或安装于其手部30的勺子等烹调器具10成为人4的投入新的食品等作业的障碍。因此,如图15B及图15C所示,设定用于使安装于第二机器人手臂5-2的手部30的烹调器具10向人4未把持盛有新食品的器皿88的手的方向(从人4看相对于锅3A的中央的虚线在左侧)退避的退避位置的目标轨道(参照图15C的实线圆)。
另外,根据人4的技能信息,设定用于使第二机器人手臂5-2退避到更适当的位置的参数。
具体而言,例如,在烹调作业的技能低的孩子的情况下,以动作比技能高的大人迟缓的方式,设定第二机器人手臂5-2的退避动作时的目标轨道。例如,目标轨道和第一实施方式同样,为各时间(t=0、t=t1、t=t2、…)下的每一测点的位置(rd0、rd1、rd2、…)信息,因此,只要由控制参数设定部21将各时间(t=0、t=t1、t=t2、…)设定为比大人大的值即可。这样,就能够以比大人迟缓的动作使第二机器人手臂5-2退避,对于孩子来说是安全的。
另外,在中止技能低的孩子的搅和作业时使第二机器人手臂5-2退避的情况下,通过由控制参数设定部21较高地设定式(1)~(3)的修正值,能够以增大的方式设定粘性D及刚性K。这样,就会在第二机器人手臂5-2的行动上产生阻力感或生硬,第二机器人手臂5-2难以行动,通过防止第二机器人手臂5-2因孩子失误而迅速地移动,可以既防止因失误而压坏食品,又防止水或肉羹汁洒在锅3A的外面。
这样,通过控制参数设定部21基于关于存储于作业状态信息数据库45的人4的作业状态的信息或由图像识别部27采集的信息等设定控制参数,可以使第二机器人手臂5-2退避到人4易作业的位置,可以提供便利性良好的机器人手臂5及机器人手臂5的控制装置105等。
(第三实施方式)
本发明第三实施方式的机器人手臂5的控制装置105的基本构成和第一实施方式及第二实施方式的情况同样,因此省略共同部分的说明,以下,只对不同的部分进行详细地说明。
图11是表示构成第一机器人系统1或第二机器人系统2的控制对象即机器人手臂5和其控制装置105的详细构成的图。
输入输出IF24、电动机驱动器25、机器人手臂5、进度管理部29、显示部9、作业信息收集部23和第一实施方式的情况同样,因此省略其说明。
在进行图3所示的烹调作业的情况下,如工序ID0008指示所示,在第二机器人手臂5-2以位置控制模式如图9A所示进行搅和作业时,在人4品尝锅3A中的料理的口味的情况下,或为了向锅3A中新投入食品,有时中止搅和作业。在其情况下,从数据输入IF26输入停止命令,当将其停止命令从进度管理部29输入控制参数设定部21时,从控制参数设定部21经由控制部22使第二机器人手臂5-2的作业停止,并且控制参数设定部21在停止作业时,将第二机器人手臂5-2的控制模式从位置控制模式切换为阻抗控制模式的指令向控制部22输出。
当基于该输出由控制部22,将第二机器人手臂5-2的控制模式在停止作业时从位置控制模式切换为阻抗控制模式时,只要人4对第二机器人手臂5-2施力,就可以使第二机器人手臂5-2向施其力的方向移动,因此,如图1A所示,人4通过直接把持第二机器人手臂5-2并向希望使其退避的位置施力,可以使第二机器人手臂5-2移动到不妨碍品尝口味或新的食品投入作业等的退避位置。其时,控制参数设定部21当如图12所示人4施力(图12的正中间一栏表示力的大小。意思是数字越大力越大)时,将其时的第二机器人手臂5-2的手部30的位置即手指位置和目标位置(姿势目标矢量rd)(图12的右端的一栏表示手指位置的当前位置的座标和目标位置的座标。)和其时的时刻一同存储在作业数据库20的作业状态信息数据库45。
接着,在人4和下述同样地在阻抗控制模式下使第二机器人手臂5-2退避的情况下,利用比较机构之一例的比较部15,将人4对第二机器人手臂5-2施的力和其时的第二机器人手臂5-2的手指位置、与存储于作业状态信息数据库45的力和手指位置,按时间序列的顺序进行比较,在两者之差在预定的误差范围内的情况下,视为两者一致,将一致信息和时刻一同向控制参数设定部21输出。控制参数设定部21以来自上述比较部15的一致信息为基础,将第二机器人手臂5-2的控制模式从阻抗控制模式变更为位置控制模式,另外,以位置控制模式的目标位置(退避位置)为由作业数据库20存储的第二机器人手臂5-2的手指位置,并向控制部22输出。因此,基于来自控制参数设定部21的输出,由控制部22将第二机器人手臂5-2的控制模式从阻抗控制模式切换为位置控制模式。在将第二机器人手臂5-2变更为位置控制模式以后,即使人4不操作第二机器人手臂5-2,也可以使第二机器人手臂5-2自动地在控制部22的控制下退避到退避位置。
如上所述,当人4一次使第二机器人手臂5-2退避到不碍事的位置后,在接着使其退避的情况下,只需要小的力,第二机器人手臂5-2此后就可以在位置控制模式下自动地退避。
另外,在想要从退避后的位置恢复到原来的位置的情况下,通过比较部15将退避后的实际位置和存储于作业状态信息数据库45的位置进行比较,在存储的数据和时间序列倒着一致的情况下,由比较部15判断为想要从退避场所返回,将存储的状态信息按时间序列的倒顺序,且将手指位置和力信息向控制参数设定部21输出。
如上所述,当人4使第二机器人手臂5-2在阻抗控制模式下退避到人4易作业的位置时,在接着使其退避的情况下,人4只施以小的力,就可以使第二机器人手臂5-2自动地退避到人4易作业的位置,作业效率高,可以提供实现易操作的机器人控制的控制装置。
(第四实施方式)
本发明第四实施方式的机器人手臂的控制装置的基本构成和第一实施方式的情况同样,因此省略共同部分的说明,以下,只对不同的部分进行详细地说明。
图17是表示构成擦拭扫除作业的机器人系统1或机器人系统2的控制装置主体部11和控制对象即机器人手臂5的详细构成的图。
输入输出IF24、电动机驱动器25、机器人手臂5、进度管理部29、显示部9、控制部22、进度管理部29和第一实施方式的情况同样,因此省略其说明。
图18表示擦拭扫除作业的作业数据库20。具体地和第一实施方式同样,构成具有:作为识别作业的作业识别信息之一例的作业ID号码、作为识别其作业中的各个工序的工序识别信息之一例的工序ID号码、与相当于工序ID号码的工序相关的信息、关于其工序中的对象物的对象信息、进行其工序的操作信息、以及其工序所需要的预计的时间即预测时间、其工序中进行烹调的分量。图18中,作业ID0002中的工序ID0001具有“请将海绵状擦子安装在第二机器人手臂5-2上”,作为作业的状态,为图19A的状态,即人4将海绵状擦子46安装在第二机器人手臂5-2的手部30上的状态。另外,工序ID0002具有“请按下擦拭扫除开始按钮”,成为图19B的状态,即人4按压操作盘13的擦拭扫除开始按钮的状态。
控制参数设定部21基于作业顺序信息和关于进度的信息,进行将机器人手臂5的控制模式在位置控制模式和阻抗控制模式之间切换的设定。
位置控制模式和第一实施方式同样地,为机器人手臂5基于目标轨道生成部55的手指位置及姿势目标矢量指令而工作的模式,具体地为进行搅和作业或擦拭扫除等作业时动作的模式。
阻抗控制模式为机器人手臂5根据从人4等施加在机器人手臂5的力而工作的模式,例如,为在如图1B所示人4和机器人手臂5协作进行搬运的作业的情况下,或在如图1A所示人4直接拿着机器人手臂5将机器人手臂5引导到作业场所时使其工作的模式。
例如图18所示,在人4和第二机器人手臂5-2协作进行擦拭扫除作业的情况下,即,如工序ID0002的指示所示,在第二机器人手臂5-2以位置控制模式将海绵状擦子46按压在作业台7的表面进行擦拭扫除作业时,人4为了使用由第二机器人手臂5-2正在进行擦拭扫除作业的场所(例如,水槽等),有时中止擦拭扫除作业。在那种情况下,从数据输入IF26输入停止命令,当将其停止命令从进度管理部29输入控制参数设定部21时,从控制参数设定部21经由控制部22使第二机器人手臂5-2的作业停止,并且控制参数设定部21在停止作业时,将第二机器人手臂5-2的控制模式从位置控制模式切换到阻抗控制模式的指令向控制部22输出。因此,基于来自控制参数设定部21的输出,由控制部22将第二机器人手臂5-2的控制模式从位置控制模式切换到阻抗控制模式。
其结果是,在由中止命令停止的第二机器人手臂5-2把持的海绵状擦子46碍事时,通过将第二机器人手臂5-2的控制模式切换到阻抗控制模式,则只是人4直接把持第二机器人手臂5-2并使其移动,就可以简单地将第二机器人手臂5-2退避到退避位置。
如上所述,具备作业数据库20、控制参数设定部21、进度管理部29、控制部22,由此,在人4操纵机器人手臂5的情况下,在人4想使机器人手臂5移动的情况下,可以迅速地使其移动。
另外,在上述第一~第四实施方式中,作业顺序信息通过互联网28进行收集,但也可以从SD卡等存储器或DVD等媒介进行收集。
另外,上述第一~第四实施方式的控制参数设定部21设定中止搅和后的机械阻抗参数,但也可以基于直接示教等人4操作机器人手臂5的作业,由控制参数设定部21设定。
另外,在上述第一~第四实施方式中,在机器人手臂5的控制装置105中,也可以通过调整位置误差补偿部56的放大项,来实现将上述机器人手臂5的机械阻抗的值模拟控制为有别于手指的方向的机械阻抗设定值。
另外,上述第二实施方式中,也可以在人4的技能低的情况下,将作业顺序信息数据库17的预测时间设定成大的值。
另外,上述实施方式中,以机器人手臂5为例进行了说明,但本发明不局限于臂,也可以应用于通过车轮而移动的移动机器人,或两足步行机器人、多足步行机器人等,关于移动机器人和人的接触,发挥同样的效果。
另外,通过将上述种种实施方式中任意的实施方式适当组合,可以实现各自具有的效果。
产业上的可利用性
本发明应用于作为进行人和家庭用机器人等机器人协作进行家庭内作业时的机器人手臂的动作控制的机器人手臂的控制装置及控制方法、具有机器人手臂的控制装置的机器人、及机器人手臂的控制程序。另外,不局限于家庭用机器人,也可适用于工业用机器人或生产设备等的可动机构的机器人手臂的控制装置及控制方法、具有机器人手臂的控制装置的机器人、及机器人手臂的控制程序。
本发明参照附图对优选的实施方式进行了充分的记述,但对该技术熟练的人们来说,可进行种种变形或修正是不言而喻的。那种变形或修正只要不脱离附带的本发明的请求的范围,应该理解为包括在其中。
Claims (11)
1.一种机器人手臂的控制装置,其具有:
作业顺序信息采集机构,其采集包括操作信息的家庭内作业的顺序信息,由人和所述机器人手臂协作的多道工序构成家庭内作业,该操作信息对所述多道工序中各个工序中(i)所述机器人手臂单体进行的作业工序、和(ii)所述人和所述机器人手臂联动进行的作业工序中任一工序进行识别;
进度管理机构,其基于由所述作业顺序信息采集机构采集到的所述家庭内作业的顺序信息,管理所述人和所述机器人手臂协作进行的所述家庭内作业的进度信息;
控制参数设定机构,其基于所述家庭内作业的顺序信息和所述进度管理机构管理的所述家庭内作业的进度信息,(i)在所述机器人手臂单体进行的作业工序的情况下,以位置控制模式控制所述机器人手臂的方式,设定所述机器人手臂的控制参数,(ii)在所述人和所述机器人手臂联动进行的作业工序的情况下,以所述机器人手臂随着所述人的力而移动的控制模式进行控制的方式,设定所述机器人手臂的控制参数;
控制机构,其基于由所述控制参数设定机构所设定的所述控制参数,控制所述机器人手臂的动作。
2.如权利要求1所述的机器人手臂的控制装置,其中,
所述家庭内作业的顺序信息为记述有烹调方法的烹调作业的顺序信息,包括烹调方法的顺序信息和成为所述烹调方法的烹调作业的对象的食品信息,
所述控制参数设定机构在以所述机器人手臂随着所述人的力而移动的控制模式进行控制的情况下,基于所述烹调作业的进度信息,使将成为所述烹调作业的对象的所述食品信息设定为易碎或具有粘性时的所述机器人手臂的机械阻抗的值、与将成为所述烹调作业的对象的所述食品信息设定为不易碎或粘性少时的所述机器人手臂的机械阻抗的值相比,分别高地设定粘性及刚性。
3.如权利要求1所述的机器人手臂的控制装置,其中,
通过所述控制参数设定机构和所述控制机构控制与所述机器人手臂不同的另一机器人手臂的动作,且独立于所述机器人手臂进行控制,
所述家庭内作业的顺序信息为记述有烹调方法的烹调作业的顺序信息,所述烹调作业的顺序信息还具有所述多个机器人手臂各自的操作对象的有无信息,
所述控制参数设定机构在以所述机器人手臂随着所述人的力而移动的控制模式进行控制的情况下,且在所述多个机器人手臂中一机器人手臂为成为所述操作对象的机器人手臂、同时另一机器人手臂为未成为所述操作对象的机器人手臂的情况下,将未成为所述操作对象的机器人手臂的机械阻抗的值设定为,与成为所述操作对象的机器人手臂的机械阻抗的值相比粘性及刚性升高。
4.如权利要求1所述的机器人手臂的控制装置,其中,
所述家庭内作业的顺序信息为记述有烹调方法的烹调作业的顺序信息,所述烹调作业的顺序信息的进度信息还具有所述顺序信息中包含的多道烹调工序的经过时间信息,
所述控制参数设定机构在以所述机器人手臂随着所述人的力而移动的控制模式进行控制的情况下,分别与所述经过时间的合计值的大小成比例地设定所述机器人手臂的机械阻抗值的粘性及刚性的大小。
5.如权利要求1所述的机器人手臂的控制装置,其中,
所述作业顺序信息采集机构除采集包括所述操作信息的所述家庭内作业的顺序信息和所述家庭内作业的进度信息以外,在所述操作信息为所述人和所述机器人手臂联动进行的作业工序的情况下,还采集和所述机器人手臂协作的所述人的家庭内作业状态的信息即作业状态信息,
所述控制参数设定机构基于所述家庭内作业的顺序信息、所述家庭内作业的进度信息以及所述作业状态信息,设定所述控制参数。
6.如权利要求5所述的机器人手臂的控制装置,其中,
所述作业状态信息包括关于所述人的位置的信息、或关于所述人的利手的信息、或所述人的利手的手指的把持状态、或关于所述人的履行家庭内作业时的能力即技能信息的信息,
在所述作业状态信息包括关于所述人的利手的信息时,所述控制参数设定机构以使所述机器人手臂向所述人的利手的方向移动的方式设定控制参数,
另外,在所述作业状态信息包括所述人的利手的手指的把持状态时,所述控制参数设定机构根据所述人的利手的手指的把持状态以使所述机器人手臂向未把持的方向移动的方式进行设定,
进而,在所述作业状态信息包括关于所述人的履行家庭内作业时的能力即技能信息的信息时,所述控制参数设定机构在所述技能信息低的情况下,使所述机器人手臂的机械阻抗的粘性及刚性比所述技能信息高的情况高。
7.如权利要求5所述的机器人手臂的控制装置,其中,
所述作业状态信息包括关于所述人和所述机器人手臂协作进行所述家庭内作业时施加的力的信息、和根据该力而移动的所述机器人手臂的手指位置,还具有比较机构,该比较机构将关于所述力的信息及所述机器人手臂的所述手指位置、和当前的关于所述人的力的信息及所述机器人手臂的所述手指位置按时间序列进行比较,
在由所述比较机构比较为两者一致的情况下,由所述控制参数设定机构,将所述机器人手臂的控制模式从所述机器人手臂随着所述人的力而移动的控制模式切换到所述位置控制模式。
8.一种机器人手臂的控制方法,其中,
由作业顺序信息采集机构采集包括操作信息的家庭内作业的顺序信息,由人和所述机器人手臂协作的多道工序构成家庭内作业,该操作信息对所述多道工序中各个工序中(i)所述机器人手臂单体进行的作业工序、和(ii)所述人和所述机器人手臂联动进行的作业工序中任一工序进行识别,进而由进度管理机构基于由所述作业顺序信息采集机构采集到的所述家庭内作业的顺序信息,管理所述人和所述机器人手臂协作进行的所述家庭内作业的进度信息,
由控制参数设定机构,基于所述家庭内作业的顺序信息和所述进度管理机构管理的所述家庭内作业的进度信息,(i)在所述机器人手臂单体进行的作业工序的情况下,以位置控制模式控制所述机器人手臂的方式,设定所述机器人手臂的控制参数;(ii)在所述人和所述机器人手臂联动进行的作业工序的情况下,以所述机器人手臂随着所述人的力而移动的控制模式进行控制的方式,设定所述机器人手臂的控制参数,
由控制机构基于所述设定的控制参数,控制所述机器人手臂的动作。
9.一种机器人,其具有:
机器人手臂;
控制所述机器人手臂的动作的权利要求1或2所述的机器人手臂的控制装置。
10.一种机器人手臂的控制方法,其是利用程序通过计算机来执行对机器人手臂进行控制的方法,其具有:
采集包括操作信息的家庭内作业的顺序信息的步骤,由人和所述机器人手臂协作的多道工序构成家庭内作业,该操作信息对所述多道工序中各个工序中(i)所述机器人手臂单体进行的作业工序、和(ii)所述人和所述机器人手臂联动进行的作业工序中任一工序进行识别;
管理进度信息的步骤,基于采集到的所述家庭内作业的顺序信息,管理所述人和所述机器人手臂协作进行的所述家庭内作业的进度信息;
设定所述机器人手臂的控制参数的步骤,基于所述采集家庭内作业的顺序信息的步骤采集到的所述家庭内作业的顺序信息和管理所述进度信息的步骤管理的所述家庭内作业的进度信息,(i)在所述机器人手臂单体进行的作业工序的情况下,以位置控制模式控制所述机器人手臂的方式,设定所述机器人手臂的控制参数,(ii)在所述人和所述机器人手臂联动进行的作业工序的情况下,以所述机器人手臂随着所述人的力而移动的控制模式进行控制的方式,设定所述机器人手臂的控制参数;
控制所述机器人手臂的动作的步骤,基于所述设定的控制参数,控制所述机器人手臂的动作。
11.一种控制机器人手臂的集成电路,其具有:
作业顺序信息采集机构,其采集包括操作信息的家庭内作业的顺序信息,由人和所述机器人手臂协作的多道工序构成家庭内作业,该操作信息对所述多道工序中各个工序中(i)所述机器人手臂单体进行的作业工序、和(ii)所述人和所述机器人手臂联动进行的作业工序中任一工序进行识别;
进度管理机构,其基于由所述作业顺序信息采集机构采集到的所述家庭内作业的顺序信息,管理所述人和所述机器人手臂协作进行的所述家庭内作业的进度信息;
控制参数设定机构,其基于所述家庭内作业的顺序信息和所述进度管理机构管理的所述家庭内作业的进度信息,(i)在所述机器人手臂单体进行的作业工序的情况下,以位置控制模式控制所述机器人手臂,设定所述机器人手臂的控制参数,(ii)在所述人和所述机器人手臂联动进行的作业工序的情况下,以使所述机器人手臂随着所述人的力而移动的控制模式进行控制的方式,设定所述机器人手臂的控制参数;
控制机构,其基于由所述控制参数设定机构所设定的所述控制参数,控制所述机器人手臂的动作。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP176990/2007 | 2007-07-05 | ||
JP2007176990 | 2007-07-05 | ||
PCT/JP2008/001668 WO2009004772A1 (ja) | 2007-07-05 | 2008-06-26 | ロボットアームの制御装置及び制御方法、ロボット、及び制御プログラム |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101687321A CN101687321A (zh) | 2010-03-31 |
CN101687321B true CN101687321B (zh) | 2012-08-08 |
Family
ID=40225837
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2008800040942A Active CN101687321B (zh) | 2007-07-05 | 2008-06-26 | 机器人手臂的控制装置及控制方法、机器人及控制程序 |
Country Status (4)
Country | Link |
---|---|
US (1) | US7751938B2 (zh) |
JP (1) | JP4361132B2 (zh) |
CN (1) | CN101687321B (zh) |
WO (1) | WO2009004772A1 (zh) |
Families Citing this family (45)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4836872B2 (ja) * | 2007-05-31 | 2011-12-14 | 株式会社東芝 | 制御装置、制御方法、プログラム及びロボット |
CN101737603B (zh) * | 2008-11-10 | 2011-11-30 | 鸿富锦精密工业(深圳)有限公司 | 万向关节 |
JP5083194B2 (ja) * | 2008-12-18 | 2012-11-28 | 株式会社デンソーウェーブ | ロボットのキャリブレーション方法及びロボットの制御装置 |
JP4568795B2 (ja) * | 2009-01-09 | 2010-10-27 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、ロボット、ロボットアームの制御プログラム、並びに、集積電子回路 |
WO2010095106A1 (en) | 2009-02-20 | 2010-08-26 | Actelion Pharmaceuticals Ltd | Solid forms of ( 2r) -2- { ( is ) -6, 7 -dimethoxy- 1- [2- (4-triflu0r0methyl-phenyl) -ethyl] -3, 4-dihydr0-1h -isoquinolin-2-yl} -n-methyl-2-phenyl-acetamide hydrochloride |
JP5369754B2 (ja) * | 2009-02-24 | 2013-12-18 | 日本精工株式会社 | マニピュレータの関節部用軸受ユニット |
JP5502348B2 (ja) * | 2009-03-12 | 2014-05-28 | ファナック株式会社 | シミュレーション方法 |
CN102292194B (zh) | 2009-08-21 | 2015-03-04 | 松下电器产业株式会社 | 机器人手臂的控制装置及控制方法、装配机器人、机器人手臂的控制程序及机器人手臂的控制用集成电路 |
WO2011021376A1 (ja) * | 2009-08-21 | 2011-02-24 | パナソニック株式会社 | ロボットアームの制御装置及び制御方法、家事ロボット、ロボットアームの制御プログラム、及び、ロボットアーム制御用集積電子回路 |
CN102470531B (zh) * | 2010-01-04 | 2016-01-20 | 松下知识产权经营株式会社 | 机器人、机器人的控制装置及控制方法 |
JP5423441B2 (ja) * | 2010-02-03 | 2014-02-19 | 株式会社安川電機 | 作業システム、ロボット装置、機械製品の製造方法 |
JP5032716B2 (ja) | 2010-08-31 | 2012-09-26 | パナソニック株式会社 | マスタースレーブロボットの制御装置及び制御方法、並びに、制御プログラム |
CN103118842A (zh) * | 2011-03-17 | 2013-05-22 | 松下电器产业株式会社 | 机器人、机器人的控制装置、控制方法以及控制程序 |
DE102012102294B4 (de) * | 2011-03-18 | 2015-03-19 | Denso Wave Inc. | Verfahren zum Erfassen eines Achsenabstand-Versatzes eines 6-Achs-Roboters |
US8843235B2 (en) | 2012-01-13 | 2014-09-23 | Toyota Motor Engineering & Manufacturing North America, Inc. | Robots, computer program products, and methods for trajectory plan optimization |
US9014850B2 (en) | 2012-01-13 | 2015-04-21 | Toyota Motor Engineering & Manufacturing North America, Inc. | Methods and computer-program products for evaluating grasp patterns, and robots incorporating the same |
US9014857B2 (en) * | 2012-01-13 | 2015-04-21 | Toyota Motor Engineering & Manufacturing North America, Inc. | Methods and computer-program products for generating grasp patterns for use by a robot |
US8447419B1 (en) | 2012-05-02 | 2013-05-21 | Ether Dynamics Corporation | Pseudo-genetic meta-knowledge artificial intelligence systems and methods |
CN102681458A (zh) * | 2012-05-31 | 2012-09-19 | 华中科技大学 | 炒菜控制方法及装置 |
CN104334544B (zh) | 2012-06-04 | 2016-10-19 | 埃科特莱茵药品有限公司 | 苯并咪唑脯氨酸衍生物 |
EA201500399A1 (ru) | 2012-10-10 | 2015-09-30 | Актелион Фармасьютиклз Лтд. | Антагонисты рецептора орексина, которые представляют собой производные [орто-би-(гетеро)арил]-[2-(мета-би-(гетеро)арил)пирролидин-1-ил]метанона |
WO2014129110A1 (ja) * | 2013-02-25 | 2014-08-28 | パナソニック株式会社 | ロボット、ロボットの制御装置及び制御方法、並びに、ロボット用制御プログラム |
CN103268074B (zh) * | 2013-04-28 | 2016-04-13 | 上海华力微电子有限公司 | 程式控制方法以及程式控制系统 |
CN104827469B (zh) * | 2013-10-10 | 2016-10-19 | 精工爱普生株式会社 | 机器人控制装置、机器人系统、机器人以及机器人控制方法 |
TWI547355B (zh) * | 2013-11-11 | 2016-09-01 | 財團法人工業技術研究院 | 人機共生安全監控系統及其方法 |
KR20160124770A (ko) * | 2014-02-20 | 2016-10-28 | 엠비엘 리미티드 | 로봇식 요리용 키친에서의 음식 준비를 위한 방법 및 시스템 |
US10324004B2 (en) * | 2015-04-15 | 2019-06-18 | The Boeing Company | Methods and devices for adaptive autonomous polynomial interpolation of time series data |
DE102016009030B4 (de) | 2015-07-31 | 2019-05-09 | Fanuc Corporation | Vorrichtung für maschinelles Lernen, Robotersystem und maschinelles Lernsystem zum Lernen eines Werkstückaufnahmevorgangs |
JP6240689B2 (ja) * | 2015-07-31 | 2017-11-29 | ファナック株式会社 | 人の行動パターンを学習する機械学習装置、ロボット制御装置、ロボットシステム、および機械学習方法 |
CN105182815A (zh) * | 2015-08-11 | 2015-12-23 | 小米科技有限责任公司 | 设备控制方法及装置 |
CN105741624A (zh) * | 2016-05-16 | 2016-07-06 | 苏州金建达智能科技有限公司 | 一种家庭用智能儿童教学机器人 |
CN106003049B (zh) * | 2016-07-05 | 2018-06-12 | 李亚楠 | 人-机协作系统的控制方法 |
US10427305B2 (en) * | 2016-07-21 | 2019-10-01 | Autodesk, Inc. | Robotic camera control via motion capture |
JP2018126810A (ja) * | 2017-02-06 | 2018-08-16 | 川崎重工業株式会社 | ロボットシステム及びロボット対話方法 |
US11607810B2 (en) | 2018-09-13 | 2023-03-21 | The Charles Stark Draper Laboratory, Inc. | Adaptor for food-safe, bin-compatible, washable, tool-changer utensils |
JP7230412B2 (ja) * | 2018-10-04 | 2023-03-01 | ソニーグループ株式会社 | 情報処理装置、情報処理方法およびプログラム |
USD926507S1 (en) | 2018-10-16 | 2021-08-03 | Sony Corporation | Kitchen with robot manipulator |
JP7172485B2 (ja) * | 2018-11-15 | 2022-11-16 | 株式会社Ihi | ロボット制御装置 |
DE102019102427B4 (de) * | 2019-01-31 | 2022-02-10 | Franka Emika Gmbh | Koordination von Bahnen zweier Robotermanipulatoren |
EP3747604B1 (en) * | 2019-06-07 | 2022-01-26 | Robert Bosch GmbH | Robot device controller, robot device arrangement and method for controlling a robot device |
KR102214933B1 (ko) * | 2019-06-11 | 2021-02-10 | 오정석 | 저유조 일체형 밸브박스 |
JP6847168B2 (ja) * | 2019-07-05 | 2021-03-24 | 株式会社ブロードリーフ | 動画再生装置及び動画再生方法 |
KR20190104488A (ko) * | 2019-08-21 | 2019-09-10 | 엘지전자 주식회사 | 인공 지능을 이용하여, 오브젝트의 이동을 관리하는 인공 지능 로봇 및 그의 동작 방법 |
US11945117B2 (en) | 2021-03-10 | 2024-04-02 | Samsung Electronics Co., Ltd. | Anticipating user and object poses through task-based extrapolation for robot-human collision avoidance |
US11833691B2 (en) | 2021-03-30 | 2023-12-05 | Samsung Electronics Co., Ltd. | Hybrid robotic motion planning system using machine learning and parametric trajectories |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004090099A (ja) * | 2002-08-29 | 2004-03-25 | National Institute Of Advanced Industrial & Technology | ロボットマニピュレータによる物体操作方法および装置 |
US6895286B2 (en) * | 1999-12-01 | 2005-05-17 | Yamaha Hatsudoki Kabushiki Kaisha | Control system of optimizing the function of machine assembly using GA-Fuzzy inference |
WO2006043396A1 (ja) * | 2004-10-19 | 2006-04-27 | Matsushita Electric Industrial Co., Ltd. | ロボット装置 |
JP2007076807A (ja) * | 2005-09-14 | 2007-03-29 | Institute Of Physical & Chemical Research | パワーアシスト装置とその適応モデル予測制御方法 |
CN1984756A (zh) * | 2004-07-13 | 2007-06-20 | 松下电器产业株式会社 | 物品保持系统、机器人以及机器人控制方法 |
CN1982003A (zh) * | 2005-12-12 | 2007-06-20 | 本田技研工业株式会社 | 腿式移动机器人及其控制装置和控制方法 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05261683A (ja) * | 1992-03-19 | 1993-10-12 | Tokico Ltd | 工業用ロボット装置 |
JP3377740B2 (ja) | 1996-12-16 | 2003-02-17 | 株式会社三協精機製作所 | 力補助装置の制御方法及びこの方法を利用した制御装置 |
JP2000343478A (ja) | 1999-05-31 | 2000-12-12 | Tokico Ltd | 工業用ロボット |
JP2004180817A (ja) | 2002-12-02 | 2004-07-02 | National Institute Of Advanced Industrial & Technology | 生体信号を利用した作業支援マニピュレータシステム |
JP3868988B2 (ja) * | 2003-08-04 | 2007-01-17 | 松下電器産業株式会社 | 生活支援システム |
US20070061041A1 (en) * | 2003-09-02 | 2007-03-15 | Zweig Stephen E | Mobile robot with wireless location sensing apparatus |
JP4303602B2 (ja) * | 2004-01-09 | 2009-07-29 | 本田技研工業株式会社 | 顔面像取得システム |
JP2006198389A (ja) | 2004-12-22 | 2006-08-03 | Doshisha | ロボット、および、そのロボットとともに使用される携帯可能な記憶媒体 |
JP4456561B2 (ja) * | 2005-12-12 | 2010-04-28 | 本田技研工業株式会社 | 自律移動ロボット |
US8260463B2 (en) * | 2006-02-02 | 2012-09-04 | Kabushiki Kaisha Yaskawa Denki | Robot system |
-
2008
- 2008-06-26 US US12/525,233 patent/US7751938B2/en active Active
- 2008-06-26 WO PCT/JP2008/001668 patent/WO2009004772A1/ja active Application Filing
- 2008-06-26 JP JP2009521512A patent/JP4361132B2/ja active Active
- 2008-06-26 CN CN2008800040942A patent/CN101687321B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6895286B2 (en) * | 1999-12-01 | 2005-05-17 | Yamaha Hatsudoki Kabushiki Kaisha | Control system of optimizing the function of machine assembly using GA-Fuzzy inference |
JP2004090099A (ja) * | 2002-08-29 | 2004-03-25 | National Institute Of Advanced Industrial & Technology | ロボットマニピュレータによる物体操作方法および装置 |
CN1984756A (zh) * | 2004-07-13 | 2007-06-20 | 松下电器产业株式会社 | 物品保持系统、机器人以及机器人控制方法 |
WO2006043396A1 (ja) * | 2004-10-19 | 2006-04-27 | Matsushita Electric Industrial Co., Ltd. | ロボット装置 |
JP2007076807A (ja) * | 2005-09-14 | 2007-03-29 | Institute Of Physical & Chemical Research | パワーアシスト装置とその適応モデル予測制御方法 |
CN1982003A (zh) * | 2005-12-12 | 2007-06-20 | 本田技研工业株式会社 | 腿式移动机器人及其控制装置和控制方法 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2009004772A1 (ja) | 2010-08-26 |
US7751938B2 (en) | 2010-07-06 |
CN101687321A (zh) | 2010-03-31 |
US20100114371A1 (en) | 2010-05-06 |
JP4361132B2 (ja) | 2009-11-11 |
WO2009004772A1 (ja) | 2009-01-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101687321B (zh) | 机器人手臂的控制装置及控制方法、机器人及控制程序 | |
CN101909829B (zh) | 机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序、及机器人手臂控制用集成电子电路 | |
CN102229147B (zh) | 机器手控制装置及控制方法、机器人 | |
JP7358352B2 (ja) | 選択されたレシピに従って食品を自動的に調理するためのシステム及びその作動方法 | |
CN102056715B (zh) | 机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序及集成电子电路 | |
CN102300679A (zh) | 机器人手臂的控制装置及控制方法、机器人、机器人手臂的控制程序及机器人手臂控制用集成电路 | |
EP2322071A1 (en) | Control device and control method for cleaner, cleaner, control program for cleaner, and integrated electronic circuit | |
CN103126536B (zh) | 适用于全自动炒菜机的锅盖控制装置 | |
US20160362147A1 (en) | Dynamically stable stair climbing home robot | |
WO2006013829A1 (ja) | 物品運搬用ロボット、物品運搬システム、及び物品運搬方法 | |
CN104942803A (zh) | 机器人控制装置、机器人、机器人系统、示教方法及程序 | |
CN210354298U (zh) | 自动炒菜设备 | |
CN107315367A (zh) | 一种智能化厨房系统及其辅助烹饪装置 | |
US20140172143A1 (en) | Control apparatus and control method for robot arm, robot, control program for robot arm, and integrated electronic circuit | |
Cabrera et al. | An exploration of accessible remote tele-operation for assistive mobile manipulators in the home | |
CN107132787A (zh) | 厨房管家机器人烹饪控制方法及厨房管家机器人 | |
Al-nabhani et al. | Automated library system using SMS based pick and place robot | |
WO2007082037A2 (en) | Touchpad control of character actions in a virtual environment using gestures | |
Watanabe et al. | Cooking behavior with handling general cooking tools based on a system integration for a life-sized humanoid robot | |
US9955823B2 (en) | Autonomous chef | |
CN207281510U (zh) | 一种智能化厨房系统及其辅助烹饪装置 | |
CN201576370U (zh) | Plc智能实训装置 | |
CN209058760U (zh) | 一种炒菜机控制系统及炒菜机 | |
WO2021236942A1 (en) | System and method for robotic food and beverage preparation using computer vision | |
CN206465090U (zh) | 厨房管家机器人 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |