CN107609228B - 面向并联钻床的自动钻孔方法 - Google Patents

面向并联钻床的自动钻孔方法 Download PDF

Info

Publication number
CN107609228B
CN107609228B CN201710730949.0A CN201710730949A CN107609228B CN 107609228 B CN107609228 B CN 107609228B CN 201710730949 A CN201710730949 A CN 201710730949A CN 107609228 B CN107609228 B CN 107609228B
Authority
CN
China
Prior art keywords
drilling
platform
axis
coordinate system
point
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.)
Expired - Fee Related
Application number
CN201710730949.0A
Other languages
English (en)
Other versions
CN107609228A (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.)
University of Electronic Science and Technology of China
Original Assignee
University of Electronic Science and Technology of China
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 University of Electronic Science and Technology of China filed Critical University of Electronic Science and Technology of China
Priority to CN201710730949.0A priority Critical patent/CN107609228B/zh
Publication of CN107609228A publication Critical patent/CN107609228A/zh
Application granted granted Critical
Publication of CN107609228B publication Critical patent/CN107609228B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

本发明公开了一种面向并联钻床的自动钻孔方法,包括以下步骤:曲面法线方向求解:根据提出的算法可自动计算出所需钻孔工件表面的法线方向N;控制参数求解:依据求得的法线方向N,通过求解法求解出刀具平台调整到该法线方向下时并联钻床的各个驱动参数(l1,l2,l3,ΔX,ΔY);根据驱动参数,控制并联机器人的各个驱动腿的伸长量,自动矫正钻头方向,使其自动对准所需的钻孔方向;并联合控制XY运动工作台沿水平面两个方向的运动位移量,最终可实现自动打孔作业。本方法使用传感技术来自动计算被加工工件上钻孔点附近表面法线方向的算法和依据该法线方向自动调整钻头位姿的自动钻孔方法,可大大提高钻孔作业的效率。

Description

