CN102608969A - 基于红外光学定位的串联型机器人手眼配准控制方法 - Google Patents
基于红外光学定位的串联型机器人手眼配准控制方法 Download PDFInfo
- Publication number
- CN102608969A CN102608969A CN2012100535835A CN201210053583A CN102608969A CN 102608969 A CN102608969 A CN 102608969A CN 2012100535835 A CN2012100535835 A CN 2012100535835A CN 201210053583 A CN201210053583 A CN 201210053583A CN 102608969 A CN102608969 A CN 102608969A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- robot
- controller
- arm
- locating support
- 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.)
- Granted
Links
Images
Classifications
-
- 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Manipulator (AREA)
Abstract
Description
技术领域
本发明涉及红外光学定位技术,属于机器人设计领域,具体涉及一种基于红外光学定位的串联型机器人手眼配准控制方法。
背景技术
机器人的“手”是机器人操作臂,机器人的“眼”是指用于给机器人导航的双目视觉,主要包括可见光双目视觉与红外线双目视觉,在医疗领域,常用的是基于红外光学定位的双目视觉,即红外光学定位仪。
红外光学定位仪用于空间测量与定位,在进行空间测量与定位过程中,需要探测安装在定位支架上面的红外反光球,二者之间需要无遮挡的光线通路,如果红外光学定位仪中的摄像头和反光球之间的光线通路被遮挡,将无法实现空间测量与定位功能。
机器人的“手眼”配准主要是为了建立机器人坐标系和视觉测量坐标系之间的关系,机器人操作臂的末端执行器需要到达的目标位姿建立在视觉测量坐标系中,而末端执行器的当前位姿是建立在机器人坐标系中,为了控制末端执行器从当前位姿到达目标位姿,需要将末端执行器目标位姿在机器人坐标系中进行描述,即在建立了机器人坐标系和视觉测量坐标系之间的关系之后,将末端执行器目标位姿从视觉测量坐标系转化到机器人坐标系中,这个过程即为机器人“手眼”配准。
在现有的所设计的串联型机器人上,定位支架被安装在机器人臂的末端执行器中,在机器人手眼配准过程中,若采用红外光学定位仪来探测定位末端执行器和工件上的定位支架,而在机器人操作臂数目增多,并且操作臂之间的工作空间狭窄等情况下,容易出现操作臂上的末端执行器定位支架之间相互遮挡的现象,这就会导致红外光学定位仪对于定位支架的空间测量和定位出错,从而降低了红外光学定位仪测量精度和机器人操作臂的工作准确度。
发明内容
有鉴于此,本发明提供了一种基于红外光学定位的串联型机器人手眼配准控制方法,以达到提高机器人操作臂的工作准确度的目的。
本发明所提供的方法涉及的设备包括控制器、红外光学定位仪、串联型n臂机器人、n个工件、n+1个带有4个反光球的定位支架,该n+1个定位支架的支架臂长度和/或支架臂夹角互不相同,n为整数。将其中一个定位支架置于机器人底座的上表面中心点处,将剩余n个定位支架分别置于n个工件上。该方法的具体步骤为:
S00、所述控制器建立所述n臂机器人的操作空间坐标系Or、所述红外光学定位仪的测量空间坐标系Oc以及n臂机器人操作臂的n个末端执行器的坐标系Ot1、...、Otn;同时,红外光学定位仪建立机器人底座上的定位支架坐标系Op以及各工件上的定位支架坐标系Ow1、...、Own,并传送至控制器。
S02、控制器根据各末端执行器坐标系Ot1、...、Otn以及操作空间坐标系Or,采用机器人正运动学原理分别得到Ot1、...、Otn在Or下的位姿矩阵 即各末端执行器坐标系在操作空间坐标系Or下的当前位姿:
S04、控制器根据所得到的位姿矩阵以及奇次变换矩阵计算得到各定位支架坐标系Ow1,...,Own分别在操作空间坐标系Or下的位姿矩阵:i=1,...,n;所得到的分别为各末端执行器坐标系Ot1、...、Otn分别在操作空间坐标系Or下的目标位姿。
S05、控制器根据所得到的采用机器人逆运动学原理计算并得到相应操作臂的各关节变量初始值,同样地,控制器根据计算得到相应操作臂的各关节变量目标值;控制器计算每个操作臂的关节变量初始值和目标值的差值,并将所得到的差值作为每个操作臂的关节运动量。
S06、控制器根据步骤S05所得到的关节运动量,控制n臂机器人的各末端执行器,使得每个末端执行器运动到相应的目标位姿,最终每个末端执行器夹持到相应的工件。
有益效果:
本发明所提供的方法是将定位支架安装在串联型机器人本体上来实现机器人操作臂和红外光学定位仪之间的手眼配准,最终使得机器人操作臂夹持到相应的工件,在机器人操作臂数目增多的情况下,当机器人工作时,安装在机器人本体上的定位支架不会受到机器人操作臂的遮挡,并且也不会发生由于机器人操作臂之间相互遮挡而导致操作臂末端执行器出现空间定位出错的现象,这样就提高了配准的精确度,从而达到了提高机器人操作臂的工作准确度的目的。
此外,在采用红外光学定位仪进行测量的过程中,相较于传统的方法,由于机器人本体上仅设置了一个定位支架,使得红外光学定位仪在定位过程中不会受到机器人操作臂数量的影响,这样就提高了红外光学定位仪进行空间定位的工作效率。
附图说明
图1为红外光学定位仪的空间测量与定位示意图;
图2为本发明所提供的机器布置示意图;
图3为本发明所提供的坐标系示意图;
其中,1-红外光学定位仪;2-摄像头;3-红外发射器;4-反光球;5-定位支架;6-三臂机器人;7-滑块;8-连杆;9-末端执行器;10-第一工件;11-第一定位支架;12-第二定位支架;13-第三定位支架;14-第四定位支架。
具体实施方式
下面结合附图,对本发明进行详细描述。
图1为现有技术中红外光学定位仪的工作示意图。红外光学定位仪1上设置有两个摄像头2,每个摄像头2周围布置有红外发射器3,红外发射器3向周围环境发射红外线,红外线经定位支架5上的每个反光球4反射后,两个摄像头2接收反射红外线,这样红外光学定位仪1计算得到每个反光球4的空间位置,红外光学定位仪1即可建立定位支架5的空间坐标系,同时得到定位支架在红外光学定位仪1坐标系下的位姿矩阵。
本发明提供了一种基于红外光学定位的串联型机器人手眼配准方法,该方法所涉及的设备包括控制器、红外光学定位仪、串联型n臂机器人、n个工件、n+1个带有4个反光球的定位支架,n为整数。将其中一个定位支架置于机器人底座的上表面中心点处,将剩余n个定位支架分别置于n个工件上。由于本发明所提供的方法是为了解决串联型机器人操作臂之间相互遮挡的问题,并结合目前机器人应用领域中所常用的机器人操作臂个数,所述n的取值范围,较佳地为2~4。下面举一个n取3时的实施例:
图2示出了一个串联型三臂机器人6与红外光学定位仪1的布置示意图,该三臂机器人6的每个操作臂连接一个滑块7,滑块7可沿底座上的滑轨进行上下滑动,每个操作臂包括3个连杆8和1个末端执行器9,其中,一个连杆8的首端连接至滑块7,尾端连接至另一连杆8的首端,这样经过3个连杆8首尾相连,最后一个连杆8的尾端连接1个末端执行器9,那么,三臂机器人6的每个操作臂就具有1个移动关节和3个转动关节。带有4个反光球4的第一定位支架11被设置在三臂机器人6的底座上表面的中心点处。3个工件10均被设置在三臂机器人6的工作空间内,在各工件10上分别设置一个具有4个反光球4的定位支架,即第二定位支架12、第三定位支架13以及第四定位支架14,所述4个定位支架的支架臂长度和/或支架臂夹角互不相同,使得控制器可以识别出4个不同的定位支架。每个工件10与三臂机器人6的操作臂一一对应,第二定位支架12、第三定位支架13和第四定位支架14用于表示相应工件10的位姿,即相应操作臂的末端执行器9的目标位姿。将三臂机器人6放置在红外光学定位仪1的工作区域内。
基于图2建立的各设备的坐标系如图3所示,本发明所提供的方法的具体步骤为:
S00、当三臂机器人6位置固定后,控制器建立机器人的操作空间坐标系Or、红外光学定位仪1的测量空间坐标系Oc以及3个末端执行器9的坐标系Ot1、Ot2和Ot3。同时,红外光学定位仪1建立第一定位支架11的坐标系Op、第二定位支架12的坐标系Ow1、第三定位支架13的坐标系Ow2以及第四定位支架14的坐标系Ow3,并传送至控制器。
S02、控制器根据3个末端执行器9的坐标系Ot1、Ot2和Ot3以及机器人操作空间坐标系Or,采用机器人正运动学原理分别得到Ot1、Ot2和Ot3在Or下的位姿矩阵即3个末端执行器9坐标系在机器人操作空间坐标系下的当前位姿为和
以上所得到的位姿矩阵和就可表示相应工件10在机器人操作空间坐标系Or下的位姿,这三个位姿矩阵分别对应于末端执行器9坐标系Ot1、Ot2和Ot3在机器人操作空间坐标系Or下,为实现对相应工件10的夹持所需到达的目标位姿和分别为3个末端执行器9坐标系Ot1、Ot2和Ot3在机器人操作空间坐标系Or下的目标位姿。
S05、控制器根据所得到的(i=1,2,3),采用机器人逆运动学原理计算得到相应操作臂的各关节变量初始值,同时控制器根据所得到的采用机器人逆运动学原理计算得到相应操作臂的各关节变量目标值,每个操作臂的关节变量包括1个移动关节变量和3个转动关节变量。
控制器计算每个操作臂的关节变量初始值和目标值的差值,并将所得到的差值作为每个操作臂的关节运动量。每个操作臂的关节运动量包括1个移动关节运动量和3个转动关节运动量。
S06、控制器根据步骤S05所得到的关节运动量,控制三臂机器人6的3个末端执行器9,使得每个末端执行器9运动到相应的目标位姿,同时可夹持到相应的工件10。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.一种基于红外光学定位的串联型机器人手眼配准控制方法,该方法所涉及的设备包括控制器、红外光学定位仪、串联型n臂机器人、n个工件、n+1个带有4个反光球的定位支架,该n+1个定位支架的支架臂长度和/或支架臂夹角互不相同,n为整数,其特征在于,将其中一个定位支架置于机器人底座的上表面中心点处,将剩余n个定位支架分别置于n个工件上;该方法的具体步骤为:
S00、所述控制器建立所述n臂机器人的操作空间坐标系Or、所述红外光学定位仪的测量空间坐标系Oc以及n臂机器人操作臂的n个末端执行器的坐标系Ot1、...、Otn;同时,红外光学定位仪建立机器人底座上的定位支架坐标系Op以及各工件上的定位支架坐标系Ow1、...、Own,并传送至控制器;
S02、控制器根据各末端执行器坐标系Ot1、...、Otn以及操作空间坐标系Or,采用机器人正运动学原理分别得到Ot1、...、Otn在Or下的位姿矩阵 即各末端执行器坐标系在操作空间坐标系Or下的当前位姿:
S04、控制器根据所得到的位姿矩阵以及奇次变换矩阵计算得到各定位支架坐标系Ow1,...,Own分别在操作空间坐标系Or下的位姿矩阵:i=1,...,n;所得到的分别为各末端执行器坐标系Ot1、...、Otn分别在操作空间坐标系Or下的目标位姿;
S05、控制器根据所得到的采用机器人逆运动学原理计算并得到相应操作臂的各关节变量初始值,同样地,控制器根据计算得到相应操作臂的各关节变量目标值;控制器计算每个操作臂的关节变量初始值和目标值的差值,并将所得到的差值作为每个操作臂的关节运动量;
S06、控制器根据步骤S05所得到的关节运动量,控制n臂机器人的各末端执行器,使得每个末端执行器运动到相应的目标位姿,最终每个末端执行器夹持到相应的工件。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210053583.5A CN102608969B (zh) | 2012-03-02 | 2012-03-02 | 基于红外光学定位的串联型机器人手眼配准控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210053583.5A CN102608969B (zh) | 2012-03-02 | 2012-03-02 | 基于红外光学定位的串联型机器人手眼配准控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102608969A true CN102608969A (zh) | 2012-07-25 |
CN102608969B CN102608969B (zh) | 2014-04-23 |
Family
ID=46526422
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210053583.5A Active CN102608969B (zh) | 2012-03-02 | 2012-03-02 | 基于红外光学定位的串联型机器人手眼配准控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102608969B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104567919A (zh) * | 2013-10-12 | 2015-04-29 | 北京航天计量测试技术研究所 | 一种标定摄影测量***动态测量误差的装置及使用方法 |
CN105105698A (zh) * | 2015-07-10 | 2015-12-02 | 中国科学院深圳先进技术研究院 | 内窥镜校准***及方法 |
CN105232155A (zh) * | 2015-09-08 | 2016-01-13 | 微创(上海)医疗机器人有限公司 | 手术机器人调整*** |
CN111956325A (zh) * | 2020-07-01 | 2020-11-20 | 北京和华瑞博医疗科技有限公司 | 一种医用器械的精准定位装置、方法和*** |
CN112454355A (zh) * | 2020-11-11 | 2021-03-09 | 施努卡(苏州)智能装备有限公司 | 一种基于双目视觉的目标跟踪定位仪器 |
CN112947403A (zh) * | 2019-11-22 | 2021-06-11 | 医达科技公司 | 用于障碍物规避的确定性机器人路径规划 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4724322A (en) * | 1986-03-03 | 1988-02-09 | Applied Materials, Inc. | Method for non-contact xyz position sensing |
CN101293350A (zh) * | 2008-06-12 | 2008-10-29 | 上海交通大学 | 仿人机器人分布式双总线运动控制*** |
CN101402199A (zh) * | 2008-10-20 | 2009-04-08 | 北京理工大学 | 基于视觉的手眼式低伺服精度机器人移动目标抓取方法 |
CN101828469A (zh) * | 2010-03-26 | 2010-09-15 | 中国农业大学 | 黄瓜采摘机器人双目视觉信息获取装置 |
CN102135776A (zh) * | 2011-01-25 | 2011-07-27 | 解则晓 | 基于视觉定位的工业机器人控制***及其控制方法 |
-
2012
- 2012-03-02 CN CN201210053583.5A patent/CN102608969B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4724322A (en) * | 1986-03-03 | 1988-02-09 | Applied Materials, Inc. | Method for non-contact xyz position sensing |
CN101293350A (zh) * | 2008-06-12 | 2008-10-29 | 上海交通大学 | 仿人机器人分布式双总线运动控制*** |
CN101402199A (zh) * | 2008-10-20 | 2009-04-08 | 北京理工大学 | 基于视觉的手眼式低伺服精度机器人移动目标抓取方法 |
CN101828469A (zh) * | 2010-03-26 | 2010-09-15 | 中国农业大学 | 黄瓜采摘机器人双目视觉信息获取装置 |
CN102135776A (zh) * | 2011-01-25 | 2011-07-27 | 解则晓 | 基于视觉定位的工业机器人控制***及其控制方法 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104567919A (zh) * | 2013-10-12 | 2015-04-29 | 北京航天计量测试技术研究所 | 一种标定摄影测量***动态测量误差的装置及使用方法 |
CN105105698A (zh) * | 2015-07-10 | 2015-12-02 | 中国科学院深圳先进技术研究院 | 内窥镜校准***及方法 |
CN105232155A (zh) * | 2015-09-08 | 2016-01-13 | 微创(上海)医疗机器人有限公司 | 手术机器人调整*** |
CN105232155B (zh) * | 2015-09-08 | 2018-11-09 | 微创(上海)医疗机器人有限公司 | 手术机器人调整*** |
CN112947403A (zh) * | 2019-11-22 | 2021-06-11 | 医达科技公司 | 用于障碍物规避的确定性机器人路径规划 |
CN111956325A (zh) * | 2020-07-01 | 2020-11-20 | 北京和华瑞博医疗科技有限公司 | 一种医用器械的精准定位装置、方法和*** |
CN111956325B (zh) * | 2020-07-01 | 2021-08-20 | 北京和华瑞博医疗科技有限公司 | 一种医用器械的精准定位装置、方法和*** |
CN112454355A (zh) * | 2020-11-11 | 2021-03-09 | 施努卡(苏州)智能装备有限公司 | 一种基于双目视觉的目标跟踪定位仪器 |
Also Published As
Publication number | Publication date |
---|---|
CN102608969B (zh) | 2014-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102608969B (zh) | 基于红外光学定位的串联型机器人手眼配准控制方法 | |
US10160116B2 (en) | Method for calibrating tool centre point for industrial robot system | |
CN107139178B (zh) | 一种无人机及其基于视觉的抓取方法 | |
JP5290324B2 (ja) | 空間内において少なくとも1つのオブジェクトを最終姿勢に高精度で位置決めするための方法およびシステム | |
CN106247932B (zh) | 一种基于摄影***的机器人在线误差补偿装置及方法 | |
US7684898B2 (en) | Method for calibrating a tool center point of tools for industrial robots | |
US9517560B2 (en) | Robot system and calibration method of the robot system | |
JP6855492B2 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
CN110276799B (zh) | 一种坐标标定方法、标定***及机械臂 | |
EP1607194A2 (en) | Robot system comprising a plurality of robots provided with means for calibrating their relative position | |
US20170322010A1 (en) | Method and apparatus for calibrating tool in flange coordinate system of robot | |
CN110370316B (zh) | 一种基于垂直反射的机器人tcp标定方法 | |
EP3221095A1 (en) | Robot and robot system | |
CN111707189B (zh) | 基于双目视觉的激光位移传感器光束方向标定方法 | |
CN109794963A (zh) | 一种面向曲面构件的机器人快速定位方法 | |
CN210819622U (zh) | 移动操作机器人大尺度空间高精度在线标定*** | |
JP6855491B2 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
TW202021752A (zh) | 機械臂奇異點控制方法及系統 | |
CN112958960B (zh) | 一种基于光学靶标的机器人手眼标定装置 | |
KR101842286B1 (ko) | 로봇의 자동 캘리브레이션 방법 | |
US20110118876A1 (en) | Teaching line correcting apparatus, teaching line correcting method, and program thereof | |
CN107756391B (zh) | 机械手臂校正***的校正方法 | |
WO2023013740A1 (ja) | ロボット制御装置、ロボット制御システム、及びロボット制御方法 | |
WO2020010627A1 (zh) | 一种工件跟踪方法、***及机器人 | |
CN113771042B (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 |