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

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

Info

Publication number
CN105619411A
CN105619411A CN201610166333.0A CN201610166333A CN105619411A CN 105619411 A CN105619411 A CN 105619411A CN 201610166333 A CN201610166333 A CN 201610166333A CN 105619411 A CN105619411 A CN 105619411A
Authority
CN
China
Prior art keywords
code
disc
coordinates
material hole
disc system
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
Application number
CN201610166333.0A
Other languages
English (en)
Other versions
CN105619411B (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

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)

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 true CN105619411A (zh) 2016-06-01
CN105619411B 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)

Cited By (11)

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

Citations (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 ロボットのキャリブレーション方法および三次元位置計測方法
CN103587719A (zh) * 2013-11-11 2014-02-19 中航沈飞民用飞机有限责任公司 平板件的全自动钻铆定位方法
CN104260112A (zh) * 2014-09-18 2015-01-07 西安航天精密机电研究所 一种机器人手眼定位方法
CN204423797U (zh) * 2015-01-12 2015-06-24 邢晓莉 一种工业机器人多模块组合实训教学装置

Patent Citations (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 ロボットのキャリブレーション方法および三次元位置計測方法
CN103587719A (zh) * 2013-11-11 2014-02-19 中航沈飞民用飞机有限责任公司 平板件的全自动钻铆定位方法
CN104260112A (zh) * 2014-09-18 2015-01-07 西安航天精密机电研究所 一种机器人手眼定位方法
CN204423797U (zh) * 2015-01-12 2015-06-24 邢晓莉 一种工业机器人多模块组合实训教学装置

Cited By (14)

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

Also Published As

Publication number Publication date
CN105619411B (zh) 2018-01-02

Similar Documents

Publication Publication Date Title
CN105619411A (zh) 一种六轴工业机器人码垛方法
CN109353833B (zh) 机器人码垛点位生成方法、设备及计算机可读存储器
US20170322010A1 (en) Method and apparatus for calibrating tool in flange coordinate system of robot
EP3221095B1 (en) Robot and robot system
CN108731591B (zh) 一种基于平面约束的机器人工具坐标系标定方法
CN108064197B (zh) 确定码垛点位置信息的方法、装置及机器人
CN111992911B (zh) 基于旁轴视觉结构振镜拼图加工的视觉定位方法
CN105509671B (zh) 一种利用平面标定板的机器人工具中心点标定方法
US10228686B2 (en) Robot programming device for teaching robot program
CN111941425B (zh) 基于激光跟踪仪和双目相机的机器人铣削***工件快速定位方法
US9423785B2 (en) Tool trajectory display device having function for displaying inversion position of servo axis
JP2010052067A (ja) 自動仕上げ装置とその制御方法
CN109465831B (zh) 一种提升工业机器人工具坐标系标定精度的方法
CN112405527A (zh) 工件表面圆弧轨迹加工方法及相关装置
CN109311155B (zh) 一种工业机器人的工具坐标系原点的标定方法及装置
CN206794824U (zh) 一种大型球壳体开多孔加工装置
JP2019197333A (ja) 経路補正方法及び多軸加工機の制御装置
CN205219118U (zh) 机器人零点校准装置及机器人零点校准***
JP5595146B2 (ja) 加工シミュレーション装置および最適工程決定装置
TWM490934U (zh) 應用多自由度機械手臂的鏟花裝置
CN105759721A (zh) 一种四轴数控机床的加工方法
CN107138762B (zh) 一种大型球壳体开多孔加工方法及***
CN107636418B (zh) 一种机器人控制方法、控制设备及***
CN106847735B (zh) 一种精确定位分选机工作台中心基准的方法
CN111157004B (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