CN105619411B - 一种六轴工业机器人码垛方法 - Google Patents

一种六轴工业机器人码垛方法 Download PDF

Info

Publication number
CN105619411B
CN105619411B CN201610166333.0A CN201610166333A CN105619411B CN 105619411 B CN105619411 B CN 105619411B CN 201610166333 A CN201610166333 A CN 201610166333A CN 105619411 B CN105619411 B CN 105619411B
Authority
CN
China
Prior art keywords
code
disc
coordinate system
teaching
industrial robot
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
CN201610166333.0A
Other languages
English (en)
Other versions
CN105619411A (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.)
China Shipbuilding Digital Information Technology Co ltd
716th Research Institute of CSIC
Original Assignee
716th Research Institute of CSIC
Jiangsu Jari Technology Group 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 716th Research Institute of CSIC, Jiangsu Jari Technology Group Co Ltd filed Critical 716th Research Institute of CSIC
Priority to CN201610166333.0A priority Critical patent/CN105619411B/zh
Publication of CN105619411A publication Critical patent/CN105619411A/zh
Application granted granted Critical
Publication of CN105619411B publication Critical patent/CN105619411B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning

Abstract

本发明提供一种六轴工业机器人码垛方法，包括：于码盘上确定三个基准点；六轴工业机器人分别于基准点处示教基准点坐标，生成码盘坐标系；在码盘坐标系中示教出三个顶点放料孔位置和一个相对中心放料孔位置；获取码盘坐标系中任意一放料孔位置；机器人运行码盘坐标系，调用任一放料孔位置进行放料。本发明简易可行、精确性高，能够快速的实现工业机器人在各种孔数码盘上的精确码垛。

Description

