CN102284956B - 一种自动钻铆机器人的法向找正方法 - Google Patents
一种自动钻铆机器人的法向找正方法 Download PDFInfo
- Publication number
- CN102284956B CN102284956B CN2011101130600A CN201110113060A CN102284956B CN 102284956 B CN102284956 B CN 102284956B CN 2011101130600 A CN2011101130600 A CN 2011101130600A CN 201110113060 A CN201110113060 A CN 201110113060A CN 102284956 B CN102284956 B CN 102284956B
- Authority
- CN
- China
- Prior art keywords
- robot
- laser displacement
- displacement sensors
- attitude
- computer
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000005553 drilling Methods 0.000 title claims abstract description 20
- 238000006073 displacement reaction Methods 0.000 claims abstract description 20
- 239000012636 effector Substances 0.000 claims description 9
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims 1
- 238000005516 engineering process Methods 0.000 description 8
- 229920000535 Tan II Polymers 0.000 description 6
- 238000004519 manufacturing process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 2
- 238000003754 machining Methods 0.000 description 2
- 238000004080 punching Methods 0.000 description 2
- 238000012827 research and development Methods 0.000 description 2
- 229910000838 Al alloy Inorganic materials 0.000 description 1
- 241000345998 Calamus manan Species 0.000 description 1
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 1
- 240000000560 Citrus x paradisi Species 0.000 description 1
- 229910001069 Ti alloy Inorganic materials 0.000 description 1
- 230000000386 athletic effect Effects 0.000 description 1
- 229910052799 carbon Inorganic materials 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000003475 lamination Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 235000012950 rattan cane Nutrition 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Landscapes
- Numerical Control (AREA)
Abstract
本发明公开了一种自动钻铆机器人的法向找正方法,属于机器人法向精度控制领域。该方法所使用的装置包括四个激光位移传感器、模拟量输入模块以及计算机,四个激光位移传感器安装在机器人的末端执行器上,并通过输入模块连接计算机,计算机连接机器人控制器。该方法首先建立机器人坐标系,并在机器人末端执行器上建立工具坐标系,获取机器人到达TCP时的坐标,然后测量传感器与目标表面之间的距离,计算出机器人目标姿态相对于当前姿态的偏差角,最后计算出机器人应调整到的目标姿态,将该姿态传输给机器人控制器完成法向找正。本发明方法所需的原始信息少且易于获取,能够快速、准确地实现机器人姿态找正。
Description
技术领域
本发明涉及一种机器人控制方法,尤其涉及一种自动钻铆机器人的法向找正控制方法,属于机器人法向精度控制领域。
背景技术
在航空航天制造领域,飞机柔性装配技术的应用已经成为国内外飞机制造业数字化制造的主流发展趋势。由于目前飞机结构件装配过程中以机械连接为主,机械连接带来了大量制孔问题,为了满足飞机长寿命要求就必须解决精密制孔技术难题,因此机器人精密制孔技术成为飞机柔性装配技术的一个重要应用和研究方向。
国外关于机器人自动制孔技术的研究和应用已相当成熟:美国Electroimpact公司与英国空客公司联合设计了一套机器人自动钻削系统(O.N.C.E),主要用于波音F/A-18E/F的机翼后缘襟翼的钻孔和锪孔;美国EOA公司与波音公司联合研制了一种机器人多功能钻削系统(EOA),可完成对钛合金、铝合金、复合材料以及叠层等飞机蒙皮的钻孔、锪孔和铰孔工作;瑞典Novator公司根据Orbital钻头专利技术开发了一套机器人多功能钻削系统(OrbitalE-D100);洛克希德·马丁公司F-35飞机碳纤维环氧复合材料机翼上壁板制孔用的大型龙门式钻孔系统(JGADS)代表了机器人制孔技术最前沿应用的方向。国内飞机装配领域与航空技术先进国家相比尚存在较大差距,对机器人精密制孔的研究处于起步阶段,因此需要大力发展以满足新一代飞机的研制与生产需求。
在机器人自动制孔过程中,由于机器人本身的定位误差、型架制造与安装误差、产品加工装配误差以及机翼空间姿态动态变化等因素的影响,导致蒙皮表面待加工点外法矢量方向与刀具轴线方向存在一定夹角。若此夹角过大,必将直接影响工件加工精度和装配可靠性,同时降低刀具的使用寿命,因此在飞机部件装配钻孔(铆接孔)加工前,提高钻铆的垂直精度就显得尤为重要。文献“大型壁板数控钻铆的三点快速调平算法(秦现生,汪文旦,楼阿莉,尉藤.航空学报,2007,28(6),1455-1460)”提出了基于机翼壁板有限曲面加工区域的三点快速调平算法。文章针对基于钻铆机和托架的数控钻铆系统,采用以机翼表面待钻铆点附近三点坐标表征铆接区域空间姿态的方法,通过钻铆系统的几何结构模型所确定的坐标变化矩阵,逆解出调平所需的各运动副位移增量。该方法有效地降低了机翼表面待钻铆区域的外法矢量与钻铆机加工轴线之间的偏差,基本实现钻铆垂直精度在0.5°的范围内,但由于该方法是通过调整工件姿态来适应钻铆机的加工轴线方向,对于大型机翼壁板操作困难,实现过程较复杂。
发明内容
本发明为满足自动钻铆过程中对垂直精度的要求,针对现有技术存在的不足,而提出一种基于激光位移传感器的自动钻铆机器人法向找正方法。
该方法所使用的装置包括四个激光位移传感器、模拟量输入模块以及计算机,四个激光位移传感器安装在机器人的末端执行器上,机器人的目标点位于四个激光位移传感器射出的四束激光的光点在目标表面上所形成的四边形内部,四个激光位移传感器通过模拟量输入模块连接计算机,计算机连接机器人控制器;
该方法包括如下步骤:
步骤1:将机器人定位到预定的姿态和位置上,在机器人的末端执行器上建立工具坐标系,获取TCP在机器人坐标系中的位置以及机器人的空间姿态,TCP即工具坐标系中心点;
步骤2:测量四个激光位移传感器与目标表面的距离,将测得的四个距离信息通过模拟量输入模块传输到计算机中;
步骤3:计算机器人由当前姿态变换到目标姿态时工具坐标系的旋转矩阵;
步骤4:在机器人坐标系中计算出机器人的目标姿态;
步骤5:将该目标姿态值传输给机器人控制器,控制机器人完成法向找正。
本发明具有如下技术效果:
(1)满足机器人自动钻铆技术中加工垂直精度在0.5°范围内的要求;
(2)应用于机器人自动钻铆系统中对工装的柔性度要求较低;
(3)所需原始信息少且易于获取,能够快速、准确地实现机器人姿态找正;
(4)可直接输出机器人应调整到的目标姿态,便于机器人的姿态调整控制。
附图说明
图1为本发明的法向找正几何模型示意图,图中:i为机器人坐标系;ii为工具坐标系;iii为待钻铆目标表面。
图2为本发明中机器人法向检测平面投影示意图。
具体实施方式
本发明方法所使用的装置由四个非接触式激光位移传感器、模拟量输入模块以及计算机构成。机器人坐标系为O-XYZ,工具坐标系T-XYZ建立在机器人的末端执行器上。如图1所示,设工具坐标系中心点(TCP)为T点,四个激光位移传感器在工具坐标系XTY平面内的安装点分别为P1、P2、P3、P4,安装尺寸应满足(l即安装尺寸)且分别为工具坐标系X轴和Y轴正方向,四个激光传感器等分安装在机器人末端执行器上以刀具轴线为中心轴的圆柱面上,且均与刀具轴线成45°夹角,这样可使得打到目标表面的四条激光束在不交叉的前提下又能够足够靠拢,即四束激光在目标表面形成的区域尽可能小,以提高法向找正的精度。机器人的目标点(待钻铆点)位于四束激光在目标表面上的光点所形成的四边形内部,将四个激光位移传感器与目标表面的距离作为确定待钻铆点实际法向姿态的输入信息,并将该信息通过倍福模拟量输入模块传输给计算机。
下面对本发明方法的步骤作进一步详细说明。
本发明方法的具体实施步骤如下:
步骤1:控制机器人按已编制好的数控程序定位到合适的姿态和位置上,在机器人末端执行器上建立工具坐标系T-XYZ,待机器人到达TCP后获取机器人当前的位姿(x,y,z,a,b,c),采用欧拉角变换序列表示运动姿态(a、b、c为欧拉角):
其中:s表示正弦;字母组奇数位的c表示余弦,如:cccb表示cos c cos b,下同;
步骤3:通过测得的四个距离信息,计算在机器人处于当前姿态和目标姿态之间工具坐标系的旋转矩阵;
在图1中,设安装在末端执行器上的刀具轴线方向为即姿态调整前工具坐标系的Z轴方向,R点为刀具轴线在目标表面的投影点。平面Q1Q2Q3Q4的外法向量为I为平面P1P2P3P4上的点,为目标区域的理论法矢。在工具坐标系的XTY平面内分别作直线IM、IN,使得直线IM//Y轴且与X轴交于M点,直线IN//X轴且与Y轴交于N点。然后分别作直线TI′//RI,直线TM′∥RM,直线TN′//RN,点I′、M′、N′均在平面Q1Q2Q3Q4上,为工具坐标系Z轴的目标方向,与分别为在XTZ面和YTZ面上的投影。
设θ为与TI′的夹角(当前姿态刀具轴线与目标姿态刀具轴线的夹角),θ1为与的夹角,θ2为与的夹角,t1为与的夹角。θ1、θ2即刀具轴线与目标区域的理论法矢在坐标平面XTZ和YTZ内的夹角,θ1、θ2和t1均有正负,根据右手法则,面向坐标轴正向看过去,逆时针旋转为正,顺时针旋转为负。
具体步骤如下:
①求θ与θ1、θ2之间的关系
由上面三式可得:
从θ与θ1、θ2的关系式可看出,通过控制θ1和θ2即可达到控制θ的目的。
②求θ1、θ2与距离h1、h2、h3、h4的关系
同理得到
于是:
③求t1与θ1、θ2的关系
由立体几何的知识可知:t1=arctan(cosθ1×tanθ2)。
④求工具坐标系补偿前后两个位置之间的旋转矩阵
设当机器人调整到目标姿态(x,y,z,a′,b′,c′)时,工具坐标系相应地旋转到T-X′Y′Z′位置。工具坐标系由初始的T-XYZ位置旋转到T-X′Y′Z′位置,可用Z-Y-X型的欧拉角来表示其旋转序列,即工具坐标系首先由T-XYZ位置绕Z轴旋转α角,再绕旋转后的Y轴旋转β角,最后绕再次旋转后的X轴旋转γ角到达T-X′Y′Z′位置,相应的旋转矩阵可表示为:
步骤4:在机器人坐标系中计算出机器人的目标姿态;
Euler(a′,b′,c′)=Euler(a,b,c)·Euler(α,β,γ)
即:
X′轴的单位方向矢量在机器人坐标系中的分量表示为nx、ny、nz;Y′轴的单位方向矢量在机器人坐标系中的分量表示为ox、oy、oz;Z′轴的单位方向矢量在机器人坐标系中的分量表示为ax、ay、az;
逆解得:
c′=atan 2(ny,nx)
c′=c′+180°
b′=a tan 2(-nz,cc′nx+sc′ny)
a′=a tan 2(sc′ax-cc′ay,-sc′ox+cc′oy)
步骤5:将该目标姿态值传输给机器人控制器,控制机器人完成法向找正。
Claims (3)
1.一种自动钻铆机器人的法向找正方法,其特征在于:
该方法所使用的装置包括四个激光位移传感器、模拟量输入模块以及计算机,四个激光位移传感器安装在机器人的末端执行器上,机器人的目标点位于四个激光位移传感器射出的四束激光的光点在目标表面上所形成的四边形内部,四个激光位移传感器通过模拟量输入模块连接计算机,计算机连接机器人控制器;
该方法包括如下步骤:
步骤1:将机器人定位到预定的姿态和位置上,在机器人的末端执行器上建立工具坐标系,获取T在机器人坐标系中的位置以及机器人的空间姿态,T即工具坐标系中心点;
步骤2:测量四个激光位移传感器与目标表面的距离,将测得的四个距离信息通过模拟量输入模块传输到计算机中;
步骤3:计算机器人由当前姿态变换到目标姿态时工具坐标系的旋转矩阵;
步骤4:在机器人坐标系中计算出机器人的目标姿态;
步骤5:将该目标姿态传输给机器人控制器,控制机器人完成法向找正。
2.根据权利要求1所述的自动钻铆机器人的法向找正方法,其特征在于:所述四个激光位移传感器等分安装在机器人末端执行器上以刀具轴线为中心轴的圆柱面上。
3.根据权利要求1所述的自动钻铆机器人的法向找正方法,其特征在于:
所述步骤4中机器人的目标姿态的计算步骤为:
1)根据四个激光位移传感器测得的四个距离信息,在工具坐标系中计算刀具轴线与目标区域的理论法矢在坐标平面XTZ和YTZ内的夹角,其中T为工具坐标系中心点;
2)计算在工具坐标系内机器人的当前姿态刀具轴线方向与目标姿态刀具轴线方向的夹角;
3)根据步骤1)和2)计算所得的夹角,机器人经过两次旋转变换调整得到机器人的目标姿态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011101130600A CN102284956B (zh) | 2011-05-04 | 2011-05-04 | 一种自动钻铆机器人的法向找正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011101130600A CN102284956B (zh) | 2011-05-04 | 2011-05-04 | 一种自动钻铆机器人的法向找正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102284956A CN102284956A (zh) | 2011-12-21 |
CN102284956B true CN102284956B (zh) | 2013-11-20 |
Family
ID=45331835
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2011101130600A Active CN102284956B (zh) | 2011-05-04 | 2011-05-04 | 一种自动钻铆机器人的法向找正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102284956B (zh) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102636110B (zh) * | 2012-03-26 | 2015-03-25 | 南京航空航天大学 | 飞机部件自动钻铆系统的基准检测装置及其检测方法 |
CN102768006B (zh) * | 2012-08-02 | 2015-05-13 | 西北工业大学 | 一种用于大曲率曲面零件法向自动测量和调整的方法 |
CN103447877B (zh) * | 2013-09-16 | 2015-08-19 | 南京航空航天大学 | 自主移动机构法矢检测与调姿运动方法 |
CN104006786A (zh) * | 2014-06-18 | 2014-08-27 | 清华大学 | 曲面法矢测量装置 |
CN104656655B (zh) * | 2014-12-31 | 2017-05-03 | 无锡贝斯特精机股份有限公司 | 八足爬行自动钻孔机器人姿态检测调整的方法 |
CN104698968B (zh) * | 2015-02-11 | 2017-05-31 | 南京航空航天大学 | 多功能自动钻铆末端执行器及自动钻铆方法 |
CN104708322B (zh) * | 2015-02-15 | 2017-03-29 | 南京航空航天大学 | 一种多功能钻铆执行器及其工作方法 |
CN105081884B (zh) * | 2015-08-24 | 2023-08-04 | 成都飞机工业(集团)有限责任公司 | 一种旋转扫描3d成型的法向测量装置 |
CN105222712A (zh) * | 2015-11-02 | 2016-01-06 | 西北工业大学 | 一种改进的大曲率半径曲面零件法向测量与调整方法 |
CN106441113B (zh) * | 2016-11-17 | 2018-10-26 | 浙江大学 | 激光位移传感器的标定装置及其标定方法 |
CN106584206B (zh) * | 2016-11-17 | 2018-10-26 | 浙江大学 | 一种自动钻铆机的制孔法向修正方法 |
CN106767397B (zh) * | 2016-11-21 | 2020-01-21 | 上海航天精密机械研究所 | 自动钻铆加工数据偏差测量及补偿方法 |
CN107063086B (zh) * | 2017-03-13 | 2019-03-12 | 浙江优迈德智能装备有限公司 | 一种基于双红外传感器的局部曲面法向量确定方法 |
CN107063089A (zh) * | 2017-04-10 | 2017-08-18 | 北京航空航天大学 | 一种曲面法线测量精度验证方法 |
US10625427B2 (en) * | 2017-06-14 | 2020-04-21 | The Boeing Company | Method for controlling location of end effector of robot using location alignment feedback |
CN108748150A (zh) * | 2018-06-04 | 2018-11-06 | 上海航天精密机械研究所 | 面向机器人加工的低成本实时补偿装置及方法 |
CN111438689B (zh) * | 2020-03-19 | 2021-09-21 | 智美康民(珠海)健康科技有限公司 | 工具头位姿的调整方法、装置及可读存储介质 |
CN112161587B (zh) * | 2020-09-27 | 2021-09-24 | 西北工业大学 | 一种机器人智能钻铆作业在线质量检测系统及方法 |
CN112296753B (zh) * | 2020-09-29 | 2021-09-03 | 苏州千机智能技术有限公司 | 基于迭代的在机测量工件装夹位置找正方法 |
CN112916515B (zh) * | 2021-03-15 | 2022-07-05 | 西安唐人电子科技有限公司 | 一种用于激光除漆的机械臂姿态自适应调整方法 |
CN114237308B (zh) * | 2021-12-20 | 2023-10-24 | 南京航空航天大学 | 一种天线类无线信号装置定位调整装备目标定位方法 |
CN114179114B (zh) * | 2022-02-17 | 2022-05-06 | 杭州飞钛航空智能装备有限公司 | 制孔法向找正方法、制孔末端执行装置及制孔机器人 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695814A (zh) * | 2009-10-15 | 2010-04-21 | 浙江大学 | 一种飞机大部件精确入位的方法及其装置 |
CN101823235A (zh) * | 2009-12-17 | 2010-09-08 | 成都飞机工业(集团)有限责任公司 | 自动法向检测控制水切割弧形薄板喷嘴切割头的方法 |
CN101957175A (zh) * | 2010-09-14 | 2011-01-26 | 西安交通大学 | 基于三点微平面式法向检测方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0429639A (ja) * | 1990-05-25 | 1992-01-31 | Shimizu Corp | 構造物の振動抑制装置 |
-
2011
- 2011-05-04 CN CN2011101130600A patent/CN102284956B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101695814A (zh) * | 2009-10-15 | 2010-04-21 | 浙江大学 | 一种飞机大部件精确入位的方法及其装置 |
CN101823235A (zh) * | 2009-12-17 | 2010-09-08 | 成都飞机工业(集团)有限责任公司 | 自动法向检测控制水切割弧形薄板喷嘴切割头的方法 |
CN101957175A (zh) * | 2010-09-14 | 2011-01-26 | 西安交通大学 | 基于三点微平面式法向检测方法 |
Non-Patent Citations (4)
Title |
---|
应明高 等.飞机壁板自动钻铆法向量测量方法研究.《机床与液压》.2010,第38卷(第23期),第5-9段及图1,2,3. |
王廉洁.自动调平系统的设计与实现.《新技术新工艺》.2008,(第10期),第9-12页. |
自动调平系统的设计与实现;王廉洁;《新技术新工艺》;20081031(第10期);第9-12页 * |
飞机壁板自动钻铆法向量测量方法研究;应明高 等;《机床与液压》;20101231;第38卷(第23期);第5-9段及图1,2,3 * |
Also Published As
Publication number | Publication date |
---|---|
CN102284956A (zh) | 2011-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102284956B (zh) | 一种自动钻铆机器人的法向找正方法 | |
Tian et al. | Auto-normalization algorithm for robotic precision drilling system in aircraft component assembly | |
CN107253084B (zh) | 飞机数字化装配中的高效高精机器人自动铣削系统 | |
US9435633B2 (en) | Quasi-virtual locate/drill/shim process | |
CN102636110B (zh) | 飞机部件自动钻铆系统的基准检测装置及其检测方法 | |
CN105783722B (zh) | 一种基于四面体构型的距离传感器法矢测量方法 | |
CN107538042B (zh) | 一种刚柔结合的环形轨道制孔系统及其运行方法 | |
CN105234743B (zh) | 一种五轴加工中心刀具变形误差补偿方法 | |
Devlieg | High-accuracy robotic drilling/milling of 737 inboard flaps | |
CN103592893B (zh) | 一种光学元件加工中自动补偿位姿误差的方法 | |
CN104182631B (zh) | 一种多轴加工系统的刀具偏离量的建模方法 | |
CN105345600B (zh) | 一种用于航空薄壁件自由曲面钻孔的法向测量与调整方法 | |
Yongguo et al. | Trajectory planning algorithm based on quaternion for 6-DOF aircraft wing automatic position and pose adjustment method | |
CN109366503A (zh) | 基于移动式混联机器人的面向大型构件的加工工艺方法 | |
Mei et al. | Accurate positioning of a drilling and riveting cell for aircraft assembly | |
CN103587719B (zh) | 平板件的全自动钻铆定位方法 | |
CN109884988A (zh) | 一种五轴数控制孔机床的制孔法向插补修正方法 | |
Mei et al. | Positioning variation synthesis for an automated drilling system in wing assembly | |
Zhao et al. | Kinematic modeling and base frame calibration of a dual-machine-based drilling and riveting system for aircraft panel assembly | |
Liu et al. | A helical milling and oval countersinking end-effector for aircraft assembly | |
Shi et al. | New design of a compact aero-robotic drilling end effector: An experimental analysis | |
US20180169768A1 (en) | Machine tool with an assembly configuration with a cantilevered tool | |
Yu et al. | Research on surface normal measurement and adjustment in aircraft assembly | |
Zhang et al. | Online adaptive measurement and adjustment for flexible part during high precision drilling process | |
Zhang et al. | Design of drilling and riveting multi-functional end effector for CFRP and aluminum components in robotic aircraft assembly |
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 |