面向并联钻床的自动钻孔方法
技术领域
本发明涉及钻孔加工技术领域,涉及一种面向并联钻床的自动钻孔方法。
背景技术
在对不规则工件的复杂曲面进行钻孔加工作业时,往往需要钻头沿被加工工件表面的法线方向进行钻孔。在以往的钻孔加工中,常常是采用人工的方式将钻头对准被加工工件表面的法线方向后,再进行进一步的钻孔加工作业。传统的人工辅助钻孔方法工作强度大、劳力成本高、加工效率低,且其加工精度易受加工人员素质、经验和疲劳等因素影响。为了提高钻孔效率,节约加工成本,本专利提出了一种面向并联钻床的自动钻孔方法,该自动钻孔方法结合传感技术可以自动计算所需被加工工件表面钻孔位置的法线方向。通过控制并联钻床,可使钻头自动指向被加工工件上钻孔点附近表面的法线方向,并沿该法线方向进行钻孔作业。采用具有高刚度的并联钻孔装置和自动测量并对准钻孔方向的钻孔方法,满足了在复杂曲面上进行不同角度的自动钻孔作业需求,可提高并联钻床钻孔的效率和精度。
发明内容
本发明的目的是为了解决现有的并联钻床在钻孔时需要手动对准钻孔位置,其效率低、误差大的技术问题,本发明提出了一种使用传感技术来自动计算被加工工件上钻孔点附近表面法线方向的算法和依据该法线方向自动调整钻头位姿的自动钻孔方法,可大大提高钻孔作业的效率。
为了达到上述的技术效果,本发明采取以下技术方案:
一种面向并联钻床的自动钻孔方法,包括以下步骤:
曲面法线方向求解:在并联钻床的刀具平台上围绕1TP+3TPS型并联机器人动平台几何中心均匀安装三个激光测距传感器,激光测距传感器的测量方向垂直于动平台,并与钻头的方向一致,通过三个激光测距传感器的测量数据和被加工工件上所需钻孔的位置点坐标,根据提出的算法可自动计算出所需钻孔工件表面的法线方向N;
控制参数求解:依据求得的法线方向N,通过求解算法求解出将刀具平台调整到该法线方向下时并联钻床的各个驱动参数(l1,l2,l3,ΔX,ΔY);其中三条驱动腿长度分别为l1,l2,l3,XY运动工作台沿X轴和Y轴分别运动量分别为ΔX和ΔY;
根据驱动参数,控制并联机器人的各个驱动腿的伸长量,自动矫正钻头方向,使其自动对准所需的钻孔方向;并联合控制XY运动工作台沿水平面两个方向的运动位移量,使钻头以一定位姿位于被加工点的正上方,在锁定该位姿下,通过控制钻头进给装置,最终可实现自动打孔作业。
进一步的技术方案是,所述的曲面法线方向求解的具体步骤如下:设由三个激光测距传感器测得动平台到曲面零件表面的距离分别为(d1,d2,d3),记录此时刀尖点位置P=(XP,YP,ZP),依据刀尖点位置,可求解出并联机器人位姿参数(α00,L0),其中α00为测量时1TP+3TPS型并联机器人动平台绕X轴和Y轴的旋转角度,L0为测量时动平台几何中心到静平台几何中心的距离;根据三个传感器测量的数值和刀尖点位置,此时可以计算出所需加工点附近表面在动坐标系中的法向量n;再根据并联机器人的位姿参数可将动坐标系中的法线量n转化为绝对坐标系中的法向量N,即钻孔点的钻孔方向;最终,根据测量参数和记录参数(d1,d2,d3,Xp,YP,ZP),该算法可计算出钻孔点的钻孔方向N。
进一步的技术方案是,所述的控制参数求解的具体步骤如下:
计算出调整到钻孔方向N下刀具平台需要转动的角度
Figure BDA0001387099110000021
在调整为该钻孔方位后,钻头头部相对钻孔点会出现位置偏移量(ΔX,ΔY,ΔZ);将参数
Figure BDA0001387099110000031
带入1TP+3TPS型并联机器人的杆长约束公式,可知三条驱动电动缸的驱动参数为(l1,l2,l3);同时依据刀尖相对钻孔点偏移量,可知XY运动工作台的驱动参数为(ΔX,ΔY);依据测量时的参数(d1,d2,d3,Xp,YP,ZP)确定钻孔时所需调整的位置参数为
Figure BDA0001387099110000032
最终得到从测量参数到钻孔时所需调整控制参数为(l1,l2,l3,ΔX,ΔY)。
进一步的技术方案是,所述的方法的具体步骤如下:
a)以并联机器人静平台中心为坐标原点建立静坐标系O-XYZ,如附图2所示,Y轴指向其中一个虎克铰,Z轴由静平台几何中心指向动平台几何中心;以动平台几何中心为原点建立动坐标系o-xyz,y轴平行于Y轴指向其中一个万向铰,z轴沿着Z轴的方向垂直于动平台;在右手定则下确定X轴和x轴;因此,动坐标系o-xyz到静坐标系O-XYZ的旋转矩阵R可用两个欧拉角(α,β)表示为:
Figure BDA0001387099110000033
其中:
Figure BDA0001387099110000034
b)设三个传感器位于以动平台中心为原点半径为r的圆上,传感器在动坐标系下的高度为h,如附图3a所示,则三个传感器Si(i=1,2,3)在动坐标系中的坐标值分别为:
Figure BDA0001387099110000035
c)由三个激光测距传感器测得动平台到曲面零件表面的距离分别为d1,d2,d3,则曲面上三个测量点Ci(i=1,2,3)在动坐标系中的坐标值为:
Figure BDA0001387099110000041
设C1,C2,C3组成的平面在动坐标系下的法线单位向量为n=(nx,ny,nz),该单位向量应同时垂直向量C1C2和C2C3,因此有:
n=C1C2×C2C3 (4)
结合等式(3)中曲面上三个测量点在动坐标系中的坐标值可知:
Figure BDA0001387099110000042
将等式(5)带入等式(4)有:
Figure BDA0001387099110000043
解得:
Figure BDA0001387099110000044
d)设测量时动平台位姿数据为(α00,L0),其中α00为测量时1TP+3TPS型并联机器人动平台绕X轴和Y轴的旋转角度,L0为测量时动平台几何中心到静平台几何中心的距离;结合等式(1),将动坐标系下的法线方向向量转换为定坐标系下的法向量:
Figure BDA0001387099110000045
根据法线单位向量N,便可以计算出动平台需要绕X轴和Y轴转动的角度
Figure BDA0001387099110000046
Figure BDA0001387099110000047
其中N可以看作由初始单位向量(0,0,1)分别绕X,Y轴转动
Figure BDA0001387099110000048
角度后所得到,根据欧拉变换关系,运用两坐标系对应的旋转变换公式(1)便可得:
Figure BDA0001387099110000051
根据依上式解得
Figure BDA0001387099110000052
的值为:
Figure BDA0001387099110000053
e)假设被加工工件上钻孔点的位置坐标为P=(XP,YP,ZP),对应1TP+3TPS型并联机器人动平台的位姿数据为(α00,L0),控制1TP+3TPS型并联机器人调整刀具平台姿态,使钻头头部处于点P=(XP,YP,ZP),若设m为刀尖点到动平台几何中心的距离,则测量时刀尖点坐标值为:
Figure BDA0001387099110000054
依据上式可计算出此时并联机器人动平台的位姿为:
Figure BDA0001387099110000055
f)若钻孔时1TP+3TPS型并联机器人的动平台绕X轴,Y轴旋转
Figure BDA0001387099110000056
角度后,钻头方向沿着测量计算出的零件表面法线方向N,则此时刀尖点的位置为:
Figure BDA0001387099110000057
因此,相对测量时调整到钻孔姿态后所带来的刀尖位置偏移量为:
Figure BDA0001387099110000061
g)钻孔时的位姿参数对应为
Figure BDA0001387099110000062
假设三条驱动腿长度分别为l1,l2,l3,静平台半径为R,动平台半径为r,则在动坐标系中球铰的位置坐标为:
Figure BDA0001387099110000063
由动坐标系到静坐标系的转换关系为:
ei=P+Rei′(i=1,2,3) (16)
则球铰和万向铰在绝对坐标系的坐标值为:
Figure BDA0001387099110000064
Figure BDA0001387099110000065
Figure BDA0001387099110000066
由并联机器人杆长约束:
Figure BDA0001387099110000067
将各万向铰和球铰的位置坐标带入等式(18)有:
Figure BDA0001387099110000071
h)结合等式(12)-(19),依据测量时的参数(d1,d2,d3,Xp,YP,ZP)确定了钻孔时所需调整的位置参数为
Figure BDA0001387099110000072
最终得到从测量参数到钻孔时所需调整控制参数(l1,l2,l3,ΔX,ΔY);在测量后调节XY运动工作台沿X轴和Y轴分别运动ΔX和ΔY;同时调节并联机器人三条驱动腿,使其长度分别为l1,l2和l3,此时钻头就对准所需钻孔的方向,在该姿态下进行打孔作业。
进一步的技术方案是,为了避免碰撞,在调整钻头指向加工曲面的法向方向N之前,首先沿Z轴平动刀具平台和补偿XY运动工作台后,再联调并联钻床的1TP+3TPS型并联机器人,从而使钻头达到预定的加工点。
进一步的技术方案是,在测量时工件处于钻头正下方,钻头方向垂直于XY运动工作台,即z轴和Z轴共线时,如附图3b。此时有:α0=β0=0和XP=YP=0,那么N=n。带入等式(8),则该工件钻孔点法线方向为:
Figure BDA0001387099110000073
根据等式(10)和(12)可知对应该法线方向的钻孔参数为:
Figure BDA0001387099110000074
那么在条件α0=β0=0和XP=YP=0下,等式(14)和(19)对应的XY运动工作台和并联机器人的控制参数为:
Figure BDA0001387099110000081
Figure BDA0001387099110000082
下面介绍一下实施本发明的一种并联钻床。
并联钻床的主体支撑为一个龙门支架,在龙门支架的下方固定一个XY运动工作台,该XY运动工作台可使被加工工件在水平面上快速移动,从而使工件快速到达被加工位置。在龙门支架上方横梁上倒置安装有一个1PT+3TPS型并联机器人。1PT+3TPS型并联机器人通过静平台与龙门支架刚性连接,1PT+3TPS型并联机器人的动平台和其上的钻头进给机构组成了刀具平台。
1TP+3TPS型并联机器人主要由静平台、动平台和连接两平台的三条TPS驱动链和一条TP从动链组成,其中三条TPS驱动链通过球铰与动平台相连,通过虎克铰与静平台相连,且球铰和虎克铰以120°间隔均匀分布在动静平台的圆周上。从动链TP一端通过移动副与静平台固接,一端通过虎克铰与动平台相连,且移动副和虎克铰的安装位置位于动静平台几何中心。该型并联机器人中间的TP从动链能保证动平台中心能稳定的沿竖直方向上运动,而外围的三条TPS驱动链采用的是折叠式的伺服电动缸驱动。通过控制三个伺服电动缸,最终可以使动平台绕TP链的虎克铰的正交转轴转动及沿Z轴的移动,从而使刀具平台到达理想的位姿。
本发明与现有技术相比,具有以下的有益效果:
本方法使用传感技术来自动计算被加工工件上钻孔点附近表面法线方向的算法和依据该法线方向自动调整钻头位姿的自动钻孔方法,可大大提高钻孔作业的效率。
附图说明
图1为本发明的并联钻床的整体结构示意图;
其中,1-龙门支架;2-1TP+3TPS型并联机器人;3-刀具平台;4-XY运动工作台。
图2为本发明的并联钻床的1TP+3TPS型并联机器人的结构示意图;
其中,11-动平台;12-传感器;13-球铰;14-伺服电动缸;15-虎克铰;16-静平台。
图3a为本发明并联加工钻床的传感器测量零件表面法线方向分析示意图;
图3b为本发明并联加工钻床的一种特殊位检测示意图;
图4为本发明的并联钻床自动钻孔的流程图。
具体实施方式
下面结合本发明的附图和实施例对本发明作进一步的阐述和说明。
图1和图2分别示出了本发明的并联钻床的整体结构示意图和并联钻床的1TP+3TPS型并联机器人的结构示意图。并联钻床的主体支撑为一个龙门支架1,在龙门支架1的下方固定一个XY运动工作台4,该XY运动工作台4可使被加工工件在水平面上快速移动,从而使工件快速到达被加工位置。在龙门支架4上方横梁上倒置安装有一个1PT+3TPS型并联机器人2。1PT+3TPS型并联机器人2通过静平台16与龙门支架1刚性连接,1PT+3TPS型并联机器人2的动平台11和其上的钻头进给机构组成了刀具平台3。
1TP+3TPS型并联机器人主要由静平台16、动平台11和连接两平台的三条TPS驱动链和一条TP从动链组成,其中三条TPS驱动链通过球铰13与动平台11相连,通过虎克铰15与静平台16相连,且球铰13和虎克铰15以120°间隔均匀分布在动静平台16的圆周上。从动链TP一端通过移动副与静平台16固接,一端通过虎克铰15与动平台11相连,且移动副和虎克铰的安装位置位于动静平台几何中心。该型并联机器人中间的TP从动链能保证动平台中心能稳定的沿竖直方向上运动,而外围的三条TPS驱动链采用的是折叠式的伺服电动缸14驱动。通过控制三个伺服电动缸14,最终可以使动平台绕TP链的虎克铰的正交转轴转动及沿Z轴的移动,从而使刀具平台到达理想的位姿。
图4中给出了,自动钻孔方法的具体实施流程为:
1.校准并联钻床初始位姿,将被加工工件安装于XY运动工作台上,保证其在加工中不会偏移。
2.到达测量位,联调XY运动工作台的两个电机和并联机器人的三个电动缸,将被加工工件快速移至并联机器人正下方。将工件移至并联机器人正下方后,若此时被加工工件上钻孔点的位置坐标为P=(XP,YP,ZP),控制并联机器人调整刀具平台姿态,使钻头头部处于点P=(XP,YP,ZP)。此时砖头头部几乎接触到所需钻孔位置的零件表面。
3.启动自动测量系统,记录此时并联机器人位姿参数(α00,L0)和三个激光测距传感器参数(d1,d2,d3)。自动计算出钻孔时所需的钻孔方位参数
Figure BDA0001387099110000101
同时计算出钻头头部在调整后出现的位置偏移量(ΔX,ΔY,ΔZ)。将参数
Figure BDA0001387099110000102
带入1TP+3TPS型并联机器人的杆长约束等式,可知三条驱动电动缸的驱动参数为(l1,l2,l3)。并同时得到相对于测量时XY运动工作台需要修正的位移参数(ΔX,ΔY)
4.退出自动测量程序,为避免调整姿态时钻头和工件碰撞,控制并联机器人,将工具平台沿Z轴移动一定高度。
5.自动对准钻孔位,以测量时计算的钻孔控制参数(l1,l2,l3,ΔX,ΔY),联动调解并联钻床,使钻头自动到达加工位。
6.开始钻孔,锁死调节位姿的各驱动装置,启动钻头进给装置。
7.钻孔加工完成,并联钻床退回初始位置或进入下一个钻孔环节。
如附图2所示,以并联机器人静平台中心为坐标原点建立静坐标系O-XYZ,Y轴指向其中一个虎克铰,Z轴由静平台几何中心指向动平台几何中心。
如附图3b所示,当测量时工件处于钻头正下方,钻头方向垂直于XY工作台,即z轴和Z轴共线时,有:α0=β0=0,XP=YP=0和N=n,假设1TP+3TPS型并联钻床的静平台半径R为382mm,动平台半径r为155mm,动平台到刀尖点距离m=440mm,则测量时钻孔位置为:
P=(0,0,1250) (24)
由等式(12)知,在测量时1TP+3TPS型并联机器人的位姿参数为:
α0=0,β0=0,L0=810 (25)
若三个激光测距传感器测量的测量数据为:
d1=556.25,d2=401.25,d3=401.25 (26)
由等式(7)可知,在动坐标系中被加工工件上钻孔点附近表面的法线方向为:
n=(36037.5,20806.26,62418.78) (27)
求得的法向量的单位向量为:
n=(0.302,0.175,0.523) (28)
由于N=n,则在绝对坐标系中被加工工件上钻孔点附近表面的法线方向为:
N=(0.302,0.175,0.523) (29)
由等式(10)知,钻孔时1TP+3TPS并联机器人动平台的方位角为:
Figure BDA0001387099110000121
由等式(14)知,在调整为该姿态后,对应测量时刀尖点的偏差量为:
ΔX=132.55,ΔY=77.18,ΔZ=-27.60 (31)
由等式(23)知,钻孔时1TP+3TPS并联机器人三条驱动腿的长度分别为:
l1=788.09,l2=867.32,l3=793.09 (32)
因此根据自动测量得到的参数(l1,l2,l3,ΔX,ΔY),调节XY运动平台沿X轴和Y轴分别运动132.55mm和77.18mm。同时调节并联机器人三条驱动腿,使其长度分别为l1=788.09mm,l2=867.32m和l3=793.09mm此时钻头就对准所需钻孔的方向,可达到自动调姿的目的。在该方向上启动钻头进给装置,最终可实现自动测量被加工工件上钻孔点附近表面法线方向和依据该法线方向自动调整钻床位姿的自动钻孔作业。
此外,在本实施例中,此并联钻床上PT+3TPS型并联机器人的三条驱动腿选用DDG10型电动缸,其具体的参数如表1所示。而激光测距传感器选用RWRFA1-2型激光测距传感器,其具体的参数如表2所示。
表1电动缸参数
Figure BDA0001387099110000122
表2激光测距传感器参数
Figure BDA0001387099110000123
本专利中所述的可自动定姿态钻孔的并联钻床,是一种结构紧凑,效率高的钻孔装置,可以胜任在复杂曲面上快速钻孔的任务。通过本专利中提到的利用传感器快速测量曲面某点法向方向并确定刀头姿态的方法,可以迅速的确定在钻孔位置打孔的角度。相应地自动调控并联钻床的各个驱动参数,使刀头能迅速调整钻孔姿态,完成自动钻孔的任务。该方式具有简单易行,处理速率快,效率高的特点,可实现并联钻床快速自动打孔的功能。
尽管这里参照本发明的解释性实施例对本发明进行了描述,上述实施例仅为本发明较佳的实施方式,本发明的实施方式并不受上述实施例的限制,应该理解,本领域技术人员可以设计出很多其他的修改和实施方式,这些修改和实施方式将落在本申请公开的原则范围和精神之内。

