[发明专利]一种五轴加工轨迹轮廓误差双闭环补偿方法

权利要求书

1.一种五轴加工轨迹轮廓误差双闭环补偿方法，其特性在于，该方法基于模型预测和反馈校正，预估下一时刻各物理轴运动位置，通过切向逆推及牛顿法计算下一时刻及当前时刻刀尖点及刀轴方向轮廓误差，根据逆向雅可比矩阵，在内环对轮廓误差进行预测补偿，在外环对轮廓误差进行反馈补偿，从而提高五轴加工轨迹轮廓精度，方法具体步骤如下：

第一步 基于模型预测和反馈校正预估物理轴运动位置

设待插补五轴双样条曲线中的刀尖点运动轨迹曲线方程为C_P＝C_P(u)，刀轴上除刀尖外另一点运动轨迹曲线方程为C_Q＝C_Q(u)，令R_p＝[R_x,R_y,R_z]^T表示理想刀尖点，R_o＝[R_i,R_j,R_k]^T表示理想刀轴矢量，R＝[R_x,R_y,R_z,R_i,R_j,R_k]^T表示理想刀位向量，计算方法为：

令P_p＝[P_x,P_y,P_z]^T表示实际刀尖点，P_o＝[P_i,P_j,P_k]^T表示实际刀轴矢量，P＝[P_x,P_y,P_z,P_i,P_j,P_k]^T表示实际刀位向量，表示的实际刀位向量预估值；r＝[r₁,r₂,r₃,r₄,r₅]^T表示物理轴理想运动位置，p＝[p₁,p₂,p₃,p₄,p₅]^T表示物理轴实际运动位置，表示物理轴实际运动位置预估值，数控进给系统z域传递函数G(z)的一般表达式为：

其中，n为系统阶次，a₁,a₂,…,a_n和b₁,b₂,…,b_n为系统参数；设λ轴，λ＝1,2,3,4,5，第t个采样周期的输入理想运动位置与输出实际运动位置分别为r_λ(t)和p_λ(t)，则第t+1个采样周期的λ轴实际运动位置模型预测值为：

为提高实际运动位置预估模型对参数的抗干扰性能，通过反馈校正的方法修正实际运动位置模型预测值，得到最终第t+1个采样周期的λ轴实际运动位置预估值

据此，第t+1个采样周期的物理轴实际运动位置预估值为

第二步 轮廓误差内环预测补偿

设函数f_tr表示五轴机床正向运动学变换函数，根据第t+1个采样周期的物理轴实际运动位置预估值计算第t+1个采样周期的实际刀位向量预估值

定义刀尖点切向轮廓误差函数通过求解方程d_t(u)＝0找到垂足点参数u_f；设理想刀位向量R处的曲线参数为u_r，通过切向逆推计算逆推点参数u_b：

将参数u_b作为牛顿法初值，利用牛顿法求取方程d_t(u)＝0的解u_N：

令到刀尖点轨迹曲线垂足点为对应的垂足点参数为判断牛顿法是否收敛，若|d_t(u_N)|＜|d_t(u_b)|，说明牛顿法收敛，令垂足点参数否则，在u_b处重新利用切向逆推计算垂足点参数，据此，垂足点参数为计算为：

计算第t+1个采样周期的刀尖点轮廓误差及刀轴方向误差

记第t+1个采样周期的五轴轮廓误差向量为设五轴机床逆向雅可比矩阵为计算物理轴轮廓误差预测补偿量

将各物理轴轮廓误差预测补偿量加入到相应的物理轴理想运动位置r_λ上得到补偿后λ轴运动指令，实现轮廓误差内环预测补偿；

第三步 轮廓误差外环反馈补偿

虽在第二步中在第t个采样周期对下一时刻，即t+1个采样周期的轮廓误差进行了预测补偿，但当实际运行到t+1时刻时，由于建模误差等因素，仍会存在残余轮廓误差，因此，在当前时刻对轮廓误差进行反馈补偿，从而进一步提高轮廓精度；通过物理轴位置反馈得到当前第t个采样周期的物理轴实际运动位置p(t)，根据运动学变换，计算第t个采样周期，即当前时刻的实际刀位向量P：

以参数为初值计算实际刀尖点P_p到理想刀尖点轨迹曲线的垂足点参数u_f：

计算当前时刻的刀尖点轮廓误差ε_p及刀轴方向误差ε_o：

记当前时刻的五轴轮廓误差向量为计算物理轴轮廓误差反馈补偿量Δr：

在内环预测补偿的同时，在外环将各物理轴轮廓误差预测补偿量Δr_λ加入到相应的物理轴理想运动位置指令上得到补偿后λ轴运动指令，实现轮廓误差双闭环补偿。