CN1283426C - 机器人的控制装置 - Google Patents
机器人的控制装置 Download PDFInfo
- Publication number
- CN1283426C CN1283426C CNB008186863A CN00818686A CN1283426C CN 1283426 C CN1283426 C CN 1283426C CN B008186863 A CNB008186863 A CN B008186863A CN 00818686 A CN00818686 A CN 00818686A CN 1283426 C CN1283426 C CN 1283426C
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- joint
- robot
- speed
- mentioned
- 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
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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- 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/39001—Robot, manipulator control
-
- 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/39005—Feedback for stability of manipulator, felt as force reflection
-
- 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/39177—Compensation position working point as function of inclination tool, hand
-
- 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/39322—Force and position control
-
- 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/39325—External force control, additional loop comparing forces corrects position
-
- 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/42—Servomotor, servo controller kind till VSS
- G05B2219/42075—Two position loops
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明提供一种机器人控制装置,该机器人控制装置通过简单的处理可将作业座标系的工具姿势保持一定、进行平移的柔软动作。在用具有位置和速度的状态反馈回路的控制回路来控制驱动关节用的马达的机器人控制装置上,具有以下机构:计测机器人的关节角度的机构;存储安装在机器人手指尖前端上的工具的初期姿势的机构(11);将特定的关节轴的位置增益或速度增益设定得比其它关节轴的位置增益或速度增益小的机构(10);根据上述关节角度和工具的初期姿势,运算对位置或速度指令的修正量以使工具姿势相对于机器人底座保持一定的机构(12)。
Description
技术领域
本发明涉及机器人等的控制方式,涉及可边使安装在机器人手指尖前端的工具姿势保持一定、边进行平移的柔软动作的机器人控制装置及可在作业座标系上另外附加柔软特性的机器人控制装置。
技术背景
现有的机器人用图13所示的位置速度控制系统进行控制。即,采用这样的控制系统,位置指令与用位置检测器检测的位置反馈信号的偏差乘位置增益KP后得到的速度指令,与对位置反馈信号进行微分而得到的速度反馈信号的偏差乘速度增益KV,进行比例积分,用放大器放大,再驱动关节马达。
用这种控制系统,进行伴随有与工件接触的作业时,当工件的位置有错位等时,由于刚性高,故因设定得较大的增益KP、KV和积分器的作用,产生较大的扭矩,难以进行作业。
作为例子,对于用机器人的工具把持压铸成型品即工件而从压铸设备中取出的作业进行说明。
现有的机器人中,用油压缸将工件强制性地从压铸设备中推出时,在高增益的控制系统的机器人上产生很大的扭矩,故不能在把持工件的状态下取出。进行这种作业的机器人必须作有适当的柔软性的顺从动作。
另外,进行这种压铸操作作业的机器人必须在作业座标系上进行适当的平移的柔软动作,这主要是因为外部机器的外力直线地作用,接触的对象物的形状由直线和平面构成的原因。
对于这样的问题,例如特开昭58-45891号公报所揭示的以往技术中,采用这样的方法,即为了吸收作用力,利用专用的顺从性工具。
另外,特开昭63-139678号公报所揭示的以往技术中,采用这样的方法,即使用力传感器检测作用力,在作用力的方向上进行力控制。
在机器人上不附加特别的装置、进行柔软控制的方式,在特开平6-332538号公报中所揭示的以往技术中,揭示了可在关节座标系上设定柔软度的控制方式。
近年来,作为在作业座标系上进行柔软性控制的方式,在特开平8-227320号公报中所揭示的以往技术中,公开了在作业座标系上可进行柔软性设定的控制方式。
特开平8-155868号公报所揭示的以往技术中,揭示了将在工具座标系上指定的向量成分的现在位置逐步变换为指令值的方式。
但是,上述以往技术存在以下问题。
特开昭58-45891号公报所记载的方式中,必须与各种作业相一致地制造专用工具,机器人的可搬运重量的减少量与专用工具的重量相当。
特开昭63-139678号公报所记载的方式中,必须设力传感器,在力传感器上作用载荷,故系统复杂。另外,力传感器的机械强度与机器人相比较低,当外力的作用超过力传感器的允许扭矩时,会引起力传感器的破损。
特开平6-332538号公报所记载的方式揭示了控制关节座标系的柔软性的方式,但由于通过降低增益,各关节轴独立地柔软地动作,故机器人的指教作业者难以明白综合的柔软动作的方向和柔软度。另外,机器人被外部机器推压等姿势产生了变化的情况下,作业座标系的平移的柔软动作的方向也产生变化,故不能进行将工具姿势保持一定的动作。因此,扭转等没有预期到的力作用于工件上,存在压铸成型品等复杂的形状,低刚性的工件会产生破损等问题。并且,由于每个关节轴制成圆弧状使其变得柔软,故即使将这些柔软动作合成,也不能完全进行作业座标系上的平移的柔软动作。
特开平8-227320号公报所记载的方式中,揭示了控制作业座标系的柔软性的方式,必须通过使关节座标系的变位和作业座标系的变位相对应求增益,故运算关系式非常烦杂,CPU的运算负荷大,不能对于机器人的姿势变化连续地求增益。特别是在特异点附近等、关节角和作业座标间,变位的对应关系的变化率大的机器人姿势,使CPU的运算负荷增大。另外,对于机器人的姿势变化,不能进行实时的运算,难以进行连续性的增益运算,故存在着机器人的柔软度因机器人的姿势不同而有大幅度差异等问题。
特开平8-155868号公报所记载的方式中,实时取入因外力作用位置变化后的各轴的角度,运算指定的工具座标系上的位置/姿势的现在位置(顺变换),只将指定的向量成分的现在位置变换成指令值(逆变换)。但是,关于机器人全部轴的顺变换和更新的指令值的逆变换必须是实时的,故运算量多,处理时间大幅度增加。
发明的公开
因此,本发明的课题在于提供一种机器人的控制装置,该机器人控制装置通过简单的处理使作业座标系的工具姿势保持一定、进行平移的柔软动作。
为解决上述课题的第1种方法是在用具有位置和速度的状态反馈回路的控制回路控制驱动关节用的马达的机器人控制装置上,具有以下机构:
计测机器人关节角度的机构,存储安装在机器人手指尖前端的工具的初期姿势的机构,
将特定的关节轴的位置增益或速度增益设定得比其它关节轴的位置增益或速度增益小的机构,
根据上述关节角度和工具的初期姿势,运算对上述其它关节轴的位置或速度指令的修正量,以使工具姿势相对于机器人底座保持一定。
为解决上述课题的第2种方法是在用具有位置和速度状态反馈回路的控制回路控制驱动关节用的马达的机器人控制装置上,具有以下机构:
计测机器人的关节角度的机构,
存储安装在机器人手指尖前端上的工具的初期姿势的机构,根据上述关节角度运算座标系间的静力学对应关系的机构,
根据上述关节角度和机器人的作业座标系上的位置指令,进行与上述控制回路分开的第2位置、速度的状态反馈控制的机构,
将上述第2反馈控制系统的特定轴的位置增益或速度增益设定得比其它关节轴的位置增益或速度增益小的机构,
通过用上述静力学对应关系,将上述第2反馈控制系统的输出值变换成关节角扭矩值的机构,
将上述第2反馈控制系统的关节角扭矩值加在上述第1反馈控制系统的输出值上的机构,
根据上述关节角度和上述工具的初期姿势,运算对位置或速度指令的修正量,以使工具姿势相对于机器人底座保持一定。
为解决上述课题的第3种方法是在控制机器人的手腕位置和姿势的马达的控制装置上,
具有用作业座标的控制系统进行上述手腕位置控制的机构和用关节座标的控制系统进行上述手腕姿势控制的机构。
将该控制装置具体化的第4种方法是上述作业座标的控制系统具有以下机构:
计测机器人关节角度的机构,
根据上述关节角度运算座标系间的静力学对应关系的机构,根据上述关节角度和机器人的作业座标系上的位置指令在作业座标系上进行位置和速度状态反馈控制的机构,通过用上述静力学对应关系将上述反馈控制系统的输出值变换成关节座标系的关节角扭矩指令的机构。
第5种方法是上述作业座标的控制系统具有以下机构:
计测机器人的关节角度的机构,根据上述关节角度运算座标系间的微小变位的对应关系的机构,
根据上述关节角度和在机器人的作业座标系上的位置指令,在作业座标系上进行位置的状态反馈控制的机构,
通过用上述微小变位的对应关系,将上述位置的反馈控制系统的输出值变换成关节座标系的速度指令的机构,
根据上述速度指令和上述关节角度,在关节座标系上进行速度的状态反馈控制的机构。
附图的简单说明
图1是表示本发明第1种基本构成的框图,图2是表示本发明的具体实施例1的框图,图3是表示本发明的第1个作用的概图。
图4是表示本发明的第2种机构的基本构成的框图,图5是表示本发明的具体实施例2的框图,图6是表示本发明的第2个作用的概图。
图7是表示本发明的适用例的说明图,图8是表示本发明的第3种机构的基本构成的框图,图9是表示本发明的第3种基本构成的框图,图10是表示本发明的具体实施例3的框图。
图11是表示本发明的第4种机构的基本构成的框图,图12是表示本发明具体实施例4的框图。
图13是表示原来的控制方式的框图。
实施发明的最佳形式
以下,对本发明的实施形式进行说明。
本发明的实施形式1如图1所示,在通过具有位置和速度的状态反馈回路的控制回路40来控制驱动关节用的马达的机器人的控制装置上,用增益降低机构10将特定的关节轴Jm的位置增益或速度增益设定得比其它轴J1、J2、J3......Jn的位置增益或速度增益小或进行扭矩限制。在机器人被外部机器推压而使其特定的关节轴柔软地动作时,进行逆变换,用修正量运算机构12运算修正量,并修正指令,以保持预先在工具初期姿势存储机构11中所存储的工具的初期姿势。
另外,如图4所示,根据对机器人的关节轴的角度指令和所计测的关节角度,与关节座标系的控制回路分开地构成作业座标系的第2位置、速度的状态反馈回路13。利用增益降低机构10,将该第2位置、速度控制系统的特定轴的位置增益或速度增益设定得比其它轴的位置增益或速度增益小或进行力限制和扭矩限制。根据所计测的关节角度,用静力学对应关系式运算机构14运算座标系间的静力学对应关系式,将第2控制系统的输出变换成关节角扭矩,加到第1控制系统中。在机器人被外部机器推压、沿着作业座标系在特定的轴向或围绕轴柔软地动作的情况下,进行逆变换,运算修正量并修正指令,以保持预先所存储的工具的初期姿势。
解决上述第2个课题的机构如图8所示,在控制机器人的手腕的位置和姿势的马达的控制装置上,将机器人的各轴的控制分为控制手腕的位置的作业座标的控制系统和控制手腕的姿势的关节座标的控制系统。作业座标系的构成机构有以下2种。
第1种机构,根据机器人的关节角度和在机器人的作业座标系上的位置指令,在作业座标系上构成位置和速度的状态反馈控制。用根据关节角度运算的座标系间的静力学对应关系,可以将该反馈控制系统的输出值变换成关节座标系的关节角扭矩指令。
第2种机构,根据机器人的关节角度和在机器人的作业座标系上的位置指令,在作业座标系上构成位置的状态反馈控制。用根据关节角度运算的座标系间的微小变位的对应关系,可以将该反馈控制系统的输出值变换成关节座标系的关节角速度指令。根据该关节角速度指令和关节角度,在关节座标系上构成速度的状态反馈控制。
在各作业座标系上的状态反馈控制中,通过降低增益或限制各控制系的输出,可实现在作业座标系上平移的柔软动作。
以下,对本发明的实施例加以说明。
图2是表示具体实施例1的图,表示在通常的关节座标系的位置速度控制系统中采用本发明控制的控制框图。用关节座标系的位置速度控制的内部回路进行通常比例积分控制,但恒定地作用的力通过静态补偿要素进行补偿。
在通常的位置速度控制状态下,由于高增益的位置控制回路和速度控制回路的作用,各关节轴在外部作用力的作用下难以柔软地变位。在这里,通过降低位置回路增益和速度回路增益,各关节轴在外力作用下可柔软地变位。但是,机器人的各关节分别不规则地进行柔软动作时,不能任意地选择柔软的方向。因此,难以使安装在机器人手指尖前端上的工具的姿势保持一定进行平移的柔软动作。
因此,本发明的控制将各关节的控制系统分为原来的高刚性的位置速度回路和低刚性的位置速度回路,为了使工具相对于机器人底座的姿势保持一定,根据以低刚性的关节轴所计测的关节角度和工具的初期姿势,实时运算对高刚性的关节轴的控制系统的角度修正量。即,根据柔软的轴的变位量,使其它的轴变位,这样,在保持工具初期姿势的状态下,可进行平移的柔软动作。以下,阐述各关节的位置速度控制回路的构成。
机器人的关节自由度有n个,将第m个轴Jm(1≤m≤n)的控制系统设定成低刚性。在此,即使设定2个以上成为低刚性的轴也没有任何问题。成为低刚性的机构,是通过增益降低机构10使Jm轴的控制系统的位置回路增益和速度回路增益比其它轴的位置增益或速度增益更降低。或者,在控制系统的后端设扭矩极限,较小地减小扭矩指令本身即可。这样,将控制系统设成低刚性的情况下,重力等静态负荷另外进行补偿。
另外,将机器人实际作业时使用的在作业座标系上的工具姿势角度RX、RY、RZ存储在工具初期姿势存储机构11中或进行设定。这实际上是将在进行柔软动作之前的工具姿势角度作为工具初期姿势进行存储,或在预先知道作业内容的情况下也可以将其姿势角度进行数值输入。
在实际作业中,当外力作用在安装在机器人手指尖前端上的工具上时,只有柔软的轴,即Jm轴按照外力进行变位。其它的轴由于高的回路增益,控制系统是高刚性的,故不进行变位。在这里,用关节角度计测机构,计测Jm轴的角度FB的值θfbm(假设FB为反馈值)。用所计测的Jm轴的角度FB值θfbm、进行作业时存储或设定的工具姿势角度RX、RY、RZ及J1~Jn轴的角度指令θref1~θrefnn(除了θfbm以外),求对Jm轴以外的J1~Jn轴的角度指令修正量Δθref1~Δθrefnn。这时,J1-Jn轴(除Jm以外)是高刚性的,对于角度指令的角度FB取几乎相同的值,故也可以用角度FBθfb1~θfbn取代角度指令。
作为用修正量运算机构12求角度指令修正量Δθref1~Δθrefn的具体方法,一般采用称为逆变换或逆运动学的变换式。这通常是根据机器人手指尖前端的工具位置和姿势求各关节的角度的变换式。关于该变换式,在很多文献(例如“机器人控制基础论”:吉川恒夫著)中已有记载,故在此不作论述了。
以下,按顺序表示求角度指令修正量Δθref1~Δθrefn的方法。
(1)根据角度指令θref1~θrefn和角度FBθfbm,一般用称为顺变换或顺运动学的变换式,求作业座标系上的手腕轴的中心点即点(以下称为P点)的位置。
(2)根据所求出的P点的位置TX、TY、TZ和进行作业前所存储的工具姿势角度RX、RY、RZ,用逆变换式求J1~Jn轴的新的角度指令θref1~θrefn。
(3)通过与现在的角度指令θref1~θrefn进行差分,求角度指令修正量Δθref1~Δθrefn,将角度指令修正量加入J1~Jn轴的角度指令中。
通过实时求该运算,Jm轴即使由于外力作用产生移动,Jm轴以外的轴也动作,以相对于机器人底座保持初期的工具姿势。
图3表示在6个自由度的机器人上采用本控制方法的例子,进行说明。设定为柔软的轴,假设为J3轴,其它的J1、J2、J4、J5、J6轴设成高的回路增益,将控制系统设成高刚性的。假设来自外部的力垂直向下地作用于安装在机器人手指尖前端的工具上。
当垂直向下的力施加在工具上时,唯一柔软的J3轴向下方(在纸面上沿顺时针方向)变位。由于控制系统是高刚性的,故除此以外的轴不产生变位。因此,工具取得以虚线所描绘的姿势,结果,工具的姿势向下变化。
于是,通过进行以下的运算,修正J5轴的姿势,可以在使工具姿势保持一定的状态下几乎进行平移的柔软动作。
(1)根据位置指令θref1~θrefn和位置FBθfb3,运算关于手腕轴中心的P点的顺变换式,求作业座标系上的P点的位置TX、TY、TZ。
(2)根据所求出的P点的位置TX、TY、TZ和进行作业前存储的工具姿势角度RX、RY、RZ,用逆变换式求J5轴的新的角度指令θref5。首先,根据工具角度姿势RX、RY、RZ求(3,3)的回转行列ROT。若用XYZ固定角等表示,则可以表示如下。
在此,CR=cos R,SR=sin R。
接着,用逆正切,求新的角度指令θref5。θref5=tan-1((-cθref1sθαcθref4+sθref1sθref4)AX-(-sθref1sθαcθref4+cθreflsθref4)AY+cθαcθref4AZ)/(cθα(cθref1AX+sθref1AY)+sθαAZ)} … (2)
在此,θα是至J3~J5的联杆相对于水平面的角度,可以根据J2和J3求出。
cθrefn=cosθrefn,sθrefn=sinθrefn
(3)通过与现在的角度指令θref5进行差分,可以求角度指令修正量Δθref5,将该角度指令修正量加入J5轴的角度指令。
在此,P点的变位量相对于从J8至工具的外力作用点的距离来说非常小的情况下,可以考虑用平移的柔软控制,但在希望比较长的行程的情况下,采取以下所述的方法。
图4表示本发明的具体实施例2,进行说明。
控制方法与具体实施例1一样,目的是确实进行工具的平移柔软动作。为了进行工具的平移动作,手腕中心的P点进行平移动作即可。为了在作业座标系上进行P点的平移动作,采取的方法是除了用通常的关节座标系位置速度回路以外,还用作业座标系位置速度回路13。
在本实施例中,对于J1~Jm轴,构成作业座标系位置速度回路13,通过用该作业座标系位置速度回路13进行柔软的动作,可以确实进行平移的柔软动作。对于Jm+1~Jn轴,用现在普通的关节座标系位置速度回路进行控制。
下面,对正交3轴和回转3轴的作业座标系位置速度回路13的构成方法进行说明。
将关节座标系的位置速度控制回路上的角度指令和角度FB的信息,一般用称为顺变换或顺运动学的关节变位和机器人的作业位置的关系式(方框15),求作业座标系上的控制点的位置指令和位置FB。根据这些位置指令和位置FB,在作业座标系的XYZ轴方向和XYZ轴周向上构成位置速度控制回路13。在这里,该作业座标系的位置速度控制回路13的输出值是对作业座标系上的XYZ轴方向的力指令和XYZ轴周向的扭矩指令。作业座标系的位置速度控制回路13,通过增益降低机构10将XYZ轴的任一轴的控制系统的位置回路增益和速度回路增益降到比其它轴的位置增益或速度增益更低。或者,在控制系统的后端设限制,将力指令或扭矩指令本身减小得较小也可以。
因此,对于外部作用的力,在作业座标系上只在某特定的轴向上进行P点的平移柔软动作时,通过降低或限制该控制系统的增益对力进行限制。这样,可以设成在特定的轴向上允许位置偏差,在其它的轴向及轴周向上不允许位置偏差。
下面,方框14根据机器人现在的状态求一般称为函数行列式的行列式转置阵的关节座标系和作业座标系的静力学对应关系式,根据作业座标系的力指令和扭矩指令,可算出关节座标系的扭矩指令。
例如,3个自由度的机器人函数行列式的转置阵的计算式用下式表示。
式中:
J:函数行列式
Osi:第i关节座标的回转方向向量(以机器人的底座座标系作为基准)
Opi:第i关节位置向量(机器人的底座座标基准)
X:表示向量的外积
r:机器人的作业位置向量
T:表示行列的转置
因此,将作业座标系的输出值设为:
F=[FX,FY,FZ]T … (4)
式中,
F:力向量
FX,FY,FZ:在作业座标系上的力
将变换成关节座标系的关节角扭矩值设为:
τ=[τ1,τ2,τ3]T …(5)
式中:
τ:在关节座标系上的扭矩向量
τ:第i轴的关节座标系的扭矩
则关节座标系上的扭矩可以根据以下关系求出。
τ=JTF …(6)
因此,通过对于机器人的姿势变化,进行(3),(6)式的运算,关节控制系统的扭矩指令加上(5)式所示的扭矩指令,便可以构成可在机器人的全部动作区域进行作业座标上的平移的柔软动作的机器人柔软控制系统。
图5表示应用于实际机器人的控制系统的构成,对各要素的作用加以说明。机器人关节的自由度设为6个,分为使J1~J3轴和J4~J6轴动作的控制方法。在控制作业座标系的手腕轴中心的P点位置的J1~J3轴上构成作业座标系的位置速度回路13。在控制工具相对于作业座标系的手腕轴中心的P点的姿势的J4~J6轴上构成关节座标系的位置速度回路。这样,将位置和姿势的控制分开,便可以通过位置的控制进行平移的柔软动作,通过姿势的控制进行工具的姿势变化的修正。
(1)由于构成作业座标系的位置速度回路,故用J1~J3轴的角度指令θref1~θreF3和角度FBθfb1~θfb3,分别用顺变换式15,求对于作业座标系上的P点的位置指令和位置FB。
(2)根据作业座标系上的位置指令和位置FB,在作业座标系的XYZ轴方向上构成位置速度控制回路。在这里,作业座标系的位置速度控制回路的输出值成为对作业座标系上的XYZ轴方向的力指令。作业座标系的位置速度控制回路,通过增益降低机构10,将XYZ任一轴的控制系统的位置回路增益和速度回路增益降低得比其它轴的位置增益或速度增益低。或者,也可以在控制系统的后端设限制,将力指令本身减小得较小。
在这里,假设在作业座标系的X轴方向上进行P点的平移柔软动作。用增益降低机构10将作业座标系的X轴控制系统的位置回路增益和速度回路增益降低得比其它轴的位置增益或速度增益更低。这样,因外力作用P点位置可以在X轴方向上柔软地动作,但由于在YZ轴方向上的作业座标系的位置速度回路是高刚性的,故产生力而限制动作,以不产生偏差。
(3)方框14根据机器人的角度FBθfb1~θfb3求关节座标系和作业座标系的静力学对应关系式,通过用其转置行列式,根据作业座标系的力指令算出关节座标系的扭矩指令。
(4)将该扭矩指令加到J1~J3轴的关节座标系的扭矩指令中,这样,作业座标系上的P点可在X轴方向上进行平移的柔软动作和在YZ轴方向上进行高刚性的动作。这时,将J1~J3轴的关节座标系的位置速度回路13发出的扭矩指令设为零,可防止扭矩指令的干扰。重力等静负荷另外进行补偿。
以下表示实际上外力作用在机器人手指尖前端的工具上时的运算方法。P点位置由于在X轴方向上进行柔软动作,J1~J3轴的角度各自产生了变化。用关系角度计测机构计测这些轴的角度FBθfb1~θfb3和手腕轴J4~J6轴的角度FBθfb4~θfb6。
根据外力作用前所存储的工具的初期姿势角度RX、RY、RZ和角度FBθfb1~θfb3,可以用逆变换式重新求使工具姿势保持初期姿势的手腕轴的角度指令θref4~θref6。根据该新的角度指令θref4~θref6和现在的手腕角度FBθfb4~θfb6(或角度指令θref4~θref6),可以通过取差分求角度指令修正量Δθref4~Δθref6。将该角度指令修正量Δθref4~Δθref6加到角度指令θref4~θref6中。
关于J5轴的角度指令θref5,可以用(1)式求出。关于J4轴和J6轴的角度指令θref4和θref6可以用以下的式子求出。
θref4=tan-1{(sθref1AX-cθRef1AY)/(cθαAZ-sθα(cθref1AX+sθref1AY))} … (7)
θref6=tan-1{((cθref1sθαsθref4+sθref1cθref4)NX+(sθref1sθαsθref4-cθref1cθref4)Ny-cθαsθref4NZ)/((cθref1sθref4+sθref1cθref4)OX+(sθref1sθαsθref4-cθref1cθref4)OY-cθαsθref4OZ)} … (8)
以上的运算量非常少,故可以实时解明。
图6表示在6个自由度的机器人上采用本控制方法的动作例子,进行说明。
设定成柔软的轴作为作业座标系的Z轴,其他的XY轴和手腕轴即J4~J6轴设成高回路增益,将控制系统设成高刚性。假设外部的力垂直向下地作用于安装在机器人手指前端的工具上。
手腕轴的中心即P点,由于作业座标系的位置速度回路的作用,在外力作用下只在垂直方向(Z轴方向)上柔软地动作,故沿着图中的虚线移动。P点向下方移动,手腕轴的角度(在这里是J5轴)变成如虚线所示那样。但是,与P点的移动相一致地运算ΔJ5,通过使J5轴变化,工具相对于机器人底座保持初期姿势状态,J5轴变成实线所示的状态,工具在垂直方向上平行移动。即,工具也沿着图中的虚线移动。这时,关于手腕轴,由于只指教了初期的工具姿势,故可以与P点的平移动作相一致地使机器人动作,以使工具姿势保持一定。
例如,图7表示本发明应用于压铸操作的情况,进行说明,压铸操作是用机器人21的手腕22把持压铸成型品即工件23,从压铸设备中取出的作业。在机器人21用手24把持工件23的状态,将用活塞25从铸模26中推压的力F设定在沿作业座标系的Y轴的方向a上,机器人21必须沿着方向a移动。这里,若稍向方向b移动,则扭转力便作用于工件23上,在铸模26中产生变形或破损。原来,在手24部分上装上滑块等机械性机构来吸收力,故机器人的可搬重量减少,必须将外力的方向正确地指教给滑块的动作方向等,很费事。
在本实施例中,沿着方向a构成作业座标系的位置速度回路,将Y轴方向设定成柔软的方式(降低增益或限制力),这样,P点只在方向a上柔软地动作。机器人21的P点被活塞25推出,但为了使作业座标系的手24的姿势保持一定而运算对手腕部分的修正量,故工件23从铸模23中笔直地被推出。这时,不用关节轴单位,可以在作业座标系上设定机器人的柔软方向和柔软度,故指教作业可非常简单地进行。
图9表示本发明的具体实施例3,进行说明。
图9表示在通常的关节座标系上的位置速度控制系统中采用本发明的控制方法的控制框图。
在上述实施例中,P点位置的控制系统和作业座标系的位置速度回路及关节座标系的位置速度回路并用。
因此,本实施例的控制,将机器人的各关节的控制系统完全地分为控制手腕轴的中心点的位置(以下称为P点)用的正交座标系的位置速度控制系统30和控制工具的姿势用的关节座标系的位置速度控制系统40,将正交座标系的位置速度控制的特定轴设成柔软的方式,这样,可进行作业座标系的平移的柔软动作。由于只集中到除回转以外的平移,仅用正交座标系构成位置速度回路,故可使运算量减半。
以下,对本实施例的各关节的位置速度控制回路的构成加以说明。将机器人关节的自由度设为n个。其中,用正交座标系的位置速度回路构成从机器人的底座至第m个轴(以下称为基本轴)的控制系统。另外,用关节座标系的位置速度回路41构成第m+1~第n个轴(以下称为手腕轴)的控制系统。正交座标系的构成机构,用基本轴的各关节的角度检测值,并且用一般称为顺变换或顺运动学的关节变位和机器人的作业位置的关系式,求关于在作业座标系上的手腕中心点(以下称为P点)的位置FB。根据该位置FB和在作业座标系上的P点的位置指令,在作业座标系的XYZ轴方向上构成位置速度控制回路。在这里,作业座标系的位置速度控制回路的输出值成为对作业座标系上的XYZ轴方向的力指令。作业座标系的位置速度控制回路,通过增益降低机构32将XYZ轴的任一控制系统的位置回路增益和速度回路增益降低得比其它轴的位置增益或速度增益要低。或者,虽未图示,在速度控制系统的后端设限制,将力指令减小得较小即可。因此,在将控制系统设为低刚性的情况下,重力等静负荷另外进行补偿。
下面,根据机器人现在的状态,求一般称为函数行列式的行列转置阵的关节座标系和作业座标系的静力学对应关系式,根据作业座标系的力指令可算出关节座标系的扭矩指令。并且,用上述(3)式~(6)式,针对机器人的姿势变化,进行(3)、(6)式的运算,将(5)式所示的扭矩指令加到关节控制系统的扭矩指令中,这样可以构成在机器人的全部动作区域可进行作业座标上的平移的柔软动作的机器人柔软控制系统。
手腕轴的关节座标系的位置控制回路中,用通常的位置回路增益、速度回路增益按高刚性进行位置控制,或将位置回路增益、速度回路增益降低得比其它轴的位置增益或速度增益更小,按低刚性进行柔软控制。另外,作为低刚性的机构,虽未进行图示,但也可以在速度控制器的后段设限制代替降低增益。
图10表示应用于实际机器人上的控制系统的构成,对各要素的作用加以说明。
机器人关节的自由度设为6个,分为使J1~J3轴和J4~J6轴动作的控制方法。在控制作业座标系的P点的位置的J1~J3轴上构成作业座标系30的位置速度回路31。在控制作业座标系的工具姿势的J4~J6上构成关节座标系40的位置速度回路41。这样,由于分为位置和姿势的控制,可以用位置的控制进行平移的柔软动作,用姿势的控制修正工具的姿势变化。
(1)由于构成作业座标系的位置速度回路41,故根据J1~J3轴的角度检测值θfb1~θfb3,用顺变换式求作业座标系上的P点的位置(角度)FB(检测值)。
(2)根据作业座标系上的位置指令和位置FB,在作业座标系的XYZ轴方向上构成位置速度控制回路31。在此,作业座标系的位置速度控制回路31的输出值成为向作业座标系上的XYZ轴方向的力指令[FX、FY、FZ]。作业座标系的位置速度控制回路31通过增益降低机构32将XYZ任一轴的控制系统的位置回路增益及速度回路增益降低得比其它轴的位置增益或速度增益更低。或者,在速度控制系统的后端设限制,减小力指令自身。
(3)然后,根据机器人的角度FBθfb1~θfb3,求关节座标系和作业座标系的静力学对应关系式,用其转置阵式,根据XYZ轴的作业座标系的力指令,算出J1~J3轴的关节座标系的扭矩指令。
(4)通过用该扭矩指令控制各关节的马达,可实现作业座标系的P点的平移柔软动作。这时,重力等静负荷另外进行补偿。
下面,利用上述的图6,对将本控制方法应用于6个自由度的机器人上的动作例进行说明。
假设在作业座标系的Z轴方向上进行P点的平移柔软动作。利用增益降低机构将作业座标系的Z轴控制系的位置回路增益和速度回路增益降低得比其它轴的位置增益或速度增益更低。这样,通过外力作用P点位置可以沿着Z轴方向柔软地动作,但在XY轴方向上作业座标系的位置速度回路则高刚性地动作,故产生力限制动作,以不产生偏差。
手腕轴的中心即P点,由于作业座标系的位置速度回路的作用,通过外力作用只在垂直方向(Z轴方向)上柔软地动作,故在图中的虚线上移动。P点向下方移动,手腕轴的角度(在此为J5轴)变成虚线所示那样。但是,通过与P点的移动速度相一致地指数ΔJ5,在工具相对于机器人底座保持初期姿势的状态下,工具在垂直方向上平行地移动。即,工具也在图中的虚线上移动。
图11表示本发明具体实施例4,进行说明。
首先,对本发明的各关节的位置速度控制回路的构成加以说明。
机器人的关节自由度设为n个。其中,用正交座标系的位置回路51和关节座标系的速度回路52构成从机器人的底座至第m个轴J1~Jm(以下称为基本轴)的控制系统50。另外,用关节座标系的位置速度回路61构成第m+1~第n个轴Jm+1~Jn(以下称为手腕轴)的控制系统60。
正交座标系的构成方法与具体实施例3一样,用基本轴的各关节的角度检测值求作业座标系上的P点的位置(角度)FB。根据该位置FB和作业座标系上的P点的位置指令,在作业座标系的XYZ轴方向上构成位置控制回路51。在这里,作业座标系的位置控制回路51的输出值成为向作业座标系上的XYZ轴方向的速度指令。作业座标系的位置控制回路51通过增益降低机构53,将XYZ轴的任一控制系统的位置回路增益降低得比其它轴的位置增益要低。或者,虽未进行图示,但也可以在位置控制系统的后端设限制,减小速度指令。这样,将控制系统设成低刚性的,重力等静负荷另外进行补偿。
然后,根据机器人的现在状态,求一般称为函数行列式的行列式逆行列的关节座标系和作业座标系的微小变位的对应关系式,根据作业座标系的速度指令可算出关节座标系的速度指令。
例如,在3个自由度的机器人上函数行列式的逆行列的计算式用下式表示。
作业座标系的速度指令用下式表示:
V=[VX,VY,VZ]T … (10)
式中,
V:速度指令向量
VX,VY,VZ:作业座标系上的速度指令变换为关节座标系的关节角速度指令用下式表示:
v=[V1,V2,V3]T … (11)
式中,
V:关节座标系上的速度指令向量
Vi:第i轴的关节座标系的速度指令
则关节座标系上的速度指令可以根据以下关系求出。
v=J-1V … (12)
因此,对于机器人的姿势变化,进行(9)、(12)式运算,根据(11)式所示的关节控制系统的速度指令和由各关节的角度检测所求出的速度FB,进行关节座标系的速度反馈控制,求关节座标系上的扭矩指令。手腕轴的关节座标系的位置控制回路设成与具体实施例3一样。
图12表示应用于实际机器人上的控制系统的构成,对各要素的作用加以说明。
将机器人的关节自由度设为6个,分别使J1~J3轴和J4~J6轴动作的控制方法。在控制作业座标系的P点位置的J1~J3轴上构成作业座标系的位置回路51和关节座标系上的速度回路52。在控制作业座标系的工具姿势的J4~J6轴上,构成关节座标系的位置速度回路61。这样,由于分为位置和姿势的控制,可以用位置的控制进行平移的柔软动作,用姿势的控制进行工具姿势变化的修正。
(1)由于构成作业座标系的位置速度回路,故用顺变换式根据J1~J3轴的角度检测值θfb1~θfb3,求作业座标系上的P点的位置FB(检测值)。
(2)根据作业座标系上的位置指令和位置FB,在作业座标系的XYZ轴方向上构成位置控制回路。在此,作业座标系的位置控制回路的输出值成为向作业座标系的XYZ轴方向发出速度指令[VX、VY、VZ]。作业座标系的位置控制回路通过增益降低机构53,将XYZ任一轴的控制系统的位置回路增益降低得比其它轴的位置增益更低。或者,在位置控制系统的后端设限制,减小速度指令。
(3)然后,根据机器人的角度FBθfb1~θfb3求关节座标系和作业座标系的微小变位的对应关系式,用其逆行列式,根据XYZ轴的作业座标系的速度指令,算出J1~J3轴的关节座标系的速度指令。
(4)用该速度指令和角度检测值,构成关节座标系50上的速度控制回路52,运算扭矩指令。通过用该扭矩指令控制各关节的马达,于是,作业座标系的P点可实现平移的柔软动作。这时,重力等静负荷另外进行补偿。以上的运算,对于构成机器人的轴来说,关于手腕的位置构成作业座标系,进行平移的柔软动作,故运算量少,可实时解明。
如上所述,根据本发明,可获得下述效果。
(1)由于将各关节的控制系统分为现有的高刚性的位置速度回路和低刚性的位置速度回路,根据因外力作用由低刚性的关节轴进行变位的关节角度和预先所存储的工具的初期姿势,实时运算对高刚性的关节轴的角度修正量,以使工具姿势相对于机器人底座保持一定,故不需要专用工具和力传感器,运算量也可以非常少,可以进行使作业座标系上的工具姿势保持一定的平移柔软控制。
(2)不需要以前必须具有的力传感器和滑块等机构性机构,不会使机器人的可搬重量减少,指教作业也容易,可非常简单地实现作业座标系上的平移的柔软控制。
(3)用关节座标系和作业座标系分别组成位置、速度的状态反馈回路,采用利用了关节角的位置信息的关节座标系和作业座标系的静力学对应关系式,使两个控制系统的输出组合起来,这样,对于外部所作用的力,可以只在作业座标系上某特定的方向上正确地限制前端的作业位置的动作,通过非常简单的运算,可以在保持工具相对于机器人底座为初期姿势的状态下,容易地实现平移的柔软控制。
(4)由于将机器人的各关节的控制系统分为控制手腕的位置的作业座标系上的反馈回路和控制手腕的姿势的关节座标系上的反馈回路,降低作业座标系的特定轴的增益或设限制,故不需要专用工具和力传感器,运算量也可以非常少,可以进行作业座标系上的平移的柔软控制。
产业上利用的可能性
本发明作为通过简单的处理使作业座标系的工具姿势保持一定、进行平移的柔软动作的机器人控制装置是有用的。
Claims (10)
1.一种机器人的控制装置,该机器人控制装置用具有位置和速度的状态反馈回路的控制回路来控制驱动关节用的马达,其特征在于,具有以下机构:
计测机器人的关节角度的机构,
存储安装在机器人手指尖前端的工具的初期姿势的机构,
将特定的关节轴的位置增益或速度增益设定得比其它关节轴的位置增益或速度增益小的机构,
根据上述关节角度和工具的初期姿势,运算对上述其它关节轴的位置或速度指令的修正量的机构,以使工具姿势相对于机器人底座保持一定。
2.根据权利要求1所记载的机器人的控制装置,其特征在于,还具有以下机构:
根据上述关节角度运算作业座标系和关节坐标系间的静力学对应关系的机构,
根据上述关节角度和机器人的作业座标系上的位置指令,进行与上述关节坐标系的控制回路分开的作业坐标系的位置、速度的状态反馈控制的机构,
通过用上述静力学对应关系,将上述作业坐标系的反馈控制系统的输出值变换成关节角扭矩值的机构,
将上述作业坐标系的反馈控制系统的关节角扭矩值加在上述关节坐标系的反馈控制系统的输出值上的机构,
上述特定关节轴是上述作业坐标系的反馈控制系统的特定轴。
3.根据权利要求1或2所记载的机器人控制装置,其特征在于,在关节坐标系的速度控制器的后段具有设扭矩极限的机构,用来取代将上述特定关节轴的位置增益或速度增益设定得较小的机构。
4.根据权利要求1或2所记载的机器人控制装置,其特征在于,在控制机器人的手腕位置和姿势的马达的控制装置上,具有下述机构:
用作业坐标系的状态反馈控制来进行上述手腕位置控制的机构,
用关节座标系的状态反馈控制来进行上述手腕姿势控制的机构。
5.根据权利要求4所记载的机器人控制装置,其特征在于,上述作业座标的控制系统具有以下机构:
计测机器人的关节角度的机构,
根据上述关节角度运算座标系间的静力学对应关系的机构,
根据上述关节角度和机器人的作业座标系上的位置指令在作业座标系上进行位置和速度状态反馈控制的机构,
通过用上述静力学对应关系将上述反馈控制系统的输出值变换成关节座标系的关节角扭矩指令的机构。
6.根据权利要求5所记载的机器人控制装置,其特征在于,具有将上述作业座标系的位置、速度的状态反馈控制的特定轴的位置增益或速度增益设定得比其它轴的位置增益或速度增益小的机构。
7.根据权利要求5所记载的机器人控制装置,其特征在于,在作业坐标系的速度控制器的后段具有设扭矩极限的机构,用来代替将在上述作业座标系的位置、速度的状态反馈控制中的特定轴的位置增益或速度增益设定得较小的机构。
8.根据权利要求4所记载的机器人控制装置,其特征在于,上述作业座标的控制系统具有以下机构:
计测机器人的关节角度的机构,
根据上述关节角度运算座标系间的微小变化的对应关系的机构,
根据上述关节角度和在机器人的作业座标系上的位置指令,在作业座标系上进行位置的状态反馈控制的机构,
通过用上述微小变化的对应关系,将上述位置的反馈控制系统的输出值变换成关节座标系的速度指令的机构,
根据上述速度指令和上述关节角度,在关节座标系上进行速度的状态反馈控制的机构。
9.根据权利要求8所记载的机器人控制装置,其特征在于,具有将上述作业座标系的位置状态反馈控制的特定关节轴的位置增益设定得比其它轴的位置增益小的机构。
10.根据权利要求8所记载的机器人控制装置,其特征在于,在作业坐标系的位置控制器的后段具有设位置偏差限制的机构,用来代替将上述作业座标系的位置状态反馈控制的特定关节轴的位置增益设定得较小的机构。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP33878999A JP3473834B2 (ja) | 1999-11-29 | 1999-11-29 | ロボットの制御装置 |
JP338789/1999 | 1999-11-29 | ||
JP338789/99 | 1999-11-29 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN1433352A CN1433352A (zh) | 2003-07-30 |
CN1283426C true CN1283426C (zh) | 2006-11-08 |
Family
ID=18321495
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CNB008186863A Expired - Fee Related CN1283426C (zh) | 1999-11-29 | 2000-11-29 | 机器人的控制装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US6919701B2 (zh) |
EP (1) | EP1234641A4 (zh) |
JP (1) | JP3473834B2 (zh) |
KR (1) | KR100629469B1 (zh) |
CN (1) | CN1283426C (zh) |
WO (1) | WO2001038048A1 (zh) |
Families Citing this family (48)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8004229B2 (en) | 2005-05-19 | 2011-08-23 | Intuitive Surgical Operations, Inc. | Software center and highly configurable robotic systems for surgery and other uses |
US9517106B2 (en) | 1999-09-17 | 2016-12-13 | Intuitive Surgical Operations, Inc. | Systems and methods for commanded reconfiguration of a surgical manipulator using the null-space |
KR100661106B1 (ko) * | 2002-04-05 | 2006-12-26 | 미쓰비시덴키 가부시키가이샤 | 모터의 제어장치 |
US7212886B2 (en) * | 2002-12-12 | 2007-05-01 | Kabushiki Kaisha Yaskawa Denki | Robot control apparatus and method |
DE10342471B4 (de) * | 2003-09-15 | 2007-08-16 | Dürr Systems GmbH | Regeleinrichtung für einen mehrachsigen Roboter |
JP4808630B2 (ja) * | 2003-12-05 | 2011-11-02 | エムティエス・システムズ・コーポレーション | 測定された応答と仮想モデルとの統合により試験を拡張する方法 |
JP4960589B2 (ja) * | 2004-12-08 | 2012-06-27 | 川崎重工業株式会社 | ロボット制御装置およびロボット制御方法 |
JP4281696B2 (ja) * | 2005-03-14 | 2009-06-17 | セイコーエプソン株式会社 | 加減速制御方法及び装置並びに加減速制御方法のプログラム |
DE102005032336B4 (de) * | 2005-07-08 | 2008-09-04 | Fachhochschule Aschaffenburg | Verfahren zur Beeinflussung einer Steuerung oder zur Steuerung einer Bewegungseinrichtung und Steuerung oder Steuerungskomponente einer Bewegungseinrichtung |
JP4202365B2 (ja) * | 2006-03-07 | 2008-12-24 | ファナック株式会社 | 力制御装置 |
JP2008073830A (ja) * | 2006-09-25 | 2008-04-03 | Fanuc Ltd | ロボット制御装置 |
JP2008302449A (ja) * | 2007-06-06 | 2008-12-18 | Fanuc Ltd | ロボット制御装置 |
US7979160B2 (en) * | 2007-07-31 | 2011-07-12 | Spirit Aerosystems, Inc. | System and method for robotic accuracy improvement |
WO2009034957A1 (ja) * | 2007-09-14 | 2009-03-19 | Kabushiki Kaisha Yaskawa Denki | ロボットの力制御方法、制御装置およびロボットシステム |
US8239063B2 (en) * | 2008-07-29 | 2012-08-07 | Fanuc Robotics America, Inc. | Servo motor monitoring and hood/deck exchange to enhance the interior coating process |
KR101537039B1 (ko) * | 2008-11-28 | 2015-07-16 | 삼성전자 주식회사 | 로봇 및 그 제어방법 |
JP4947073B2 (ja) * | 2009-03-11 | 2012-06-06 | トヨタ自動車株式会社 | ロボット装置及びその制御方法 |
EP2243586B1 (de) * | 2009-04-22 | 2014-07-02 | KUKA Roboter GmbH | Verfahren und Kontrollvorrichtung zum Schweißen mittels einer Positioniervorrichtung |
US8989898B2 (en) * | 2009-10-22 | 2015-03-24 | Electroimpact, Inc. | Robotic manufacturing system with accurate control |
KR101459174B1 (ko) * | 2010-10-19 | 2014-11-10 | 현대중공업 주식회사 | 산업용 다관절 로봇의 제어 장치 및 방법 |
US9119655B2 (en) | 2012-08-03 | 2015-09-01 | Stryker Corporation | Surgical manipulator capable of controlling a surgical instrument in multiple modes |
CN103732363A (zh) * | 2011-08-19 | 2014-04-16 | 株式会社安川电机 | 机器人系统、机器人控制装置、机器人手部及机器人控制方法 |
JP5374613B2 (ja) * | 2012-05-30 | 2013-12-25 | 株式会社神戸製鋼所 | 多関節ロボットの弾性変形補償制御装置および制御方法 |
CN107595392B (zh) | 2012-06-01 | 2020-11-27 | 直观外科手术操作公司 | 使用零空间回避操纵器臂与患者碰撞 |
KR102146708B1 (ko) | 2012-06-01 | 2020-08-21 | 인튜어티브 서지컬 오퍼레이션즈 인코포레이티드 | 영-공간을 이용하여 매니퓰레이터 암들 사이의 충돌을 회피하는 시스템 및 방법 |
JP6291484B2 (ja) | 2012-06-01 | 2018-03-14 | インテュイティブ サージカル オペレーションズ, インコーポレイテッド | ゼロ空間を使用して手術用マニピュレータの命令された再構成を取るためのシステム及び方法 |
US9226796B2 (en) | 2012-08-03 | 2016-01-05 | Stryker Corporation | Method for detecting a disturbance as an energy applicator of a surgical instrument traverses a cutting path |
CA2879414A1 (en) | 2012-08-03 | 2014-02-06 | Stryker Corporation | Systems and methods for robotic surgery |
CN105338920B (zh) * | 2013-03-15 | 2018-01-26 | 直观外科手术操作公司 | 用于利用零空间跟踪路径的系统和方法 |
JP6137976B2 (ja) * | 2013-07-25 | 2017-05-31 | オリンパス株式会社 | マニピュレータシステム |
JP2015033747A (ja) * | 2013-08-09 | 2015-02-19 | 株式会社安川電機 | ロボットシステム、ロボット制御装置及びロボット制御方法 |
EP3119342B1 (en) | 2014-03-17 | 2021-05-12 | Intuitive Surgical Operations, Inc. | System for maintaining a tool pose |
JP5946859B2 (ja) * | 2014-04-14 | 2016-07-06 | ファナック株式会社 | 力に応じて動かすロボットのロボット制御装置およびロボットシステム |
JP5897662B2 (ja) * | 2014-07-30 | 2016-03-30 | ファナック株式会社 | 複数軸の加工精度を向上させるサーボモータの制御装置 |
JP2016064479A (ja) * | 2014-09-25 | 2016-04-28 | ファナック株式会社 | ロボット制御装置 |
US9592608B1 (en) * | 2014-12-15 | 2017-03-14 | X Development Llc | Methods and systems for providing feedback during teach mode |
KR102312368B1 (ko) * | 2015-08-04 | 2021-10-12 | 한국전기연구원 | 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 |
JP6332197B2 (ja) * | 2015-08-11 | 2018-05-30 | トヨタ自動車株式会社 | モータの制御装置 |
KR20180059888A (ko) | 2015-10-14 | 2018-06-05 | 카와사키 주코교 카부시키 카이샤 | 로봇교시방법 및 로봇 암 제어장치 |
US9919422B1 (en) | 2016-01-06 | 2018-03-20 | X Development Llc | Methods and systems to provide mechanical feedback during movement of a robotic system |
JP6666234B2 (ja) * | 2016-11-29 | 2020-03-13 | ファナック株式会社 | 数値制御装置 |
KR102221089B1 (ko) * | 2018-12-05 | 2021-02-26 | (주)미래컴퍼니 | 수술용 슬레이브 암을 원격으로 제어하는 방법 및 시스템 |
CN109352661B (zh) * | 2018-12-11 | 2022-01-18 | 上海辛格林纳新时达电机有限公司 | 一种机器人关节的控制方法、伺服驱动装置和可存储介质 |
JP7451940B2 (ja) * | 2019-10-31 | 2024-03-19 | セイコーエプソン株式会社 | 制御方法および算出装置 |
CN113768640B (zh) * | 2021-11-09 | 2022-02-08 | 极限人工智能有限公司 | 一种确定机械臂工作位姿的方法和装置 |
CN115157256B (zh) * | 2022-07-20 | 2024-08-20 | 燕山大学 | 可自动切换工作模式的遥操纵机器人系统控制方法 |
CN117001662B (zh) * | 2023-07-20 | 2024-05-31 | 北京纳通医用机器人科技有限公司 | 一种机械臂控制方法、装置、设备及存储介质 |
CN118161835B (zh) * | 2024-05-13 | 2024-07-26 | 江西求是高等研究院 | 一种机械臂助力控制方法、康复机器人、计算机及介质 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62172581U (zh) * | 1986-04-22 | 1987-11-02 | ||
JPH01116704A (ja) * | 1987-10-30 | 1989-05-09 | Fanuc Ltd | 産業ロボットの動作制御方式 |
US4808063A (en) * | 1987-11-03 | 1989-02-28 | Westinghouse Electric Corp. | Robot system employing force/position control |
JP3207409B2 (ja) * | 1988-03-10 | 2001-09-10 | ファナック株式会社 | ロボットのツール姿勢制御方法 |
JP2582445B2 (ja) | 1989-10-16 | 1997-02-19 | 三菱重工業株式会社 | 関節形マニュピュレータの手先方向演算装置 |
JP3283650B2 (ja) * | 1993-07-05 | 2002-05-20 | ファナック株式会社 | ロボット制御装置 |
JP2619227B2 (ja) * | 1994-11-30 | 1997-06-11 | 川崎重工業株式会社 | ロボットの制御方法および装置 |
JP3681431B2 (ja) | 1995-02-21 | 2005-08-10 | ファナック株式会社 | 直交座標系上で柔らかさが調節可能なサーボ系 |
WO1997010081A1 (fr) * | 1995-09-11 | 1997-03-20 | Kabushiki Kaisha Yaskawa Denki | Circuit de commande de robots |
JP3207728B2 (ja) * | 1995-10-11 | 2001-09-10 | 三菱重工業株式会社 | 冗長マニピュレータの制御方法 |
JP2682977B2 (ja) | 1995-12-25 | 1997-11-26 | 川崎重工業株式会社 | ロボットの制御方法および装置 |
JPH11149304A (ja) | 1997-11-17 | 1999-06-02 | Yaskawa Electric Corp | 産業用ロボットの制御装置 |
JP4134369B2 (ja) * | 1998-02-09 | 2008-08-20 | 株式会社安川電機 | ロボットの制御装置 |
EP1847892A3 (en) * | 1998-09-28 | 2007-10-31 | Kabushiki Kaisha Yaskawa Denki | Position controller |
-
1999
- 1999-11-29 JP JP33878999A patent/JP3473834B2/ja not_active Expired - Fee Related
-
2000
- 2000-11-29 KR KR1020027006911A patent/KR100629469B1/ko not_active IP Right Cessation
- 2000-11-29 US US10/130,283 patent/US6919701B2/en not_active Expired - Fee Related
- 2000-11-29 CN CNB008186863A patent/CN1283426C/zh not_active Expired - Fee Related
- 2000-11-29 WO PCT/JP2000/008463 patent/WO2001038048A1/ja active IP Right Grant
- 2000-11-29 EP EP00978030A patent/EP1234641A4/en not_active Withdrawn
Also Published As
Publication number | Publication date |
---|---|
WO2001038048A1 (fr) | 2001-05-31 |
KR100629469B1 (ko) | 2006-09-27 |
CN1433352A (zh) | 2003-07-30 |
US6919701B2 (en) | 2005-07-19 |
JP3473834B2 (ja) | 2003-12-08 |
EP1234641A1 (en) | 2002-08-28 |
KR20020067690A (ko) | 2002-08-23 |
EP1234641A4 (en) | 2010-05-19 |
JP2001157975A (ja) | 2001-06-12 |
US20030025473A1 (en) | 2003-02-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN1283426C (zh) | 机器人的控制装置 | |
CN1131766C (zh) | 机器人控制设备 | |
CN1868690A (zh) | 用于修正示教点的装置、程序、记录介质及方法 | |
CN1068253C (zh) | 弯板机 | |
CN1064427C (zh) | 建筑机械用的限定区域挖掘控制系统 | |
CN1522829A (zh) | 数字控制装置及数字控制方法 | |
Pan et al. | Robotic machining from programming to process control: a complete solution by force control | |
CN1845025A (zh) | 用零相位误差跟踪控制和干扰观测提高轮廓加工精度方法 | |
CN1240016C (zh) | 基于预先规定的时间上最优的轨迹形状的机器人操纵器 | |
CN101062561A (zh) | 机器人操作参数调整方法和装置以及用于该方法的程序和记录介质 | |
CN101076763A (zh) | 机器人系统 | |
CN1181416C (zh) | 预测控制设备 | |
CN1150450C (zh) | 综合控制器,综合控制系统和传输控制器 | |
CN1738699A (zh) | 机器人控制装置 | |
CN1680893A (zh) | 减振控制装置 | |
CN1714965A (zh) | 锻压机床的伺服电动机控制装置 | |
CN1905982A (zh) | 焊接系统及自耗电极式焊接方法 | |
CN1894640A (zh) | 一种控制多轴线自动装置的运动部分位移的方法和装置 | |
CN1484118A (zh) | 过程控制器的无模型自适应 | |
CN101076426A (zh) | 惯性摩擦焊方法和系统 | |
CN1066083C (zh) | 圆柱件夹持器、具有夹持器的机加工设备及其机加工方法 | |
CN1522487A (zh) | 同步电机的电流控制方法和控制装置 | |
CN112601640A (zh) | 机器人调节 | |
CN1372785A (zh) | 零件识别方法及装置和零件安装方法及装置 | |
Özer et al. | Experimental implementation and analysis of robotic metal spinning with enhanced trajectory tracking algorithms |
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: 20061108 Termination date: 20171129 |
|
CF01 | Termination of patent right due to non-payment of annual fee |