Claims (2)

1.一种面向并联钻床的自动钻孔方法,其特征在于包括以下步骤:
i)曲面法线方向求解:在并联钻床的刀具平台上围绕1TP+3TPS型并联机器人动平台几何中心均匀安装三个激光测距传感器,激光测距传感器的测量方向垂直于动平台,并与钻头的方向一致,通过三个激光测距传感器的测量数据和被加工工件上所需钻孔的位置点坐标,根据提出的算法可自动计算出所需钻孔工件表面的法线方向N;
所述的曲面法线方向求解的具体步骤如下:
设由三个激光测距传感器测得动平台到曲面零件表面的距离分别为(d1,d2,d3),记录此时刀尖点位置P=(XP,YP,ZP),依据刀尖点位置,可求解出并联机器人的位姿参数(α00,L0),其中α00为测量时1TP+3TPS型并联机器人动平台绕X轴和Y轴的旋转角度,L0为测量时动平台几何中心到静平台几何中心的距离;根据三个传感器测量的数值,此时可以计算出所需加工点附近表面在动坐标系中的法向量n;再根据并联机器人的位姿参数可将动坐标系中的法线量n转化为绝对坐标系中的法向量N,即钻孔点的钻孔方向;最终,根据测量参数和测量参数(d1,d2,d3,Xp,YP,ZP),该算法可计算出钻孔点的钻孔方向N;
ii)控制参数求解:依据求得的法线方向N,通过求解算法求解出将刀具平台调整到该法线方向下时并联钻床的各个驱动参数(l1,l2,l3,ΔX,ΔY);其中三条驱动腿长度分别为l1,l2,l3,XY运动工作台沿X轴和Y轴运动量分别为ΔX和ΔY;
所述的控制参数求解的具体步骤如下:
计算出调整到钻孔方向N下刀具平台需要转动的角度
Figure FDA0002733257560000011
在调整为该钻孔方位后,钻头头部相对钻孔点会出现位置偏移量(ΔX,ΔY,ΔZ);将参数
Figure FDA0002733257560000012
带入1TP+3TPS型并联机器人的杆长约束公式,可知三条驱动电动缸的驱动参数为(l1,l2,l3);同时依据刀尖相对钻孔点偏移量,可知XY运动工作台的驱动参数为(ΔX,ΔY);依据测量时的参数(d1,d2,d3,Xp,YP,ZP)确定钻孔时所需调整的位置参数为
Figure FDA0002733257560000021
最终得到从测量参数到钻孔时所需调整控制参数为(l1,l2,l3,ΔX,ΔY);
iii)根据求得的驱动参数,控制并联机器人的各个驱动腿的伸长量,自动矫正钻头方向,使其自动对准所需的钻孔方向;并联合控制XY运动工作台沿水平面两个方向的运动位移量,使钻头以一定位姿位于被加工点的正上方,在锁定该位姿下,通过控制钻头进给装置,最终可实现自动打孔作业;
所述方法的具体步骤如下:
a)以并联机器人静平台中心为坐标原点建立静坐标系O-XYZ,Y轴指向其中一个虎克铰,Z轴由静平台几何中心指向动平台几何中心;以动平台几何中心为原点建立动坐标系o-xyz,y轴平行于Y轴指向其中一个万向铰,z轴沿着Z轴的方向垂直于动平台;在右手定则下确定X轴和x轴;因此,动坐标系o-xyz到静坐标系O-XYZ的旋转矩阵R可用两个欧拉角(α,β)表示为:
Figure FDA0002733257560000022
其中:
Figure FDA0002733257560000023
b)设三个传感器位于以动平台中心为原点半径为r的圆上,传感器在动坐标系下的高度为h,则三个传感器Si(i=1,2,3)在动坐标系中的坐标值分别为:
Figure FDA0002733257560000024
c)由三个激光测距传感器测得动平台到曲面零件表面的距离分别为d1,d2,d3,则曲面上三个测量点Ci(i=1,2,3)在动坐标系中的坐标值为:
Figure FDA0002733257560000031
设C1,C2,C3组成的平面在动坐标系下的法线单位向量为n=(nx,ny,nz),该单位向量应同时垂直向量C1C2和C2C3,因此有:
n=C1C2×C2C3 (4)
结合等式(3)中曲面上三个测量点在动坐标系中的坐标值可知:
Figure FDA0002733257560000032
将等式(5)带入等式(4)有:
Figure FDA0002733257560000033
解得:
Figure FDA0002733257560000034
d)设测量时动平台位姿数据为(α00,L0),其中α00为测量时1TP+3TPS型并联机器人动平台绕X轴和Y轴的旋转角度,L0为测量时动平台几何中心到静平台几何中心的距离;结合等式(1),将动坐标系下的法线方向向量转换为定坐标系下的法向量:
Figure FDA0002733257560000035
根据法线单位向量N,便可以计算出动平台需要绕X轴和Y轴转动的角度θ,
Figure FDA0002733257560000036
其中N可以看作由初始单位向量(0,0,1)分别绕X,Y轴转动θ,
Figure FDA0002733257560000037
角度后所得到,根据欧拉变换关系,运用两坐标系对应的旋转变换公式(1)便可得:
Figure FDA0002733257560000041
根据依上式解得θ,
Figure FDA0002733257560000042
的值为:
Figure FDA0002733257560000043
e)假设被加工工件上钻孔点的位置坐标为P=(XP,YP,ZP),对应1TP+3TPS型并联机器人动平台的位姿数据为(α00,L0),控制1TP+3TPS型并联机器人调整刀具平台姿态,使钻头头部处于点P=(XP,YP,ZP),若设m为刀尖点到动平台几何中心的距离,则测量时刀尖点坐标值为:
Figure FDA0002733257560000044
依据上式可计算出此时并联机器人动平台的位姿为:
Figure FDA0002733257560000045
f)若钻孔时1TP+3TPS型并联机器人的动平台绕X轴,Y轴旋转θ,
Figure FDA0002733257560000046
角度后,钻头方向沿着测量计算出的零件表面法线方向N,则此时刀尖点的位置为:
Figure FDA0002733257560000047
因此,相对测量时调整到钻孔姿态后所带来的刀尖位置偏移量为:
Figure FDA0002733257560000048
g)钻孔时的位姿参数对应为
Figure FDA0002733257560000049
假设三条驱动腿长度分别为l1,l2,l3,静平台半径为R,动平台半径为r,则在动坐标系中球铰的位置坐标为:
Figure FDA0002733257560000051
由动坐标系到静坐标系的转换关系为:
ei=P+Re′i(i=1,2,3) (16)
则球铰和万向铰在绝对坐标系的坐标值为:
Figure FDA0002733257560000052
Figure FDA0002733257560000053
Figure FDA0002733257560000054
由并联机器人杆长约束:
Figure FDA0002733257560000055
将各万向铰和球铰的位置坐标带入等式(18)有:
Figure FDA0002733257560000056
h)结合等式(12)-(19),依据测量时的参数(d1,d2,d3,Xp,YP,ZP)确定了钻孔时所需调整的位置参数为
Figure FDA0002733257560000061
最终得到从测量参数到钻孔时所需调整控制参数(l1,l2,l3,ΔX,ΔY);在测量后调节XY运动工作台沿X轴和Y轴分别运动ΔX和ΔY;同时调节并联机器人三条驱动腿,使其长度分别为l1,l2和l3,此时钻头就对准所需钻孔的方向,在该姿态下进行打孔作业。
2.根据权利要求1所述的面向并联钻床的自动钻孔方法,其特征在于在调整钻头指向加工曲面的法向方向N之前,首先沿Z轴平动刀具平台和补偿XY运动工作台后,再联调并联钻床的1TP+3TPS型并联机器人,从而使钻头达到预定的加工点。
CN201710730949.0A 2017-08-23 2017-08-23 面向并联钻床的自动钻孔方法 Expired - Fee Related CN107609228B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710730949.0A CN107609228B (zh) 2017-08-23 2017-08-23 面向并联钻床的自动钻孔方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710730949.0A CN107609228B (zh) 2017-08-23 2017-08-23 面向并联钻床的自动钻孔方法

Publications (2)

Publication Number Publication Date
CN107609228A CN107609228A (zh) 2018-01-19
CN107609228B true CN107609228B (zh) 2021-03-16

Family

ID=61065872

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710730949.0A Expired - Fee Related CN107609228B (zh) 2017-08-23 2017-08-23 面向并联钻床的自动钻孔方法

Country Status (1)

Country Link
CN (1) CN107609228B (zh)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109663944B (zh) * 2018-12-27 2020-11-03 四川艾格瑞特模具科技股份有限公司 一种精密机械打孔装置
CN110153461A (zh) * 2019-06-26 2019-08-23 电子科技大学 面向并联钻床的智能姿态调控装置及其调控方法
CN110293247B (zh) * 2019-07-02 2020-05-22 电子科技大学 并联型钻床的刚度增强装置及其控制方法
CN111844071B (zh) * 2020-07-20 2021-11-09 清华大学 一种移动式深孔原位加工机器人
CN111844070B (zh) * 2020-07-20 2021-10-15 清华大学 一种面向深孔原位加工作业的移动式混联机器人
CN112286143B (zh) * 2020-10-27 2021-09-14 广州傲创智能科技有限公司 一种3+2轴机床的坐标自动计算测试方法
CN112589449A (zh) * 2020-12-18 2021-04-02 南京库森科技有限公司 一种轮船的钻斜孔装置
CN112916901A (zh) * 2021-03-04 2021-06-08 天蓬智慧建造(广东)科技有限公司 一种同时打多个孔的打孔机
CN113231664B (zh) * 2021-03-31 2022-01-25 成都飞机工业(集团)有限责任公司 一种飞机框梁上固定点的孔位定位和开孔的装置及方法
CN113579766B (zh) * 2021-07-23 2022-08-02 哈尔滨工程大学 一种六自由度串并混联数控机床及其后处理方法
CN113500308A (zh) * 2021-07-27 2021-10-15 苏州大学 一种激光去除交叉孔毛刺的方法
CN113399711B (zh) * 2021-08-06 2022-11-22 中国十九冶集团有限公司 一种拉杆打孔设备支架
CN113914880B (zh) * 2021-09-01 2024-02-23 中铁九局集团电务工程有限公司 基于激光测距的倾角可修正隧道打孔方法及打孔机器人
CN113836662B (zh) * 2021-09-26 2023-04-25 电子科技大学 凸轮曲线槽机构设计缺陷的动态辨识及去特征化修复方法
CN115106566B (zh) * 2022-08-19 2023-01-10 成都联星技术股份有限公司 一种柔性自适应钻孔装置
CN117272549B (zh) * 2023-11-17 2024-03-08 数格科技(天津)有限公司 一种自动打孔的方法、装置、存储介质及电子设备

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9545697B2 (en) * 2009-04-06 2017-01-17 The Boeing Company Automated hole generation
CN103447877B (zh) * 2013-09-16 2015-08-19 南京航空航天大学 自主移动机构法矢检测与调姿运动方法
CN106313007B (zh) * 2016-10-10 2018-10-12 电子科技大学 并联型钻床的示教再现系统
CN206391026U (zh) * 2016-10-27 2017-08-11 吉林百合口腔医院股份有限公司 一种加工义齿的微型并联机床
CN106584206B (zh) * 2016-11-17 2018-10-26 浙江大学 一种自动钻铆机的制孔法向修正方法

Also Published As

Publication number Publication date
CN107609228A (zh) 2018-01-19

Similar Documents

Publication Publication Date Title
CN107609228B (zh) 面向并联钻床的自动钻孔方法
CN109605371B (zh) 一种移动式混联机器人加工集成系统
US9448552B2 (en) Numerically-controlled machine tool and spindle error compensating method thereof
KR101744962B1 (ko) 다관절로봇을 이용한 목재부재 가공시스템
KR940003204B1 (ko) 제어로봇
JP7153085B2 (ja) ロボットキャリブレーションシステム及びロボットキャリブレーション方法
US20150314450A1 (en) Calibration method for coordinate system of robot manipulator
CN107378324B (zh) 一种基于视觉提取的异型工件的焊接系统及方法
Devlieg High-accuracy robotic drilling/milling of 737 inboard flaps
CN104858748A (zh) 一种叶片进排气边磨削机器人自动化装备
JP6667376B2 (ja) 部品圧入方法および部品圧入システム
CN111037542B (zh) 一种逆动力学控制机器人直线加工的轨迹误差补偿方法
WO2008110559A2 (en) A support arrangement for a treatment device
EP3351355B1 (en) Device and method for positioning processing tool
CN105364924A (zh) 机器人零点校准系统及机器人零点校准方法
US7957834B2 (en) Method for calculating rotation center point and axis of rotation, method for generating program, method for moving manipulator and positioning device, and robotic system
CN205201527U (zh) 机器人零点校准系统
JP4396553B2 (ja) ロボット制御装置,コンピュータプログラム
CN113579766B (zh) 一种六自由度串并混联数控机床及其后处理方法
JP7042925B2 (ja) ワーク自動搬送機
CN115373288A (zh) 一种ac双摆头五轴制孔机床的法向调整方法及系统
US20230202039A1 (en) Control device, robot system, and control method for causing robot to execute work on workpiece
CN115647438A (zh) 一种超大径厚比整体箱底自适应补偿加工的找正方法
CN115847408A (zh) 一种运维机器人的智能识别和调整位姿方法
KR101503304B1 (ko) 레이저 포인터를 이용하는 러그 용접 로봇의 위치 및 자세 세팅방법

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20210316

Termination date: 20210823