一种六轴工业机器人码垛方法
技术领域
本发明涉及一种工业机器人技术，特别是一种六轴工业机器人码垛方法。
背景技术
码盘码垛是工业机器人的常规应用之一，通常出现在数控机床的自动上下料系统中。由于数控机床加工工件的各异、加工节拍及工序要求不同等因素，码盘的种类也各不相同。在此种情况下，如何简易、精确地寻求码盘上各孔位的位置是工业机器人码垛的重要前提。目前，除使用工业机器人进行码盘逐点示教外，尚未有简易可行、定位精确的码盘码垛方法。
发明内容
本发明的目的在于提供一种简易可行、精确的六轴工业机器人的码盘码垛方法，能够快速的实现工业机器人在各种孔数码盘上的精确码垛。
实现本发明的技术方案为：
步骤1，于码盘上确定三个基准点cp1、cp2、cp3，其中cp1与cp2间的连线Lcp1-cp2垂直于cp1与cp3间的连线Lcp1-cp3，
步骤2，六轴工业机器人分别于基准点cp1、cp2、cp3处示教基准点坐标，生成以cp1为坐标原点、Lcp1-cp2和Lcp1-cp3为坐标轴的码盘坐标系，
步骤3，在码盘坐标系中示教出三个顶点放料孔位置a1(1,1)、a2(m,1)、a3(1,n)和一个相对中心放料孔位置其中m为码盘放料孔的行数，n为码盘放料孔的列数
步骤4，推导位置计算公式，获取码盘坐标系下的任意一放料孔位置a(i,j)，其中i∈m是码盘上放料孔行的索引值，j∈n是是码盘上放料孔列的索引值；
其中a(i,j)在码盘坐标系中表示为
其中，a(i,j).x、a(i,j).y、a(i,j).z为a(i,j)在码盘坐标系中的X、Y、Z轴的取值，
a1.x、a1.y、a1.z、a2.x、a2.y、a2.z、a3.x、a3.y、a3.z、a0.x、a0.y、a0.z分别为步骤3所示的三个顶点和相对中心点放料孔坐标在码盘坐标系中的X、Y、Z轴的取值，
a(i,j).a、a(i,j).b、a(i,j).c为a(i,j)在码盘坐标系对X、Y、Z轴的角分量，a1.a、a1.b、a1.c、a2.a、a2.b、a2.c、a3.a、a3.b、a3.c、a0.a、a0.b、a0.c分别为步骤3所示的三个顶点和相对中心点放料孔在码盘坐标系对X、Y、Z轴的角分量。
步骤5，机器人运行码盘坐标系，调用码盘任一放料孔位置进行放料。
本发明与现有技术相比，具有以下优点：(1)不需复杂的算法及工具，整个过程简易可行，精确度高；(2)该方法不受码盘种类限制，可移植性强；(3)该方法可拓展至多关节工业机器人的码盘码垛应用。
下面结合说明书附图对本发明做进一步描述。
附图说明
图1是码盘的结构示意图。
图2是码盘的基准点选择示意图。
图3是码盘的码盘坐标系示意图。
图4是码盘的放料基准点示意图。
图5是本发明的方法流程图。
具体实施方式
结合图5，一种六轴工业机器人的码盘码垛方法，包括以下步骤：
步骤1，利用直角三角板，在码盘上(如图1所示)确定三个基准点cp1、cp2、cp3，使直线Lcp1-cp2垂直于直线Lcp1-cp3，且使直线Lcp1-cp2和直线Lcp1-cp3分别近似平行于机器人的X轴和Y轴，如图2所示。
步骤2，利用三个基准点cp1、cp2、cp3在机器人的示教器中建立码盘坐标系，如图3所示：
1)选择三点(含原点)示教法；
2)首先示教原点cp1坐标；
3)将机器人沿着X轴运动到基准点cp2，示教cp2坐标；
4)将机器人沿着XY平面运动到基准点cp3，示教cp3坐标；
5)生成码盘平面坐标系。
步骤3，在码盘平面坐标系中，精确的示教出码盘上三个顶点放料孔位置a1(1,1)、a2(m,1)、a3(1,n)和一个相对中心放料孔位置如图4所示，其中m为码盘放料孔的行数，n为码盘放料孔的列数。
步骤4，推导码盘放料孔a(i,j)位置计算公式如下：
其中，a(i,j).x、a(i,j).y、a(i,j).z为a(i,j)在码盘坐标系中的X、Y、Z轴的取值，
a1.x、a1.y、a1.z、a2.x、a2.y、a2.z、a3.x、a3.y、a3.z、a0.x、a0.y、a0.z分别为步骤3所示的三个顶点和相对中心点放料孔在码盘坐标系中的X、Y、Z轴的取值，
a(i,j).a、a(i,j).b、a(i,j).c为a(i,j)在码盘坐标系对X、Y、Z轴的角分量，a1.a、a1.b、a1.c、a2.a、a2.b、a2.c、a3.a、a3.b、a3.c、a0.a、a0.b、a0.c分别为步骤3所示的三个顶点和相对中心点放料孔在码盘坐标系对X、Y、Z轴的角分量。
步骤5，机器人运行码盘坐标系，输入码盘放料孔行数m和列数n、索引值i和j，调用码盘任一放料孔a(i,j)位置进行放料。

Claims (2)

