五轴加工奇异区域的检测方法 技术领域 本发明涉及一种数控技术领域中的五轴加工技术, 具体的说是一种五轴加工奇异 区域的检测方法。
背景技术 五轴机床在三个平动轴的基础上增加了两个旋转轴, 使刀具能够以不同的角度对 工件进行加工, 这种加工模式能够获得比三轴加工更高的加工效率和更好的加工质量。但 是由于旋转运动的影响, 当刀具通过奇异点附近区域时, 旋转轴会产生不连续并且急速的 转动, 这不但使加工过程产生很大误差, 而且极易破坏工件, 甚至损伤机床部件。 因此, 准确 的检测出奇异点的位置和奇异区域的范围, 是对奇异区域内的加工进行处理的第一步, 对 提高加工精度和效率至关重要。
奇异区域不只包括奇异点这一个点, 当加工进入奇异区域时, 机床轴的运动就会 发生突变, 导致环状加工轨迹的产生。 但现有的检测方法大多仅针对奇异点的位置, 没有考 虑整个区域的范围。 有的检测方法通过检测平动轴的位置变化量和旋转轴的角度变化量来 判定加工是否接近奇异点, 但是这种方法没有涉及时间概念, 不能完全反映出奇异区域内 机床轴的 “速度突变” 。在实际应用中, 有的系统通过在加工中访问奇异点资料库来检测当 前位置是否为奇异点, 但建库的过程繁琐, 而且该方法的通用性也不高。
发明内容
针对五轴加工过程中存在对奇异区域检测的通用性不高、 准确性差等不足之处, 本发明要解决的技术问题是提供一种能够准确判断奇异点区域范围的五轴加工奇异区域 的检测方法。
为解决上述技术问题, 本发明采用的技术方案是 :
本发明五轴加工奇异区域的检测方法包括以下步骤 :
建立五轴机床的运动学转换关系, 确定相应的雅可比矩阵通式 ;
根据数控加工程序求解相邻加工点的各轴变化量 ;
对雅可比矩阵按列进行归一化处理, 并求解雅可比矩阵的条件数 ;
通过雅可比矩阵的状态判断加工路径是否处于奇异区域。
所述对雅可比矩阵按列进行归一化处理通过以下公式实现 :
其中 max(aj) 和 min(aj) 分别表示初始雅可比矩阵中第 j 列中的最大值和最小值 ; A(i, j) 为初始的雅可比矩阵中第 i 行第 j 列的数据, B(i, j) 为归一化后的雅可比矩阵中 第 i 行第 j 列的数据。
求解雅可比矩阵的条件数通过以下公式实现 :
cond(J(QΔG))2 = ||J(QΔG)||2||J-1(QΔG)||2 (20)
3102371505 A CN 102371506
-1说明书2/7 页其中 ΔG 为相邻加工点的各轴变化量, J(QΔG) 是各轴变化量为 ΔG 时的雅可比矩 2 阵, J (QΔG) 为 J(QΔG) 的逆矩阵, cond(J(QΔG)) 为利用矩阵的 2 范数来求解 J(QΔG) 的条件 数。
所述通过雅可比矩阵的状态判断加工路径是否处于奇异区域为 :
通过条件数大小判断雅可比矩阵处于非病态、 轻度病态、 重病态还是严重病态, 当 为重病态或严重病态时, 确定加工路径处于奇异区域。
本发明具有以下有益效果及优点 :
1. 应用本发明方法采能够检测到整个奇异区域的边界范围。
2. 本发明利用雅可比矩阵可将单个关节的运动与整个机构的运动联系起来的特 性, 考虑到了各轴的速度突变, 从而在检测上更加准确。
3. 本发明不仅可以检测奇异点的位置及其周围区域的范围, 对于不存在奇异点的 路径, 也可以检测出非线性误差较大的加工区间。 附图说明
图 1 为本发明方法应用的 AC 双转台五轴机床结构简图 ; 图 2 为 AC 双转台五轴机床运动链 ; 图 3 为实验一的实际路径和编程直线对照图 ; 图 4 为实验一的仿真加工路径图 ; 图 5 为实验二的实际加工路径图。具体实施方式
下面结合附图对本发明方法作进一步详细说明。
为了准确检测出奇异区域的边界范围, 本实施例以 AC 双转台五轴机床为研究对 象, 将加工过程中各轴运动变化量与五轴机床的雅可比矩阵结合起来, 通过判断雅可比矩 阵的条件数是否过大, 进而得到雅可比矩阵的状态, 从而检测出当前加工位置是否已进入 或离开奇异区域。如图 1 所示, 为本发明方法中所用 AC 双转台五轴机床结构示意图。
本发明方法步骤如下 :
建立 AC 双转台五轴机床的运动学转换关系, 确定相应的雅可比矩阵通式 ;
根据数控加工程序求解相邻加工点的各轴变化量 ;
对雅可比矩阵按列进行归一化处理, 并求解雅可比矩阵的条件数 ;
通过雅可比矩阵的状态判断加工路径是否处于奇异区域。
步骤 1) 建立 AC 双转台五轴机床的运动学转换关系, 确定相应的雅可比矩阵通 式;
本实施例根据图 2 所示的运动链, AC 双转台五轴机床的正向运动学方程为 : T
[ux, uy, uz, 0] = Rot(Z, -C)Rot(X, -A)Trans(-X+Tx, Y+Ty, -Z+Tz)[ 0 0 1 0]T (1)
[px, p y, p z, 1]T = Rot(Z, -C)Rot(X, -A)Trans(-X+Tx, Y+Ty, -Z+Tz)[0 0 0 1]T (2)
其中 (ux, uy, uz) 和 (px, py, pz) 分别为工件坐标系中的刀具方向矢量和刀具位置矢量, (Tx, Ty, Tz) 为 A 轴中心到工件坐标系原点的长度补偿矢量, X, Y, Z, A, C 为各轴运动量。 Rot 和 Trans 分别表示回转和平移运动的齐次坐标变换矩阵。
经过反向运动学变换得到机床运动坐标为 :
A = arccos(uz)(0 ≤ A ≤ π) (3)
C = arctan 2(ux, uy)(-π ≤ C ≤ π) (4)
X = -pxcos(C)+pysin(C)+Tx (5)
Y = pxcos(A)sin(C)+pycos(A)cos(C)-pzsin(A)-Ty (6)
Z = -pxsin(A)sin(C)-pysin(A)cos(C)-pzcos(A)+Tz (7)
雅可比矩阵表示机构部件随时间变化的几何关系, 它可以将单个关节的微分运动 或速度转换为感兴趣的微分运动或速度, 也可将单个关节的运动与整个机构的运动联系起 来。根据雅可比矩阵的定义和机床正向运动学方程可以推导出 AC 双转台五轴机床的雅可 比矩阵 J(Q) 为
步骤 2) 根据数控加工程序求解相邻加工点的各轴变化量 ;
ΔG 的各轴分量为 :
ΔX = X2-X1 (12)
ΔY = Y2-Y1 (13)
ΔZ = Z2-Z1 (14)
ΔA = A2-A1 (15)
ΔC = C2-C1 (16)
其中, X1、 Y1、 Z 1、 A1、 C1 为前一加工点的各轴运动量 ; X2、 Y 2、 Z2、 A2、 C2 为后一加工点 的各轴运动量。
步骤 3) 雅可比矩阵按列进行归一化处理, 并求解雅可比矩阵的条件数
由于构建的雅可比矩阵包含了位置 ( 与机床平动有关 ) 和姿态 ( 与机床转动有 关 ) 两个不同单位的量, 因此需要进行单位归一化处理, 否则不能很好的进行奇异性的判 定。因为雅可比矩阵第 j 列代表了第 j 个关节 ( 轴 ) 速度对刀具末端线速度和角速度的影 响, 也就是说不同的列代表不同的轴, 因此以列进行归一化。
设初始的雅可比矩阵为 :
A = [a1,…, aj,… an] (17)
归一化后的雅可比矩阵为 :
B = [b1,…, bj,… bn] (18)
归一化公式为 :
其中 max(aj) 和 min(aj) 分别表示初始雅可比矩阵中第 j 列中的最大值和最小值 ; A(i, j) 为初始的雅可比矩阵中第 i 行第 j 列的数据, B(i, j) 为归一化后的雅可比矩阵中 第 i 行第 j 列的数据。利用 (19) 式对原矩阵的每一列进行归一化, 使得新矩阵的每一列元 素的值都介于 [0, 1] 之间。
将 ΔG 的各分量带入式 (11), 并归一化得到 J(QΔG)。接着求 J(QΔG) 的逆矩阵。之 后利用矩阵的 2 范数来求解雅可比矩阵 J(QΔG) 的条件数 cond(J(QΔG))。
cond(J(QΔG))2 = ||J(QΔG)||2||J-1(QΔG)||2 (20)。
步骤 4) 通过雅可比矩阵的状态判断加工路径是否处于奇异区域
系统病态具有相对性, 条件数多大时矩阵为病态目前还没有严格精确的定量标 准。一般认为条件数为 1 ~ 10 时是非病态系统 ; 条件数为 10 ~ 50 时是轻度病态系统 ; 条 件数为 50 ~ 100 时是重病态系统 ; 条件数大于 100, 则被认为是严重病态系统。通常轻度 病态系统产生的误差可以容忍, 不会对机床和工件产生破坏, 因此这里以 50 为界限, 条件 数超过 50, 矩阵 “重病态” 或 “严重病态” , 加工路径处于奇异区域。
下面针对 AC 双转台五轴机床, 给出本发明的实验。
实验一 :
表 1 原始刀位点
区间号 条件数表 2 雅可比矩阵条件数1 14.3 2 4.1 3 3.4 4 22.6 5 196.1 6 294.4 7 553.8 8 232.3 9 41.2 10 16.0 11 13.9 12 3.0
根据表 2 可知, 区间 5 到区间 8( 第 5 个刀位点到第 9 个刀位点之间 ) 的雅可比矩阵条件数均大于 50, 矩阵状态属于 “重病态” 或 “严重病态” , 其中区间 7 的条件数最大, 病 态程度最严重。因此判定区间 5 到区间 8 为奇异区域。由图 3 和图 4 可以看到, 这一区域 内的实际加工路径显著偏离编程直线, 并存在环状轨迹。在奇异点附近 ( 第 7 区间 ) 处的 情况尤为严重, 证明判断与实际相吻合。
实验二 :
加工曲面 S(u, v) = (x(u, v), y(u, v), z(u, v)) 的参数为 :
x = 100u-50
y = 100v-50 (0 ≤ u ≤ 1, 0 ≤ v ≤ 1) (21) 2 2
z = 10((u+0.5) +v )-50
表 3 刀位点列表
表 4 雅可比矩阵条件数
从表 3 知, 本实验中不存在奇异点, 但仍然存在过大误差。因为根据表 4 可知, 区 间 2 到区间 7( 刀位文件中第 2 点到第 8 点之间 ) 雅可比矩阵条件数都超过 50, 因此可以推 知这几个区间误差比较大。但是由于这几个区间的条件数都没有超过 100, 没有达到 “严重 病态” , 因此没有像第一个例子那样误差显著。观察图 5 所给出的路径, 结合曲面参数方程 (21) 式, 可以验证上述判断的正确性。