CN107491035A - 一种五轴双样条曲线插补轨迹生成方法 - Google Patents
一种五轴双样条曲线插补轨迹生成方法 Download PDFInfo
- Publication number
- CN107491035A CN107491035A CN201710810296.7A CN201710810296A CN107491035A CN 107491035 A CN107491035 A CN 107491035A CN 201710810296 A CN201710810296 A CN 201710810296A CN 107491035 A CN107491035 A CN 107491035A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msubsup
- mfrac
- mtr
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35408—Calculate new position data from actual data to compensate for contour error
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
本发明一种五轴双样条曲线插补轨迹生成方法属于多轴数控加工技术领域，涉及一种基于雅可比矩阵及亚当斯数值算法的五轴双样条曲线插补过程中物理轴运动轨迹直接生成方法。该方法利用二阶泰勒级数展开法计算插补点处曲线参数，根据五轴刀轨双样条曲线方程求取包含刀尖点、刀轴矢量的刀位向量，进而计算刀位向量增量，利用基于雅可比矩阵的亚当斯预估‑校正法直接确定各物理轴理想运动位置。该方法可实现在除初始位置外不进行逆向运动学变换，且无需对多解进行判断选择的情况下，根据双样条曲线方程直接快速生成连续物理轴运动轨迹，算法简单，且通用性好。
Description
技术领域
本发明属于精密高效智能化多轴数控加工技术领域，涉及一种用于五轴数控机床物理轴运动轨迹实时计算的五轴双样条曲线插补轨迹生成方法。
背景技术
曲线插补技术相比于传统直线、圆弧插补技术具有加工轨迹与理想模型逼近精度高、加工过程运动平稳、加工代码易于存储与传输等优势。在曲线插补加工过程中，加工代码仅提供曲线信息，而非机床各轴运动坐标，因此，为实现曲线插补加工，数控系统需根据曲线方程，对机床轴运动位置进行在线实时计算。对于三轴数控机床，当求得曲线上插补点坐标后，其坐标分量即为机床三个物理轴的运动位置；然而，对于五轴数控机床，虽刀尖点及刀轴矢量可通过双样条曲线刀轨确定，但因五个物理轴运动和刀尖点运动间具有极强的非线性对应关系，导致五轴数控机床物理轴轨迹实时计算困难。鉴于此，研究五轴双样条曲线插补轨迹生成算法对促进五轴数控机床发展具有重要意义。
现有技术文献1“NC post-processor for 5-axis milling machine of table-rotating/tilting type”，Jung等，Journal of Materials Processing Technology，2002，130-131：641-646，该文献为生成连续的五轴机床物理轴运动轨迹，给出了基于逆向运动学变换的后处理方法，但属于离线方法，无法用于实时插补。文献2“Modeling andimprovement of dynamic contour errors for five-axis machine tools undersynchronous measuring paths”，Lin等，International Journal of Machine Tools andManufacture，2013，72：58-72，该文献通过在每一插补点处进行逆向运动学变换，并通过对运动连续性进行判断，迭代选择最优物理轴运动位置解析解，然而由于基于逆向运动学变换获得的物理轴位置具有多解性，故需要根据机床实际结构进行复杂判断，以对多解进行迭代选择，算法复杂，且通用性差。
发明内容
本发明旨在克服现有技术缺陷，发明一种五轴双样条曲线插补轨迹生成方法，该方法利用二阶泰勒级数展开法计算插补点处刀尖点及刀轴矢量，利用雅可比矩阵的广义逆矩阵，根据刀轨运动增量，基于亚当斯法计算物理轴运动位置增量，从而直接确定各物理轴理想运动位置。本发明算法可在不进行复杂迭代判断的情况下直接根据刀尖点及刀轴矢量计算物理轴运动轨迹。
本发明的技术方案是一种五轴双样条曲线插补轨迹生成方法，其特性在于，该方法利用二阶泰勒级数展开法计算插补点处曲线参数，根据五轴刀轨双样条曲线方程求取包含刀尖点、刀轴矢量的刀位向量，进而计算刀位向量增量，利用基于雅可比矩阵的亚当斯预估-校正法直接确定各物理轴理想运动位置。方法具体步骤如下：
第一步利用逆向运动学变换计算初始物理轴位置
设待插补双样条曲线中的刀尖点运动轨迹曲线方程为CP＝CP(u)，u∈[us,ue]，刀轴上除刀尖外另一点运动轨迹曲线方程为CQ＝CQ(u)，u∈[us,ue]，令Rp＝[Rx,Ry,Rz]T表示刀尖点，Ro＝[Ri,Rj,Rk]T表示刀轴矢量，R＝[Rx,Ry,Rz,Ri,Rj,Rk]T表示刀位向量，计算方法为：
将初始点参数us代入公式(1)计算初始刀位向量R1；令q表示物理轴运动位置向量，且q为五行一列的向量，其中五个元素对应于机床的五个物理轴，根据刀位向量R1，利用五轴机床逆向运动学变换，计算初始物理轴运动位置向量q1；
第二步计算刀位向量增量
设当前插补点序号为t，当前插补点处曲线参数为ut，根据二阶泰勒级数展开，计算第t+1个插补点处的曲线参数ut+1：
其中，vt为第t个插补点处进给速度，T为插补周期；将ut+1代入公式(1)计算第t+1个刀位向量Rt+1，进而计算刀位向量增量ΔRt：
ΔRt＝Rt+1-Rt (3)
第三步利用基于雅可比矩阵的亚当斯法计算物理轴位置
根据正向运动学变换，计算雅可比矩阵J6×5：
进而根据方程组(5)求解雅可比矩阵的广义逆矩阵即
利用四阶显示亚当斯法计算物理轴位置向量预估值qtemp，t+1：
进而利用五阶隐式亚当斯法校正物理轴位置向量，得到qt+1：
判断是否到达曲线终点，若未到达，则令t＝t+1，根据qt，利用正向运动学变换计算实际刀位向量Rt，返回第二步；若到达，则结束算法；据此实现五轴双样条曲线插补连续物理轴运动轨迹直接生成。
本发明的有益效果是：发明了五轴双样条曲线插补轨迹生成方法，可实现除初始刀位外无需逆向运动学变换的物理轴运动轨迹实时直接生成；计算方法利用基于雅可比矩阵的亚当斯预估校正算法，可在不进行多解判断选择的前提下生成连续无突变物理轴运动轨迹。算法简单，且通用性好。
附图说明
图1—方法整体流程图；
图2—直角坐标系中五轴双样条曲线刀轨几何模型图；其中，曲线1表示刀尖点运动轨迹曲线，曲线2表示刀轴上除刀尖外一点运动轨迹曲线；
图3—利用本发明方法生成的五轴机床各直线轴运动轨迹；其中B1轴表示运动时间，单位为s，B2轴表示运动位置，单位为mm；曲线1表示x轴运动轨迹，曲线2表示y轴运动轨迹，曲线3表示z轴运动轨迹；
图4—利用本发明方法生成的五轴机床各旋转轴运动轨迹；其中B1轴表示运动时间，单位为s，B2轴表示运动位置，单位为rad；曲线1表示A轴运动轨迹，曲线2表示C轴运动轨迹，
图5—利用本发明方法获得的实际刀尖点与理想刀尖点距离偏差；其中B1轴表示运动时间，单位为s，B2轴表示距离偏差，单位为mm；
图6—利用本发明方法获得的实际刀轴矢量与理想刀轴矢量角度偏差；其中B1轴表示运动时间，单位为s，B2轴表示角度偏差，单位为rad。
具体实施方式
结合技术方案与附图详细说明本发明的具体实施方式。
在五轴双样条曲线插补加工过程中，由于五轴刀轨运动与物理轴运动间存在极强非线性对应关系，导致根据曲线方程实时计算物理轴运动位置困难。为解决这一难题，发明一种五轴双样条曲线插补轨迹生成方法。
附图1为方法整体流程图，附图2为直角坐标系中五轴双样条曲线刀轨几何模型图，以附图2所示刀轨为例，详细说明本发明具体实施过程，其中，曲线1，即刀尖点运动轨迹曲线的参数为：阶数：2；控制点：{(0,0,0),(5,-5,-2),(10,0,0),(0,20,2),(10,30,5),(30,30,5),(40,20,2),(30,0,0),(35,-5,-2),(40,0,0)}；权因子：{1；0.5；2；1；2；2；1；2；0.5；1}；节点向量：{0,0,0,1/8,2/8,3/8,4/8,5/8,6/8,7/8,1,1,1}，曲线2的阶数、权因子及节点向量与曲线1相同，控制点为：{(0,0,2),(5,-6,0),(10,0,2),(-5,20,4),(10,33,7),(30,33,7),(45,20,4),(30,0,2),(35,-6,0),(40,0,2)}。
根据附图1所示方法整体流程，以AC双转台五轴机床为例，进行五轴双样条曲线插补轨迹生成，具体步骤为：
第一步利用逆向运动学变换计算初始物理轴位置：首先令插补点序号t＝1，将初始点参数us＝0代入公式(1)计算初始刀位向量R1＝[Rx,1,Ry,1,Rz,1,Ri,1,Rj,1,Rk,1]T，将R1代入AC双转台五轴机床逆向运动学变换方程(7)计算初始物理轴运动向量q1：
其中x、y、z分别为x轴、y轴、z轴运动位置，θa、θc分别为A轴、C轴运动位置，Lacy为A轴转台与C轴转台在y方向的偏置距离，Lacz为A轴转台与C轴转台在z方向的偏置距离。
第二步计算刀位向量增量：根据公式(2)所示二阶泰勒级数展开法，取插补周期T＝0.001s，进给速度vk＝50mm/s，计算第t+1个插补点处的曲线参数ut+1，将ut+1代入公式(1)求取第t+1个刀位向量Rt+1，根据公式(3)计算刀位向量增量ΔRt；
第三步利用基于雅可比矩阵的亚当斯法计算物理轴位置：根据公式(4)计算雅可比矩阵，可得AC双转台五轴机床雅可比矩阵为：
进而根据方程组(5)求解雅可比矩阵的广义逆矩阵利用公式(6)、(7)所示的四阶亚当斯预估法及五阶亚当斯校正法计算第t+1个物理轴运动位置向量qt+1；判断是否到达曲线终点，若未到达，令t＝t+1，将qt代入公式(10)所示正向运动学变换方程计算实际刀位向量Rt，并返回第二步；
若到达曲线终点，则结束算法。
附图3所示为利用本发明方法生成的五轴机床各直线轴运动轨迹，其中B1轴表示运动时间，单位为s，B2轴表示运动位置，单位为mm，曲线1表示x轴运动轨迹，曲线2表示y轴运动轨迹，曲线3表示z轴运动轨迹；可见，用本发明方法生成的各直线轴运动轨迹连续、无突变；
附图4所示为利用本发明方法生成的五轴机床各旋转轴运动轨迹，其中B1轴表示运动时间，单位为s，B2轴表示运动位置，单位为rad，曲线1表示A轴运动轨迹，曲线2表示C轴运动轨迹；可见，用本发明方法生成的各旋转轴运动轨迹连续、无突变；
附图5所示为利用本发明方法获得的实际刀尖点与理想刀尖点距离偏差，其中B1轴表示运动时间，单位为s，B2轴表示距离偏差，单位为mm；图中，最大实际刀尖点与理想刀尖点距离偏差小于0.0003mm；
附图6所示为利用本发明方法获得的实际刀轴矢量与理想刀轴矢量角度偏差，其中B1轴表示运动时间，单位为s，B2轴表示角度偏差，单位为rad；图中，最大实际刀轴矢量与理想刀轴矢量角度偏差小于0.000006rad；
综上，本发明五轴双样条曲线插补轨迹生成方法可根据双样条曲线方程直接生成连续、无突变物理轴运动轨迹，且精度极高。
该方法在五轴双样条曲线插补过程中，根据双样条曲线方程计算连续物理轴运动轨迹，采用微分思想，基于雅可比矩阵和亚当斯数值计算的五轴双样条曲线插轨迹生成方法，方法简单可靠，精度高，对提高五轴数控机床性能具有重要意义。
Claims (1)
1.一种五轴双样条曲线插补轨迹生成方法，其特性在于，该方法利用二阶泰勒级数展开法计算插补点处刀尖点及刀轴矢量，根据五轴刀轨双样条曲线方程求取包含刀尖点、刀轴矢量的刀位向量，进而计算刀位向量增量，利用基于雅可比矩阵的亚当斯预估-校正法直接确定各物理轴理想运动位置；方法具体步骤如下：
第一步利用逆向运动学变换计算初始物理轴位置
设待插补双样条曲线中的刀尖点运动轨迹曲线方程为CP＝CP(u)，u∈[us,ue]，刀轴上除刀尖外另一点运动轨迹曲线方程为CQ＝CQ(u)，u∈[us,ue]，令Rp＝[Rx,Ry,Rz]T表示刀尖点，Ro＝[Ri,Rj,Rk]T表示刀轴矢量，R＝[Rx,Ry,Rz,Ri,Rj,Rk]T表示刀位向量，计算方法为：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>R</mi>
<mi>p</mi>
</msub>
<mo>=</mo>
<msub>
<mi>C</mi>
<mi>P</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>u</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>R</mi>
<mi>o</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>C</mi>
<mi>Q</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>u</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>P</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>u</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msub>
<mi>C</mi>
<mi>Q</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>u</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>P</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>u</mi>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>R</mi>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msubsup>
<mi>R</mi>
<mi>p</mi>
<mi>T</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>R</mi>
<mi>o</mi>
<mi>T</mi>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
将初始点参数us代入公式(1)计算初始刀位向量R1；令q表示物理轴运动位置向量，且q为五行一列的向量，其中五个元素对应于机床的五个物理轴，根据刀位向量R1，利用五轴机床逆向运动学变换，计算初始物理轴运动位置向量q1；
第二步计算刀位向量增量
设当前插补点序号为t，当前插补点处曲线参数为ut，根据二阶泰勒级数展开，计算第t+1个插补点处的曲线参数ut+1：
<mrow>
<msub>
<mi>u</mi>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>u</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>v</mi>
<mi>t</mi>
</msub>
<mrow>
<mo>|</mo>
<mo>|</mo>
<msubsup>
<mi>C</mi>
<mi>P</mi>
<mo>&prime;</mo>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>u</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>|</mo>
<mo>|</mo>
</mrow>
</mfrac>
<mi>T</mi>
<mo>-</mo>
<mfrac>
<mrow>
<msubsup>
<mi>v</mi>
<mi>t</mi>
<mn>2</mn>
</msubsup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>C</mi>
<mi>P</mi>
<mo>&prime;</mo>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>u</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<msubsup>
<mi>C</mi>
<mi>P</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>u</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mn>2</mn>
<mo>|</mo>
<mo>|</mo>
<msup>
<mi>C</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>u</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>4</mn>
</msup>
</mrow>
</mfrac>
<msup>
<mi>T</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
其中，vt为第t个插补点处进给速度，T为插补周期；将ut+1代入公式(1)计算第t+1个刀位向量Rt+1，进而计算刀位向量增量ΔRt：
ΔRt＝Rt+1-Rt (3)
第三步利用基于雅可比矩阵的亚当斯法计算物理轴位置
根据正向运动学变换，计算雅可比矩阵J6×5：
<mrow>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>d</mi>
<mi>R</mi>
</mrow>
<mrow>
<mi>d</mi>
<mi>q</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mo>&lsqb;</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>R</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>R</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>R</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>R</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>,</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>R</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>q</mi>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
</mfrac>
<mo>&rsqb;</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
进而根据方程组(5)求解雅可比矩阵的广义逆矩阵即
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>&CenterDot;</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>&CenterDot;</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>&CenterDot;</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mo>*</mo>
</msup>
<mo>=</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>&CenterDot;</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>)</mo>
</mrow>
<mo>*</mo>
</msup>
<mo>=</mo>
<msub>
<mi>J</mi>
<mrow>
<mn>6</mn>
<mo>&times;</mo>
<mn>5</mn>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
利用四阶显示亚当斯法计算物理轴位置向量预估值qtemp,t+1：
<mrow>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>e</mi>
<mi>m</mi>
<mi>p</mi>
<mo>,</mo>
<mi>t</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>q</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>24</mn>
</mfrac>
<mrow>
<mo>(</mo>
<mn>55</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mn>59</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>+</mo>
<mn>37</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mn>9</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<msub>
<mi>&Delta;R</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
利用五阶隐式亚当斯法校正物理轴位置向量，得到qt+1：
<mrow>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msub>
<mi>q</mi>
<mi>t</mi>
</msub>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>720</mn>
</mfrac>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mn>251</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mi>e</mi>
<mi>m</mi>
<mi>p</mi>
<mo>,</mo>
<mi>t</mi>
<mo>+</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>+</mo>
<mn>646</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mi>t</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mn>264</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>)</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<mn>106</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>2</mn>
</mrow>
</msub>
<mo>)</mo>
<mo>-</mo>
<mn>19</mn>
<msubsup>
<mi>J</mi>
<mrow>
<mn>5</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
<mo>+</mo>
</msubsup>
<mo>(</mo>
<msub>
<mi>q</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>)</mo>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<msub>
<mi>&Delta;R</mi>
<mi>t</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
判断是否到达曲线终点，若未到达，则令t＝t+1，根据qt，利用正向运动学变换计算实际刀位向量Rt，返回第二步；若到达，则结束算法；据此实现五轴双样条曲线插补连续物理轴运动轨迹直接生成。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710810296.7A CN107491035B (zh) | 2017-09-11 | 2017-09-11 | 一种五轴双样条曲线插补轨迹生成方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710810296.7A CN107491035B (zh) | 2017-09-11 | 2017-09-11 | 一种五轴双样条曲线插补轨迹生成方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107491035A true CN107491035A (zh) | 2017-12-19 |
| CN107491035B CN107491035B (zh) | 2019-06-21 |
Family
ID=60651596
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710810296.7A Active CN107491035B (zh) | 2017-09-11 | 2017-09-11 | 一种五轴双样条曲线插补轨迹生成方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107491035B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113706625A (zh) * | 2021-07-28 | 2021-11-26 | 昆山丘钛微电子科技股份有限公司 | 一种镜头畸变校正方法及装置 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2011173234A (ja) * | 2011-01-15 | 2011-09-08 | Ken Kobayashi | 工作機械の制御方法 |
| CN102528554A (zh) * | 2010-12-09 | 2012-07-04 | 中国科学院沈阳计算技术研究所有限公司 | 一种五轴加工奇异区域的轨迹优化方法 |
| CN104678888A (zh) * | 2013-12-02 | 2015-06-03 | 昌河飞机工业（集团）有限责任公司 | 基于机床运动约束环形刀多轴加工复杂曲面刀轨生成方法 |
| CN105426697A (zh) * | 2015-12-30 | 2016-03-23 | 西安交通大学 | 一种螺旋铣刀五轴加工铣削力精确预测方法 |
| CN106843140A (zh) * | 2016-11-28 | 2017-06-13 | 北京动力机械研究所 | 一种闭式叶轮的精加工刀具轨迹规划方法 |
-
2017
- 2017-09-11 CN CN201710810296.7A patent/CN107491035B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102528554A (zh) * | 2010-12-09 | 2012-07-04 | 中国科学院沈阳计算技术研究所有限公司 | 一种五轴加工奇异区域的轨迹优化方法 |
| JP2011173234A (ja) * | 2011-01-15 | 2011-09-08 | Ken Kobayashi | 工作機械の制御方法 |
| CN104678888A (zh) * | 2013-12-02 | 2015-06-03 | 昌河飞机工业（集团）有限责任公司 | 基于机床运动约束环形刀多轴加工复杂曲面刀轨生成方法 |
| CN105426697A (zh) * | 2015-12-30 | 2016-03-23 | 西安交通大学 | 一种螺旋铣刀五轴加工铣削力精确预测方法 |
| CN106843140A (zh) * | 2016-11-28 | 2017-06-13 | 北京动力机械研究所 | 一种闭式叶轮的精加工刀具轨迹规划方法 |
Non-Patent Citations (1)
| Title |
|---|
| 杲春芳等: "复杂曲面环形刀五轴端铣加工的刀具轨迹规划方法", 《工具技术》 * |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113706625A (zh) * | 2021-07-28 | 2021-11-26 | 昆山丘钛微电子科技股份有限公司 | 一种镜头畸变校正方法及装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107491035B (zh) | 2019-06-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105425727B (zh) | 五轴侧铣加工刀具路径光顺方法 | |
| CN107479497B (zh) | 一种五轴加工轨迹轮廓误差双闭环补偿方法 | |
| CN105700466A (zh) | 高速数控加工轨迹的曲率光顺方法 | |
| CN103048947B (zh) | 五坐标联动机床数控程序后置处理方法 | |
| CN106647623B (zh) | 一种几何精度及衔接速度最优化的五轴联动平滑插补方法 | |
| CN108803487B (zh) | 一种零件侧铣表面的点位轮廓误差预测方法 | |
| Qiao et al. | Bézier polygons for the linearization of dual NURBS curve in five-axis sculptured surface machining | |
| CN105005265B (zh) | 一种基于曲线光滑变形的数控加工进给率规划方法 | |
| CN109278048B (zh) | 五轴焊接机器人的焊接路径规划方法及五轴焊接机器人 | |
| CN106959664B (zh) | 基于五轴双转台在线非线性误差补偿方法 | |
| CN108490871A (zh) | 四轴数控铣床加工方法、装置、计算机设备和存储介质 | |
| CN113276130B (zh) | 一种基于点云切片的自由曲面喷涂路径规划方法及系统 | |
| CN104875104A (zh) | 基于cad/cam技术的轮毂不规则曲面抛光方法 | |
| CN106125674A (zh) | 一种高精度实时轮廓误差估计方法 | |
| CN103801982B (zh) | 一种基于误差控制的五轴nc系统平滑插补方法 | |
| CN105843174A (zh) | 一种样条曲线插补参数计算方法 | |
| CN107491035B (zh) | 一种五轴双样条曲线插补轨迹生成方法 | |
| Yu et al. | Post-processing algorithm of a five-axis machine tool with dual rotary tables based on the TCS method | |
| CN107065769A (zh) | 基于ab型五轴数控机床球头刀加工刀轴矢量光顺方法 | |
| CN108490874B (zh) | 一种双轴运动控制系统的非线性pid交叉耦合控制方法 | |
| Lee et al. | Real-time compensation of two-dimensional contour error in CNC machine tools | |
| CN107511830A (zh) | 一种五自由度混联机器人控制器参数自适应调整实现方法 | |
| CN116224910A (zh) | 面向数控系统的新型参数插补方法、系统及数控加工机床 | |
| CN116088425A (zh) | 一种数控加工的伺服控制方法、装置、设备和存储介质 | |
| CN107045328A (zh) | 基于ba型五轴数控机床球头刀加工刀轴矢量光顺方法 |
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 |