CN102015223B - 机械手及其控制方法 - Google Patents
机械手及其控制方法 Download PDFInfo
- Publication number
- CN102015223B CN102015223B CN200980105246.2A CN200980105246A CN102015223B CN 102015223 B CN102015223 B CN 102015223B CN 200980105246 A CN200980105246 A CN 200980105246A CN 102015223 B CN102015223 B CN 102015223B
- Authority
- CN
- China
- Prior art keywords
- movable link
- barrier
- arm
- manipulator
- joint
- 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.)
- Expired - Fee Related
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39082—Collision, real time collision avoidance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
- Y10T—TECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
- Y10T74/00—Machine element or mechanism
- Y10T74/20—Control lever and linkage systems
- Y10T74/20207—Multiple controlling elements for single controlled element
- Y10T74/20305—Robotic arm
- Y10T74/20329—Joint between elements
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种机械手,包括:臂(4);臂(6);保持部(8);将臂(4)和臂(6)可转动地连接的第一关节部(5);将臂(6)和保持部(8)可转动地连接的第二关节部(7);可驱动第一关节部(5)的第一关节驱动部;可驱动第二关节部(7)的第二关节驱动部;确定臂(4)和臂(6)中存在与障碍物碰撞的可能性的其中一个臂或与障碍物发生了碰撞的其中一个臂的构件确定部;以及控制第一关节驱动部和第二关节驱动部,以使由构件确定部确定的其中一个臂朝离开障碍物的方向转动,并且使另一个臂朝接近障碍物的方向转动的控制装置(22)。
Description
技术领域
本发明涉及一种机械手及其控制方法。
背景技术
关于避免向障碍物碰撞的技术,提出有各种各样的方案。
例如,在日本专利公开公报特开平9-207089号所公开的机械手中,在多关节结构体的前端设置有照相机,利用该照相机拍摄机械手的前端附近的图像,并且在检测出障碍物的情况下控制机械手的姿势以避开障碍物。
在以往的机械手中,若在进行姿势控制时检测出障碍物,则使流向驱动可动构件的驱动部的马达的电流方向反转,从而对臂施加反向的转矩。然后,通过该反向的转矩来避免碰撞。一般,在机械手中,为了获得驱动转矩,在马达输出部组装有减速机构,马达工作时的转速较高。因此,存在马达从减速到反转为止的时间变长的倾向。即,在以往的机械手中,由于直到可动构件的反转为止的时间较长,所以存在避免碰撞或碰撞时的反转动作的响应性不足的问题。
发明内容
本发明鉴于上述问题,其目的在于提供一种能够迅速地进行可动构件的反转动作的机械手及其控制方法。
本发明所涉及的机械手包括:第一可动构件;第二可动构件;保持部;第一关节部,可转动地连接所述第一可动构件和所述第二可动构件;第二关节部,可转动地连接所述第二可动构件和所述保持部;第一关节驱动部,驱动所述第一关节部;第二关节驱动部,驱动所述第二关节部;构件确定部,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及控制装置,控制所述第一关节驱动部和所述第二关节驱动部,使由所述构件确定部确定的所述其中之一的可动构件朝离开所述障碍物的方向转动,并使另一可动构件朝接近所述障碍物的方向转动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
此外,本发明所涉及的另一种机械手包括:第一可动构件;第二可动构件;第一关节部,可转动地连接所述第一可动构件和所述第二可动构件;移动部,具有移动驱动部;第三关节部,可转动地连接所述第二可动构件和所述移动部;第一关节驱动部,驱动所述第一关节部;第三关节驱动部,驱动所述第三关节部;构件确定部,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及控制装置,控制所述第一关节驱动部、所述第三关节驱动部以及所述移动驱动部,使由所述构件确定部确定的其中之一的可动构件朝离开所述障碍物的方向转动,当所述其中之一的可动构件为所述第一可动构件的情况下,使所述移动部朝离开所述障碍物的方向移动,当所述其中之一的可动构件为所述第二可动构件的情况下,使所述移动部朝接近所述障碍物的方向移动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
此外,本发明提供机械手的控制方法,其中,该机械手包括:第一可动构件;第二可动构件;保持部:将所述第一可动构件和所述第二可动构件可转动地连接的第一关节部;将所述第二可动构件和所述保持部可转动地连接的第二关节部;驱动所述第一关节部的第一关节驱动部;以及驱动所述第二关节部的第二关节驱动部,所述机械手的控制方法包括以下步骤:构件确定步骤,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及控制步骤,控制所述第一关节驱动部和所述第二关节驱动部,使在所述构件确定步骤确定的其中之一的可动构件朝离开所述障碍物的方向转动,并使另一可动构件朝接近所述障碍物的方向转动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
此外,本发明提供另一种机械手的控制方法,其中,该机械手包括:第一可动构件;第二可动构件;具有移动驱动部的移动部;将所述第一可动构件和所述第二可动构件可转动地连接的第一关节部;将所述第二可动构件和所述移动部可转动地连接的第三关节部;驱动所述第一关节部的第一关节驱动部;以及驱动所述第三关节部的第三关节驱动部,所述机械手的控制方法包括以下步骤:构件确定步骤,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及控制步骤,控制所述第一关节驱动部、所述第三关节驱动部以及所述移动驱动部,使在所述构件确定步骤确定的其中之一的可动构件朝离开障碍物的方向转动,当所述其中之一的可动构件为所述第一可动构件的情况下,使所述移动部朝离开所述障碍物的方向移动,当所述其中之一的可动构件为所述第二可动构件的情况下,使所述移动部朝接近所述障碍物的方向移动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
附图说明
图1是本发明实施方式1的机械手的概略结构图。
图2是表示该机械手的结构的方框图。
图3是表示该机械手的碰撞回避动作的第一例的概略正视图。
图4是表示该机械手的碰撞回避动作的第二例的概略正视图。
图5是用于说明该机械手的加速判断部的加速判断条件的图。
图6是用于说明有助于该机械手的可动构件的旋转的反作用力成分的方向的图。
图7是说明该机械手的障碍物回避动作的流程图。
图8是本发明实施方式2的机械手的概略结构图。
图9是表示该机械手的结构的方框图。
图10是表示该机械手的退避动作的第一例的概略正视图。
图11是表示该机械手的退避动作的第二例的概略正视图。
具体实施方式
以下,参照附图对本发明的实施方式进行详细说明。
(实施方式1)
首先,参照图1,对本发明的实施方式1的机械手1的结构进行说明。图1是本发明实施方式1的机械手1的概略结构图。
机械手1具备可动部91和保持该可动部91的保持部8。可动部91具有作为可动构件的手2、作为可动构件的臂4、以及作为可动构件的臂6。另外,可动部91只要至少具有两个可动构件(第一可动构件和第二可动构件)即可,例如,可动部91也可以采用仅具有手2和臂4的结构、或仅具有臂4和臂6的结构、或者还连接有其它可动构件的结构。
手2具有把持物品的功能,通过关节部3与臂4的前端部连接。臂4的基端部通过关节部5与臂6的前端部连接。臂6的基端部通过关节部7与保持部8连接。手2和臂4、臂6可分别相互转动地连接在一起。关节部5的转动轴与关节部7的转动轴在与图1的纸面垂直的方向上相互平行。
保持部8具备机构部81和驱动部82。机构部81具备能够拍摄可动部91的拍摄部11、12。拍摄部11、12还能够拍摄与可动部91碰撞的障碍物9。驱动部82具备:用于输入操作指令的输入部21;用于监视与障碍物9的碰撞的碰撞监视部23;以及驱动手2和臂4、6的关节驱动部(后述的致动器31、51、71)的控制装置22。拍摄部11、12向碰撞监视部23输出拍摄图像。控制装置22基于从输入部21得到的操作指令信息和从碰撞监视部23得到的监视信息,利用关节驱动部的控制部22进行控制。
另外,此处采用了将拍摄部11、12设置于机构部81的结构,但也可以采用将拍摄部11、12设置于机构部81以外的其他部位的结构(例如,设置在能够俯瞰整个机械手1的周围环境位置上的结构)。
接下来,参照图2,对机械手1的结构和动作进行说明。图2是表示本发明的实施方式1的机械手1的结构的方框图。
关节部3、5、7分别具备作为关节驱动部的致动器31、51、71。致动器31通过减速机38相对于臂4旋转地驱动手2。同样地,致动器51通过减速机38相对于臂6旋转地驱动臂4。致动器71通过减速机38相对于保持部8旋转地驱动臂6。减速机38通过齿轮等使后述的马达34的旋转减速,并且提高致动器31、51、71的驱动转矩。此外,减速机38还具有作为将致动器31、51、71的驱动力分别传递至手2、臂4、臂6的动力传递机构的作用。减速机38可采用例如可行星齿轮减速机、正齿轮减速机或带减速机构等。
致动器31、51、71具备驱动用的马达34、驱动该马达34的马达驱动部35、以及编码器36。
马达驱动部35例如具有H桥式驱动电路等驱动电路,通过该驱动电路向马达供给电力,从而进行马达34的正反转。
编码器36被设置成与马达34的轴(未图示)连接,用于检测马达34的转动信息。编码器36可采用例如由编码板(codingplate)和光传感器构成的光学编码器、使用了霍尔元件(hall element)或磁阻元件(magnetic resistor element)和NS两极磁化的旋转磁体(rotary magnet)的磁编码器等。
输入部21具备省略了图示的输入装置。输入部21将通过该输入装置输入的操作指令输出至控制装置22。作为输入装置,例如可采用按键输入装置、操纵杆、触摸屏等。另外,输入部21在图1所示的示例中采用了收纳于保持部8的结构,但是也可以采用相对于保持部8装卸自如的结构、或者作为其他的单元而构成。此外,在机械手1能够自主移动的情况下,输入部21也可以输入来自外部的上位控制装置(未图示)的操作指令。
碰撞监视部23分析由各拍摄部11、12所得到的两个拍摄图像,并监视通过立体观察检测到的包含距离、方向的障碍物9的动作信息、以及障碍物9与可动部91的相互位置关系等位置关系信息。而且,碰撞监视部23判断是否存在障碍物9与可动部91碰撞的可能性。并且,碰撞监视部23在判断为存在障碍物9与可动部91碰撞的可能性的情况下,确定存在碰撞的可能性的可动部91的可动构件(例如臂4),并将障碍物9的信息(动作信息、位置信息)以及存在碰撞的可能性的可动构件的位置信息作为监视信息输出至控制装置22。另外,也可以将碰撞监视部23的功能设置为控制装置22的功能。此外,此处作为监视包含距离方向的障碍物9的动作以及障碍物9与可动部91的相互位置关系等的方法,采用了利用拍摄部11、12的视差的立体照相法,但并不限定于该方法。例如,也可以采用距离图像传感器等,该距离图像传感器通过对从发光二极管照射出的光被测量对象反射而返回至CCD(Charge Coupled Device)上的到达时间(Time of Flight)进行计测,并重叠图像信息,以此按各像素输出对象的图像和至对象为止的距离。
控制装置22包括基于程序执行各种功能的中央控制装置(CPU)、存储各种程序等的读出专用的只读存储器(ROM)、暂时存储数据的可重写的随机存取存储器(RAM)和进行与外部的数据输入输出的输入输出部。据此,控制装置22通过基于从输入部21得到的操作指令和从碰撞监视部23得到的监视信息来执行各种程序,从而驱动致动器31、51、71,当可动部91有可能与障碍物9碰撞的情况下,控制成进行回避动作。此外,控制装置22可基于从编码器36得到的马达34的旋转信息,来检测手2、臂4和臂6各自的位置和姿势、以及可动构件之间的角度。另外,根据从编码器36得到的马达34的旋转方向的信息,控制装置22能够获得关于与由碰撞监视部23确定的可动构件(例如臂4)不同的可动构件(例如臂6)的转动方向的信息(转动方向信息)。
此外,控制装置22具备加速判断部25。加速判断部25进行在障碍物9与可动部91的碰撞回避动作时的加速判断。关于该加速判断部25,将在后面进行叙述。
接下来,参照图2、图3和图4,对机械手1的避免与障碍物9碰撞的动作进行说明。图3是表示本实施方式1的机械手1的碰撞回避动作的第一例的概略正视图,图4是表示该机械手1的碰撞回避动作的第二例的概略正视图。
首先,参照图2和图3,对机械手1的避免碰撞的第一例进行说明。
控制装置22根据来自输入部21的操作指令使致动器31、51、71驱动,并且从碰撞监视部23取得监视信息。控制装置22在根据该监视信息检测出可动部91有可能与障碍物9碰撞的情况下,根据有关存在碰撞的可能性的可动部91的可动构件(手2或臂4、6)的位置和姿势的信息、有关其它的可动构件的位置和姿势的信息、关节部3、5、7的驱动信息(包括转动方向信息)等,开始进行使可动构件避开障碍物9的动作。即,生成使可动构件避开障碍物9的控制信息,根据该控制信息使致动器31、51、71驱动,从而对关节部3、5、7进行转动控制。
机械于1例如根据来自输入部21的操作指令来使致动器31、51、71驱动。例如,机械手1根据操作指令,让致动器31停止,而让致动器51、71驱动。
据此,例如图3(a)所示,机械手1使臂4相对于关节部5的旋转中心朝A方向转动,并使臂6相对于关节部7的旋转中心朝A方向转动。即,以关节部7为中心,使臂6转动的方向和使臂4转动的方向为相同方向。
因该转动动作,例如存在障碍物9与臂4碰撞的可能性的情况下,碰撞监视部23工作,并输出监视信息。监视信息被输入至控制装置22。
控制装置22在检测出障碍物9与臂4碰撞的可能性后,根据监视信息,对致动器51和致动器71进行驱动控制。具体来说,致动器51以与A方向相反的方向的转矩驱动臂4,致动器71提高转矩从而使臂6在不改变转动方向的情况下加速。即,机械手1使臂4相对于臂6朝避开障碍物9的方向(图3(b)的B方向)转动,并且使臂6相对于障碍物9朝碰撞方向加速转动。
如图3(b)所示,当使臂6相对于关节部7的旋转中心朝A方向加速转动时,臂4的基端部朝A方向加速,因此在臂4的重心位置4a作用由惯性产生的反作用力(旋转力矩)。该反作用力以使臂4绕关节部5的旋转中心朝B方向转动。即,通过借助该反作用力使臂6的转动加速,能够辅助使臂4的转动反转的动作。因此,虽然臂6的动作相对于障碍物9向碰撞方向加速,但是在臂4作用与碰撞方向相反的旋转力矩,因此臂4的姿势向B方向迅速变化。即,臂4朝离开障碍物9的方向移动。
其结果,在机械手1中,在使臂4向B方向转动驱动时,能够在致动器51的转矩上还加上由惯性产生的反作用力来进行驱动,从而能够使臂4迅速地避开障碍物9。
另外,根据臂6的姿势,以将可动部91向保持部8折叠的方式进行驱动。由此,能够更可靠地使臂4避开障碍物9。
如上所述,机械手1通过在不改变臂6的转动方向的情况下进行加速,能够在致动器51的转矩的基础上还利用反作用力使臂4向回避方向旋转驱动。由此,能够使臂4迅速地避开障碍物9。
另外,在本实施方式中,即使在致动器51的机械/电时间常数较大、或者驱动力较小的情况下,由于有效地利用了反作用力,因此能够如上所述地使臂4迅速地避开障碍物9。
接下来,参照图4,对避免碰撞的第二例进行说明。
在上述第一例中,通过使臂6的转动向图3的A方向加速,以此在使臂4反转的方向(图3的B方向)产生反作用力。与此相对,在第二例中,通过使作为臂6的转动中心的关节部7自身移动,从而产生反作用力。
机械手1的保持部8具备:保持部主体8a;以及用于使可动部的位置相对于该保持部主体8a平行移动的移动部13。利用该移动部13来避免碰撞。
移动部13是沿指定方向可滑动地设置于保持部8的保持部主体8a的构件。作为该移动部13,例如采用直线滑块(rectilinear slider)。由于关节部7被支撑于移动部13,所以能够通过该移动部13使可动部91向图4(b)的D方向平行移动。移动部13具备移动驱动部14。该移动驱动部14具有马达(未图示)、减速机(未图示)、以及驱动马达的驱动器(未图示),并且该移动驱动部14通过控制装置22而被控制。臂6通过关节部7转动自如地连接于移动部13。为了通过移动部13的移动来可靠地产生反作用力,移动部13的移动方向优选与关节部7的转动轴垂直的方向。但是,在由于保持部8的结构等而移动部13的移动范围受限制的情况下,移动部13的移动方向也可以是除此以外的方向。
此处,例如图4(a)所示,以臂4的重心位置4a相对于关节部5位于根部一侧(比X-X轴更靠机构部81一侧)的情况为例,对避免与障碍物9碰撞的动作进行说明。该情况下,机械手1根据第二例的障碍物9与臂4的位置关系以及臂4、6的动作状况来进行碰撞回避动作。
机械手1根据来自输入部21的操作指令来使致动器31、51、71驱动。例如,机械手1使致动器31停止,而使致动器51、71驱动。具体来说,使臂4以关节部5为中心向B方向转动,并使臂6以关节部7为中心向A方向转动。
在该动作时,当存在障碍物9与臂4碰撞的可能性的情况下,碰撞监视部23工作,向控制装置22输出监视信息。控制装置22基于该监视信息来控制致动器51、71,并且控制移动驱动部14,以使臂4避开障碍物9。
具体来说,控制装置22在检测出臂4与障碍物9碰撞的可能性后,在致动器51以与B方向相反的方向(A方向)的转矩驱动臂4,并且在致动器71以与A方向相反的方向(B方向)的转矩驱动臂6。由此,臂4绕关节部5的转动方向反转,并且臂6绕关节部7的转动方向也反转。控制装置22还让移动驱动部14进行驱动,以使移动部13从停止状态向D方向加速移动。即,机械手1使臂4和臂6分别向相反方向转动,并且使移动部13相对于障碍物9向碰撞方向加速移动。
如图4(b)所示,当使移动部13向D方向加速移动时,臂6的基端部向D方向加速,因此由惯性产生的反作用力(旋转力矩)在臂4的重心位置4a向E方向作用。基于该反作用力,使臂4以关节部5为旋转中心向A方向转动的力作用于臂4。同样地,由惯性产生的反作用力在臂6的重心位置6a向E方向作用。因此,使臂6以关节部7为旋转中心向B方向转动的力作用于臂6。因此,虽然使移动部13相对于障碍物9向碰撞方向(D方向)加速,但在臂4的重心位置4a和臂6的重心位置6a,由惯性产生的反作用力作为使两个臂4、6反转的辅助力而向E方向作用,因此能够使被确定为有可能与障碍物9碰撞的臂4朝离开障碍物9的方向迅速地移动。
如上所述,机械手1能够对臂4施加反向转矩(碰撞回避方向),并且,还利用反作用力使臂4避开障碍物9,因此能够迅速地避免碰撞。
另外,在例如臂4的碰撞回避动作时,既可以一并采用臂6的加速动作和移动部13的加速动作,也可以只进行其中之一的动作。
接下来,参照图5和图6(a)至(d),对设置于控制装置22的加速判断部25进行说明。图5是用于说明基于本实施方式1的机械手1的加速判断部25的加速判断条件的图,图6(a)至(d)是用于说明有助于机械手1的可动构件2、4、6的转动的反作用力成分(以下,称为反作用力)的方向的图。
如图5所示,加速判断部25根据由臂6与臂4所夹的角度θ、臂4与障碍物9的位置关系以及臂6的转动方向所决定的加速判断条件,来判断加速的适当与否。并且,在判断为作用于臂4的重心位置4a的反作用力的方向有助于碰撞回避动作的情况下,输出“加速转动”的判断结果,在判断为作用于重心位置4a的反作用力无助于碰撞回避动作的情况下,输出“不加速转动”的判断结果。
对可否加速的判断进行具体说明。在本实施方式中,如图5所示,以相对于相互正交的绝对坐标轴Xa、Ya的原点使臂6向顺时针方向(A方向)转动,并且相对于相互正交的相对坐标轴Xb、Yb的原点使臂4向顺时针方向(A方向)转动的情况为动作例进行说明。另外,如图5所示,绝对坐标轴Xa、Ya的原点设定在关节部7的旋转中心,相对坐标轴Xb、Yb的原点设定在关节部5的旋转中心。另外,相对坐标轴Xb被设定在与臂6的长度方向正交的方向,相对坐标轴Yb被设定在臂6的长度方向。
此处,相对坐标轴Xb、Yb的原点在以绝对坐标轴Xa、Ya的原点为中心、以两原点间的距离为半径的圆周20上移动。
加速判断部25基于臂4在相对坐标轴Xb、Yb系中的位置,来判断作用于臂4的中心位置4a的反作用力方向,根据该反作用力方向、以及臂4与障碍物9的位置关系,来进行加速判断。即,加速判断部25首先判断在相对坐标轴Xb、Yb系中臂4的中心位置位于第一区域(Xb<0、Yb<0)、第二区域(Xb<0、Yb>0)、第三区域(Xb>0、Yb>0)、第四区域(Xb>0、Yb<0)的情况下的反作用力方向。然后,根据该反作用力方向以及臂4与障碍物9的位置关系,来进行加速判断。另外,在图5中,臂6与臂4所成的角度θ是以与连接关节部5和关节部7的转动中心而得到的线段一致的臂6的中心线为基准,从此基准起,当臂4的转动方向为正时的两臂4、6所夹的角度。即,臂4与臂6重合时的角度为零,从此处使臂4向图5的顺时针方向进行了转动时的角度为θ。
接下来,参照图6(a)至图6(d),对作用于各区域内的臂4的重心的反作用力方向进行说明。
图6(a)是臂4的重心位置4a位于第一区域时的示例。若以所述角度θ来描述第一区域,则为0°<θ<90°的区域。此时,通过使臂6加速,在臂4的重心位置4a产生的反作用力作用于F方向。即,反作用力的作用方向与重心位置4a基于向A方向的臂4的转动而移动的方向相同。因此,加速判断部25在障碍物9位于通过反作用力而促进臂4的转动的方向的相反侧(角度θ减小的方向)的情况下,判断为“加速转动”。这是因为通过使臂6加速而使作用于臂4的反作用力朝向碰撞回避方向。另一方面,在障碍物9位于臂4基于反作用力而转动的方向(角度θ增大的方向)的情况下,判断为“不加速转动”。这是因为在该情况下反作用力作用于碰撞方向。
图6(b)是臂4的重心位置4a位于第二区域时的示例。若以所述角度θ来描述第二区域,则为90°<θ<180°的区域。此时,通过使臂6加速而在臂4的重心位置4a产生的反作用力作用于G方向。即,反作用力的作用方向与重心位置4a基于向A方向的臂4的转动而移动的方向相反。因此,加速判断部25在障碍物9位于通过反作用力而促进臂4的转动的方向的相反侧(角度θ增大的方向)的情况下,判断为“加速转动”。这是因为通过使臂6加速而使作用于臂4的反作用力朝向碰撞回避方向。另一方面,在障碍物9位于臂4基于反作用力而转动的方向(角度θ减小的方向)的情况下,判断为“不加速转动”。这是因为在该情况下反作用力作用于碰撞方向。
图6(c)是臂4的重心位置4a位于第三区域时的示例。若以所述角度θ来描述第三区域,则为180°<θ<270°的区域。此时,施加于臂4的重心位置4a的反作用力作用于H方向。即,反作用力的作用方向与重心位置4a基于向A方向的臂4的转动而移动的方向相反。因此,加速判断部25在障碍物9位于臂4基于反作用力而转动的方向的相反侧(角度θ增大的方向)的情况下,判断为“加速转动”。这是因为通过使臂6加速而使作用于臂4的反作用力朝向碰撞回避方向。另一方面,在障碍物9位于臂4基于反作用力而转动的方向(角度θ减小的方向)的情况下,判断为“不加速转动”。这是因为在该情况下反作用力作用于碰撞方向。
图6(d)是臂4的重心位置4a位于第四区域时的示例。若以所述角度θ来描述第四区域,则为270°<θ4<360°的区域。此时,施加于臂4的重心位置4a的反作用力作用于I方向。即,反作用力的作用方向与重心位置4a基于向A方向的臂4的转动而移动的方向相同。因此,加速判断部25在障碍物9位于臂4基于反作用力而转动的方向的相反侧(角度θ减小的方向)的情况下,判断为“加速转动”。这是因为通过使臂6加速而使作用于臂4的反作用力朝向碰撞回避方向。另一方面,在障碍物9位于臂4基于反作用力而转动的方向(角度θ增大的方向)的情况下,判断为“不加速转动”。这是因为在该情况下反作用力作用于碰撞方向。
另外,加速判断部25也可以将施加于各区域内的臂4的重心位置的反作用力的作用方向储存于储存部(未图示),并基于该储存的反作用力的作用方向来进行判断。
这样,加速判断部25在根据加速判断条件判断为由惯性产生的反作用力有助于碰撞回避动作的情况下,判断为“加速转动”。据此,控制装置22能够在施加于臂4的重心位置4a的反作用力的作用方向有助于避免与障碍物9的碰撞动作时使臂6加速转动。即,臂4在由致动器51产生的障碍物回避方向的转矩的基础上,还能够利用朝向障碍物回避方向的反作用力,因此能够迅速地避免与障碍物9的碰撞。
接下来,参照图7,对机械手1的动作进行说明。图7是说明本发明实施方式1的机械手1的障碍物回避动作的流程图。
首先,机械手1根据来自输入部21的操作指令,通过致动器31、51、71驱动关节部3、5、7(步骤S100)。
接着,机械手1利用碰撞监视部23监视障碍物9与可动构件2、4、6的碰撞(步骤S102)。
然后,机械手1根据从碰撞监视部23输出的监视信息来判断可动构件2、4、6是否会与障碍物9碰撞(步骤S104)。即,由于碰撞监视部23在存在可动构件2、4、6与障碍物9碰撞的可能性的情况下工作,所以碰撞监视部23在存在碰撞的可能性的情况下向控制装置22输出监视信息。另一方面,碰撞监视部23在不存在障碍物9与可动构件2、4、6碰撞的可能性的情况下不工作,从而不向控制装置22输出监视信息。因此,机械手1能够根据监视信息来判断障碍物9与可动构件2、4、6的碰撞的有无。即,步骤S102和步骤S104是判断在各可动构件2、4、6是否存在碰撞可能性的碰撞监视步骤。
机械手1在碰撞监视部23工作时,根据监视信息来控制致动器31、51、71或移动驱动部14,以使可动构件2、4、6避开障碍物9(步骤S106)。
此时,机械手1的加速判断部25根据臂4与臂6所成的角度θ,对由碰撞监视部23确定的可动构件(例如臂4)的重心位置(例如,在图3(a)的姿势下为臂4的重心位置4a)存在于设定在关节部5的相对坐标系的四个区域的哪个区域进行确定。然后,根据重心位置所存在的区域、另一可动构件(例如臂6)的转动方向信息以及可动构件(例如臂4)与障碍物9的位置关系信息,来判断在使另一可动构件(例如臂6)加速转动的情况下作用于可动构件(臂4)的重心位置的反作用力是否有助于碰撞回避动作(步骤S108)。然后,加速判断部25在伴随另一可动构件(例如臂6)的加速而产生的反作用力有助于碰撞回避动作的情况下,判断为“加速转动”,在反作用力无助于碰撞回避动作的情况下,判断为“不加速转动”。此处,所谓作用于可动构件(例如臂4)的重心位置的反作用力有助于碰撞回避动作的情况,是指反作用力的作用方向相对于障碍物9作用于碰撞回避方向的情况。此外,所谓作用于可动构件(例如臂4)的重心位置的反作用力无助于碰撞回避动作的情况,是指反作用力的作用方向相对于障碍物9作用于碰撞方向的情况。即,步骤S108是加速判断步骤。
机械手1在利用加速判断部25判断为“加速转动”的情况下,例如在图3(b)的姿势下使臂4向相反方向反转转动,并且提高致动器71的转矩,从而使臂6的转动加速(步骤S110)。据此,臂4在其基端部不仅受到由致动器51产生的旋转力,而且受到伴随臂6的加速动作而产生的绕重心位置4a的旋转力矩。据此,臂4朝离开障碍物9的方向迅速地转动。即,步骤S110作为控制步骤。然后,机械手1判断是否避开了障碍物9(步骤S112)。机械手1在判断为未避开障碍物的情况下返回步骤S110,继续加速转动。另一方面,在判断为避开了的情况下,前进至步骤S114。
机械手1在进行了碰撞回避动作后,例如使致动器31、51、71或移动驱动部14停止,从而使可动部91的动作停止(步骤S114)。另外,在设定有目标位置的情况下,也可再次使可动部91的动作开始而进行移动。
如上所述,根据本实施方式1的机械手1,在由碰撞监视部23确定的可动构件进行回避障碍物的动作时,在致动器31、51、71的驱动力的基础上,还能够利用作用于该可动构件重心的由惯性产生的反作用力。因此,在手2或臂4、6能够实现从障碍物9迅速避开的动作。
另外,在本实施方式1中,以两个臂4、6的情况为例进行了说明,但是并不限于此。即使是由三个以上的可动构件连结而成的机械手,也能够获得同样的效果。
另外,在本实施方式1中,采用了移动部13能够相对于保持部主体8a移动的结构,但是也可以取而代之,让保持部8本身具备车轮等驱动部及具有该驱动部的自走式结构,在碰撞回避动作时使保持部8自身加速移动的结构。在该情况下,保持部8作为可动构件发挥作用。此外,在该情况下,由于保持部8作为可动构件发挥作用,所以也可以采用仅设置有一个臂的结构。
此外,也可以采用如下结构,即各关节部3、5、7具有如后述实施方式2所示的离合器以及切换部,例如在臂4的碰撞回避动作时进行使关节部5的离合器成为闲游(free)状态的控制。
(实施方式2)
下面,利用图8至图10,对本发明实施方式2的机械手10进行说明。图8是本发明实施方式2的机械手10的概略正视图,图9是表示该机械手10的结构的方框图,图10是说明该机械手10的退避动作的概略正视图。以下,对与实施方式1相同的结构要素,标注相同符号进行说明。
在实施方式1的机械手1中,设置有碰撞监视部23,根据该碰撞监视部23的监视信息来确定存在碰撞可能性的可动构件(例如臂4)。一并使用施加于可动构件的障碍物回避方向的转矩和伴随另一可动构件(例如臂6)的加速动作而作用于可动构件的由惯性产生的反作用力,来避免此时确定的可动构件(例如臂4)与障碍物9的碰撞。
与此相对,本实施方式2的机械手10具备后述的碰撞检测部24,根据该碰撞检测部24的检测信息来确定与障碍物9发生了碰撞的可动构件,并在由碰撞检测部24确定的可动构件利用由惯性产生的反作用力来缓和冲击力。据此,即使在机械手10与障碍物9发生了碰撞的情况下,也能够缓和由该碰撞产生的冲击力。
首先,参照图8,对本实施方式2的机械手10的结构进行说明。
机械手10包括:具有手2、臂4和臂6的可动部;关节部30、50、70;以及保持可动部的保持部8。
手2通过关节部30与臂4连接。臂4通过关节部50与臂6连接。臂6通过关节部70与保持臂6的保持部8连接。手2、臂4、6以及保持部8可分别相互转动地连接。
在臂4、6的表面分别设置有检测与障碍物9的接触的接触传感器41、61。
接触传感器41、61例如可采用使用导电性压敏油墨(conductive andpressure-sensitive ink)印刷成纵横图案的压敏片(pressure-sensitive sheet)等。据此,基于障碍物9与臂4接触从而对压敏片施加了压力时的压敏片的电阻变化,利用接触传感器41可感知到接触。同样地,当障碍物9与臂6接触从而对压敏片施加压力时,接触传感器61能够感知到接触。
保持部8具备机构部81和驱动部82。驱动部82具备用于输入操作指令的输入部21、用于检测与障碍物9的碰撞的碰撞检测部24、以及控制装置22。控制装置22基于从输入部21得到的操作指令信息和从碰撞检测部24得到的检测信息,来控制手2和臂4、6的动作。在碰撞检测部24连接有接触传感器41、61。
接下来,参照图9,对机械手10的结构和动作进行说明。图9是表示本发明实施方式2的机械手10的结构的方框图。
控制装置22根据来自输入部21的操作指令来控制手2和臂4、6的动作。此外,控制装置22基于碰撞检测部24的检测信息使后述致动器31、51、71进行驱动,从而使与障碍物9发生了碰撞的可动构件退避。另外,控制装置22具备加速判断部25,在按照由该加速判断部25作出的判断使可动构件从障碍物9退避时,对是否利用作用于可动构件的重心的、由惯性产生的反作用力进行判断。
碰撞检测部24根据从接触传感器41、61取得的接触感知信息,确定与障碍物9发生了碰撞的可动构件,并将该确定的可动构件的检测信息输出至控制装置22。例如,碰撞检测部24当接触传感器41感知到接触时,检测出臂4与障碍物9发生了碰撞。同样地,当接触传感器61感知到接触时,检测出臂6与障碍物9发生了碰撞。
关节部30、50、70具备:作为关节驱动部的致动器31、51、71;作为传递关节驱动部的动力的动力传递部的离合器32、52、72;作为动力传递切换部的切换部33、53、73;以及角度传感器37、57、77。
离合器32通过切换部33的工作或不工作,而使致动器31的动力经由减速机38传递至手2(连接状态)、或不让致动器31的动力传递至手2(非连接状态)。作为离合器32,例如采用一对离合板,作为切换部33,例如采用通过电流的导通/断开来使一对离合板成为接触/非接触状态的电磁体。另外,切换部33的“工作”状态是通过电流的断开而使所述一对离合板接触的状态,“不工作”状态是通过电流的导通而使所述一对离合板非接触的状态。离合器32通过使一对离合板处于接触状态,来使致动器31的动力经由减速机38传递至手2。另一方面,离合器32通过使一对离合板处于非接触状态,不让致动器31的动力传递至手2。
同样,离合器52通过切换部53的工作或不工作,而使致动器51的动力经由减速机38传递至臂4(连接状态)、或不让致动器51的动力传递至臂4(非连接状态)。此外,离合器72通过切换部73的工作或不工作,而使致动器71的动力经由减速机38传递至臂6(连接状态)、或不让致动器71的动力传递至臂6(非连接状态)。
因此,当离合器32为非连接状态时,关节部30处于相对于外力转动自如的(闲游)状态。同样,当离合器52为非连接状态时,关节部50处于相对于外力转动自如的(闲游)状态,当离合器72为非连接状态时,关节部70处于相对于外力转动自如的(闲游)状态。
编码器36检测马达34的旋转信息。控制装置22基于该旋转信息和减速机38的减速比,来检测手2、臂4和臂6的位置和姿势,并且控制手2、臂4和臂6的动作。
角度传感器37基于绝对关节角度信息来检测手2的姿势和动作。在使离合器32处于非连接状态时,致动器31的动力不再被传递至手2,因此不能通过编码器36来检测手2的动作,但即使在该情况下,也能够通过角度传感器37来检测手2的动作。此外,在再次使离合器32处于连接状态的情况下,利用角度传感器37的绝对关节角度信息,能够修正编码器36的旋转信息。同样,角度传感器57基于绝对关节角度信息来检测臂4的姿势和动作。角度传感器77基于绝对关节角度信息来检测臂6的姿势和动作。
作为角度传感器37、57、77,例如可以使用采用了霍尔元件或磁阻元件和NS两极磁化的旋转磁体的磁编码器、利用了可变电阻器原理的电位计(potentiometer)等。
接下来,参照图9和图10(a)、(b),对机械手10的退避动作进行说明。
控制装置22根据来自输入部21的操作指令,使致动器31、51、71进行驱动,并且从碰撞监视部24取得与障碍物9接触的可动构件(手2或臂4、6)的检测信息。控制装置22在根据该检测信息检测到障碍物9与可动构件发生了碰撞的情况下,根据发生了碰撞的可动构件的检测信息、关节部50、70的驱动信息等,开始进行使可动构件从障碍物9退避的动作。即,生成用于使可动构件从障碍物9退避、并缓和因碰撞产生的冲击力的控制信息,根据该控制信息使致动器31、51、71进行驱动,从而对关节部30、50、70进行转动控制。
如图10(a)所示,机械手10根据来自输入部21的操作指令来使致动器31、51、71进行驱动。例如,机械手10使致动器31停止,使切换部33、53、73工作,并且使致动器51、71进行驱动。据此,例如臂4以关节部50为旋转中心向A方向转动,并且臂6以关节部70为旋转中心向A方向转动。
然后,在障碍物9与臂4接触的情况下,接触传感器41工作,碰撞检测部24检测到臂4与障碍物9的碰撞并向控制装置22输出检测信息。控制装置22根据该检测信息来设定切换部53、73,并控制致动器51、71,以使臂4从障碍物9退避。
具体来说,控制装置22在检测到臂4与障碍物9的碰撞后,将切换部53从“工作,,切换为“不工作”,并且提高致动器71的驱动力,使臂6向A方向加速转动。即,机械手10在使关节部50相对于外力转动自如(闲游)的状态下,使臂6相对于障碍物9向碰撞方向(A方向)加速转动。
如图10(b)所示,当使臂6以关节部70为旋转中心向A方向加速转动时,关节部50处于相对于外力转动自如(闲游)的状态,因此伴随臂6的加速而作用于臂4的惯性力成为反作用力而发挥作用。由此,臂4以关节部50为旋转中心朝离开障碍物9的方向(B方向)转动。因此,虽然使臂6相对于障碍物9向碰撞方向加速转动,但由惯性产生的朝向障碍物退避方向的反作用力作用于臂4的重心,因此发生了碰撞时的臂4的姿势向C方向变化。
其结果,机械手10能够使臂4从障碍物9退避。同样,在接触传感器61工作、碰撞检测部24检测到臂6与障碍物9的碰撞的情况下,控制装置22使致动器51、71进行驱动,以使臂6从障碍物9退避。
如上所述,根据本实施方式2的机械手10,与实施方式1相同,由于能够利用由惯性产生的反作用力使臂4从障碍物9退避,所以即使在臂与障碍物发生了碰撞的情况下,也能够缓和因碰撞产生的冲击力。
另外,在接触传感器41、61未感知到接触的状态(即,臂4和臂6均未与障碍物9碰撞的状态)下,碰撞检测部24不向控制装置22输出检测信息。此时,控制装置22使切换部53、73工作,从而使离合器52、72连接。据此,机械手10根据来自输入部21的操作指令,能够使臂4和臂6移动至指定位置。
此外,当从碰撞检测部24输出检测信息时,CPU通过硬件中断(hardware interrupt)接受检测信息,并执行用于进行回避动作的程序。据此,控制装置22能够提高发生碰撞时的响应速度。
此外,机械手10在发生了碰撞时使马达34的转动方向变更为相反方向。因此,例如在使臂4从所碰撞的障碍物9退避的情况下,也能够同时利用由惯性产生的反作用力来使臂4从障碍物9退避,因此能够使臂4更迅速地从障碍物退避。
另外,机械手10也可以同时使用碰撞监视部23和碰撞检测部24,从而利用从碰撞监视部23获得的监视信息和从碰撞检测部24获得的检测信息。据此,不但在发生了碰撞的情况下能够进行使碰撞后的冲击力缓和的动作,而且在碰撞前能够使用监视信息来进行朝向碰撞回避方向的动作。
另外,如图11(a)所示,也可以在检测到可动构件与障碍物9的碰撞时使移动部13加速移动。即,在臂4的重心位置4a相对于关节部50位于根部侧(比X-X轴更靠机构部81一侧)的状况下,当碰撞检测部24检测出臂4与障碍物9碰撞时,机械手10使切换部53、73不工作,使两个关节部50、70处于相对于外力转动自如(闲游)的状态,并且使移动部13相对于障碍物9向碰撞方向加速。据此,如图11(b)所示,能够使臂4从障碍物9退避,因此能够缓和因碰撞而产生的冲击力。
此外,控制装置22也可以具备使多个关节部30、50、70的动作协调的协调程序,通过执行该程序,来使关节部30、50、70协调动作。据此,能够提高碰撞回避动作、冲击力缓和动作的效果。
另外,在本实施方式2中,控制装置22根据编码器36的旋转信息和减速机38的减速比,来检测手2、臂4和臂6的位置和姿势,并控制它们的动作,但是也可以不设置编码器36,而仅利用角度传感器37、57、77的绝对关节角度信息,来检测手2、臂4和臂6的位置和姿势,并控制手2等的动作。根据该结构,当在使离合器32、52、72处于非连接状态后、再次连接了离合器32、52、72的情况下,也可以不修正角度信息而进行控制。
产业上的可利用性
根据本发明,能够控制机械手,特别是用于在有可能与障碍物碰撞的状况下使用的机械手及控制方法等。
Claims (9)
1.一种机械手,其特征在于包括:
第一可动构件;
第二可动构件;
机械手的根部侧的保持部;
第一关节部,可转动地连接所述第一可动构件和所述第二可动构件;
第二关节部,可转动地连接所述第二可动构件和所述保持部;
第一关节驱动部,驱动所述第一关节部;
第二关节驱动部,驱动所述第二关节部;
构件确定部,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及
控制装置,控制所述第一关节驱动部和所述第二关节驱动部,使由所述构件确定部确定的所述其中之一的可动构件朝离开所述障碍物的方向转动,并使另一可动构件朝接近所述障碍物的方向转动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩,
所述控制装置具备加速判断部,该加速判断部根据表示由所述构件确定部确定的所述其中之一的可动构件与所述障碍物的位置关系的位置关系信息、表示所述第一可动构件和所述第二可动构件所夹的角度的角度信息、以及表示所述另一可动构件的转动方向的转动方向信息,来判断是否加速所述另一可动构件的转动,
所述加速判断部,根据所述位置关系信息、所述角度信息以及所述转动方向信息,当所述障碍物位于与因所述另一可动构件的转动的加速而在所述其中之一的可动构件上产生的反作用力的方向相反的方向时,判断为加速所述另一可动构件的转动,而当所述障碍物位于所述反作用力的方向时,判断为不加速所述另一可动构件的转动。
2.根据权利要求1所述的机械手,其特征在于:
当设所述另一可动构件绕所述第一关节部的转动中心转动的方向为正,所述第一可动构件相对于所述第二可动构件所夹的角度为θ时,
在所述另一可动构件朝所述转动方向转动的情况下,所述加速判断部进行如下所述判断:
当0°<θ<90°或270°<θ<360°的条件成立、且所述障碍物位于所述角度θ变小的方向时,判断为加速所述另一可动构件的转动;
当0°<θ<90°或270°<θ<360°的条件成立、且所述障碍物位于所述角度θ变大的方向时,判断为不加速所述另一可动构件的转动;
当90°<θ<180°或180°<θ<270°的条件成立、且所述障碍物位于所述角度θ变大的方向时,判断为加速所述另一可动构件的转动;
当90°<θ<180°或180°<θ<270°的条件成立、且所述障碍物位于所述角度θ变小的方向时,判断为不加速所述另一可动构件的转动。
3.根据权利要求1或2所述的机械手,其特征在于:
所述保持部所具备的移动部,保持所述第二可动构件且基于移动驱动部可移动,
所述控制装置控制所述移动驱动部,
在所述其中之一的可动构件为所述第一可动构件的情况下,使所述移动部朝离开所述障碍物的方向移动;
在所述其中之一的可动构件为所述第二可动构件的情况下,使所述移动部朝接近所述障碍物的方向移动。
4.根据权利要求1或2所述的机械手,其特征在于:
所述构件确定部,从至少由两个拍摄部拍摄而得到的拍摄图像导出所述障碍物的位置,并确定在所述第一可动构件和所述第二可动构件中被检测出有可能与所述障碍物碰撞或已经与所述障碍物碰撞的其中之一的可动构件。
5.一种机械手,其特征在于包括:
第一可动构件;
第二可动构件;
第一关节部,可转动地连接所述第一可动构件和所述第二可动构件;
移动部,具有移动驱动部;
第三关节部,可转动地连接所述第二可动构件和所述移动部;
第一关节驱动部,驱动所述第一关节部;
第三关节驱动部,驱动所述第三关节部;
构件确定部,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及
控制装置,控制所述第一关节驱动部、所述第三关节驱动部以及所述移动驱动部,使由所述构件确定部确定的其中之一的可动构件朝离开所述障碍物的方向转动,当所述其中之一的可动构件为所述第一可动构件的情况下,使所述移动部朝离开所述障碍物的方向移动;当所述其中之一的可动构件为所述第二可动构件的情况下,使所述移动部朝接近所述障碍物的方向移动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
6.根据权利要求5所述的机械手,其特征在于:
所述控制装置具备加速判断部,该加速判断部根据表示由所述构件确定部确定的所述其中之一的可动构件和所述障碍物的位置关系的位置关系信息、以及表示所述第一可动构件和所述第二可动构件所夹的角度的角度信息,来判断是否加速所述移动部。
7.根据权利要求6所述的机械手,其特征在于:
所述加速判断部,根据所述位置关系信息以及所述角度信息,在所述障碍物位于与因所述移动部的加速而在所述其中之一的可动构件的重心产生的反作用力的方向相反的方向时,判断为加速所述移动部,而在所述障碍物位于所述反作用力的方向时,判断为不加速所述移动部。
8.一种机械手的控制方法,其中,该机械手包括:第一可动构件;第二可动构件;机械手的根部侧的保持部;将所述第一可动构件和所述第二可动构件可转动地连接的第一关节部;将所述第二可动构件和所述保持部可转动地连接的第二关节部;驱动所述第一关节部的第一关节驱动部;以及驱动所述第二关节部的第二关节驱动部,其特征在于,所述机械手的控制方法包括以下步骤:
构件确定步骤,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及
控制步骤,控制所述第一关节驱动部和所述第二关节驱动部,以使在所述构件确定步骤确定的其中之一的可动构件朝离开所述障碍物的方向转动,并使另一可动构件朝接近所述障碍物的方向转动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩,
所述控制步骤,在所述障碍物位于与因所述另一可动构件的转动加速而在所述其中之一的可动构件上产生的反作用力的方向相反的方向时,判断为使所述另一可动构件加速,而在所述障碍物位于所述反作用力的方向时,判断为不使所述另一可动构件的转动加速。
9.一种机械手的控制方法,其中,该机械手包括:第一可动构件;第二可动构件;具有移动驱动部的移动部;将所述第一可动构件和所述第二可动构件可转动地连接的第一关节部;将所述第二可动构件和所述移动部可转动地连接的第三关节部;驱动所述第一关节部的第一关节驱动部;以及驱动所述第三关节部的第三关节驱动部,其特征在于,所述机械手的控制方法包括以下步骤:
构件确定步骤,确定所述第一可动构件和所述第二可动构件中被检测出有可能与障碍物碰撞或已经与障碍物碰撞的其中之一的可动构件;以及
控制步骤,控制所述第一关节驱动部、所述第三关节驱动部以及所述移动驱动部,使在所述构件确定步骤确定的其中之一的可动构件朝离开障碍物的方向转动,当所述其中之一的可动构件为所述第一可动构件的情况下,使所述移动部朝离开所述障碍物的方向移动;当所述其中之一的可动构件为所述第二可动构件的情况下,使所述移动部朝接近所述障碍物的方向移动,由此在所述其中之一的可动构件的重心位置作用由惯性产生的旋转力矩。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008056102 | 2008-03-06 | ||
JP2008-056102 | 2008-03-06 | ||
PCT/JP2009/001002 WO2009110242A1 (ja) | 2008-03-06 | 2009-03-05 | マニピュレータおよびその制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102015223A CN102015223A (zh) | 2011-04-13 |
CN102015223B true CN102015223B (zh) | 2014-08-13 |
Family
ID=41055807
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200980105246.2A Expired - Fee Related CN102015223B (zh) | 2008-03-06 | 2009-03-05 | 机械手及其控制方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US8504203B2 (zh) |
JP (1) | JP5044011B2 (zh) |
CN (1) | CN102015223B (zh) |
WO (1) | WO2009110242A1 (zh) |
Families Citing this family (48)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2009093451A1 (ja) * | 2008-01-22 | 2009-07-30 | Panasonic Corporation | ロボットアーム |
JP5580031B2 (ja) * | 2009-12-21 | 2014-08-27 | 株式会社Kec | 自動機による位置出し方法及び自動機の位置出し装置 |
JP5528095B2 (ja) * | 2009-12-22 | 2014-06-25 | キヤノン株式会社 | ロボットシステム、その制御装置及び方法 |
US8650965B2 (en) * | 2010-08-31 | 2014-02-18 | Kabushiki Kaisha Yaskawa Denki | Robot, robot system, robot control device, and state determining method |
US8756361B1 (en) | 2010-10-01 | 2014-06-17 | Western Digital Technologies, Inc. | Disk drive modifying metadata cached in a circular buffer when a write operation is aborted |
JP5556558B2 (ja) * | 2010-10-05 | 2014-07-23 | トヨタ自動車株式会社 | ロボットアームの制御装置、制御方法、及び制御用プログラム |
JP2013184257A (ja) | 2012-03-08 | 2013-09-19 | Sony Corp | ロボット装置及びロボット装置の制御方法、並びにコンピューター・プログラム |
CN102825608A (zh) * | 2012-09-04 | 2012-12-19 | 上海松盛机器人系统有限公司 | 一种电动汽车换电机械臂结构 |
US9242376B2 (en) * | 2013-03-28 | 2016-01-26 | Denso Wave Incorporated | Method of generating path of multiaxial robot and control apparatus for the multiaxial robot |
US9221175B2 (en) * | 2013-03-28 | 2015-12-29 | Denso Wave Incorporated | Method of generating path of multiaxial robot and control apparatus for the multiaxial robot |
CN105555222B (zh) * | 2013-09-24 | 2018-08-17 | 索尼奥林巴斯医疗解决方案公司 | 医用机械臂装置、医用机械臂控制系统、医用机械臂控制方法、及程序 |
WO2015129473A1 (ja) * | 2014-02-28 | 2015-09-03 | ソニー株式会社 | ロボットアーム装置、キャリブレーション方法及びプログラム |
WO2015129474A1 (ja) * | 2014-02-28 | 2015-09-03 | ソニー株式会社 | ロボットアーム装置、ロボットアーム制御方法及びプログラム |
EP2952304A1 (de) * | 2014-06-03 | 2015-12-09 | Siemens Aktiengesellschaft | Verfahren und Vorrichtung zur Feststellung einer unsachgemäßen Belastung eines Elementes |
DE102014210544B4 (de) * | 2014-06-04 | 2023-04-13 | Robert Bosch Gmbh | Verfahren zur Steuerung eines Manipulators bei einer point-to-point Bewegung |
EP2952301B1 (en) * | 2014-06-05 | 2019-12-25 | Softbank Robotics Europe | Humanoid robot with collision avoidance and trajectory recovery capabilities |
CN104562427B (zh) * | 2015-01-07 | 2016-09-28 | 浙江理工大学 | 一种用于三维环形编织机芯轴换接方法及其系统 |
CN104647379A (zh) * | 2015-01-19 | 2015-05-27 | 广东工业大学 | 一种驱动器非线性条件下的双臂机器人运动控制方法 |
DE102015004087B3 (de) * | 2015-03-31 | 2016-12-29 | gomtec GmbH | Fahrbarer Roboter mit Kollisionserkennung |
JP6678396B2 (ja) * | 2015-05-19 | 2020-04-08 | アズビル株式会社 | 衝突検知装置 |
CN105058396A (zh) * | 2015-07-31 | 2015-11-18 | 深圳先进技术研究院 | 机器人示教系统及其控制方法 |
JP7058929B2 (ja) * | 2015-10-27 | 2022-04-25 | キヤノン株式会社 | 駆動装置、ロボット装置、制御方法、物品の製造方法、制御プログラム、および記録媒体 |
TWI564128B (zh) * | 2015-11-17 | 2017-01-01 | 和碩聯合科技股份有限公司 | 防撞偵測裝置、相應之控制方法及適用其之機械手臂 |
TWI674179B (zh) * | 2016-01-18 | 2019-10-11 | 廣明光電股份有限公司 | 機器手臂解除剎車的方法(二) |
JP6693229B2 (ja) * | 2016-03-30 | 2020-05-13 | ブラザー工業株式会社 | ワーク交換装置、ワーク交換方法及びコンピュータプログラム |
US10697505B2 (en) * | 2016-06-01 | 2020-06-30 | Microsoft Technology Licensing, Llc | Clutch control |
CN107116541A (zh) * | 2016-11-10 | 2017-09-01 | 厦门创材健康科技有限公司 | 一种智能机器人的仿生手臂结构 |
JP6496335B2 (ja) * | 2017-03-03 | 2019-04-03 | ファナック株式会社 | ロボットシステム |
JP2019063902A (ja) * | 2017-09-29 | 2019-04-25 | Ntn株式会社 | 多関節ロボットおよびその操作方法 |
CN107877502B (zh) * | 2017-11-08 | 2020-12-08 | 弗埃斯工业技术(苏州)有限公司 | 伺服驱动的抓取装置 |
JP6680752B2 (ja) * | 2017-11-28 | 2020-04-15 | ファナック株式会社 | ロボットの速度を制限する制御装置 |
US10902377B2 (en) * | 2018-01-24 | 2021-01-26 | Amazon Technologies, Inc. | Robotic item handling using a variable area manipulator |
JP7141232B2 (ja) * | 2018-04-06 | 2022-09-22 | 川崎重工業株式会社 | ロボットの制御装置 |
JP7000992B2 (ja) * | 2018-05-25 | 2022-01-19 | トヨタ自動車株式会社 | マニピュレータおよび移動ロボット |
CN109262652B (zh) * | 2018-09-06 | 2022-01-07 | 上海大学 | 一种用于多杆件多关节机构的干涉检测预警方法 |
CN109507752B (zh) * | 2018-11-29 | 2020-12-25 | 深圳市华讯方舟太赫兹科技有限公司 | 安检仪自动测试系统、方法及具有存储功能的装置 |
JP2019061715A (ja) * | 2018-12-17 | 2019-04-18 | ファナック株式会社 | 可動部を直接手動で操作可能な数値制御工作機械 |
CN109927035A (zh) * | 2019-04-08 | 2019-06-25 | 济南大学 | 一种多臂机器人c-空间线障碍的映射方法 |
WO2021022626A1 (zh) * | 2019-08-02 | 2021-02-11 | 深圳市越疆科技有限公司 | 传感电路、逻辑电路板、关节控制板、主控器板及机器人 |
CN110744550A (zh) * | 2019-11-14 | 2020-02-04 | 北京海益同展信息科技有限公司 | 机器人及机械臂装置 |
KR102097487B1 (ko) * | 2019-12-13 | 2020-04-06 | 주식회사 유닉테크노스 | 접촉감지벨트를 구비한 다관절 목재 가공기 |
KR102094441B1 (ko) * | 2019-12-13 | 2020-05-15 | 주식회사 유닉테크노스 | 하강위치제어부가 구비된 다관절 목재 가공기 |
KR102107142B1 (ko) * | 2019-12-13 | 2020-05-06 | 주식회사 유닉테크노스 | 서포트유닛의 분리가 가능한 다관절 목재 가공기 |
KR102184146B1 (ko) * | 2019-12-20 | 2020-11-27 | 주식회사 유닉테크노스 | 다관절 목재 가공 방법 및 시스템 |
KR102365149B1 (ko) * | 2020-12-29 | 2022-02-18 | 백인규 | 치과 시술을 위한 보조 장치 |
DE112021008023T5 (de) * | 2021-10-14 | 2024-05-08 | Fanuc Corporation | Steuervorrichtung zum steuern eines roboters, der mehrere aufbauelemente aufweist, robotervorrichtung, die mit der steuervorrichtung versehen ist, und betätigungsvorrichtung zum festlegen von parametern |
WO2023174558A1 (de) * | 2022-03-18 | 2023-09-21 | Roundpeg Technologies Gmbh | Verfahren zum betrieb einer roboterbaugruppe und roboterbaugruppe |
CN115593964A (zh) * | 2022-10-31 | 2023-01-13 | 安徽省凤阳县前力玻璃制品有限公司(Cn) | 六轴机械臂九宫格堆积码垛运动控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004306247A (ja) * | 2003-03-23 | 2004-11-04 | Sony Corp | ロボット装置及びその制御方法 |
JP2004326437A (ja) * | 2003-04-24 | 2004-11-18 | Matsushita Electric Ind Co Ltd | 物品管理システム及び物品管理方法 |
JP2005100143A (ja) * | 2003-09-25 | 2005-04-14 | Kobe Steel Ltd | モータ駆動装置の制御方法及び制御装置 |
CN1839019A (zh) * | 2003-10-10 | 2006-09-27 | 三菱电机株式会社 | 机器人的控制装置 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09207089A (ja) | 1996-02-01 | 1997-08-12 | Matsushita Electric Ind Co Ltd | 多関節構造体制御装置 |
JP3578375B2 (ja) * | 1997-03-17 | 2004-10-20 | 技術研究組合医療福祉機器研究所 | ロボットアーム駆動装置およびロボットハンド |
US6429139B1 (en) * | 1999-12-17 | 2002-08-06 | Eaton Corporation | Serial wafer handling mechanism |
US7761184B2 (en) | 2003-03-23 | 2010-07-20 | Sony Corporation | Robot apparatus and control method thereof |
JP2005056066A (ja) | 2003-08-01 | 2005-03-03 | Matsushita Electric Ind Co Ltd | 物品管理システム、物品管理サーバ、物品管理方法 |
KR101300492B1 (ko) * | 2005-12-02 | 2013-09-02 | 아이로보트 코퍼레이션 | 커버리지 로봇 이동성 |
-
2009
- 2009-03-05 CN CN200980105246.2A patent/CN102015223B/zh not_active Expired - Fee Related
- 2009-03-05 JP JP2010501807A patent/JP5044011B2/ja active Active
- 2009-03-05 WO PCT/JP2009/001002 patent/WO2009110242A1/ja active Application Filing
- 2009-03-05 US US12/866,959 patent/US8504203B2/en not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004306247A (ja) * | 2003-03-23 | 2004-11-04 | Sony Corp | ロボット装置及びその制御方法 |
JP2004326437A (ja) * | 2003-04-24 | 2004-11-18 | Matsushita Electric Ind Co Ltd | 物品管理システム及び物品管理方法 |
JP2005100143A (ja) * | 2003-09-25 | 2005-04-14 | Kobe Steel Ltd | モータ駆動装置の制御方法及び制御装置 |
CN1839019A (zh) * | 2003-10-10 | 2006-09-27 | 三菱电机株式会社 | 机器人的控制装置 |
Also Published As
Publication number | Publication date |
---|---|
JP5044011B2 (ja) | 2012-10-10 |
CN102015223A (zh) | 2011-04-13 |
US8504203B2 (en) | 2013-08-06 |
JPWO2009110242A1 (ja) | 2011-07-14 |
US20100318224A1 (en) | 2010-12-16 |
WO2009110242A1 (ja) | 2009-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102015223B (zh) | 机械手及其控制方法 | |
JP5195054B2 (ja) | アームの関節、及びそれを有するロボット | |
CN108049893B (zh) | 拱架台车工作臂防撞系统及拱架台车 | |
CN110494260A (zh) | 用于控制协作机器人的装置和方法 | |
KR102418451B1 (ko) | 로봇 제어 시스템 | |
WO2013175553A1 (ja) | ロボット | |
WO2019194138A1 (ja) | ロボットの制御装置 | |
WO2013175554A1 (ja) | ロボットおよびロボットシステム | |
CN113508206B (zh) | 工程机械 | |
JP6859812B2 (ja) | 干渉監視装置 | |
CN111483808A (zh) | 机器人控制装置及管理系统 | |
KR102422355B1 (ko) | 증강현실 기반의 수중로봇 원격제어 시스템 | |
US11358276B2 (en) | Robot and robot system | |
CN112621751A (zh) | 机器人的碰撞检测方法及装置、机器人 | |
JP4568319B2 (ja) | ワイパ装置制御方法及びワイパ制御装置 | |
US20200338727A1 (en) | Robot | |
JP2021133439A (ja) | ロボットシステム | |
US5150023A (en) | Method and apparatus for indexing moving portion of robot to origin | |
WO2022259706A1 (ja) | 接触検知装置 | |
WO2001059409A3 (de) | Positionsmesssystem sowie zwangsführung für einen 2-koordinaten-stellantrieb | |
JP2017189154A (ja) | 農作業機 | |
KR100480012B1 (ko) | 스트레인 게이지를 이용한 조이스틱 | |
JP2009190557A (ja) | 車両用制御装置 | |
JP4443455B2 (ja) | モータ制御装置 | |
KR101244442B1 (ko) | 햅틱 컨트롤러 및 이를 이용한 기기 제어 시스템 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140813 Termination date: 20190305 |
|
CF01 | Termination of patent right due to non-payment of annual fee |