1.一种六轴工业机器人码垛方法，其特征在于，包括以下步骤：
步骤1，于码盘上确定三个基准点cp1、cp2、cp3，其中cp1与cp2间的连线Lcp1-cp2垂直于cp1与cp3间的连线Lcp1-cp3；
步骤2，六轴工业机器人分别于基准点cp1、cp2、cp3处示教基准点坐标，生成以cp1为坐标原点、Lcp1-cp2和Lcp1-cp3为坐标轴的码盘坐标系；
步骤3，在码盘坐标系中示教出三个顶点放料孔位置a1(1,1)、a2(m,1)、a3(1,n)和一个相对中心放料孔位置其中m为码盘放料孔的行数，n为码盘放料孔的列数；
步骤4，推导位置计算公式，获取码盘坐标系下的任意一放料孔位置a(i,j)，其中i∈m是码盘上放料孔行的索引值，j∈n是是码盘上放料孔列的索引值；
其中a(i,j)在码盘坐标系中表示为
其中，a(i,j).x、a(i,j).y、a(i,j).z为a(i,j)在码盘坐标系中的X、Y、Z轴的取值，
a1.x、a1.y、a1.z、a2.x、a2.y、a2.z、a3.x、a3.y、a3.z、a0.x、a0.y、a0.z分别为步骤3所示的三个顶点和相对中心点放料孔在码盘坐标系中的X、Y、Z轴的取值，
a(i,j).a、a(i,j).b、a(i,j).c为a(i,j)在码盘坐标系对X、Y、Z轴的角分量，
a1.a、a1.b、a1.c、a2.a、a2.b、a2.c、a3.a、a3.b、a3.c、a0.a、a0.b、a0.c分别为步骤3所示的三个顶点和相对中心点放料孔在码盘坐标系对X、Y、Z 轴的角分量；
步骤5，机器人运行码盘坐标系，调用码盘任一放料孔位置进行放料。
2.根据权利要求1所述的方法，其特征在于，所述六轴工业机器人示教基准点坐标顺序为：
首先示教cp1；
然后沿Lcp1-cp2移动至cp2处进行示教；
最后沿XY平面移动至cp3处进行示教。
CN201610166333.0A 2016-03-22 2016-03-22 一种六轴工业机器人码垛方法 Active CN105619411B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610166333.0A CN105619411B (zh) 2016-03-22 2016-03-22 一种六轴工业机器人码垛方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610166333.0A CN105619411B (zh) 2016-03-22 2016-03-22 一种六轴工业机器人码垛方法

Publications (2)

Publication Number Publication Date
CN105619411A CN105619411A (zh) 2016-06-01
CN105619411B true CN105619411B (zh) 2018-01-02

Family

ID=56034949

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610166333.0A Active CN105619411B (zh) 2016-03-22 2016-03-22 一种六轴工业机器人码垛方法

Country Status (1)

Country Link
CN (1) CN105619411B (zh)

