CN114115125B - 预算轴定位过程的方法 - Google Patents

预算轴定位过程的方法 Download PDF

Info

Publication number
CN114115125B
CN114115125B CN202111394084.8A CN202111394084A CN114115125B CN 114115125 B CN114115125 B CN 114115125B CN 202111394084 A CN202111394084 A CN 202111394084A CN 114115125 B CN114115125 B CN 114115125B
Authority
CN
China
Prior art keywords
equal
shaft
displacement
acceleration
positioning
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
Application number
CN202111394084.8A
Other languages
English (en)
Other versions
CN114115125A (zh
Inventor
杨长林
黄龙腾
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yunnan Baitong Electronics Co ltd
Original Assignee
Yunnan Baitong Electronics Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Yunnan Baitong Electronics Co ltd filed Critical Yunnan Baitong Electronics Co ltd
Priority to CN202111394084.8A priority Critical patent/CN114115125B/zh
Publication of CN114115125A publication Critical patent/CN114115125A/zh
Application granted granted Critical
Publication of CN114115125B publication Critical patent/CN114115125B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/408Numerical 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 data handling or data format, e.g. reading, buffering or conversion of data
    • G05B19/4086Coordinate conversions; Other special calculations
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/11Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/35Nc in input of data, input till input file format
    • G05B2219/35356Data handling

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Mathematical Optimization (AREA)
  • Pure & Applied Mathematics (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Theoretical Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • Manufacturing & Machinery (AREA)
  • Operations Research (AREA)
  • Algebra (AREA)
  • Human Computer Interaction (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position Or Direction (AREA)

Abstract

本发明公开了预算轴定位过程的方法,涉及伺服控制技术领域。本发明预算轴定位过程的方法,其中算法建模步骤和算法应用步骤:算法应用步骤包括,从轴先随主轴位移同步转动,建立二者角度坐标;从轴依据主轴和从轴各自相对于其零位的角度及工艺要求的主/从轴间对齐角度,计算出从轴轴定位编码器计量的角度对齐行程;调用算法模型,预算出角度对齐累计位移过程曲线;计算出对应的角度对齐位移增量;与主轴同步位移增量相加,作为从轴位移同步增量设定值,实现角度对齐或对齐偏差修正功能;完成。本发明预算轴定位过程的算法在位移同步运行过程中,实现基于位移同步控制的角度对齐或角度对齐偏差修正功能。

Description

预算轴定位过程的方法
技术领域
本发明涉及伺服控制技术领域,特别是涉及预算轴定位过程的方法。
背景技术
伺服驱动器又称为“伺服控制器”、“伺服放大器”,是用来控制伺服电机的一种控制器,其作用类似于变频器作用于普通交流马达,属于伺服系统的一部分,主要应用于高精度的定位系统,一般是通过位置、速度和力矩三种方式对伺服电机进行控制,实现高精度的传动系统定位,是传动技术的高端产品,伺服驱动器是现代运动控制的重要组成部分,被广泛应用于工业机器人及数控加工中心等自动化设备中;
目前的伺服控制器不公开其内部预算轴定位过程的方法模型等核心技术,部分厂家的伺服控制器缺少基于位移同步控制的轴定位(角度对齐或角度对齐偏差修正)功能;因此,我们提出预算轴定位过程的方法。
发明内容
本发明的目的在于提供预算轴定位过程的方法,通过研发预算轴定位过程算法模型,在应用层面或集成于伺服控制器中,实现基于位移同步控制器的轴定位(角度对齐或角度对齐偏差修正)功能,以解决上述背景中提出的问题。
为解决上述技术问题,本发明是通过以下技术方案实现的:
本发明为预算轴定位过程的方法,包括算法建模和算法应用步骤:
算法建模步骤如下:
步骤1:用解析几何方法建立描述量化轴定位连续平滑速度过程的基本方程式X2*(X+1)=S*N/A/2;其中:X为一段变加速度段所用的单位时间数,轴定位速度过程由4个相互对称的变加速度段包围,成为轴定位速度连续平滑变化的基础;X≥1,预算速度过程肯定连续平滑,即要求S*N/A≥2,S为轴定位行程,A为轴定位最大加速度,N为等分加速度A的份数,用于计算变加速度段速变过程。
步骤2:模型参数A≥1rpm,X≥1和定位行程S≥1Incr给定,可算出N值;若N<X*A/Ta,则N=X*A/Ta;受加速度约束,若X>N,则X=N;受速度Xm*(Xm+1)*A/N≤V约束,若X>Xm,则X=Xm;模型参数Ta≥0.2ms为单位计算时间;X和N确定,可计算变加速度部分实际行程Sx=2*X2*(X+1)*A/N,实际最大加速度Ax=X*A/N。
步骤3:建立匀加速部分方程式Y2+(3X+1)*Y=Sy*N/A/X;Sy=S-Sx,如Sy>1,N、A、X已定,求解Y;Y≥0,以Ax≤A恒加速度速变,受速度X*(X+1)*A/N+X*Ym*A/N≤V约束,若Y>Ym,则Y=Ym。
步骤4:建立匀速部分方程式Z*X*(X+Y+1)*A/N=Sz;Sz=S-Sx-Sy,如Sz≥X*(X+Y+1)*A/N/2,四舍五入计算Z。
步骤5:M=X+Y+Z,得到轴定位连续平滑速度过程离散数组元素总数;按组成轴定位连续平滑速度过程的7段速度变化分别计算加速度离散数组元素值Ai;速度离散数组元素值Vi=∑Ai;位移过程离散数组元素值Si=∑Vi,1≤i≤M;计算过程平差比例系数c=S/Sm,遍乘位移过程离散数组元素Si,不改预算的轴定位速度过程的连续平滑特征。
算法应用步骤如下:
应用步骤6:从轴先随主轴位移同步转动,一旦主轴与从轴分别检测到轴编码器零位信号,则二者角度坐标建立;
应用步骤7:从轴依据主轴和从轴各自相对于其零位的角度及工艺要求的主/从轴间对齐角度,计算出从轴轴定位编码器计量的角度对齐行程;
应用步骤8:调用算法模型,预算出角度对齐累计位移过程曲线;
应用步骤9:从轴在每个同步计算时段,从预算的角度对齐累计位移过程曲线查出对应位移量,计算出对应的角度对齐位移增量;
应用步骤10:基于上述步骤,与主轴同步位移增量相加,作为从轴位移同步增量设定值,实现角度对齐或对齐偏差修正功能;
应用步骤11:完成预算轴定位过程。
优选地,所述算法模型中X2*(X+1)=C一元三次方程计算机最简求解近似解。
优选地,所述算法在轴定位行程已知,且最大定位加速度和最高定位速度约束下,利用算法模型,预算出满足精度要求的连续平滑且平缓度受控的速度过程和位移累计过程。
优选地,所述算法通过Excel的VB编程算法模型进行验算,满足应用要求。
本发明具有以下有益效果:
本发明预算轴定位过程的方法,既可集成在伺服控制器中,也能在应用层面实现基于位移同步的角度对齐或角度对齐偏差修正功能,本方案是在多年全数字驱动控制应用的基础上摸索研发的算法方案。
本发明预算轴定位过程的方法,叠加在位移同步速度过程上的角度对齐速度过程是连续平滑的,能够通过整定轴定位算法模型参数(最大加速度和最高速度等),控制平缓度。
当然,实施本发明的任一产品并不一定需要同时达到以上所述的所有优点。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例描述所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明的预算轴定位过程的方法建模步骤流程图;
图2为本发明的预算轴定位过程的方法应用步骤流程图;
图3为本发明预算轴定位过程的方法升/降速过程对称的轴定位连续平滑速度过程离散示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
实施例1
请参阅图1-2所示:本发明为预算轴定位过程的方法,包括算法建模和算法应用步骤:
算法建模步骤如下:
步骤1:用解析几何方法建立描述量化轴定位连续平滑速度过程的基本方程式X2*(X+1)=S*N/A/2;其中:X为一段变加速度段所用的单位时间数,轴定位速度过程由4个相互对称的变加速度段包围,成为轴定位速度连续平滑变化的基础;X≥1,预算速度过程肯定连续平滑,即要求S*N/A≥2。S为轴定位行程,A为轴定位最大加速度,N为等分加速度A的份数,用于计算变加速度段速变过程。
步骤2:模型参数A≥1rpm,X≥1和定位行程S≥1Incr给定,可算出N值;若N<X*A/Ta,则N=X*A/Ta;受加速度约束,若X>N,则X=N;受速度Xm*(Xm+1)*A/N≤V约束,若X>Xm,则X=Xm;模型参数Ta≥0.2ms为单位计算时间;X和N确定,可计算变加速度部分实际行程Sx=2*X2*(X+1)*A/N,实际最大加速度Ax=X*A/N。
步骤3:建立匀加速部分方程式Y2+(3X+1)*Y=Sy*N/A/X;Sy=S-Sx,如Sy>1,N、A、X已定,求解Y;Y≥0,以Ax≤A恒加速度速变,受速度X*(X+1)*A/N+X*Ym*A/N≤V约束,若Y>Ym,则Y=Ym。
步骤4:建立匀速部分方程式Z*X*(X+Y+1)*A/N=Sz;Sz=S-Sx-Sy,如Sz≥X*(X+Y+1)*A/N/2,四舍五入计算Z。
步骤5:M=X+Y+Z,得到轴定位连续平滑速度过程离散数组元素总数;按组成轴定位连续平滑速度过程的7段速度变化分别计算加速度离散数组元素值Ai;速度离散数组元素值Vi=∑Ai;位移过程离散数组元素值Si=∑Vi,1≤i≤M;计算过程平差比例系数c=S/Sm,遍乘位移过程离散数组元素Si,不改预算的轴定位速度过程的连续平滑特征。
算法应用步骤如下:
应用步骤6:从轴先随主轴位移同步转动,一旦主轴与从轴分别检测到轴编码器零位信号,则二者角度坐标建立;
应用步骤7:从轴依据主轴和从轴各自相对于其零位的角度及工艺要求的主/从轴间对齐角度,计算出从轴轴定位编码器计量的角度对齐行程;
应用步骤8:调用算法模型,预算出角度对齐累计位移过程曲线;
应用步骤9:从轴在每个同步计算时段,从预算的角度对齐累计位移过程曲线查出对应位移量,计算出对应的角度对齐位移增量;
应用步骤10:基于上述步骤,与主轴同步位移增量相加,作为从轴位移同步增量设定值,实现角度对齐或对齐偏差修正功能;
应用步骤11:完成预算轴定位过程。
实施例2
本方案技术改进如下:①、算法模型中X2*(X+1)=C一元三次方程计算机最简求解近似解;②、在轴定位行程已知,且最大定位加速度和最高定位速度约束下,利用算法模型,预算出满足精度要求的连续平滑且平缓度受控的速度过程和位移累计过程;③、过程平差处理。
本方案通过Excel的VB编程算法模型进行验算,满足应用要求。
本方案中:
①升/降速过程对称的轴定位连续平滑速度过程离散示意如图3所示:
②A段:加速度Ai=i*A/N,速度Vi=i*(i+1)*A/N/2,0≤Ai≤A,Vi<V
③B段:加速度Ai=Ai-1+A/N,速度Vi=Vi-1+Ai,0≤Ai≤A,Vi<V
④C段:加速度Ai=Ai-1-A/N,速度Vi=Vi-1+Ai,0≤Ai≤A,Vi<V
⑤D段:加速度Ai=0,速度Vi=Vi-1,0≤Ai≤A,Vi<V
⑥轴定位行程=速度过程与横坐标i包围的面积。
⑦模型参数N≥1,A>0,V>0,单位时间t是最小同步时段的整数倍。
模型参数A,V越小,过程越平缓,用时自动加长;模型参数N越大,小行程的轴定位预算精度越高。
在本说明书的描述中,参考术语“一个实施例”、“示例”、“具体示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上公开的本发明优选实施例只是用于帮助阐述本发明。优选实施例并没有详尽叙述所有的细节,也不限制该发明仅为所述的具体实施方式。显然,根据本说明书的内容,可作很多的修改和变化。本说明书选取并具体描述这些实施例,是为了更好地解释本发明的原理和实际应用,从而使所属技术领域技术人员能很好地理解和利用本发明。本发明仅受权利要求书及其全部范围和等效物的限制。

Claims (6)

1.预算轴定位过程的方法,其特征在于,所述预算轴定位过程的方法,包括算法建模步骤和算法应用步骤:
所述算法建模步骤如下:
步骤1:用解析几何方法建立描述量化轴定位连续平滑速度过程的基本方程式X2*(X+1)=S*N/A/2,其中:X为一段变加速度段所用的单位时间数,轴定位速度过程由4个相互对称的变加速度段包围,成为轴定位速度连续平滑变化的基础;X≥1,预算速度过程肯定连续平滑,即要求S*N/A≥2,S为轴定位行程,A为轴定位最大加速度,N为等分加速度A的份数;
步骤2:模型参数A≥1rpm,X≥1和定位行程S≥1Incr给定,算出N值,若N<X*A/Ta,则N=X*A/Ta;受加速度约束,若X>N,则X=N;受速度Xm*(Xm+1)*A/N≤V约束,若X>Xm,则X=Xm;模型参数Ta≥0.2ms为单位计算时间;X和N确定,可计算变加速度部分实际行程Sx=2*X2*(X+1)*A/N,实际最大加速度Ax=X*A/N;
步骤3:建立匀加速部分方程式Y2+(3X+1)*Y=Sy*N/A/X,Sy=S-Sx,如Sy>1,N、A、X已定,求解Y;Y≥0,以Ax≤A恒加速度速变,受速度X*(X+1)*A/N+X*Ym*A/N≤V约束,若Y>Ym,则Y=Ym;
步骤4:建立匀速部分方程式Z*X*(X+Y+1)*A/N=Sz,Sz=S-Sx-Sy,如Sz≥X*(X+Y+1)*A/N/2,四舍五入计算Z;
步骤5:M=X+Y+Z,得到轴定位连续平滑速度过程离散数组元素总数,按组成轴定位连续平滑速度过程的7段速度变化分别计算加速度离散数组元素值Ai;速度离散数组元素值Vi=∑Ai;位移过程离散数组元素值Si=∑Vi,1≤i≤M;计算过程平差比例系数c=S/Sm,遍乘位移过程离散数组元素Si,不改预算的轴定位速度过程的连续平滑特征;
所述算法应用步骤如下:
步骤6:从轴先随主轴位移同步转动,一旦主轴与从轴分别检测到轴编码器零位信号,则二者角度坐标建立;
步骤7:从轴依据主轴和从轴各自相对于其零位的角度及工艺要求的主/从轴间对齐角度,计算出从轴轴定位编码器计量的角度对齐行程;
步骤8:调用算法模型,预算出角度对齐累计位移过程曲线;
步骤9:从轴在每个同步计算时段,从预算的角度对齐累计位移过程曲线查出对应位移量,计算出对应的角度对齐位移增量;
步骤10:基于上述步骤,与主轴同步位移增量相加,作为从轴位移同步增量设定值,实现角度对齐或对齐偏差修正功能;
步骤11:完成预算轴定位过程。
2.根据权利要求1所述的预算轴定位过程的方法,其特征在于,所述步骤1中X为一段变加速度段所用的单位时间数,轴定位速度过程由4个相互对称的变加速度段包围,成为轴定位速度连续平滑变化的基础;X≥1,预算速度过程肯定连续平滑,即要求S*N/A≥2;S为轴定位行程,A为轴定位最大加速度,N为等分加速度A的份数,用于计算变加速度段速变过程。
3.根据权利要求1所述的预算轴定位过程的方法,其特征在于,所述步骤5中按组成轴定位连续平滑速度过程的7段速度变化分别计算加速度离散数组元素值Ai;速度离散数组元素值Vi=∑Ai;位移过程离散数组元素值Si=∑Vi,1≤i≤M;计算过程平差比例系数c=S/Sm,遍乘位移过程离散数组元素Si,不改预算的轴定位速度过程的连续平滑特征。
4.根据权利要求1所述的预算轴定位过程的方法,其特征在于,所述算法模型中X2*(X+1)=C一元三次方程计算机最简求解近似解。
5.根据权利要求2所述的预算轴定位过程的方法,其特征在于,所述算法在轴定位行程已知,且最大定位加速度和最高定位速度约束下,利用算法模型,预算出满足精度要求的连续平滑且平缓度受控的速度过程和位移累计过程。
6.根据权利要求1所述的预算轴定位过程的方法,其特征在于,所述算法通过Exce l的VB编程算法模型进行验算,满足应用要求。
CN202111394084.8A 2021-11-23 2021-11-23 预算轴定位过程的方法 Active CN114115125B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111394084.8A CN114115125B (zh) 2021-11-23 2021-11-23 预算轴定位过程的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111394084.8A CN114115125B (zh) 2021-11-23 2021-11-23 预算轴定位过程的方法

Publications (2)

Publication Number Publication Date
CN114115125A CN114115125A (zh) 2022-03-01
CN114115125B true CN114115125B (zh) 2024-01-12

Family

ID=80440127

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111394084.8A Active CN114115125B (zh) 2021-11-23 2021-11-23 预算轴定位过程的方法

Country Status (1)

Country Link
CN (1) CN114115125B (zh)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108983705A (zh) * 2018-08-16 2018-12-11 居鹤华 一种基于轴不变量的多轴机器人系统正运动学建模与解算方法
CN109799778A (zh) * 2019-01-17 2019-05-24 深圳市显控科技股份有限公司 一种电子凸轮曲线生成方法及相关装置
CN110214241A (zh) * 2016-12-22 2019-09-06 伊顿康明斯自动传输技术有限责任公司 用于操作高效率、高输出变速器的系统、方法和设备
CN113561911A (zh) * 2021-08-12 2021-10-29 森思泰克河北科技有限公司 车辆控制方法、装置、毫米波雷达及存储介质

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110214241A (zh) * 2016-12-22 2019-09-06 伊顿康明斯自动传输技术有限责任公司 用于操作高效率、高输出变速器的系统、方法和设备
CN108983705A (zh) * 2018-08-16 2018-12-11 居鹤华 一种基于轴不变量的多轴机器人系统正运动学建模与解算方法
CN109799778A (zh) * 2019-01-17 2019-05-24 深圳市显控科技股份有限公司 一种电子凸轮曲线生成方法及相关装置
CN113561911A (zh) * 2021-08-12 2021-10-29 森思泰克河北科技有限公司 车辆控制方法、装置、毫米波雷达及存储介质

Also Published As

Publication number Publication date
CN114115125A (zh) 2022-03-01

Similar Documents

Publication Publication Date Title
CN101493687B (zh) 实时前瞻全程加减速控制的nurbs曲线自适应分段插补方法
Yau et al. Fast Bezier interpolator with real-time lookahead function for high-accuracy machining
CN1149918A (zh) 一种补偿机器轴非线性的装置
CN111913441B (zh) 一种基于轨迹模式的拐角平滑过渡方法
Zhong et al. A real-time interpolator for parametric curves
Jin et al. A fine-interpolation-based parametric interpolation method with a novel real-time look-ahead algorithm
JPH08179831A (ja) フルクローズド・ループ方式における象限突起補正方法
CN102049717A (zh) 一种数控成形高次非球面控制方法及硬件系统
US5070287A (en) Method for a numerical positioning control system
CN103149879B (zh) 一种基于弧长的数控系统椭圆插补方法
CN114115125B (zh) 预算轴定位过程的方法
JP7382537B2 (ja) スマートコーナ切断のための方法、コンピュータプログラムおよびレーザ切断システム
CN112549027B (zh) 一种笛卡尔空间与关节空间曲线平滑过渡方法及装置
Li et al. Accurate interpolation and contouring control algorithm based on FIR filters for the corner transition
CN112865750A (zh) 基于fir滤波器的数控系统倍率变化平滑控制方法及装置
CN114326842A (zh) 驱动装置的控制方法及装置、无人设备的控制方法
CN102082545B (zh) 马达速度控制器及其控制方法
CN108762064B (zh) 一种伺服驱动器的速度平滑方法
KR970002259B1 (ko) 서보모터의 제어방법
CN114019911B (zh) 一种基于速度规划的曲线拟合方法
CN110355780A (zh) 一体化柔性机器人关节的输出力矩计算方法
CN115453968A (zh) 一种数控凸轮磨削加工的速度规划控制方法及系统
JP7109490B2 (ja) 数値制御方法及び数値制御装置
CN113467466A (zh) 一种工业机器人控制方法、装置及工业机器人
JP2737725B2 (ja) ロボット制御装置及び方法

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