CN109856962B - 一种智能圆轴类校直机主轴自适应速度控制方法 - Google Patents
一种智能圆轴类校直机主轴自适应速度控制方法 Download PDFInfo
- Publication number
- CN109856962B CN109856962B CN201910034650.0A CN201910034650A CN109856962B CN 109856962 B CN109856962 B CN 109856962B CN 201910034650 A CN201910034650 A CN 201910034650A CN 109856962 B CN109856962 B CN 109856962B
- Authority
- CN
- China
- Prior art keywords
- acceleration
- speed
- stage
- deceleration
- motor
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000001133 acceleration Effects 0.000 claims abstract description 277
- 230000033001 locomotion Effects 0.000 claims abstract description 21
- 238000004364 calculation method Methods 0.000 claims description 23
- 230000008569 process Effects 0.000 claims description 8
- 230000003247 decreasing effect Effects 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 4
- 230000006798 recombination Effects 0.000 claims description 3
- 238000005215 recombination Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 238000005452 bending Methods 0.000 abstract description 5
- 238000005259 measurement Methods 0.000 abstract description 2
- 238000012937 correction Methods 0.000 description 4
- 230000009467 reduction Effects 0.000 description 4
- 239000000463 material Substances 0.000 description 3
- 229910000831 Steel Inorganic materials 0.000 description 1
- 206010044565 Tremor Diseases 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 238000010791 quenching Methods 0.000 description 1
- 230000000171 quenching effect Effects 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
Images
Landscapes
- Control Of Stepping Motors (AREA)
Abstract
一种智能圆轴类校直机主轴自适应速度控制方法,采用自适应减速阶段加速度控制算法的调整减速阶段的加速度大小,即在同一个路程的速度规划中,与加速阶段的时间相比,增大了减速阶段的时间,从而减少了主轴在停下运动时产生的冲击力;将主轴运动的目标距离L、设定的目标速度Vm,各个阶段速度及相对应的脉冲步数进行比对,利用加速阶段正推和减速阶段倒推法调整电机实际能达到的最大速度,并实时规划出电机加减速曲线。本发明能有效解决圆轴类校直机主轴在停止运动时产生的冲击力,以及引起的抖动和碰撞、弯曲度的测量精确、机器和电机的损坏的问题。
Description
技术领域
本发明涉及一种速度控制方法,尤其是一种智能圆轴类校直机主轴自适应速度控制方法,属于运动控制领域。
背景技术
近年来,随着国内经济的快速发展,圆轴类校直机的运用也越来越广泛,智能化的校直机可以校直硬度和淬火等程度不一的圆轴类钢材。智能的圆轴类校直机采用由电机驱动带动负载的主轴(校直头)进行对圆轴类材料的弯曲位置进行下压校直,并且受到广泛的关注。
智能圆轴类校直机的主轴校正***主要在圆轴的弯曲位置,通过继电器控制弯曲位置两端支撑点来支撑圆轴,依靠电机驱动主轴(校直头)移动一定距离,对圆轴弯曲的地方进行校正。然而,要是想要对不同材质的圆轴能到很好的校正,那么主轴(校直头)必须要有很大的力才能对圆轴进行校正,这样主轴就必须带有很大的负载。主轴(校直头)在移动校直功能减速停止时,由公式Ft=mv可知,速度和负载很大时会产生很大的冲击力,就会是设备很容易发生抖动和碰撞现象,而一旦抖动就将引起弯曲度的测量不精确,甚至还会导致校直机的机械碰撞损坏机器和电机,尤其是在高速运动情况下更易发生。同时,主轴(校直头)为了加快校正的进度,缩短校直时间,需要进行短距离内的迅速提速,在停止减速阶段需要缓慢一点减速,增大减速时间,减少冲击力。因此迫切需要一种新的速度控制方法来提升主轴电机的转速和稳定性。
发明内容
为了提高智能圆轴类校直机主轴的速度以及克服其在高速运动且负载很大的情况下减速阶段下存在的设备颤抖、电机损坏等缺点,本发明提供了一种能实现电机迅速提速、有效避免过载、提升稳定性的智能圆轴类校直机主轴自适应速度控制方法。
本发明解决其技术问题所采用的技术方案如下:
一种智能圆轴类校直机主轴自适应速度控制方法,所述方法包括以下步骤:
1)首先根据圆轴类校直机主轴的机械结构、采用电机的型号属性以及现场测试,确定主轴在进行上下移动动作时,电机能允许运行的最大加速度amax,最小加速度amin,最大速度Vmax,高速阶段最小速度Vcon2,匀加速阶段最小速度Vcon1和匀加速度ac;
2)在加速度值低于主轴电机的最大加速度amax的条件下,根据加阶段加速度控制算法,可以得出加速阶段的各个加速度(a1,a2,···,an),a表示加速度的值,下标1到n表示加速度的规划顺序;
3)根据实际圆轴类校直机主轴负载的重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与速度控制算法,可以得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中,ad表示减速阶段的速度,au表示加速阶段的速度,k表示加速阶段的加速度与减速阶段的加速度的比例关系;
4)根据现场调试,设定主轴电机的起始速度Vmin、每次速度改变的规划周期为2ms,结合步骤2)得到的加速阶段的每个加速度(a1,a2,···,an)依次可得到电机的加速阶段的速度(v1,v2,···,vn+1)和相对应的脉冲步长数(P1,P2,···,Pn+1),在加速阶段达到匀加速阶段最小速度Vcon1对应的脉冲步长数Pcon1和高速阶段最小速度Vcon2对应的脉冲步长数Pcon2,达到最大速度Vmax对应的脉冲步长数Pmax;再结合步骤3)得到的减速阶段加速度和加速阶段的加速度关系得到的减速阶段的加速度(a1',a2',···,am')就可以得到减速阶段的各个阶段的速度(v1',v2',···,vm+1')和相对应的脉冲步长数(P1',P2',···,Pm+1');
5)主轴运动的目标距离L、设定的目标速度Vm,与步骤2)、步骤3)和步骤4)中得到的各个阶段速度及相对应的脉冲步数进行比对,利用加速阶段正推和减速阶段倒推法调整电机实际能达到的最大速度,并实时规划出电机加减速曲线。
进一步,在步骤1)中,现场测试出的最大加速度amax需满足当滚主轴带动质量为M的负载时,电机在当前负载下以起始速度Vmin突增amax速度都能够保持稳定运行;测试出的最小加速度amin需满足电机在接近最大速度Vmax高速运动时突增amin不会引起电机过载和堵转丢步等现象;在步骤4)中,匀加速阶段最小速度Vcon1,是Vmin通过减加速阶段加速度达到匀加速度ac(ac=[amin+(amax-amin)/40])时对应的速度;测试出的高速阶段最小速度Vcon2,需满足电机在以加速度ac匀加速加到不会引起电机过载和堵转丢步时最大的速度。
再进一步,在步骤2)中,由于电机在低速阶段能承受较大阻力,且为实现校直机主轴的快速提速,令首个加速度值等于最大加速度,即a1=amax,再根据加速阶段加速控制算法依次递减得出a1~aj的值,j<n;同时为使主轴电机运转速度尽可能达到目标速度Vm,保持速度的稳定提升;加速阶段加速度(a1,a2,···,an)具体计算公式如下:
ai=a1-2·(i-1)2 (ac<=ai) (1)
ai=ac-(i-c)2 (ai>=amin) (2)
其中a1=amax,即电机的起跳加速度设为最大加速度,i是大于0的整数,公式(1)是加速段低速减加速阶段的加速度计算公式,公式(2)是加速段高速减加速阶段的加速度计算公式,其中ac计算公式:
ac=amin+(amax-amin)/40 (3)
ai表示第i个规划周期的加速度值,当i满足ai<=amin<ai-1时,令j=i,即此时ai=aj,因此得aj~an的计算公式为:
aj=aj+1=···=an (4)
其中aj近似等于最小加速度,能够满足电机在任意速度下进行速度的突变。
再进一步,实际圆轴类校直机主轴负载的重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与速度控制算法,得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中ad表示减速阶段的速度,au表示加速阶段的速度,k表示加速阶段的加速度与减速阶段的加速度的比例关系,其计算公式为:
k=1+0.01·(lgM+lgVm) (5)
其中M代表的是主轴负载的重量,单位是千克,Vm代表的是目标速度;
在步骤4)中,当电机运转到实际速度或者目标速度Vm后,进行减速运动,再根据步骤3)和加减速控制算法中加速阶段的加速度控制算法依次递减得出加速度v1',v2',···,vm+1'的值,减速阶段加速度(a1',a2',···,am')计算公式如下:
ai'=-[(an+1+(i-c)2)·j/k] (-ai'<=ac) (6)
ai'=-[(ac+2*(i-1)2)·j/k] (-ai'<=amax) (7)
其中,j表示加速度临时计数,此值是从1开始计数,每次加1,当加到k时,从1开始重新计数。
再进一步,在步骤4)中,主轴电机以Vmin为起跳速度,即v1=Vmin,再根据加速度(a1,a2,···,an)依次递增得出加速阶段速度(v1,v2,···,vn+1),其计算公式如下:
vn=vn-1+an-1 (8)
其中v1=Vmin,vn表示第n个规划周期时电机达到的速度,单位为电机每秒运行的脉冲量;再结合规划周期2ms可得出脉冲步长(P1,P2,···,Pn+1)和(P1',P2',···,Pm+1')的计算公式:
Pn=2vn·10-3+Pn-1 (9)
Pm'=2vm'·10-3+Pm-1' (10)
其中P1=2v1·10-3,P1'=2vn·10-3,Pn表示电机以初速度Vmin为起跳速度,加速度阶段每经过一个规划周期2ms按照加速度(v1,v2,···,vn+1)进行一次提速,当速度提升到vn时其所运行的脉冲量;Pm'表示电机从最大速度vn开始减速运行到vm时其所运行的脉冲量。
所述步骤5)中,根据加速阶段加速度(v1,v2,···,vn+1)对相应脉冲步长(P1,P2,···,Pn+1)和减速阶段加速度(v1',v2',···,vm+1')对相应脉冲步长(P1',P2',···,Pm+1')再结合目标速度Vm以及目标位置L,用加速阶段正推和减速阶段倒推法计算出最接近目标速度Vm的实际最大速度vp、加速距离Pp和减速距离Pp',加速阶段正推和减速阶段倒推法,就是从加速度阶段加速度v1,v2,···,vn+1中从第一个速度开始推导,计算某个速度vj对应的脉冲数Pj加上这个速度在减速阶段到最小速度的脉冲数Pj'和目标距离L相比,减速阶段脉冲数利用倒推法计算公式为:
Pj'=Pm+1'-Pvj' (11)
其中j从1开始,Pvj'为速度vj对应减速阶段的脉冲步长量;根据最大速度Vmax,可以分为两种距离情况:
(a)如果推到速度Vmax时,Pj+Pj'<L;则vp=Vmax,Pp=Pmax;
(b)如果没有推到速度vj<Vmax时,Pj+Pj'>L;则vp=vj,Pp=Pj;
在根据上面得到的电机速度vp与目标速度Vm相比,以此又可分为两种情况:
(a)如果行程vp<=Vm<Vmax,此时图2内电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pp (12)
减速阶段的距离为:
S2=Pp' (13)
(b)如果行程vm<=vp<=Vmax,此时图2内电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pm (14)
减速阶段的距离为:
S2=Pm' (15)
匀速阶段的距离为:
S3=L-S1-S2 (16)
主轴电机加减速曲线是将速度控制整体分为低速减加速、匀加速、高速减加速、高速减减速、匀减速和低速减减速七段的不对称速度曲线,当速度达到目标速度Vm或运动步长达到L/2时,运行状态进入匀速阶段或者减速阶段。
本发明的优点在于:(1)圆轴类校直机主轴控制***采用的加速度a1,a2,···,an使得主轴在低速阶段进行低速减加速度运动,在中速阶段进行匀加速度运动,在高速阶段进行高速减加速度运动,大大缩短了电机运转达到实际速度或目标速度Vm的时间;(2)采用在主轴运行过程中实时调用提前计算好的速度v1,v2,···,vn+1、v1',v2',···,vm+1'的控制方法,减少运动过程中***计算时间,提高了处理效率,使得智能圆轴类校直机主轴运动的实时性更高;(3)通过目标距离L与得到脉冲步长(P1,P2,···,Pn+1)和(P1',P2',···,Pm+1')的比对,利用加速阶段正推和减速阶段倒推法能够精确得出主轴理论能达到的最大速度,减小计算误差,提高控制精度;(4)根据主轴的负载M和设定运动的速度Vm,可以自适应的调整不同状态下运动减速阶段的加速度大小;(5)自适应的调整减速阶段的加速度大小,就是在同一个路程的速度规划中与加速阶段的时间相比,增大了减速阶段的时间,从而减少了主轴在停下运动时产生的冲击力,就能够有效避免设备的抖动和碰撞现象,消除抖动影响弯曲度的测量精确,还减少校直机的内部机械碰撞,防止机器和电机的损坏;(6)控制方法基于STM32H742IIT6实现,资源丰富并且能减小智能圆轴类校直机控制器的体积。
附图说明
图1为智能圆轴类校直机主轴电机速度控制的实现流程图。
图2为智能圆轴类校直机主轴电机的速度规划曲线。
具体实施方式
下面结合附图对本发明的实施方式作进一步描述。
参照图1和图2,一种智能圆轴类校直机自适应速度控制方法,所述方法包括以下步骤:
1)首先根据圆轴类校直机主轴的机械结构、步电机的型号属性以及现场测试,确定主轴在进行上下移动动作时,电机能允许运行的,电机能允许运行的最大加速度amax,最小加速度amin,最大速度Vmax,高速阶段最小速度Vcon2,匀加速阶段最小速度Vcon1,匀加速度ac;
2)在加速度值低于主轴电机的最大加速度amax的条件下,根据加速阶段加速控制算法,得出加速阶段的加速度(a1,a2,···,an),a表示加速阶段加速度的值,下标1到n表示加速度的规划顺序;
3)实际中圆轴类校直机主轴负载会不同,根据负载重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与加速度控制算法,可以得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中,ad表示减速阶段的速度,au表示加速阶段的速度,a'表示减速阶段加速度的值,下标1到m表示加速度的规划顺序;
4)设定主轴电机的起跳速度Vmin、规划周期为2ms,结合步骤2)和步骤3)得到的加速阶段加速度(a1,a2,···,an)和减速阶段的加速度(a1',a2',···,am'),依次建立电机的加速阶段的速度(v1,v2,···,vn+1)及对应的脉冲步长数(P1,P2,···,Pn+1)和减速阶段的速度(v1',v2',···,vm+1')及对应的脉冲步长数(P1',P2',···,Pm+1');
5)主轴运动的目标距离L、设定的目标速度Vm,与步骤2)、步骤3)和步骤4)中得到的各个阶段速度及相对应的脉冲步数进行比对,利用加速阶段正推和减速阶段倒推法调整电机实际能达到的最大速度,并实时规划出电机加减速曲线。
进一步,在步骤1)中,现场测试出的最大加速度amax需满足当滚主轴带动质量为M的负载时,电机在当前负载下以起跳速度Vmin突增amax速度都能够保持稳定运行;测试出的最小加速度amin需满足电机在接近最大速度Vmax高速运动时突增amin不会引起电机过载和堵转丢步等现象;在步骤4)中,匀加速阶段最小速度Vcon1,是Vmin通过减加速阶段加速度达到匀加速度ac(ac=[amin+(amax-amin)/40])时对应的速度;测试出的高速阶段最小速度Vcon2,需满足电机在以加速度ac匀加速加到不会引起电机过载和堵转丢步时最大的速度。
再进一步,在步骤2)中,由于电机在低速阶段能承受较大阻力,且为实现校直机主轴的快速提速,令首个加速度值等于最大加速度,即a1=amax,再根据加速阶段加速控制算法依次递减得出a1~aj的值,j<n;同时为使主轴电机运转速度尽可能达到目标速度Vm,保持速度的稳定提升;加速阶段加速度(a1,a2,···,an)具体计算公式如下:
ai=a1-2·(i-1)2 (ac<=ai) (1)
ai=ac-(i-c)2 (ai>=amin) (2)
其中a1=amax,即图2中电机的起跳加速度设为最大加速度,i是大于0的整数,公式(1)是加速段低速减加速阶段的加速度计算公式,公式(2)是加速段高速减加速阶段的加速度计算公式。其中ac计算公式:
ac=amin+(amax-amin)/40 (3)
ai表示第i个规划周期的加速度值,当i满足ai<=amin<ai-1时,令j=i,即此时ai=aj,因此可得aj~an的计算公式为:
aj=aj+1=···=an (4)
其中aj近似等于最小加速度,能够满足电机在任意速度下进行速度的突变。
再进一步,在步骤3)中,实际圆轴类校直机主轴负载的重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与速度控制算法,可以得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中ad表示减速阶段的速度,au表示加速阶段的速度,k表示加速阶段的加速度与减速阶段的加速度的比例关系,其计算公式为:
k=1+0.01·(lgM+lgVm) (5)
其中M代表的是主轴负载的重量,单位是千克,Vm代表的是目标速度。
再进一步,在步骤4)中,当电机运转到实际速度或者目标速度Vm后,进行减速运动,再根据步骤3)和加减速控制算法中加速阶段的加速度控制算法依次递减得出加速度v1',v2',···,vm+1'的值,具体减速阶段加速度(a1',a2',···,am')计算公式如下:
ai'=-[(an+1+(i-c)2)·j/k] (-ai'<=ac) (6)
ai'=-[(ac+2*(i-1)2)·j/k] (-ai'<=amax) (7)
其中,j表示加速度临时计数,此值是从1开始计数,每次加1,当加到k时,从1开始重新计数。
再进一步,在步骤3)中,主轴电机以Vmin为起跳速度,即v1=Vmin,再根据加速度(a1,a2,···,an)依次递增得出加速阶段速度(v1,v2,···,vn+1),其计算公式如下:
vn=vn-1+an-1 (8)
其中v1=Vmin,vn表示第n个规划周期时电机达到的速度,单位为电机每秒运行的脉冲量;再结合规划周期2ms可得出脉冲步长(P1,P2,···,Pn+1)和(P1',P2',···,Pm+1')的计算公式:
Pn=2vn·10-3+Pn-1 (9)
Pm'=2vm'·10-3+Pm-1' (10)
其中P1=2v1·10-3,P1'=2vn·10-3,Pn表示电机以初速度Vmin为起跳速度,加速度阶段每经过一个规划周期2ms按照加速度(v1,v2,···,vn+1)进行一次提速,当速度提升到vn时其所运行的脉冲量;Pm'表示电机从最大速度vn开始减速运行到vm时其所运行的脉冲量。
所述步骤4)中,电机加减速曲线是将速度控制整体分为低速减加速、匀加速、高速减加速、高速减减速、匀减速和低速减减速七段的不对称速度曲线,当速度达到目标速度Vm或运动步长达到L/2时,运行状态进入匀速阶段或者减速阶段。
本例实施的智能圆轴类校直机主轴速度控制方法如图1所示,首先需进行低速减加速运动步骤,根据加速阶段加速度(v1,v2,···,vn+1)对相应脉冲步长(P1,P2,···,Pn+1)和减速阶段加速度(v1',v2',···,vm+1')对相应脉冲步长(P1',P2',···,Pm+1')再结合目标速度Vm以及目标位置L,用加速阶段正推和减速阶段倒推法计算出最接近目标速度Vm的实际最大速度vp、加速距离Pp和减速距离Pp'。
加速阶段正推和减速阶段倒推法,就是从加速度阶段加速度v1,v2,···,vn+1中从第一个速度开始推导,计算某个速度vj对应的脉冲数Pj加上这个速度在减速阶段到最小速度的脉冲数Pj'和目标距离L相比,减速阶段脉冲数利用倒推法计算公式为:
Pj'=Pm+1'-Pvj' (11)
其中j从1开始,Pvj'为速度vj对应减速阶段的脉冲步长量;根据最大速度Vmax,可以分为两种距离情况:
(c)如果推到速度Vmax时,Pj+Pj'<L;则vp=Vmax,Pp=Pmax;
(d)如果没有推到速度vj<Vmax时,Pj+Pj'>L;则vp=vj,Pp=Pj;
在根据上面得到的电机速度vp与目标速度Vm相比,以此又可分为两种情况:
(a)如果行程vp<=Vm<Vmax,此时图2内电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pp (12)
减速阶段的距离为:
S2=Pp' (13)
(b)如果行程vm<=vp<=Vmax,此时图2内电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pm (14)
减速阶段的距离为:
S2=Pm' (15)
匀速阶段的距离为:
S3=L-S1-S2 (16)
如图1所示,当主轴电机当前位置小于等于加速距离距离S1时,会继续进行加速阶段,当当前速度小于目标速度Vm或者实际计算最大速度vp时,若当前速度小于速度Vcon1会进行低速减加速运动,若前速度大于速度Vcon1且小于Vcon2会进行匀加速阶段,否则进行高速减加速阶段;当S3≠0时,主轴电机当前位置大于加速距离距离S1时,运行状态会进入匀速阶段,电机此时速度为整个行程中的最大速度;当主轴电机当前位置离目标位置的距离小于等于减速距离S2时,运行状态进入减速状态,此时电机依照减速过程速度(v1',v2',···,vm+1')进行减速,根据速度大小也可分为高速减减速阶段、匀减速阶段和低速减减速阶段,从而实现速度和脉冲长度的精确控制;当主轴电机当前位置等于目标位置时,电机就会停止运行,结束此次主轴校直下压动作。
本实施例提出的一种智能圆轴类校直机主轴的自适应速度控制方法,采用自适应减速阶段加速度控制算法的调整减速阶段的加速度大小,即在同一个路程的速度规划中,与加速阶段的时间相比,增大了减速阶段的时间,从而减少了主轴在停下运动时产生的冲击力,就能够有效避免抖动和碰撞现象,消除抖动影响弯曲度的测量精确,还间接减少校直机的机械碰撞,防止机器和电机的损坏,有效保证了电机的持续加速和稳定运行。
Claims (2)
1.一种智能圆轴类校直机主轴自适应速度控制方法,其特征在于,所述方法包括以下步骤:
1)首先根据圆轴类校直机主轴的机械结构、采用电机的型号属性以及现场测试,确定主轴在进行上下移动动作时,电机能允许运行的最大加速度amax,最小加速度amin,最大速度Vmax,高速阶段最小速度Vcon2,匀加速阶段最小速度Vcon1和匀加速度ac;
2)在加速度值低于主轴电机的最大加速度amax的条件下,根据加阶段加速度控制算法,可以得出加速阶段的各个加速度(a1,a2,···,an),a表示加速度的值,下标1到n表示加速度的规划顺序;
3)根据实际圆轴类校直机主轴负载的重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与速度控制算法,可以得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中,ad表示减速阶段的速度,au表示加速阶段的速度,k表示加速阶段的加速度与减速阶段的加速度的比例关系;
4)根据步骤2)和步骤3)得到加速阶段的加速度(a1,a2,···,an)和减速阶段的加速度(a1',a2',···,am')依次可得到电机的加速阶段的速度(v1,v2,···,vn+1)及相对应的脉冲步长数(P1,P2,···,Pn+1)和减速阶段的各个阶段的速度(v1',v2',···,vm+1')和相对应的脉冲步长数(P1',P2',···,Pm+1'),在加速阶段达到匀加速阶段最小速度Vcon1对应的脉冲步长数Pcon1和高速阶段最小速度Vcon2对应的脉冲步长数Pcon2,达到最大速度Vmax对应的脉冲步长数Pmax;
5)将主轴运动的目标距离L、设定的目标速度Vm,与步骤2)、步骤3)和步骤4)中得到的各个阶段速度及相对应的脉冲步数进行比对,利用加速阶段正推和减速阶段倒推法调整电机实际能达到的最大速度,并实时规划出电机加减速曲线;
所述步骤2)中,令首个加速度值等于最大加速度,即a1=amax,再根据加速阶段加速控制算法依次递减得出a1~aj的值,j<n;同时为使主轴电机运转速度尽可能达到目标速度Vm,保持速度的稳定提升;加速阶段加速度(a1,a2,···,an)具体计算公式如下:
ai=a1-2·(i-1)2(ac<=ai) (1)
ai=ac-(i-c)2(ai>=amin) (2)
其中a1=amax,即电机的起跳加速度设为最大加速度,i是大于0的整数,公式(1)是加速段低速减加速阶段的加速度计算公式,公式(2)是加速段高速减加速阶段的加速度计算公式,其中ac计算公式:
ac=amin+(amax-amin)/40 (3)
ai表示第i个规划周期的加速度值,当i满足ai<=amin<ai-1时,令j=i,即此时ai=aj,因此得aj~an的计算公式为:
aj=aj+1=···=an (4)
其中aj近似等于最小加速度,能够满足电机在任意速度下进行速度的突变;
所述步骤3)中,实际圆轴类校直机主轴负载的重量M和设定的目标速度Vm,再根据自适应减速阶段加速度算法与速度控制算法,得出减速阶段的加速度与加速阶段加速度之间的关系ad=au/k和减速阶段的加速度(a1',a2',···,am'),其中ad表示减速阶段的速度,au表示加速阶段的速度,k表示加速阶段的加速度与减速阶段的加速度的比例关系,其计算公式为:
k=1+0.01·(lgM+lgVm) (5)
其中M代表的是主轴负载的重量,单位是千克,Vm代表的是目标速度;
在步骤4)中,当电机运转到实际速度或者目标速度Vm后,进行减速运动,再根据步骤3)和加减速控制算法中加速阶段的加速度控制算法依次递减得出加速度v1',v2',···,vm+1'的值,减速阶段加速度(a1',a2',···,am')计算公式如下:
ai'=-[(an+1+(i-c)2)·j/k](-ai'<=ac) (6)
ai'=-[(ac+2*(i-1)2)·j/k](-ai'<=amax) (7)
其中,j表示加速度临时计数,此值是从1开始计数,每次加1,当加到k时,从1开始重新计数;
在步骤4)中,主轴电机以Vmin为起跳速度,即v1=Vmin,再根据加速度(a1,a2,···,an)依次递增得出加速阶段速度(v1,v2,···,vn+1),其计算公式如下:
vn=vn-1+an-1 (8)
其中v1=Vmin,vn表示第n个规划周期时电机达到的速度,单位为电机每秒运行的脉冲量;再结合规划周期2ms可得出脉冲步长(P1,P2,···,Pn+1)和(P1',P2',···,Pm+1')的计算公式:
Pn=2vn·10-3+Pn-1 (9)
Pm'=2vm'·10-3+Pm-1' (10)
其中P1=2v1·10-3,P1'=2vn·10-3,Pn表示电机以初速度Vmin为起跳速度,加速度阶段每经过一个规划周期2ms按照加速度(v1,v2,···,vn+1)进行一次提速,当速度提升到vn时其所运行的脉冲量;Pm'表示电机从最大速度vn开始减速运行到vm时其所运行的脉冲量;
所述步骤5)中,根据加速阶段加速度(v1,v2,···,vn+1)对相应脉冲步长(P1,P2,···,Pn+1)和减速阶段加速度(v1',v2',···,vm+1')对相应脉冲步长(P1',P2',···,Pm+1')再结合目标速度Vm以及目标位置L,用加速阶段正推和减速阶段倒推法计算出最接近目标速度Vm的实际最大速度vp、加速距离Pp和减速距离Pp',加速阶段正推和减速阶段倒推法,就是从加速度阶段加速度v1,v2,···,vn+1中从第一个速度开始推导,计算某个速度vj对应的脉冲数Pj加上这个速度在减速阶段到最小速度的脉冲数Pj'和目标距离L相比,减速阶段脉冲数利用倒推法计算公式为:
(a)如果推到速度Vmax时,Pj+Pj'<L;则vp=Vmax,Pp=Pmax;
(b)如果没有推到速度vj<Vmax时,Pj+Pj'>L;则vp=vj,Pp=Pj;
在根据上面得到的电机速度vp与目标速度Vm相比,以此又可分为两种情况:
(a)如果行程vp<=Vm<Vmax,此时图2内电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pp (12)
减速阶段的距离为:
S2=Pp' (13)
(b)如果行程vm<=vp<=Vmax,此时电机运行过程中实际能够达到的最大速度为vp,此时的加速距离为:
S1=Pm (14)
减速阶段的距离为:
S2=Pm' (15)
匀速阶段的距离为:
S3=L-S1-S2 (16)
主轴电机加减速曲线是将速度控制整体分为低速减加速、匀加速、高速减加速、高速减减速、匀减速和低速减减速七段的不对称速度曲线,当速度达到目标速度Vm或运动步长达到L/2时,运行状态进入匀速阶段或者减速阶段。
2.如权利要求1所述的一种智能圆轴类校直机主轴自适应速度控制方法,其特征在于:所述步骤1)中,现场测试出的最大加速度amax需满足当滚主轴带动质量为M的负载时,电机在当前负载下以起始速度Vmin突增amax速度都能够保持稳定运行;测试出的最小加速度amin需满足电机在接近最大速度Vmax高速运动时突增amin不会引起电机过载和堵转丢步等现象;在步骤4)中,匀加速阶段最小速度Vcon1,是Vmin通过减加速阶段加速度达到匀加速度ac(ac=[amin+(amax-amin)/40])时对应的速度;测试出的高速阶段最小速度Vcon2,需满足电机在以加速度ac匀加速加到不会引起电机过载和堵转丢步时最大的速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910034650.0A CN109856962B (zh) | 2019-01-15 | 2019-01-15 | 一种智能圆轴类校直机主轴自适应速度控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910034650.0A CN109856962B (zh) | 2019-01-15 | 2019-01-15 | 一种智能圆轴类校直机主轴自适应速度控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109856962A CN109856962A (zh) | 2019-06-07 |
CN109856962B true CN109856962B (zh) | 2022-04-08 |
Family
ID=66894652
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910034650.0A Active CN109856962B (zh) | 2019-01-15 | 2019-01-15 | 一种智能圆轴类校直机主轴自适应速度控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109856962B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110815233B (zh) * | 2019-11-28 | 2020-12-08 | 北京云迹科技有限公司 | 机器人驱动方法、装置、存储介质及机器人 |
CN111842556B (zh) * | 2020-07-14 | 2022-04-26 | 深圳市汇川技术股份有限公司 | 折弯机主轴速度控制方法、折弯机及可读存储介质 |
CN112428301B (zh) * | 2020-09-28 | 2023-09-26 | 重庆瑞普机器人研究院有限责任公司 | 一种移动机器人的急刹冲击力计算方法 |
CN112636658A (zh) * | 2020-12-11 | 2021-04-09 | 广东智源机器人科技有限公司 | 电机变速控制方法、装置、计算机设备和存储介质 |
CN115016559B (zh) * | 2022-08-04 | 2022-12-02 | 深圳市杰美康机电有限公司 | 一种全闭环多路径规划送线方法及装置 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105327976A (zh) * | 2015-11-17 | 2016-02-17 | 重庆纵翼机械制造有限公司 | 能调节输送速度的轴类零件校直装置 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5249118A (en) * | 1991-09-03 | 1993-09-28 | Golden Gate Microsystems Incorporated | Fully adaptive velocity tracking drive control positioning system |
CN206925171U (zh) * | 2017-06-22 | 2018-01-26 | 长春上科机械有限公司 | 一种校直机伺服加载传动机构 |
-
2019
- 2019-01-15 CN CN201910034650.0A patent/CN109856962B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105327976A (zh) * | 2015-11-17 | 2016-02-17 | 重庆纵翼机械制造有限公司 | 能调节输送速度的轴类零件校直装置 |
Non-Patent Citations (1)
Title |
---|
S曲线加减速速度控制新方法;胡磊 等;《组合机床与自动化加工技术》;20100131(第1期);第22-26、34页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109856962A (zh) | 2019-06-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109856962B (zh) | 一种智能圆轴类校直机主轴自适应速度控制方法 | |
CN107850887B (zh) | S型曲线规划方法、装置及数控机床 | |
CN101699763B (zh) | 交流永磁同步电机伺服***的转动惯量辨识方法 | |
CN101853013B (zh) | 一种用于数控机床高速加工的加减速控制方法 | |
CN110109490A (zh) | 一种步进电机驱动机头的自适应速度控制方法 | |
CN106444645A (zh) | 一种基于嵌入式裁床控制器的多轴联动运动控制方法 | |
CN106341063B (zh) | 步进电机加减速控制方法 | |
CN109940609B (zh) | 一种基于中心对称静摩擦模型的机器人动力学建模方法 | |
CN108396451B (zh) | 一种智能手套机滚筒选针的离散速度控制方法 | |
CN113489393B (zh) | 一种永磁式步进电机细分驱动方法 | |
CN105591586B (zh) | 电动机控制装置 | |
CN108319300A (zh) | 执行机构的运行控制方法及装置 | |
CN105629882A (zh) | 一种用于样条插补的三角函数速度规划方法 | |
CN105511510A (zh) | 仓储安全距离的扫描监测***及其定位控制方法 | |
CN105717873A (zh) | 一种基于模板缝纫机控制器的自动送料速度控制方法 | |
CN101689824B (zh) | 通过驱动分段的行程来校准步进电动机 | |
CN101699764A (zh) | 交流永磁同步电机伺服***的转动惯量辨识器 | |
CN109508050B (zh) | 一种自动点钻机速度控制方法 | |
CN109842333B (zh) | 一种基于摇杆的步进电机阶梯速度控制方法 | |
CN113359620B (zh) | 一种用于轴运动的软限位控制方法及基于rtx64的开放式运动控制器 | |
CN112302917A (zh) | 游梁式抽油机辅助平衡重调平衡方法及控制装置 | |
CN115070762A (zh) | 一种高速分拣机器人的非对称s型速度曲线规划方法 | |
CN101635551A (zh) | 无齿轮步进电机在仪表应用上的控制方法 | |
JP3657718B2 (ja) | 制御システムおよび制御システムにおける加速度パターンの設定方法およびパラメータ設定方法 | |
CN112654229A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |