本发明专利技术提出一种工业机器人精准制孔的法向调平方法，利用四个激光距离传感器建立零面坐标系，根据加工过程中四个激光距离传感器在加工表面的实际光点位置，来确定加工表面和刀具轴线的实际夹角，并将夹角传给工业机器人，通过多次循环调整工业机器人直到加工表面和刀具轴线的垂直角度符合要求；同时，在法向调平中将工业机器人工具坐标系的原点标定在和缩回状态的压力鼻平面沿刀具轴线正方向距离为l的平行平面上，该平面与刀具轴线的交点即为工具坐标系原点，以保证制孔加工时，工具坐标系的坐标系原点在零组件表面，为待制孔位置，使得待制孔的空间位置坐标不会受到法向调平程序的影响。
【技术实现步骤摘要】
本专利技术涉及工业机器人标定
，是一种制孔系统的法向调平方法，具体为 一种工业机器人精准制孔的法向调平方法。
技术介绍
目前，工业机器人自动化制孔已经在飞机、汽车等制造领域被逐渐应用。自动制 孔过程中，制孔精度很大程度上取决于制孔过程中，刀具轴线相对工件的垂直精度。从理论 上讲，制孔时可以根据理论数学模型获得制孔部位的法向信息，但由于部件的加工误差、装 配误差、变形等因素，往往导致制孔部位的实际外形与理论外形有一定的偏差，如果仍然按 照理论数学模型确定制孔部位的法向，会导致制孔质量缺陷。 现有某些设备为实现法向调平功能，对传感器的安装要求很高，很难达到要求； 同时，也有一套很繁琐的标定方法和复杂的标定工具；算法对传感器自身和标定方法过分 依赖。
技术实现思路
为解决现有技术存在的问题，本专利技术提出了一种工业机器人精准制孔的法向调平 方法。 本专利技术的技术方案为： 所述一种工业机器人精准制孔的法向调平方法，其特征在于：包括以下步骤： 步骤1 :在工业机器人制孔刀具周围布置四个激光距离传感器八4、(：、0，并利用标 定圆盘，通过以下步骤对四个激光距离传感器进行标定，所述标定圆盘由盘身和中心杆组 成，中心杆与盘身保证垂直度为90±0. 05° : 步骤1. 1 :将工业机器人制孔刀具保持竖直状态，并将中心杆装夹在工业机器人 制孔刀具的刀柄上； 步骤1. 2 :调整四个激光距离传感器，是其将激光点均打在标定圆盘盘面上； 步骤1. 3 :工业机器人制孔刀具电主轴沿轴向运动，带动标定圆盘轴向运动，观察 四个激光距离传感器在盘面上的激光点运动轨迹；调整四个激光距离传感器，使四个激光 距离传感器在盘面上的激光点运动轨迹相互平行，且任意三个激光距离传感器在盘面上的 激光点运动轨迹不共线； 步骤1.4:分别测量计算四个激光距离传感器光轴与标定圆盘盘面的夹角I、 dB、dc、dD ； 步骤2 :轴向调整工业机器人制孔刀具电主轴，使标定圆盘盘面与模拟工作面重 合；所述模拟工作面指沿电主轴进给方向的，且与工业机器人制孔刀具中处于缩回状态的 压力鼻平面距离为1的平面；1为制孔时，待制孔零组件平面和处于缩回状态的压力鼻平面 的距离；测量当前状态下四个激光距离传感器的距离读数S A，SB，SC，SD; 步骤3 :在标定圆盘盘面上建立与工业机器人制孔刀具固连的零面坐标系 ObXbYbZb,并得到四个激光距离传感器在盘面上的激光点在零面坐标系O bXbYbZb中的坐标值 (xA，yA)，（xB，yB)，（X。，y。)，（x D，yD);零面坐标系原点选择为任意一个激光距离传感器在盘 面上的激光点，并以该激光点的运动轨迹为O bYb轴；〇 bXb轴处于盘面上，且〇 bXb垂直于〇 Jb 轴；ObYb轴正方向与工具坐标系OtXtY tZt的OtYt轴正方向夹角为锐角，ObX b轴正方向与工具 坐标系OtXtYtZ t的0 tXt轴正方向夹角为锐角；0 bZb轴正方向由0 Jb轴正方向以及0 bxb轴正 方向按照右手定则确定； 所述工具坐标系OtXtYtZ t与工业机器人制孔刀具末端固连，本步骤中工具坐标系 OtXtYtZt原点处于模拟工作面上，0 tXt轴和0 tYt轴在模拟工作面上，电主轴进给方向为0 tzt 轴正方向，工业机器人法兰坐标系OfXfYfZf的O fXf轴正方向在模拟工作面上的投影为0 tXt轴 正方向，OfYf轴正方向在模拟工作面上的投影为O tYt轴正方向； 步骤4 :移除标定圆盘，并移动工业机器人，使工具坐标系OtXtYtZ t原点处于待制孔 零组件的待制孔位置； 步骤5 :四个激光距离传感器将激光点A'、B'、C'、D'打在待制孔零组件表面，得到 四个激光距离传感器的测量距离值SA'，SB'，SC'，SD' ；根据SA'，SB'，SC'，SD'，步骤1得到的 ^、4、4、4以及步骤2得到的~％，\，81)，计算得到激光点六'、8'、(：'、0'在零面坐 标系O bXbYbZb的坐标值； 步骤6 :由激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值计算得到四个平 面 A'B'C'、A'B'D'、A'C'D'、B'C'D' 的法向量，取四个平面 A'B'C'、A'B'D'、A'C'D'、B'C'D' 法向量的平均值为待制孔零组件表面法向量nl ; 步骤7 :根据法向量nl在零面坐标系ObXbYbZb中的坐标，得到法向量nl与O bZb轴 的夹角Q1，若\在±0.2°范围内，则法向调平结束，否则根据法向量nl在零面坐标系 ObXbYbZb中的坐标，得到将零面坐标系O bXbYbZb旋转至ObZ b轴与法向量nl重合时，0义轴的 旋转角度γ和ObYb轴的旋转角度β ;按照角度γ和角度β移动工业机器人，使工具坐标 系的OtXt轴旋转角度γ，〇 tYt轴旋转角度β，并返回步骤5。 有益效果 本方法没有过分依赖法向传感器的安装姿态和标定方法。对法向传感器的安装位 置姿态要求更容易实现；法向传感器的标定方法和工具简单易行，验证方法简单。该犯法应 用范围广，法向调平方法适合多种零组件表面，在保证精度的同时能适应更广泛的应用场 合。【附图说明】 附图1是机器人末端工具坐标系示意图； 附图2是法向传感器标定及法向调平验证示意图； 附图3是法向调平加工应用示意图； 其中：1.气缸；2.法向激光距离传感器；3.压力鼻；4.机器人末端工具坐标系； 5.模拟工作面；6.丝杠导轨；7.刀柄；8.电主轴；9.待制孔零组件表面法向量；10.待制孔 零组件表面；11.法向激光距离传感器激光束；12.法向激光距离传感器激光点；13.标定 圆盘；14.零面坐标系；15.光点运动轨迹。【具体实施方式】 下面结合具体实施例描述本专利技术： 本实施例属于工业机器人标定
，该方法利用四个激光距离传感器建立零 面坐标系，根据加工过程中四个激光距离传感器在加工表面的实际光点位置，来确定加工 表面和刀具轴线的实际夹角，并将夹角传给工业机器人，通过多次循环调整工业机器人直 到加工表面和刀具轴线的垂直角度符合要求；同时，在法向调平中将工业机器人工具坐标 系的原点标定在和缩回状态的压力鼻平面沿刀具轴线正方向距离为1的平行平面上，该平 面与刀具轴线的交点即为工具坐标系原点，以保证制孔加工时，工具坐标系的坐标系原点 在零组件表面，为待制孔位置，使得待制孔的空间位置坐标不会受到法向调平程序的影响。 下面给出本实施例中方法的具体步骤： 步骤1 :参照附图1和附图2,在工业机器人制孔刀具周围布置四个激光距离传感 器A、B、C、D，四个激光距离传感器用来检测刀具和待制孔零组件的法向角度，所以需要对四 个激光距离传感器进行标定。本专利技术利用标定圆盘，通过以下步骤对四个激光距离传感器 进行标定，所述标定圆盘由盘身和中心杆组成，中心杆与盘身保证垂直度为90±0. 05°。 步骤I. 1 :将工业机器人制孔刀具保持竖直状态，避免重力因素影响标定结果，将 中心杆装夹在工业机器人制孔刀具的刀柄上； 步骤1. 2 :调整四个激光距离传感器，是其将激光点均打在标定圆盘盘面上； 步骤1. 3 :工业机器人制孔刀具电主轴沿轴向运动，带动标定圆盘轴向运动，使四 个本文档来自技高网...
【技术保护点】
一种工业机器人精准制孔的法向调平方法，其特征在于：包括以下步骤：步骤1：在工业机器人制孔刀具周围布置四个激光距离传感器A、B、C、D，并利用标定圆盘，通过以下步骤对四个激光距离传感器进行标定，所述标定圆盘由盘身和中心杆组成，中心杆与盘身保证垂直度为90±0.05°：步骤1.1：将工业机器人制孔刀具保持竖直状态，并将中心杆装夹在工业机器人制孔刀具的刀柄上；步骤1.2：调整四个激光距离传感器，是其将激光点均打在标定圆盘盘面上；步骤1.3：工业机器人制孔刀具电主轴沿轴向运动，带动标定圆盘轴向运动，观察四个激光距离传感器在盘面上的激光点运动轨迹；调整四个激光距离传感器，使四个激光距离传感器在盘面上的激光点运动轨迹相互平行，且任意三个激光距离传感器在盘面上的激光点运动轨迹不共线；步骤1.4：分别测量计算四个激光距离传感器光轴与标定圆盘盘面的夹角步骤2：轴向调整工业机器人制孔刀具电主轴，使标定圆盘盘面与模拟工作面重合；所述模拟工作面指沿电主轴进给方向的，且与工业机器人制孔刀具中处于缩回状态的压力鼻平面距离为l的平面；l为制孔时，待制孔零组件平面和处于缩回状态的压力鼻平面的距离；测量当前状态下四个激光距离传感器的距离读数sA，sB，sC，sD；步骤3：在标定圆盘盘面上建立与工业机器人制孔刀具固连的零面坐标系ObXbYbZb，并得到四个激光距离传感器在盘面上的激光点在零面坐标系ObXbYbZb中的坐标值(xA，yA)，(xB，yB)，(xC，yC)，(xD，yD)；零面坐标系原点选择为任意一个激光距离传感器在盘面上的激光点，并以该激光点的运动轨迹为ObYb轴；ObXb轴处于盘面上，且ObXb垂直于ObYb轴；ObYb轴正方向与工具坐标系OtXtYtZt的OtYt轴正方向夹角为锐角，ObXb轴正方向与工具坐标系OtXtYtZt的OtXt轴正方向夹角为锐角；ObZb轴正方向由ObYb轴正方向以及ObXb轴正方向按照右手定则确定；所述工具坐标系OtXtYtZt与工业机器人制孔刀具末端固连，本步骤中工具坐标系OtXtYtZt原点处于模拟工作面上，OtXt轴和OtYt轴在模拟工作面上，电主轴进给方向为OtZt轴正方向，工业机器人法兰坐标系OFXFYFZF的OFXF轴正方向在模拟工作面上的投影为OtXt轴正方向，OFYF轴正方向在模拟工作面上的投影为OtYt轴正方向；步骤4：移除标定圆盘，并移动工业机器人，使工具坐标系OtXtYtZt原点处于待制孔零组件的待制孔位置；步骤5：四个激光距离传感器将激光点A'、B'、C'、D'打在待制孔零组件表面，得到四个激光距离传感器的测量距离值sA’，sB’，sC’，sD’；根据sA’，sB’，sC’，sD’，步骤1得到的以及步骤2得到的sA，sB，sC，sD，计算得到激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值；步骤6：由激光点A'、B'、C'、D'在零面坐标系ObXbYbZb的坐标值计算得到四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'的法向量，取四个平面A'B'C'、A'B'D'、A'C'D'、B'C'D'法向量的平均值为待制孔零组件表面法向量n1；步骤7：根据法向量n1在零面坐标系ObXbYbZb中的坐标，得到法向量n1与ObZb轴的夹角α1，若α1在±0.2°范围内，则法向调平结束，否则根据法向量n1在零面坐标系ObXbYbZb中的坐标，得到将零面坐标系ObXbYbZb旋转至ObZb轴与法向量n1重合时，ObXb轴的旋转角度γ和ObYb轴的旋转角度β；按照角度γ和角度β移动工业机器人，使工具坐标系的OtXt轴旋转角度γ，OtYt轴旋转角度β，并返回步骤5。...
【技术特征摘要】
【专利技术属性】
技术研发人员：王战玺，李飞飞，王宁，秦现生，谭小群，白晶，王增翠，武俊强，刘健，王玮，郭欣，杨奇，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。