[go: up one dir, main page]

CN106092053B - 一种机器人重复定位系统及其定位方法 - Google Patents

一种机器人重复定位系统及其定位方法 Download PDF

Info

Publication number
CN106092053B
CN106092053B CN201510988678.XA CN201510988678A CN106092053B CN 106092053 B CN106092053 B CN 106092053B CN 201510988678 A CN201510988678 A CN 201510988678A CN 106092053 B CN106092053 B CN 106092053B
Authority
CN
China
Prior art keywords
robot
ccd camera
camera lenses
operating side
acceleration
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
Application number
CN201510988678.XA
Other languages
English (en)
Other versions
CN106092053A (zh
Inventor
宋明安
孙洁
付焕清
刘学平
同彦恒
李志博
麻辉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Ningxia Juneng Robot Co Ltd
Original Assignee
Ningxia Juneng Robot System Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Ningxia Juneng Robot System Co Ltd filed Critical Ningxia Juneng Robot System Co Ltd
Priority to CN201510988678.XA priority Critical patent/CN106092053B/zh
Publication of CN106092053A publication Critical patent/CN106092053A/zh
Application granted granted Critical
Publication of CN106092053B publication Critical patent/CN106092053B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Multimedia (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Manipulator (AREA)
  • Length Measuring Devices By Optical Means (AREA)
  • Numerical Control (AREA)

Abstract

本发明公开了一种机器人重复定位系统，包括编码器，安装在机器人每个转动关节上，用于测量转动关节的转动角度；三轴加速度传感器，安装在机器人的操作端，用于测量机器人操作端在三维方向上的加速度；CCD镜头，安装在机器人的操作端，用于捕捉位于定位参照物上的标记点，标记点为同心设置的若干个环形标记，定为参照物上至少设置有三个标记点；控制模块，与编码器、三轴加速度传感器和CCD镜头通讯连接，用于对检测到的定位参数进行处理；数据库模块，与控制模块通讯连接，用于存储机器人定位过程的历史数据。本发明还提供了一种上述机器人重复定位系统的定位方法。本发明能够解决现有技术的不足，提高机器人重复定位的精度。

Description

一种机器人重复定位系统及其定位方法
技术领域
本发明涉及工厂自动化技术领域，尤其是一种机器人重复定位系统及其定位方法。
背景技术
在自动化生产中，各种机器人是代替人工进行工件运输、加工的主要设备。在机器人的运动过程中，为了保证对于工件加工的精度，对于机器人运动的重复定位精度要求较高。现有技术中，机器人的重复定位通常使用参考定位点进行重复定位。这种方式在定位末期由于惯性的作用会出现往复的振动，影响定位精度和定位速度。
发明内容
本发明要解决的技术问题是提供一种机器人重复定位系统及其定位方法，能够解决现有技术的不足，提高机器人重复定位的精度。
为解决上述技术问题，本发明所采取的技术方案如下。
一种机器人重复定位系统，包括，
编码器，安装在机器人每个转动关节上，用于测量转动关节的转动角度；
三轴加速度传感器，安装在机器人的操作端，用于测量机器人操作端在三维方向上的加速度；
CCD镜头，安装在机器人的操作端，用于捕捉位于定位参照物上的标记点，标记点为同心设置的若干个环形标记，定为参照物上至少设置有三个标记点；
控制模块，与编码器、三轴加速度传感器和CCD镜头通讯连接，用于对检测到的定位参数进行处理；
数据库模块，与控制模块通讯连接，用于存储机器人定位过程的历史数据。
一种用于上述的机器人重复定位系统的定位方法，包括以下步骤：
A、机器人根据预设数据进行动作，编码器对各个转动关节的转动角度进行监控，控制模块根据编码器的测量数据判断机器人操作端的实时位置；
B、当机器人操作端靠近定位位置时，CCD镜头通过捕捉标记点使控制模块进行机器人操作端的精确定位；
C、三轴加速度传感器对机器人操作端的三维方向加速度进行测量，控制模块使用加速度数据对CCD镜头捕捉标记点过程中机器人操作端的移动方向和速度进行修正。
作为优选，步骤A中，使用三轴加速度传感器的加速度测量结果对转动关节的转动角度进行修正。
作为优选，对转动关节的转动角度进行修正的修正函数为，
其中，c为修正后的转动角度，c1为修正前的转动角度，a为此转动关节转动方向上的加速度测量值，k1～k3为比例常数。
作为优选，步骤B中，当CCD镜头捕捉到任意一个环形标记时，控制模块控制机器人操作端沿着这一环形标记进行移动，同时降低速度，当CCD镜头捕捉到其它环形标记时，控制模块控制机器人操作端沿着已捕捉到的环形标记的圆心所形成的多边形进行移动，直至CCD镜头捕捉到所有标记点。
作为优选，机器人操作端的速度降低变化率随着CCD镜头捕捉到的环形标记数量增加而提高。
作为优选，步骤C中，机器人操作端沿着环形标记进行移动时，移动的方向与机器人操作端投影在标记点参考平面上的加速度方向相同。
作为优选，步骤C中，机器人操作端沿着环形标记进行移动时，其移动速度根据CCD镜头捕捉到的环形标记数量进行调节的同时，再进行二次修正，修正函数为，
其中，v为机器人操作端移动的实时速度，v1为机器人操作端移动的初始速度，a1为三维方向加速度投影在标记点参考平面上的加速度分量，a2为三维方向加速度垂直于标记点参考平面的加速度分量，k4～k6为比例常数。
采用上述技术方案所带来的有益效果在于：本发明通过利用编码器、CCD镜头来确定机器人操作端的实时位置，并同时使用三轴加速度传感器采集到的机器人操作端加速度对机器人操作端的实时位置进行修正，从而降低了定位过程的往复波动幅度，提高了定位速度和定位精度。
附图说明
图1是本发明的一个具体实施方式的结构图。
图中：1、编码器；2、三轴加速度传感器；3、CCD镜头；4、控制模块；5、数据库模块。
具体实施方式
参照图1，本发明的一个具体实施方式包括编码器1，安装在机器人每个转动关节上，用于测量转动关节的转动角度；
三轴加速度传感器2，安装在机器人的操作端，用于测量机器人操作端在三维方向上的加速度；
CCD镜头3，安装在机器人的操作端，用于捕捉位于定位参照物上的标记点，标记点为同心设置的若干个环形标记，定为参照物上至少设置有三个标记点；
控制模块4，与编码器1、三轴加速度传感器2和CCD镜头3通讯连接，用于对检测到的定位参数进行处理；
数据库模块5，与控制模块4通讯连接，用于存储机器人定位过程的历史数据。
一种用于上述机器人重复定位系统的定位方法，包括以下步骤：
A、机器人根据预设数据进行动作，编码器1对各个转动关节的转动角度进行监控，控制模块4根据编码器1的测量数据判断机器人操作端的实时位置；步骤A中，使用三轴加速度传感器2的加速度测量结果对转动关节的转动角度进行修正，对转动关节的转动角度进行修正的修正函数为，
其中，c为修正后的转动角度，c1为修正前的转动角度，a为此转动关节转动方向上的加速度测量值，k1～k3为比例常数。
B、当机器人操作端靠近定位位置时，CCD镜头3通过捕捉标记点使控制模块4进行机器人操作端的精确定位；当CCD镜头3捕捉到任意一个环形标记时，控制模块4控制机器人操作端沿着这一环形标记进行移动，同时降低速度，当CCD镜头3捕捉到其它环形标记时，控制模块4控制机器人操作端沿着已捕捉到的环形标记的圆心所形成的多边形进行移动，直至CCD镜头3捕捉到所有标记点，机器人操作端的速度降低变化率随着CCD镜头3捕捉到的环形标记数量增加而提高。
C、三轴加速度传感器2对机器人操作端的三维方向加速度进行测量，控制模块4使用加速度数据对CCD镜头3捕捉标记点过程中机器人操作端的移动方向和速度进行修正；机器人操作端沿着环形标记进行移动时，移动的方向与机器人操作端投影在标记点参考平面上的加速度方向相同，机器人操作端沿着环形标记进行移动时，其移动速度根据CCD镜头3捕捉到的环形标记数量进行调节的同时，再进行二次修正，修正函数为，
其中，v为机器人操作端移动的实时速度，v1为机器人操作端移动的初始速度，a1为三维方向加速度投影在标记点参考平面上的加速度分量，a2为三维方向加速度垂直于标记点参考平面的加速度分量，k4～k6为比例常数。
其中，步骤A中，使用三轴加速度传感器2的加速度测量结果对转动关节的转动角度进行修正时，从远离机器人操作端的一侧进行修正，下一个转动关节进行修正时，根据上一个转动关节的修正量，对本次修正过程中的k3进行等比例调整。
另外，控制模块4通过读取数据库模块5内记录的CCD镜头3捕捉到第一个环形标记至定位完成过程中操作端的位移和速度变化数据，对上述数据进行加权平均，使用得到的结果修正转动关节转动的预设数据，从而缩短整个定位过程的时间和复杂度。加权过程中，生成时间较早的数据的权重值小于生成时间较晚的数据的权重值。
本发明可以明显缩短机器人定位的速度，减少定位过程中出现的位置波动问题，提高了最终的定位精度。
上述描述仅作为本发明可实施的技术方案提出，不作为对其技术方案本身的单一限制条件。

Claims (5)

1.一种机器人重复定位系统的定位方法，包括，
编码器(1)，安装在机器人每个转动关节上，用于测量转动关节的转动角度；
三轴加速度传感器(2)，安装在机器人的操作端，用于测量机器人操作端在三维方向上的加速度；
CCD镜头(3)，安装在机器人的操作端，用于捕捉位于定位参照物上的标记点，标记点为同心设置的若干个环形标记，定为参照物上至少设置有三个标记点；
控制模块(4)，与编码器(1)、三轴加速度传感器(2)和CCD镜头(3)通讯连接，用于对检测到的定位参数进行处理；
数据库模块(5)，与控制模块(4)通讯连接，用于存储机器人定位过程的历史数据；
其特征在于包括以下步骤：
A、机器人根据预设数据进行动作，编码器(1)对各个转动关节的转动角度进行监控，控制模块(4)根据编码器(1)的测量数据判断机器人操作端的实时位置；
使用三轴加速度传感器(2)的加速度测量结果对转动关节的转动角度进行修正；
对转动关节的转动角度进行修正的修正函数为，
其中，c为修正后的转动角度，c1为修正前的转动角度，a为此转动关节转动方向上的加速度测量值，k1～k3为比例常数；
B、当机器人操作端靠近定位位置时，CCD镜头(3)通过捕捉标记点使控制模块(4)进行机器人操作端的精确定位；
C、三轴加速度传感器(2)对机器人操作端的三维方向加速度进行测量，控制模块(4)使用加速度数据对CCD镜头(3)捕捉标记点过程中机器人操作端的移动方向和速度进行修正。
2.根据权利要求1所述的机器人重复定位系统的定位方法，其特征在于：步骤B中，当CCD镜头(3)捕捉到任意一个环形标记时，控制模块(4)控制机器人操作端沿着这一环形标记进行移动，同时降低速度，当CCD镜头(3)捕捉到其它环形标记时，控制模块(4)控制机器人操作端沿着已捕捉到的环形标记的圆心所形成的多边形进行移动，直至CCD镜头(3)捕捉到所有标记点。
3.根据权利要求2所述的机器人重复定位系统的定位方法，其特征在于：机器人操作端的速度降低变化率随着CCD镜头(3)捕捉到的环形标记数量增加而提高。
4.根据权利要求3所述的机器人重复定位系统的定位方法，其特征在于：步骤C中，机器人操作端沿着环形标记进行移动时，移动的方向与机器人操作端投影在标记点参考平面上的加速度方向相同。
5.根据权利要求3所述的机器人重复定位系统的定位方法，其特征在于：步骤C中，机器人操作端沿着环形标记进行移动时，其移动速度根据CCD镜头(3)捕捉到的环形标记数量进行调节的同时，再进行二次修正，修正函数为，
其中，v为机器人操作端移动的实时速度，v1为机器人操作端移动的初始速度，a1为三维方向加速度投影在标记点参考平面上的加速度分量，a2为三维方向加速度垂直于标记点参考平面的加速度分量，k4～k6为比例常数。
CN201510988678.XA 2015-12-25 2015-12-25 一种机器人重复定位系统及其定位方法 Active CN106092053B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510988678.XA CN106092053B (zh) 2015-12-25 2015-12-25 一种机器人重复定位系统及其定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510988678.XA CN106092053B (zh) 2015-12-25 2015-12-25 一种机器人重复定位系统及其定位方法

Publications (2)

Publication Number Publication Date
CN106092053A CN106092053A (zh) 2016-11-09
CN106092053B true CN106092053B (zh) 2018-11-09

Family

ID=57216295

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510988678.XA Active CN106092053B (zh) 2015-12-25 2015-12-25 一种机器人重复定位系统及其定位方法

Country Status (1)

Country Link
CN (1) CN106092053B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106534283A (zh) * 2016-11-02 2017-03-22 旗瀚科技有限公司 一种同步控制多台机器人的系统及方法
CN106382934A (zh) * 2016-11-16 2017-02-08 深圳普智联科机器人技术有限公司 一种高精度移动机器人定位系统和方法
CN108171749A (zh) * 2018-02-12 2018-06-15 中南大学湘雅二医院 一种基于陀螺仪的机械手臂热源追踪辅助系统及其方法
CN110065072B (zh) * 2019-05-21 2021-04-20 西南交通大学 机器人重复定位精度的验证方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1762670A (zh) * 2004-10-18 2006-04-26 发那科株式会社 具备学习控制功能的机器人及机器人的控制方法
CN102501242A (zh) * 2011-09-28 2012-06-20 华南理工大学 一种三自由度柔性机械臂控制装置与方法
CN103085068A (zh) * 2011-09-21 2013-05-08 精工爱普生株式会社 机器人以及机器人的控制方法
CN104589304A (zh) * 2013-10-31 2015-05-06 精工爱普生株式会社 机器人控制装置以及机器人

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07314360A (ja) * 1994-05-31 1995-12-05 Ishikawajima Harima Heavy Ind Co Ltd カメラ操作ロボット

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1762670A (zh) * 2004-10-18 2006-04-26 发那科株式会社 具备学习控制功能的机器人及机器人的控制方法
CN103085068A (zh) * 2011-09-21 2013-05-08 精工爱普生株式会社 机器人以及机器人的控制方法
CN102501242A (zh) * 2011-09-28 2012-06-20 华南理工大学 一种三自由度柔性机械臂控制装置与方法
CN104589304A (zh) * 2013-10-31 2015-05-06 精工爱普生株式会社 机器人控制装置以及机器人

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于视觉定位的二自由度机械臂控制系统;王军南;《机械与电子》;20080229(第2期);第49-52页 *

Also Published As

Publication number Publication date
CN106092053A (zh) 2016-11-09

Similar Documents

Publication Publication Date Title
CN109029257B (zh) 基于立体视觉和结构光视觉的大型工件位姿测量系统、方法
CN105792996B (zh) 机器人系统以及机器人系统的控制方法
CN110125926B (zh) 自动化的工件取放方法及系统
US10232512B2 (en) Coordinate system setting method, coordinate system setting apparatus, and robot system provided with coordinate system setting apparatus
US7532949B2 (en) Measuring system
CN106092053B (zh) 一种机器人重复定位系统及其定位方法
US20050273199A1 (en) Robot system
CN104786226A (zh) 抓取在线工件的机器人位姿及运动轨迹定位系统与方法
CN101493315A (zh) 机械手标定方法
CN106247932A (zh) 一种基于摄影系统的机器人在线误差补偿装置及方法
CN104552341B (zh) 移动工业机器人单点多视角挂表位姿误差检测方法
CN108214487A (zh) 基于双目视觉和激光雷达的机器人目标定位和抓取方法
CN109352646B (zh) 纱线自动装卸方法及系统
CN110695982A (zh) 一种基于三维视觉的机械臂手眼标定方法和装置
CN109916346B (zh) 一种基于视觉系统的工件平整度的检测装置及检测方法
KR101987824B1 (ko) 양팔 로봇 시스템
CN104236466A (zh) 检测机器手重复定位精度的测量系统
CN106546190B (zh) 一种用于表面缺陷检测的机械手装置及方法
US20130342659A1 (en) Three-dimensional position/attitude recognition apparatus, three-dimensional position/attitude recognition method, and three-dimensional position/attitude recognition program
CN104819690A (zh) 一种表面贴装元件的双相机机器视觉定位方法
CN107756391B (zh) 机械手臂校正系统的校正方法
CN112577423B (zh) 包含在运动中进行机器视觉位置定位的方法及其应用
TWI617405B (zh) Correction method for robot arm correction system
CN103199022B (zh) 预对准机的标定方法
EP3974105B1 (en) Measurement device

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: No.296, Tongxin South Street, Yinchuan Development Zone, 750021 Ningxia Hui Autonomous Region

Patentee after: NINGXIA JUNENG ROBOT Co.,Ltd.

Address before: No.296, Tongxin South Street, Yinchuan Development Zone, 750021 Ningxia Hui Autonomous Region

Patentee before: NINGXIA JUNENG ROBOT SYSTEM Co.,Ltd.