专利名称：：高速加工中心速度优化与平滑运动控制方法
技术领域：
：本发明高速加工
技术领域：
，提供了一种用于高速加工中心的速度优化与平滑运动控制方法，能够实现进给速度高速、平滑衔接，满足高速加工中心速度控制的要求。
背景技术：
：高速加工中心的进给速度高达40m/min，加速度高达2g。速度优化与平滑运动控制的目标是保证进给速度的高速、平稳变化，以提高数控系统加工效率、零件加工精度和刀具使用寿命。研究适合高速加工的速度优化与平滑运动控制方法，对于提高加工中心的整体性能具有十分重要的意义。目前，不少学者对高速加工的速度优化与平滑运动控制进行了研究。其中包括(1)采用插补后加减速控制实现连续微线段的高速加工，该方法由于后加减速控制难以保证各加工轴的精确联动关系，其加工轨迹存在一定的偏差，从而影响加工精度；(2)采用插补前加减速控制算法对合成速度进行控制，现有算法在预测减速点的同时，并未综合考虑弓高误差以及机床进给系统速度、加速度的进给能力；(3)采用前瞻预处理策略对预读加工段进行速度规划，以实现多程序段的平滑加工，该算法需迭代求解加工段最优衔接速度，算法实现复杂，难以满足数控系统实时性要求。
发明内容针对上述现有方法存在的缺陷，本发明提供了一种高速加工中心的速度优化与平滑运动控制方法，其目的在于对加工段进给速度进行优化，以保证进给速度的连续性和平稳性。本发明是通过以下技术方案实现的，速度控制由进给速度优化、前加减速控制两步骤构成。根据加工中心进给系统性能限制以及加工段拐角因素约束，建立了进给速度整数优化模型，其中加工段进给速度序列满足转接点速度上限，加工段内最大进给速度和最大进给速度变化量等约束条件，保证了进给速度的平稳性。根据进给速度序列相关性，简化了模型的约束条件和决策变量，根据决策变量对目标函数影响程度的主次分析，给出了简化模型分步优化各决策变量的解析计算公式，避免了分枝定界法、割平面法等传统整数规划方法的迭代计算过程，保证了优化过程的实时性。所述的进给速度优化预计算包括进给速度约束条件预计算；速度序列特征值预计算；进给速度优化参数预计算。为了保证进给速度的平滑运动控制，相邻加工段转接点速度、加工段进给速度、相邻两插补周期的进给速度变化量均应不大于其相应的最大允许值。为此，进给速度的约束条件预计算包括转接点速度上限、加工段内最大进给速度以及最大进给速度变化量的计算。所述的速度序列特征值预计算包括加工段速度序列{^,}(f=0,l,..,iV)中的加速段的^和V匀速段速度,+1，减速段的—2，一和，以及W等7个特征值。所述的进给速度优化参数预计算包括在上述预计算进给速度约束条件和速度序列特征值的基础上，求解进给速度的优化参数。优化参数包括进给速度序列长度最优值f，以及速度调整参数最优值Av'和r。所述的前加减速控制包括采用S加减速，迭代计算出各插补周期进给速度初值，根据进给速度的优化参数和速度初值计算出进给速度优化值。所述的进给速度优化包括以下步骤1)进给速度约束条件预计算高速加工中，为了保证进给速度的平滑运动控制，相邻加工段的转接点速度、加工段的进给速度、相邻两插补周期的进给速度变化量均应不大于其相应的最大允许值，为此，根据加工段拐角限制，各轴进给速度和进给加速度限制，圆弧半径误差限制，计算转接点速度上限、加工段内最大进给速度和最大进给速度变化量等约束条件；/(/0段与/("i)段的转接点速度上限、一为v歸力=min{，v:力,《:)}(1)其中，《!L^八t如鹏/KJ，VA^U，vCAtJaAmaxr/|eA^+1—eAe》|}，v=)=>/^/r。v八，脆和"八腿分别为八(A=x，y,z)轴最大允许速度和最大允许加速度，^=(^，^,~/为段终点的单位方向矢量，e一+一,^+一一f为/("i)段起点的单位方向矢量，r为插补周期，i和分别为圆弧插补半径和最大半径误差；/(/0段的段内最大进给速度、一为v=minlv(1)v("re)(2)其中，《^=Atnz{L/S^k4}，e,,*=(^,^,^)7为/(/0段第外插补周期轨迹处的单位方向矢量；/段最大进给速度变化量为(3)2)速度序列特征值预计算一般地，加工段/(/0的进给速度序列(0SKiV)由加速段(/=0，l,2,...,iVl)，匀速段G、M+l,…,iV2)和减速段(,'=iV2+l,...,iV)三部分组成，实际仅需计算加速段的v。和v匀速段速度1+1，减速段的_2，v^和，以及iV7个特征值；3)进给速度优化参数预计算进给速度优化参数包括进给速度序列长度最优值f，速度调整参数最优值A/和yt',其计算公式为<formula>formulaseeoriginaldocumentpage6</formula>!}>ors乂iV-l,Av"),^-d),其他其中，(A$),)和为序列长度《=iV时的进给速度简化模型最优解及其相应的目标函数最小值，(d,)和为序列长度《=iV-1时的进给速度简化模型最优解及其相应的目标函数最小值；所述的前加减速控制采用S加减速规律，分为两个步骤首先根据S加减速规律迭代计算第/个插补周期的进给速度初始值v,.(h0,l,…,r)，然后根据所求得进给速度优化参数(f,A/，r)，按照下式计算进给速度优化值v—,';<formula>formulaseeoriginaldocumentpage7</formula>(5)采用优化后的进给速度进行插补运算，实现了进给速度的高速、平滑衔接，能够满足高速加工中心速度控制的要求。本发明提供的速度优化与平滑运动控制方法，不受指令速度的影响，对不同指令速度的加工程序均能实现进给速度的高速、平稳衔接；同时本发明的方法计算速度快，能够满足高档速数控系统高实时性的要求，在不改变原数控系统控制软件结构的情况下，能够实现高速加工中心的进给速度平稳衔接。图l为速度控制方法流程图，其中，图1(a)为后台背景程序流程图，图l(b)为前台4ms中断流程图2为圆弧插补半径误差示意图3为优化前后速度变化曲线；图4为不同指令速度的实际进给速度曲线。下面结合附图对本发明的内容作进一步详细说明。具体实施例方式参见图1，控制系统的运动控制软件架构采用前、后台型软件结构，速度控制由进给速度优化、前加减速控制两步骤构成。其中，进给速度优化在后台背景程序中实现，前加减速控制在前台定时中断服务程序中实现。下面将结合附图对本发明方法进一步详细描述。1.速度优化速度优化包括预计算进给速度约束条件、速度序列特征值以及速度优化参数。1)进给速度约束条件预计算高速加工时要求加工段段首速度与段尾速度应满足其转接点速度上限约束，段内进给速度应满足段内最大进给速度约束，进给速度调整量应满足最大进给速度变化量约束；参照图2所示，为圆弧插补半径误差示意图，其中7为圆弧半径，y为步距角，^为最大半径误差。约束条件包括转接点速度上限、加工段内最大进给速度以及最大进给速度变化量，计算公式如下a./(/0段与/("l)段的转接点速度上限v^力Kmax力=min{v^一,ve(H,v=)}(1)其中，《ia为各轴最大进给速度，e^=^jvAlrax/K4vAraK/k』，《u为各轴最大进给加速度，《,A=A^」"Am^/|^+1-eA4，《=)为圆弧半径最大误差，v=)=V^/r。、狀和"細分别为A(A=xj,z)轴最大允许速度和最大允许加速度，=(^,^,~/为/(A)段终点的单位方向矢量，e,,A+1为/("i)段起点的单位方向矢量，r为插补周期，i和分别为圆弧插补半径和最大半径误差。b./(/0段的段内最大进给速度v^其中，v:,为进给速度最大值，CAtnJmax/2^」k4}，e,》—"^力A力f为/(/0段第/个插补周期轨迹处的单位方向矢量。C./(/0段最大进给速度变化量A;^△Vmax》=A^z{"Amax7/m严力|}}(3)2)速度序列特征值预计算将加工段/(/0的进给速度序列hl(o&、ao分为三部分，包括加速段(/=0,1,2，...,iVl)，匀速段(/=Aa+l,...,Aa)和减速段(/=W2+l，...,iV)，需计算的速度序列特征值包括加速段的v。和^，匀速段速度~1+1，减速段的_2，^和，以及iV。3)速度优化参数预计算进给速度优化参数包括进给速度序列长度最优值r，速度调整参数最优值A/和F，其计算公式为<formula>formulaseeoriginaldocumentpage9</formula>其中，(A$),)和为序列长度《=iV时的进给速度简化模型最优解及其相应的目标函数最小值，(Av^D,^一))和/(:—1}为序列长度《=^-1时的进给速度简化模型最优解及其相应的目标函数最小值。2.前加减速控制前加减速控制采用S加减速算法，假设上段段末速度为v^—P则当前段加减速控制步骤为步骤l:初始化，令v。-v^一，/=0;步骤2:根据S加减速算法，计算第f个插补周期进给速度原始值v,.;步骤3:根据速度优化参数(f,A/,F)和进给速度原始值v,，按照下式计算进给速度优化值《，控制系统以《值进行插补计算；v,+Av*+1,z=0(5)步骤4:若/=(，本段速度控制结束；否则，令/=/+1，跳至步骤2'应用实例在实际数控加工中心上对本发明的速度优化与平滑运动控制方法进行验证。实验所用的加工测试程序G代码如下O001画lG90G92X0Y0N002G01X10Y5F7000N003G02X20Y7R10F8500画4G03X30Y9R9F8500画5G01X40Y15F5000N006G01X50Y20F5000腦7M30该加工测试程序包括直线(GOl)、顺圆(G02)、逆圆(G03)等多种插补类型，以及直线接直线、直线接圆弧、圆弧接圆弧和圆弧接直线等多种曲线过渡类型。图3为加工测试程序O001的优化前后的进给速度曲线，其中纵坐标表示指令速度，单位为附m/min，横坐标表示加工时间，单位为,。由图3可知，采用速度优化与平滑运动控制方法前存在多处段末速度突变现象，其加减速频繁，导致数控加工中心存在一定程度的机械振动，而采用速度优化与平滑运动控制方法后段末速度突变得到有效地避免，其进给速度能够实现高速、平稳变化，保证数控加工精度。其次，测试了不同指令速度下采用本发明优化控制方法后的实际进给速度，以验证该方法的速度适用范围。实验所用的加工测试程序G代码如下O002N001G90G92X0Y0廳2G01X5Y10N003G01X10Y20N004G01X15Y25N005M30实验中，力Q工测试程序O002分别在1500ww/min，5000ww/min，15000mm/min的指令速度下运行，实际进给速度的实验结果如图4所示，其中纵坐标表示指令速度，单位为附附/min，横坐标表示加工时间，单位为腊。由图4可知，不同指令速度下的实际进给速度曲线均平滑无突变。因此，本发明方法不受指令速度的影响，对不同指令速度的加工程序均能实现进给速度的高速、平稳衔接。另外，对本发明速度优化控制方法的运行时间进行了测试。在本加工中心中，根据优化前的加工程序段速度序列，采用该方法计算优化后的速度序列，其计算时间最大不超过0.03ms，能够满足高速数控加工的实时性要求。权利要求1.一种高速加工中心速度优化与平滑运动控制方法，其特征在于，该控制方法分为进给速度优化和前加减速控制两个步骤；所述的进给速度优化包括以下步骤1)进给速度约束条件预计算高速加工中，为了保证进给速度的平滑运动控制，相邻加工段的转接点速度、加工段的进给速度、相邻两插补周期的进给速度变化量均应不大于其相应的最大允许值，为此，根据加工段拐角限制，各轴进给速度和进给加速度限制，圆弧半径误差限制，计算转接点速度上限、加工段内最大进给速度和最大进给速度变化量约束条件；l(h)段与l(h+1)段的转接点速度上限vemax，h为<mathsid="math0001"num="0001"><math><![CDATA[<mrow><msub><mi>v</mi><mrow><mi>e</mi><mi>max</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>=</mo><mi>min</mi><mo>{</mo><msubsup><mi>v</mi><mrow><mi>e</mi><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>v</mi><mrow><mi>e</mi><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><mo>,</mo><msubsup><mi>v</mi><mi>max</mi><mrow><mo>(</mo><mi>arc</mi><mo>)</mo></mrow></msubsup><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math></maths>其中，<mathsid="math0002"num="0002"><math><![CDATA[<mrow><msubsup><mi>v</mi><mrow><mi>e</mi><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><mo>=</mo><munder><mi>min</mi><mrow><mi>Λ</mi><mo>=</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi></mrow></munder><mo>{</mo><msub><mi>v</mi><mrow><mi>Λ</mi><mi>max</mi></mrow></msub><mo>/</mo><mo>|</mo><msub><mi>e</mi><mrow><mi>Λe</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>|</mo><mo>,</mo><msub><mi>v</mi><mrow><mi>Λ</mi><mi>max</mi></mrow></msub><mo>/</mo><mo>|</mo><msub><mi>e</mi><mrow><mi>Λs</mi><mo>,</mo><mi>h</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>|</mo><mo>}</mo><mo>,</mo></mrow>]]></math>id="icf0002"file="A2009100233910002C2.tif"wi="64"he="7"top="118"left="47"img-content="drawing"img-format="tif"orientation="portrait"inline="yes"/></maths><mathsid="math0003"num="0003"><math><![CDATA[<mrow><msubsup><mi>v</mi><mrow><mi>e</mi><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><mo>=</mo><munder><mi>min</mi><mrow><mi>Λ</mi><mo>=</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi></mrow></munder><mo>{</mo><msub><mi>a</mi><mrow><mi>Λ</mi><mi>max</mi></mrow></msub><mi>T</mi><mo>/</mo><mo>|</mo><msub><mi>e</mi><mrow><mi>Λs</mi><mo>,</mo><mi>h</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>e</mi><mrow><mi>Λe</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>|</mo><mo>}</mo><mo>,</mo></mrow>]]></math>id="icf0003"file="A2009100233910002C3.tif"wi="64"he="7"top="117"left="118"img-content="drawing"img-format="tif"orientation="portrait"inline="yes"/></maths><mathsid="math0004"num="0004"><math><![CDATA[<mrow><msubsup><mi>v</mi><mi>max</mi><mrow><mo>(</mo><mi>arc</mi><mo>)</mo></mrow></msubsup><mo>=</mo><msqrt><mn>8</mn><mi>R</mi><msub><mi>e</mi><mi>R</mi></msub></msqrt><mo>/</mo><mi>T</mi><mo>,</mo></mrow>]]></math>id="icf0004"file="A2009100233910002C4.tif"wi="31"he="5"top="130"left="23"img-content="drawing"img-format="tif"orientation="portrait"inline="yes"/></maths>vΛmax和aΛmax分别为Λ(Λ＝x，y，z)轴最大允许速度和最大允许加速度，ee，h＝(exe，h，eye，h，eze，h)T为l(h)段终点的单位方向矢量，es，h+1＝(exs，h+1，eys，h+1，ezs，h+1)T为l(h+1)段起点的单位方向矢量，T为插补周期，R和eR分别为圆弧插补半径和最大半径误差；l(h)段的段内最大进给速度vmax，h为<mathsid="math0005"num="0005"><math><![CDATA[<mrow><msub><mi>v</mi><mrow><mi>max</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>=</mo><mi>min</mi><mo>{</mo><msubsup><mi>v</mi><mrow><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><msubsup><mi>v</mi><mi>max</mi><mrow><mo>(</mo><mi>arc</mi><mo>)</mo></mrow></msubsup><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math></maths>其中，<mathsid="math0006"num="0006"><math><![CDATA[<mrow><msubsup><mi>v</mi><mrow><mi>max</mi><mo>,</mo><mi>h</mi></mrow><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><mo>=</mo><munder><mi>min</mi><mrow><mi>Λ</mi><mo>=</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi></mrow></munder><mo>{</mo><msub><mi>v</mi><mrow><mi>Λ</mi><mi>max</mi></mrow></msub><mo>/</mo><munder><mi>max</mi><mrow><mi>i</mi><mo>=</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi></mrow></munder><mo>{</mo><mo>|</mo><msub><mi>e</mi><mrow><mi>Λi</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>|</mo><mo>}</mo><mo>}</mo><mo>,</mo></mrow>]]></math>id="icf0006"file="A2009100233910002C6.tif"wi="59"he="9"top="191"left="37"img-content="drawing"img-format="tif"orientation="portrait"inline="yes"/></maths>ei，h＝(exi，h，eyi，h，ezi，h)T为l(h)段第i个插补周期轨迹处的单位方向矢量；l(h)段最大进给速度变化量Δvmax，h为<mathsid="math0007"num="0007"><math><![CDATA[<mrow><mi>Δ</mi><msub><mi>v</mi><mrow><mi>max</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>=</mo><munder><mi>min</mi><mrow><mi>Λ</mi><mo>=</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi></mrow></munder><mo>{</mo><msub><mi>a</mi><mrow><mi>Λ</mi><mi>max</mi></mrow></msub><mi>T</mi><mo>/</mo><munder><mi>max</mi><mi>i</mi></munder><mo>{</mo><mo>|</mo><msub><mi>e</mi><mrow><mi>Λi</mi><mo>,</mo><mi>h</mi></mrow></msub><mo>|</mo><mo>}</mo><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math></maths>2)速度序列特征值预计算加工段l(h)的进给速度序列{vi}(0≤i≤N)由加速段(i＝0，1，2，...，N1)，匀速段(i＝N1+1，...，N2)和减速段(i＝N2+1，...，N)三部分组成，实际仅需计算加速段的v0和v1，匀速段速度vN1+1，减速段的vN-2，vN-1和vN，以及N共7个特征值；3)进给速度优化参数预计算进给速度优化参数包括进给速度序列长度最优值K*，速度调整参数最优值Δv*和k*，其计算公式为其中，(Δv(N)*，k(N)*)和f(N)*为序列长度K＝N时的进给速度简化模型最优解及其相应的目标函数最小值，(Δv(N-1)*，k(N-1)*)和f(N-1)*为序列长度K＝N-1时的进给速度简化模型最优解及其相应的目标函数最小值；所述的前加减速控制采用S加减速规律，分为两个步骤首先根据S加减速规律迭代计算第i个插补周期的进给速度初始值vi(i＝0，1，...，K*)，然后根据所求得进给速度优化参数(K*，Δv*，k*)，按照下式计算进给速度优化值id="icf0009"file="A2009100233910003C2.tif"wi="5"he="4"top="138"left="58"img-content="drawing"img-format="tif"orientation="portrait"inline="yes"/><mathsid="math0008"num="0008"><math><![CDATA[<mrow><msubsup><mover><mi>v</mi><mo>~</mo></mover><mi>i</mi><mo>*</mo></msubsup><mo>=</mo><mfencedopen='{'close=''><mtable><mtr><mtd><msub><mi>v</mi><mn>0</mn></msub><mo>,</mo></mtd><mtd><mi>i</mi><mo>=</mo><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>v</mi><mi>i</mi></msub><mo>+</mo><mi>Δ</mi><msup><mi>v</mi><mo>*</mo></msup><mo>+</mo><mn>1</mn><mo>,</mo></mtd><mtd><mn>1</mn><mo>≤</mo><mi>i</mi><mo>≤</mo><msup><mi>k</mi><mo>*</mo></msup></mtd></mtr><mtr><mtd><msub><mi>v</mi><mi>i</mi></msub><mo>+</mo><mi>Δ</mi><msup><mi>v</mi><mo>*</mo></msup><mo>,</mo></mtd><mtd><msup><mi>k</mi><mo>*</mo></msup><mo>+</mo><mn>1</mn><mo>≤</mo><mi>i</mi><mo>≤</mo><msup><mi>K</mi><mo>*</mo></msup><mo>-</mo><mn>1</mn></mtd></mtr><mtr><mtd><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mi>K</mi></mrow><mi>N</mi></munderover><msub><mi>v</mi><mi>i</mi></msub><mo>-</mo><mrow><mo>(</mo><msup><mi>K</mi><mo>*</mo></msup><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mi>Δ</mi><msup><mi>v</mi><mo>*</mo></msup><mo>-</mo><msup><mi>k</mi><mo>*</mo></msup><mo>,</mo></mtd><mtd><mi>i</mi><mo>=</mo><msup><mi>K</mi><mo>*</mo></msup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math></maths>采用优化后的进给速度进行插补运算，实现了进给速度的高速、平滑衔接。全文摘要本发明提供了一种高速加工中心的速度优化与平滑运动控制方法，涉及高速加工
技术领域：
。高速加工中心要求进给速度达40m/min，加速度达2g，而且要求机床在进行微小段加工时能平稳运行。该方法由进给速度优化、前加减速控制两步骤构成。速度优化考虑了加工段拐角因素和机床速度、加速度的约束，为保证计算实时性，通过相关性分析获得了简化的整数优化模型，并根据决策变量对目标函数影响程度的主次分析，给出了简化模型分步优化各决策变量的解析计算公式。本发明的速度优化与平滑运动控制方法，在不改变原数控系统控制软件结构的情况下，能够使高速加工中心的进给速度平稳衔接。文档编号G05D13/00GK101615038SQ20091002339公开日2009年12月30日申请日期2009年7月21日优先权日2009年7月21日发明者明周,曹建福,霖汪,浩王申请人:西安交通大学;苏州江南电梯(集团)有限公司