Families Citing this family (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108064197B (zh) * 2016-12-30 2021-04-06 深圳配天智能技术研究院有限公司 确定码垛点位置信息的方法、装置及机器人
CN109318225A (zh) * 2017-08-01 2019-02-12 中达电子零组件(吴江)有限公司 用于控制码垛机器人的方法、装置及系统
CN107671855A (zh) * 2017-08-31 2018-02-09 广州泰行智能科技有限公司 一种基于机械臂的空间坐标系的构建方法和装置
CN107696032A (zh) * 2017-08-31 2018-02-16 广州泰行智能科技有限公司 一种基于机械臂的空间坐标系的构建方法和装置
CN107717984A (zh) * 2017-08-31 2018-02-23 广州泰行智能科技有限公司 一种基于空间坐标系的路径规划方法和装置
CN107696031A (zh) * 2017-08-31 2018-02-16 广州泰行智能科技有限公司 一种基于机械臂的空间坐标系的构建方法和装置
CN107538491B (zh) * 2017-08-31 2020-05-08 广州泰行智能科技有限公司 一种基于机械臂的空间坐标系的构建方法
CN107671856A (zh) * 2017-08-31 2018-02-09 广州泰行智能科技有限公司 一种基于空间坐标系的机械臂路径规划方法和装置
CN109436821B (zh) * 2018-10-18 2021-11-09 埃夫特智能装备股份有限公司 一种实现多边形物体自定义码垛的方法
CN109353833B (zh) * 2018-11-27 2021-06-29 深圳市汇川技术股份有限公司 机器人码垛点位生成方法、设备及计算机可读存储器
CN110342016A (zh) * 2019-07-03 2019-10-18 湖北工业大学 一种填料仪的石墨电极自动收纳控制系统及控制方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005186193A (ja) * 2003-12-25 2005-07-14 Nachi Fujikoshi Corp ロボットのキャリブレーション方法および三次元位置計測方法
CN103587719B (zh) * 2013-11-11 2016-01-06 中航沈飞民用飞机有限责任公司 平板件的全自动钻铆定位方法
CN104260112B (zh) * 2014-09-18 2016-05-18 西安航天精密机电研究所 一种机器人手眼定位方法
CN204423797U (zh) * 2015-01-12 2015-06-24 邢晓莉 一种工业机器人多模块组合实训教学装置

Also Published As

Publication number Publication date
CN105619411A (zh) 2016-06-01

Similar Documents

Publication Publication Date Title
CN105619411B (zh) 一种六轴工业机器人码垛方法
CN104729407B (zh) 机器人基坐标系与世界坐标系之间关系的自动确定方法
CN107942949B (zh) 一种机床视觉定位方法及系统、机床
CN110625600B (zh) 一种机器人末端工件坐标系标定方法
US10539406B2 (en) Method and apparatus for calibrating tool in flange coordinate system of robot
CN110148187B (zh) 一种SCARA机械手Eye-in-Hand的高精度手眼标定方法和系统
US10228686B2 (en) Robot programming device for teaching robot program
CN103107121B (zh) 一种基于视觉的晶圆角度偏差自动校正方法
CN104552341B (zh) 移动工业机器人单点多视角挂表位姿误差检测方法
CN105509671B (zh) 一种利用平面标定板的机器人工具中心点标定方法
CN109732589B (zh) 一种基于线激光传感器的机器人作业轨迹获取方法
CN102266958B (zh) 基于制孔设备坐标系确定的柔性导轨孔群加工方法
CN107560538A (zh) 基于激光跟踪仪的六自由度机器人工具坐标系的标定方法
CN111941425B (zh) 基于激光跟踪仪和双目相机的机器人铣削系统工件快速定位方法
CN108655820A (zh) 一种数控加工基坐标系的标定方法
CN108015762B (zh) 机器人视觉定位的验证方法
TW202128378A (zh) 校準方法及校準系統
JP2012230041A (ja) 位置検出方法、位置検出装置、ロボットシステム
CN109048887A (zh) 一种基于三点标定法的单轴变位机标定方法
CN105094051B (zh) 运动平台系统的平面定位补偿方法
CN114012724A (zh) 一种基于探针的工业机器人坐标系自动标定方法
CN112631200A (zh) 一种机床轴线测量方法以及装置
CN112578730A (zh) 自适应加工中基准坐标的快速转换方法
CN114770219B (zh) 工件自动找正方法、装置、设备、存储介质及程序产品
CN114675600A (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
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20201120

Address after: 222061 Jiangsu city of Lianyungang Province Lake Road No. 18

Patentee after: 716TH RESEARCH INSTITUTE OF CHINA SHIPBUILDING INDUSTRY Corp.

Patentee after: CSIC Information Technology Co.,Ltd.

Address before: 222061 Jiangsu city of Lianyungang Province Lake Road No. 18

Patentee before: 716TH RESEARCH INSTITUTE OF CHINA SHIPBUILDING INDUSTRY Corp.

Patentee before: JIANGSU JARI TECHNOLOGY GROUP Co.,Ltd.

TR01 Transfer of patent right
CP01 Change in the name or title of a patent holder

Address after: 222061 No.18, Shenghu Road, Lianyungang City, Jiangsu Province

Patentee after: The 716th Research Institute of China Shipbuilding Corp.

Patentee after: CSIC Information Technology Co.,Ltd.

Address before: 222061 No.18, Shenghu Road, Lianyungang City, Jiangsu Province

Patentee before: 716TH RESEARCH INSTITUTE OF CHINA SHIPBUILDING INDUSTRY Corp.

Patentee before: CSIC Information Technology Co.,Ltd.

CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: 222061 No.18, Shenghu Road, Lianyungang City, Jiangsu Province

Patentee after: The 716th Research Institute of China Shipbuilding Corp.

Patentee after: China Shipbuilding Digital Information Technology Co.,Ltd.

Address before: 222061 No.18, Shenghu Road, Lianyungang City, Jiangsu Province

Patentee before: The 716th Research Institute of China Shipbuilding Corp.

Patentee before: CSIC Information Technology Co.,Ltd.

CP01 Change in the name or title of a patent holder