CN114454060A - 一种机器人自适应曲面跟踪恒力磨抛方法及系统 - Google Patents
一种机器人自适应曲面跟踪恒力磨抛方法及系统 Download PDFInfo
- Publication number
- CN114454060A CN114454060A CN202210166615.6A CN202210166615A CN114454060A CN 114454060 A CN114454060 A CN 114454060A CN 202210166615 A CN202210166615 A CN 202210166615A CN 114454060 A CN114454060 A CN 114454060A
- Authority
- CN
- China
- Prior art keywords
- robot
- polishing
- polished
- grinding
- workpiece
- 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
Links
- 238000005498 polishing Methods 0.000 title claims abstract description 124
- 238000000034 method Methods 0.000 title claims abstract description 56
- 230000036544 posture Effects 0.000 claims abstract description 22
- 238000006073 displacement reaction Methods 0.000 claims description 33
- 230000003044 adaptive effect Effects 0.000 claims description 18
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000008569 process Effects 0.000 claims description 14
- 230000009466 transformation Effects 0.000 claims description 10
- 230000006835 compression Effects 0.000 claims description 9
- 238000007906 compression Methods 0.000 claims description 9
- 238000013507 mapping Methods 0.000 claims description 8
- 230000008859 change Effects 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 3
- 238000012847 principal component analysis method Methods 0.000 claims description 3
- 239000006185 dispersion Substances 0.000 claims description 2
- 238000010030 laminating Methods 0.000 claims description 2
- 230000004044 response Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000007517 polishing process Methods 0.000 description 3
- 230000006872 improvement Effects 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000003746 surface roughness Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B24—GRINDING; POLISHING
- B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
- B24B27/00—Other grinding machines or devices
- B24B27/0084—Other grinding machines or devices the grinding wheel support being angularly adjustable
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B24—GRINDING; POLISHING
- B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
- B24B49/00—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation
- B24B49/006—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation taking regard of the speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B24—GRINDING; POLISHING
- B24B—MACHINES, DEVICES, OR PROCESSES FOR GRINDING OR POLISHING; DRESSING OR CONDITIONING OF ABRADING SURFACES; FEEDING OF GRINDING, POLISHING, OR LAPPING AGENTS
- B24B49/00—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation
- B24B49/16—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation taking regard of the load
- B24B49/165—Measuring or gauging equipment for controlling the feed movement of the grinding tool or work; Arrangements of indicating or measuring equipment, e.g. for indicating the start of the grinding operation taking regard of the load for grinding tyres
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computing Systems (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Algebra (AREA)
- Manipulator (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
Abstract
本发明公开了一种机器人自适应曲面跟踪恒力磨抛方法及系统,该方法包括：调整机器人末端姿态，记录机器人末端姿态和打磨机三轴陀螺仪初始值；确定待打磨工件边界和打磨盘参数；根据待打磨工件边界和打磨盘参数设置每条打磨路径的起始点；设置打磨参数，根据打磨路径的起始点控制机器人运动到指定位置，使打磨盘圆心与待打磨工件刚刚接触；调整打磨头与表面跟随装置姿态并与待打磨工件曲面适配；调整机器人姿态使得柔性接触装置轴线和待打磨工件曲面法线重合；根据设定好的起点和终点坐标，按照上述恒力磨抛方法完成整个待打磨工件表面的自适应恒力打磨；本发明能够适应多品种少批量零部件的加工，极大地提升打磨效率，改善打磨物体表面质量。
Description
技术领域
本发明属于恒力磨抛技术领域，更具体地，涉及一种机器人自适应曲面跟踪恒力磨抛方法及系统。
背景技术
机器人恒力磨抛技术可以提高打磨质量，保证加工一致性，改善工人劳动条件，被广泛应用于各类产品零部件的打磨工序中。但是在复杂曲面零部件的磨抛作业中，由于零件表面曲率变化导致打磨过程中的接触点不在同一个回转半径上，使得各点的接触力不同，导致物体表面去除率不一致，严重影响了工件表面的加工一致性和表面粗糙度，这也阻碍了机器人恒力打磨技术在高精密磨抛技术中的应用。
为了解决上述问题，专利文献CN110315396A公开了一种基于大数据的工业机器人恒力磨抛方法，其根据力传感器采集大量的工业机器人打磨过程中的力位信息作为数据集，来训练BP神经网络拓扑模型，然后使用该模型来计算预设的打磨力与实际运行过程中打磨力之间的差值，最后根据该差值调整工业机器人沿着TCP方向前进或者后退的距离，从而实现打磨过程中的恒力控制。该方法虽然可实现恒力打磨，但是打磨的力的控制精度需要大量的数据集作为支撑，很难适应加工一致性要求较高的产品的打磨，此外，更换不同的打磨工件需要重新制作数据集，相关的准备工作比较耗时。
专利文献CN111055293A公开了一种基于曲面自适应的工业机器人高精度恒力打磨方法，该方法首先根据线结构光传感器采集待打磨物体的点云数据，然后根据扫描数据构建STL模型，并根据模型采用切割平面投影方法生成机器人打磨轨迹，最后采用未知环境刚度下的阻抗控制算法计算实时接触力和期望接触力的差值，来调整打磨头的伸缩量，从而实现恒力打磨。该方法虽然可实现机器人的恒力打磨控制，但是使用的阻抗控制算法对接触环境参数变化比较敏感，对打磨面的一致性要求较高。
发明内容
针对现有技术的以上缺陷或改进需求，本发明提供一种机器人自适应曲面跟踪恒力磨抛方法及系统，通过结合柔性接触装置、表面跟随装置和三轴陀螺仪等设备实现了机器人自适应曲面恒力打磨控制，不仅能够有效提高打磨过程中恒力控制的精度，而且能够简化打磨过程中的编程步骤，能够很好地适应多品种少批量零部件的加工，极大地提升了打磨效率，改善了打磨物体表面质量，提高了打磨一致性；通过引用三轴陀螺仪来计算打磨机的偏摆角度，从而减少人工编程中对接触点坐标法向的求解，降低了对打磨作业人员的专业要求；通过将曲面参数化后映射到二维空间，在二维空间中确定物体的边界，再将边界转换到三维空间中，减少了曲面最小边界的求解运算量，能够提高系统的响应速度；本发明无需离线编程，只需确定每条打磨路径的起始点坐标即可实现整个路径的打磨。
为了实现上述目的，本发明的一个方面提供一种机器人自适应曲面跟踪恒力磨抛方法，包括如下步骤：
S1：通过机器人示教器调整机器人末端法兰姿态，记录机器人末端姿态和打磨机三轴陀螺仪的初始值；
S2：确定待打磨工件的边界和打磨机打磨盘参数；
S3：根据待打磨工件的边界和打磨盘参数设置每条打磨路径的起始点；
S4：设置打磨参数，并根据步骤S3获得的打磨路径的起始点控制机器人运动到指定位置，使打磨盘圆心与待打磨工件刚刚处于接触状态；
S5：调整打磨机的打磨头与表面跟随装置的姿态并与待打磨工件曲面进行适配；
S6：调整机器人姿态使得柔性接触装置轴线和待打磨工件曲面法线重合；
S7：根据步骤S3设定好的起点和终点坐标，按照步骤S5～S6的恒力控制方法完成整个待打磨工件表面的自适应恒力打磨。
进一步地，步骤S1还包括调整机器人末端姿态，使得打磨机的打磨盘垂直向下，使机器人末端法兰、柔性接触装置、表面跟随装置两端法兰、打磨机四者轴向重合且与重力垂线平行。
进一步地，步骤S2还包括提取打磨工件理论模型边界，并对其进行参数化，并将参数化之后的曲面映射得到待打磨工件边界的2D平面图形；
所述待打磨工件边界的获得还包括如下步骤：
S21：定义待打磨工件曲面的两个维度分为为U，V向；
S22：定义待打磨工件曲面中任意一个控制点为Pi(xi,yi,zi)，Pi(xi,yi,zi)为第i个坐标点的坐标值，xi,yi,zi为其在三维坐标系下的各轴坐标值；
S23：所述控制点Pi(xi,yi,zi)对应的参数化之后的关系式为Qi(u(t),v(s))，其中t为该控制点在U方向距离起点的距离，s为该控制点在V方向距离起点的距离；
S24：根据步骤S23中的关系式将参数化之后的曲面映射得到待打磨工件边界的2D平面图形；
S25：根据PCA主成分分析法求取所述待打磨工件边界的2D平面图形的主方向，垂直于该主方向的另一向量为副方向，以此获得映射图形将边界点包括在内的最小有向包围盒，即为待打磨工件边界；
进一步地，步骤S3中打磨路径的起始点和终止点的设置还包括如下步骤：
S31：将将步骤S25中获得的最小有向包围盒的其中一个方向的两条边界线进行等弧长离散；
S32：将点Pj(xj,yj,zj)和点Pk(xk,yk,zk)间距间距满足||Pj-Pk||＝R的两个点转换到UV坐标系，计算其间距Δl，其中，Pj(xj,yj,zj)为第j个坐标点的坐标值，xj,yj,zj为其在三维坐标系下的各轴坐标值；Pk(xk,yk,zk)为第k个坐标点的坐标值，xk,yk,zk为其在三维坐标系下的各轴坐标值，R为打磨盘的端面半径；
S33：根据步骤S33获得的间距Δl等距切割所述包围盒内其中一个方向的两条平行边界线和和L1和L2，得到一系列两两对应的点集Qs{qs1,qs2Kqsn}和Qe{qe1,qe2Kqen}，集合{qs1,qs2Kqsn}和集合{qe1,qe2Kqen}分别为边界L1和L2上的等弧长离散点；
S34：以qmi、qsi分别为起点和终点，在垂直于边界L1的方向上按照约定插值步长Δs进行插值，得到插值点集Qse{qse1,qse1L qsem}，其中{qse1,qse1L qsem}为等参数化平面上的插值点集合，qmi、qsi分别为第i条打磨路径的起始点和终点坐标；
S35：结合打磨对象曲面信息将集合Qse转换到笛卡尔坐标系下得到点集Pse{pse1,pse2L psem}，进而得到打磨起始点和打磨终止点；其中，集合{pse1,pse2L psem}为打磨路径点的集合，pse1为打磨起始点，psem为打磨终止点。
进一步地，步骤S4中的打磨参数包括打磨机的转速、恒定打磨力、柔性接触装置内置位移传感器的目标位移以及机器人的移动速度。
进一步地，步骤S5还包括在打磨盘圆心与待打磨工件的深入接触过程中，柔性接触装置的位移传感器一直处于被压缩状态，直到位移传感器的实时位移满足||di-d0||≤σ后，保持位移传感器的目标压缩量不变，其中di为位移传感器的实时位移，σ为目标距离偏差；以恒定打磨力f以及柔性接触装置内置位移传感器的目标压缩量d0接触待打磨工件后，打磨机在表面跟随装置的自由摆动下自动贴合曲面，使得打磨机轴线与曲面法线重合，表面跟随装置的两个法兰轴线不重合，存在夹角。
进一步地，步骤S6还包括：通过打磨机内置的三轴陀螺仪计算出打磨机绕自身坐标系旋转的角度，得到旋转之后的三轴陀螺仪的坐标系；其中，打磨机绕自身坐标系旋转的角度分别记为(y,p,r)，其中，y表示绕Z轴旋转的角度，p表示绕Y轴旋转的角度，r表示绕X轴旋转的角度；
则打磨机旋转之后的陀螺仪的坐标系为Wtool＝RZ(y)RY(p)RX(r)，
其中，RZ(y)表示打磨机绕Z轴旋转的变换矩阵，RY(p)表示打磨机绕Y轴旋转的变换矩阵，Rx(r)表示打磨机绕X轴旋转的变换矩阵；
则机器人的姿态调整矩阵为：
其中，
为机器人末端法兰与柔性接触装置之间的变化矩阵，其通过机器人末端工具标定方法进行确定；
机器人控制器根据所述机器人的姿态调整矩阵计算出各关节轴的运动角度调整机器人的姿态，使得机器人末端法兰回转轴线与打磨机的轴线保持一致，从而实现精确的恒力控制。
本发明的另一个方面提供一种机器人自适应曲面跟踪恒力磨抛系统，包括机器人、柔性接触装置、表面跟随装置以及打磨机；
所述柔性接触装置能够实现恒力，其一端与所述机器人1末端法兰固定连接，另一端与所述表面跟随装置的一端法兰连接；
所述柔性接触装置的运动轴线和所述机器人末端法兰轴线共线；
所述表面跟随装置能够实现表面贴合，能够在所述柔性接触装置的轴线方向运动；
所述表面跟随装置远离所述柔性接触装置的法兰能够实现两个方向的自由摆动,但不能沿周向转动；
所述打磨机与所述表面跟随装置远离所述柔性接触装置的一端的法兰固定连接,可随所述表面跟随装置的法兰摆动而摆动；
进一步地，所述柔性接触装置内置位移传感器,用于判断是否与工件接触及接触后的压缩量；
所述打磨机内部安装有三轴陀螺仪，所述三轴陀螺仪用于测量所述打磨机绕自身坐标系摆动的角度；
在恒力打磨的过程中，所述机器人末端法兰的轴线、所述柔性接触装置的轴线和所述打磨机的轴线保持一致。
进一步地，所述机器人为六自由度工业机器人，所述机器人上设有机器人控制器。
总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：
(1)本发明的一种机器人自适应曲面跟踪恒力磨抛方法及系统，通过结合柔性接触装置、表面跟随装置和打磨机三轴陀螺仪等设备实现了机器人自适应曲面恒力打磨控制，不仅有效地提高了打磨过程中恒力控制的精度，而且简化了打磨过程中的编程步骤，能够很好地适应多品种少批量零部件的加工，极大地提升了打磨效率，改善了打磨物体表面质量，提高了打磨一致性。
(2)本发明的一种机器人自适应曲面跟踪恒力磨抛方法及系统，引用表面跟随装置，通过在接触的过程中自动定心，能快速的找到接触点的法线，在保证恒力输出的同时，还能保证机器人末端法兰轴线和打磨机轴线共线，从而提供恒力打磨的精度。
(3)本发明的一种机器人自适应曲面跟踪恒力磨抛方法及系统，通过在打磨机内设三轴陀螺仪来计算打磨机的偏摆角度，从而减少人工编程中对接触点坐标法向的求解，降低了对打磨作业人员的专业要求，此外，可以很好地适应未知理论模型或者理论模型与实物偏差较大对象的打磨。
(4)本发明的一种机器人自适应曲面跟踪恒力磨抛方法及系统，通过将待打磨工件的曲面参数化后映射到二维空间，在二维空间中确定物体的边界，再将边界转换到三维空间中，减少了曲面最小边界的求解运算量，提高了系统的响应速度；本发明无需离线编程，只需确定每条打磨路径的起始点坐标即可实现整个路径的打磨。
附图说明
图1为本发明实施例一种机器人自适应曲面跟踪恒力磨抛控制系统的结构示意图；
图2为本发明实施例一种机器人自适应曲面跟踪恒力磨抛控制方法的流程示意图。
图3为本发明实施例一种机器人自适应曲面跟踪恒力磨抛控制方法的待打磨工件边界的获得流程图；
图4为本发明实施例一种机器人自适应曲面跟踪恒力磨抛控制方法的打磨路径的起始点和终止点的获得流程图。
在所有附图中，同样的附图标记表示相同的技术特征，具体为：1-机器人、2-柔性接触装置、3-表面跟随装置、4-打磨机、5-待打磨工件。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，当元件被称为“固定于”、“设置于”或“设于”另一个元件，它可以直接在另一个元件上或者间接在该另一个元件上。当一个元件被称为是“连接于”另一个元件，它可以是直接连接到另一个元件或间接连接至该另一个元件上；术语“安装”、“相连”、“连接”、“设有”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言，可以根据具体情况理解上述术语在本发明中的具体含义。
如图1所示，本发明提供一种机器人自适应曲面跟踪恒力磨抛系统，用于对待打磨工件5恒力打磨，包括机器人1、柔性接触装置2、表面跟随装置3以及打磨机4；其中，所述机器人为六自由度工业机器人，为整个打磨运动的载体；所述机器人1上设有机器人控制器，用于调整机器人末端姿态；所述柔性接触装置2为能实现恒力的产品，如CN202021025759.2(一种气动自适应恒力系统)等产品均可,所述柔性接触装置2的一端与所述机器人1末端法兰固定连接,所述柔性接触装置2内置位移传感器,能够判断是否与工件接触及接触后的压缩量，所述柔性接触装置2的运动轴线和所述机器人1末端法兰轴线共线；所述表面跟随装置3为可以实现表面贴合的装置，如202120549597.0(一种多头表面跟随恒力磨抛装置)中所述的表面跟随装置等产品均可；所述表面跟随装置3的一端法兰与所述柔性接触装置2远离所述机器人1的一端固定连接,能够在所述柔性接触装置2的轴线方向运动,所述表面跟随装置3的另一端法兰能够实现两个方向的自由摆动,但不能沿周向转动；所述打磨机4与所述表面跟随装置3远离所述柔性接触装置2的一端的法兰固定连接,可随所述表面跟随装置3的法兰摆动而摆动；在所述打磨机4内部安装有三轴陀螺仪，所述三轴陀螺仪能够测量所述打磨机4绕自身坐标系摆动的角度；本发明在恒力打磨的过程中所述机器人1末端法兰的轴线、所述柔性接触装置2的轴线和所述打磨机4的轴线保持一致。
如图2-图4所示，本发明的另一个方面提供一种机器人自适应曲面跟踪恒力磨抛方法，其包括如下步骤：
S1：通过机器人示教器调整机器人末端法兰姿态，记录机器人末端姿态和打磨机三轴陀螺仪的初始值；具体地，调整机器人末端姿态，使得打磨机的打磨盘垂直向下，此时六轴机器人末端法兰、柔性接触装置、表面跟随装置两端法兰、打磨机四者轴向重合且与重力垂线平行，记录六轴机器人末端姿态与打磨机内三轴陀螺仪的初始值。
S2：确定待打磨工件的边界和打磨机打磨盘参数；具体地，提取打磨工件理论模型边界，并对其进行参数化；由于曲面具有长度和宽度两个维度，其中两个维度互相垂直，将两个维度分别定义为U,V向，对于待打磨工件曲面中任意一个控制点Pi(xi,yi,zi)，其对应的参数化之后的表达为Qi(u(t),v(s))，其中，Pi(xi,yi,zi)为第i个坐标点的坐标值，xi,yi,zi为其在三维坐标系下的各轴坐标值，t为该控制点在U方向距离起点的距离，s为该控制点在V方向距离起点的距离；根据上述转换公式将参数化之后的曲面映射得到2D平面图形；根据PCA主成分分析法求取所述2D平面图形的主方向，垂直于该主方向的另一向量为副方向，以此求取映射图形将边界点包括在内的最小有向包围盒，即为待打磨工件的边界；打磨机打磨盘参数通常根据选用的打磨砂纸确定，在设计打磨机时，为适配市场上已有的打磨片的尺寸，一般以打磨片的尺寸作为打磨盘的参数；
S3：根据待打磨工件的边界和打磨盘参数设置每条打磨路径的起始点和终止点；具体地，将步骤S2获得的最小有向包围盒其中一个方向的两条边界线进行等弧长离散；将点Pj(xj,yj,zj)和点Pk(xk,yk,zk)间距满足||Pi-Pj||＝R的两个点转换到UV坐标系，然后计算其在UV坐标系下的间距Δl；其中Pj(xj,yj,zj)为第i个坐标点的坐标值，xj,yj,zj为其在三维坐标系下的各轴坐标值；Pk(xk,yk,zk)为第j个坐标点的坐标值，xk,yk,zk为其在三维坐标系下的各轴坐标值，R为打磨盘的端面半径；以所述间距Δl来等距切割包围盒其中一个方向的两条平行边界L1和L2，得到一系列两两对应的点集Qm{qm1,qm2Kqmn}和Qs{qs1,qs2Kqsn}，集合{qs1,qs2Kqsn}和集合{qe1,qe2Kqen}分别为边界L1和L2上的等弧长离散点；以qmi、qsi分别为起点和终点，在垂直于边界L1的方向上按照约定插值步长Δs进行插值，得到插值点集Qse{qse1,qse1L qsem}，其中{qse1,qse1L qsem}为等参数化平面上的插值点集合，qmi、qsi分别为第i条打磨路径的起始点和终点坐标；然后再结合打磨对象曲面信息将集合Qse转换到笛卡尔坐标系下得到点集Pse{pse1,pse2L psem}；集合{pse1,pse2L psem}为打磨路径点的集合，其中pse1为打磨起始点，psem为打磨终止点。该操作可保证打磨过程中相邻两条打磨路径的间距一致，使得待打磨物体表面去除率保持一致；通过将曲面参数化后映射到二维空间，在二维空间中确定物体的边界，再将边界转换到三维空间中，减少了曲面最小边界的求解运算量，能够提高系统的响应速度；
S4：设置打磨参数，并根据步骤S3获得的打磨路径的起始点控制机器人运动到指定位置，使打磨盘圆心与待打磨工件刚刚处于接触状态；具体地，所述打磨参数包括打磨机的转速、恒定打磨力、柔性接触装置内置位移传感器的目标位移以及机器人的移动速度；在打磨开始之前，需要根据工艺参数设置打磨机的转速v，恒定打磨力f、柔性接触装置内置位移传感器的目标位移d0和机器人的移动速度；按照步骤S3设定好的起始点控制机器人运动到指定位置，此时打磨盘圆心与被打磨物体刚刚处于接触状态；
S5：打磨头与表面跟随装置调整姿态对曲面进行适配；具体地，在接触的过程中，柔性接触装置的位移传感器一直处于被压缩状态，直到位移传感器的实时位移满足||di-d0||≤σ后，保持目标压缩量不变；其中di为位移传感器的实时位移，σ为目标距离偏差。当以恒定打磨力f以及柔性接触装置内置位移传感器的目标压缩量d0接触待打磨工件后，打磨机在表面跟随装置的自由摆动下自动贴合曲面，使得打磨机轴线与曲面法线重合，此时表面跟随装置的两个法兰轴线不重合，存在夹角；
S6：调整机器人姿态使得柔性接触装置轴线和曲面法线重合；具体地，在上述打磨机与待打磨工件接触调整的过程中，偏心电动机内置的三轴陀螺仪可计算出绕着自身坐标系旋转的角度，分别记为(y,p,r)，其中，y表示绕轴Z旋转的角度，p表示绕Y轴旋转的角度，r表示绕X轴旋转的角度；旋转之后的三轴陀螺仪的坐标系为Wtool＝RZ(y)RY(p)RX(r)；其中RZ(y)表示绕Z轴旋转的变换矩阵，RY(p)表示绕Y轴旋转的变换矩阵，Rx(r)表示绕X轴旋转的变换矩阵；由于柔性接触装置与机器人末端固连，假设末端法兰与柔性接触装置之间的变化矩阵为
该矩阵可通过机器人末端工具标定方法进行确定；那么机器人的姿态调整矩阵可表示
机器人控制器根据此变换矩阵调正机器人末端位姿使得末端法兰回转轴线与打磨机的轴线保持一致，从而实现精确的恒力控制。
S7：按照指定起点和终点即可完成整个线路的打磨；根据步骤S4设定好的起点和终点坐标，按照步骤S5～S6所述的恒力控制方法即可实现整个物体表面的自适应恒力打磨。
本发提供的一种机器人自适应曲面跟踪恒力磨抛系统及方法的工作原理：通过结合柔性接触装置、表面跟随装置和三轴陀螺仪等设备实现了机器人自适应曲面恒力打磨控制，不仅有效地提高了打磨过程中恒力控制的精度，而且简化了打磨过程中的编程步骤，能够很好地适应多品种少批量零部件的加工，极大地提升了打磨效率，改善了打磨物体表面质量。本发明的方法，引用表面跟随装置，通过在接触的过程中自动定心，能快速的找到接触点的法线，在保证恒力输出的同时，还能保证机器人末端法兰轴线和打磨机轴线共线，从而提供恒力打磨的精度；通过引用三轴陀螺仪来计算打磨机的偏摆角度，从而减少人工编程中对接触点坐标法向的求解，降低了对打磨作业人员的专业要求，此外，可以很好地适应未知理论模型或者理论模型与实物偏差较大对象的打磨；通过将曲面参数化后映射到二维空间，在二维空间中确定物体的边界，再将边界转换到三维空间中，减少了曲面最小边界的求解运算量，提高了系统的响应速度；本发明无需离线编程，只需确定每条打磨路径的起始点坐标即可实现整个路径的打磨。
本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用于限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。
Claims (10)
1.一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于：包括如下步骤：
S1：通过机器人示教器调整机器人末端法兰姿态，记录机器人末端姿态和打磨机三轴陀螺仪的初始值；
S2：确定待打磨工件的边界和打磨机打磨盘参数；
S3：根据待打磨工件的边界和打磨盘参数设置每条打磨路径的起始点和终止点；
S4：设置打磨参数，并根据步骤S3获得的打磨路径的起始点和终止点控制机器人运动到指定位置，使打磨盘圆心与待打磨工件刚刚处于接触状态；
S5：调整打磨机的打磨头与表面跟随装置的姿态并与待打磨工件曲面进行适配；
S6：调整机器人姿态使得柔性接触装置轴线和待打磨工件曲面法线重合；
S7：根据步骤S3设定好的起点和终点坐标，按照步骤S5～S6的恒力控制方法完成整个待打磨工件表面的自适应恒力打磨。
2.根据权利要求1所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于：步骤S1还包括调整机器人末端姿态，使得打磨机的打磨盘垂直向下，使机器人末端法兰、柔性接触装置、表面跟随装置两端法兰、打磨机四者轴向重合且与重力垂线平行。
3.根据权利要求2所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于：步骤S2还包括提取打磨工件理论模型边界，并对其进行参数化，并将参数化之后的曲面映射得到待打磨工件边界的2D平面图形；
所述待打磨工件边界的获得还包括如下步骤：
S21：定义待打磨工件曲面的两个维度分为U，V向；
S22：定义待打磨工件曲面中任意一个控制点为Pi(xi,yi,zi)，Pi(xi,yi,zi)为第i个坐标点的坐标值，xi,yi,zi为其在三维坐标系下的各轴坐标值；
S23：所述控制点Pi(xi,yi,zi)对应的参数化之后的关系式为Qi(u(t),v(s))，其中t为该控制点在U方向距离起点的距离，s为该控制点在V方向距离起点的距离；
S24：根据步骤S23中的关系式将参数化之后的曲面映射得到待打磨工件边界的2D平面图形；
S25：根据PCA主成分分析法求取所述待打磨工件边界的2D平面图形的主方向，垂直于该主方向的另一向量为副方向，以此获得映射图形将边界点包括在内的最小有向包围盒，即为待打磨工件边界。
4.根据权利要求3所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于，步骤S3中打磨路径的起始点和终止点的设置还包括如下步骤：
S31：将步骤S25中获得的最小有向包围盒的其中一个方向的两条边界线进行等弧长离散；
S32：将点Pj(xj,yj,zj)和点Pk(xk,yk,zk)间距间距满足||Pj-Pk||＝R的两个点转换到UV坐标系，计算其间距Δl，其中，Pj(xj,yj,zj)为第j个坐标点的坐标值，xj,yj,zj为其在三维坐标系下的各轴坐标值；Pk(xk,yk,zk)为第k个坐标点的坐标值，xk,yk,zk为其在三维坐标系下的各轴坐标值，R为打磨盘的端面半径；
S33：根据步骤S33获得的间距Δl等距切割所述包围盒内其中一个方向的两条平行边界线L1和L2，得到一系列两两对应的点集Qs{qs1,qs2Kqsn}和Qe{qe1,qe2Kqen}，集合{qs1,qs2Kqsn}和集合{qe1,qe2Kqen}分别为边界L1和L2上的等弧长离散点；
S34：以qsi、qei分别为起点和终点，在垂直于边界L1的方向上按照约定插值步长Δs进行插值，得到插值点集Qse{qse1,qse1L qsem}，其中{qse1,qse1L qsem}为等参数化平面上的插值点集合；qmi、qsi分别为第i条打磨路径的起始点和终点坐标；
S35：结合打磨对象曲面信息将集合Qse转换到笛卡尔坐标系下得到点集Pse{pse1,pse2Lpsem}，进而得到打磨路径的起始点和终止点；其中，集合{pse1,pse2L psem}为打磨路径点的集合，pse1为打磨起始点，psem为打磨终止点。
5.根据权利要求1-4中任一项所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于：步骤S4中的打磨参数包括打磨机的转速、恒定打磨力、柔性接触装置内置位移传感器的目标位移以及机器人的移动速度。
6.根据权利要求1-4中任一项所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于：步骤S5还包括在打磨盘圆心与待打磨工件的深入接触过程中，柔性接触装置的位移传感器一直处于被压缩状态，直到位移传感器的实时位移满足||di-d0||≤σ后，保持位移传感器的目标压缩量不变，其中di为位移传感器的实时位移，σ为目标距离偏差；以恒定打磨力f以及柔性接触装置内置位移传感器的目标压缩量d0接触待打磨工件后，打磨机在表面跟随装置的自由摆动下自动贴合曲面，使得打磨机轴线与曲面法线重合，表面跟随装置的两个法兰轴线不重合，存在夹角。
7.根据权利要求1-4中任一项所述的一种机器人自适应曲面跟踪恒力磨抛方法，其特征在于，步骤S6还包括：通过打磨机内置的三轴陀螺仪计算出打磨机绕自身坐标系旋转的角度，得到旋转之后的三轴陀螺仪的坐标系；其中，打磨机绕自身坐标系旋转的角度分别记为(y,p,r)，其中，y表示绕Z轴旋转的角度，p表示绕Y轴旋转的角度，r表示绕X轴旋转的角度；
则打磨机旋转之后的陀螺仪的坐标系为Wtool＝RZ(y)RY(p)RX(r)，
其中，RZ(y)表示打磨机绕Z轴旋转的变换矩阵，RY(p)表示打磨机绕Y轴旋转的变换矩阵，Rx(r)表示打磨机绕X轴旋转的变换矩阵；
则机器人的姿态调整矩阵为
其中，
为机器人末端法兰与柔性接触装置之间的变化矩阵，其通过机器人末端工具标定方法进行确定；
机器人控制器根据所述机器人的姿态调整矩阵计算出各关节轴的运动角度调整机器人的姿态，使得机器人末端法兰回转轴线与打磨机的轴线保持一致，从而实现精确的恒力控制。
8.一种机器人自适应曲面跟踪恒力磨抛系统，用于实现如权利要求1-7中任一项所述的磨抛方法，其特征在于：包括机器人(1)、柔性接触装置(2)、表面跟随装置(3)以及打磨机(4)；
所述柔性接触装置(2)能够实现恒力，其一端与所述机器人1末端法兰固定连接，另一端与所述表面跟随装置(3)的一端法兰连接；
所述柔性接触装置(2)的运动轴线和所述机器人(1)末端法兰轴线共线；
所述表面跟随装置(3)能够实现表面贴合，能够在所述柔性接触装置(2)的轴线方向运动；
所述表面跟随装置(3)远离所述柔性接触装置(2)的法兰能够实现两个方向的自由摆动,但不能沿周向转动；
所述打磨机(4)与所述表面跟随装置(3)远离所述柔性接触装置(2)的一端的法兰固定连接,可随所述表面跟随装置(3)的法兰摆动而摆动。
9.根据权利要求8所述的一种机器人自适应曲面跟踪恒力磨抛系统，其特征在于：所述柔性接触装置(2)内置位移传感器,用于判断是否与工件接触及接触后的压缩量；
所述打磨机(4)内部安装有三轴陀螺仪，所述三轴陀螺仪用于测量所述打磨机(4)绕自身坐标系摆动的角度；
在恒力打磨的过程中，所述机器人(1)末端法兰的轴线、所述柔性接触装置(2)的轴线和所述打磨机(4)的轴线保持一致。
10.根据权利要求9所述的一种机器人自适应曲面跟踪恒力磨抛系统，其特征在于：所述机器人(1)为六自由度工业机器人，所述机器人(1)上设有机器人控制器。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210166615.6A CN114454060B (zh) | 2022-02-23 | 2022-02-23 | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210166615.6A CN114454060B (zh) | 2022-02-23 | 2022-02-23 | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114454060A true CN114454060A (zh) | 2022-05-10 |
| CN114454060B CN114454060B (zh) | 2023-06-09 |
Family
ID=81416276
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210166615.6A Active CN114454060B (zh) | 2022-02-23 | 2022-02-23 | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114454060B (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115213901A (zh) * | 2022-07-05 | 2022-10-21 | 华中科技大学 | 机器人磨抛力-位-速度协同工艺规划方法、系统及终端 |
| CN115383581A (zh) * | 2022-08-15 | 2022-11-25 | 龙口金鸣乐器有限公司 | 一种萨克斯喇叭口的外表面打磨设备 |
| CN117017496A (zh) * | 2023-09-28 | 2023-11-10 | 真健康（北京）医疗科技有限公司 | 柔性体表定位装置及穿刺手术导航定位系统 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105643399A (zh) * | 2015-12-29 | 2016-06-08 | 沈阳理工大学 | 基于柔顺控制的机器人复杂曲面自动研抛系统及加工方法 |
| CN108581745A (zh) * | 2018-04-20 | 2018-09-28 | 华中科技大学 | 一种三自由度曲面自适应智能力控柔性磨抛末端执行装置 |
| CN110103115A (zh) * | 2019-05-23 | 2019-08-09 | 华中科技大学 | 一种曲面顺应的三自由度远心定点柔性力控磨抛执行器 |
| CN110281108A (zh) * | 2019-06-18 | 2019-09-27 | 蓝点触控(北京)科技有限公司 | 一种基于六维力传感器的机器人柔性智能打磨系统 |
| CN111055293A (zh) * | 2019-11-21 | 2020-04-24 | 东南大学 | 一种基于曲面自适应的工业机器人高精度恒力打磨方法 |
| US20210078177A1 (en) * | 2019-09-16 | 2021-03-18 | The Boeing Company | Robotic end effector system with surface tracking and methods for use |
| US20210187745A1 (en) * | 2019-12-18 | 2021-06-24 | Industrial Technology Research Institute | Automated calibration system and method for a workpiece coordinate frame of a robot |
| CN113084700A (zh) * | 2021-03-25 | 2021-07-09 | 上海智能制造功能平台有限公司 | 机器臂的打磨装置及机器臂 |
-
2022
- 2022-02-23 CN CN202210166615.6A patent/CN114454060B/zh active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105643399A (zh) * | 2015-12-29 | 2016-06-08 | 沈阳理工大学 | 基于柔顺控制的机器人复杂曲面自动研抛系统及加工方法 |
| CN108581745A (zh) * | 2018-04-20 | 2018-09-28 | 华中科技大学 | 一种三自由度曲面自适应智能力控柔性磨抛末端执行装置 |
| CN110103115A (zh) * | 2019-05-23 | 2019-08-09 | 华中科技大学 | 一种曲面顺应的三自由度远心定点柔性力控磨抛执行器 |
| CN110281108A (zh) * | 2019-06-18 | 2019-09-27 | 蓝点触控(北京)科技有限公司 | 一种基于六维力传感器的机器人柔性智能打磨系统 |
| US20210078177A1 (en) * | 2019-09-16 | 2021-03-18 | The Boeing Company | Robotic end effector system with surface tracking and methods for use |
| CN111055293A (zh) * | 2019-11-21 | 2020-04-24 | 东南大学 | 一种基于曲面自适应的工业机器人高精度恒力打磨方法 |
| US20210187745A1 (en) * | 2019-12-18 | 2021-06-24 | Industrial Technology Research Institute | Automated calibration system and method for a workpiece coordinate frame of a robot |
| CN113084700A (zh) * | 2021-03-25 | 2021-07-09 | 上海智能制造功能平台有限公司 | 机器臂的打磨装置及机器臂 |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115213901A (zh) * | 2022-07-05 | 2022-10-21 | 华中科技大学 | 机器人磨抛力-位-速度协同工艺规划方法、系统及终端 |
| CN115213901B (zh) * | 2022-07-05 | 2024-06-04 | 华中科技大学 | 机器人磨抛力-位-速度协同工艺规划方法、系统及终端 |
| CN115383581A (zh) * | 2022-08-15 | 2022-11-25 | 龙口金鸣乐器有限公司 | 一种萨克斯喇叭口的外表面打磨设备 |
| CN117017496A (zh) * | 2023-09-28 | 2023-11-10 | 真健康（北京）医疗科技有限公司 | 柔性体表定位装置及穿刺手术导航定位系统 |
| CN117017496B (zh) * | 2023-09-28 | 2023-12-26 | 真健康（北京）医疗科技有限公司 | 柔性体表定位装置及穿刺手术导航定位系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114454060B (zh) | 2023-06-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109434843B (zh) | 一种基于拖动示教的机器人力控打磨叶片的设备及方法 | |
| CN109623656B (zh) | 基于厚度在线检测的移动式双机器人协同打磨装置及方法 | |
| CN114454060B (zh) | 一种机器人自适应曲面跟踪恒力磨抛方法及系统 | |
| Ke et al. | Review on robot-assisted polishing: Status and future trends | |
| CN105643399B (zh) | 基于柔顺控制的机器人复杂曲面自动研抛系统及加工方法 | |
| CN104858748B (zh) | 一种叶片进排气边磨削机器人自动化装备 | |
| Chen et al. | Robotic grinding of a blisk with two degrees of freedom contact force control | |
| JP3670700B2 (ja) | ロボット機構制御方法 | |
| CN105500147A (zh) | 基于力控制的龙门吊装机器人打磨加工方法 | |
| CN110794762B (zh) | 用于打磨机器人的控制方法及系统 | |
| CN110524371B (zh) | 基于实时力控的复杂曲面恒定切除率的机器人打磨方法 | |
| CN110561237A (zh) | 一种结合主被动力控制的机器人砂带磨削方法及系统 | |
| CN110394802B (zh) | 一种打磨机器人及位置补偿方法 | |
| CN109848989B (zh) | 一种基于红宝石探针的机器人执行末端自动标定及检测方法 | |
| CN110576375B (zh) | 一种机器人自动涂层打磨系统及方法 | |
| CN111823100A (zh) | 一种基于机器人的小曲率抛光打磨方法 | |
| CN113156819A (zh) | 协调打磨机械臂系统自适应神经网络同步阻抗控制方法 | |
| CN114800542B (zh) | 螺旋锥齿轮全角度柔性打磨机器装置、打磨方法及系统 | |
| Li et al. | Robotic polishing of unknown-model workpieces with constant normal contact force control | |
| Huang et al. | Study on the impact of positioning errors on the process performance of robotic bonnet polishing | |
| CN114274047A (zh) | 一种基于力感知测量的高效精密研抛轨迹优化方法 | |
| Wen et al. | Robotic surface finishing of curved surfaces: Real-Time identification of surface profile and control | |
| Park et al. | Gantry type lapping manipulator toward unmanned lapping process for a large work surface | |
| CN114131605B (zh) | 一种船体零件打磨轨迹自动配准调整装置及方法 | |
| CN111070045A (zh) | 一种叶片磨抛加工防碰撞与力过冲检测系统及方法 |
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 | ||
| CB02 | Change of applicant information |
Address after: 214174 c602-c605, No. 2, Qingyan Road, economic development zone, Huishan District, Wuxi City, Jiangsu Province Applicant after: Wuxi CRRC times Intelligent Equipment Research Institute Co.,Ltd. Address before: 214174 c602-c605, No. 2, Qingyan Road, economic development zone, Huishan District, Wuxi City, Jiangsu Province Applicant before: WUXI CRRC TIMES INTELLIGENT EQUIPMENT CO.,LTD. |
|
| CB02 | Change of applicant information | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |