CN111061216A - 基于二元样条尺度函数的贴片机运动***智能控制方法 - Google Patents
基于二元样条尺度函数的贴片机运动***智能控制方法 Download PDFInfo
- Publication number
- CN111061216A CN111061216A CN201911384138.5A CN201911384138A CN111061216A CN 111061216 A CN111061216 A CN 111061216A CN 201911384138 A CN201911384138 A CN 201911384138A CN 111061216 A CN111061216 A CN 111061216A
- Authority
- CN
- China
- Prior art keywords
- function
- chip mounter
- binary
- spline
- motion system
- 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
Images
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/19—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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
-
- 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/35349—Display part, programmed locus and tool path, traject, dynamic locus
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
Abstract
基于二元样条尺度函数的贴片机运动***智能控制方法,本发明涉及一种贴片机运动***的模型辨识及智能控制方法。本发明的目的是为了解决现有技术中贴片机运动***模型和参数(***模型中的质量、摩擦系数、粘滞阻力系数等参数)未知的情况下跟踪精度低的问题;具体过程为:建立贴片机运动***的动力学模型;构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架;根据建立的框架,选择合适的尺度,对建立的模型中的未建模动态项进行函数逼近;根据建立的模型和逼近函数,设计智能控制算法,使贴片机运动***跟踪精度得到提高。本发明属于贴片机运动***的轨迹跟踪控制领域。
Description
技术领域
本发明涉及贴片机运动***的轨迹跟踪控制领域,特别涉及贴片机运动***的模型辨识及智能控制方法。
背景技术
贴片机运动***是一个非常复杂的机械***,因此在建立贴片机运动***的数学模型时往往会忽略一些非主要力,例如只考虑粘滞阻力和库仑摩擦力,不考虑其他形式的阻力对贴片机平台运动产生的影响;忽略有效电磁驱动力中的高阶项和***中的一些柔性特性;将定位力化简为随位置变化的周期函数或直接忽略定位力对***模型的影响等。这些被忽略掉的动态模型往往在贴片机***高速运动时对***的跟踪性能产生很大的影响,导致贴片机运动***的跟踪性能下降,进一步影响产品质量。除此之外,利用神经网络控制方法虽然能够提高***的精度,但是巨大的计算量使得这种方法难以实现实时控制。为了保证***实时控制并且进一步提高贴片机运动***的跟踪性能,需要提出一种基于二元样条尺度函数的智能控制方法。
发明内容
本发明的目的是为了解决现有技术中贴片机运动***模型和参数(***模型中的质量、摩擦系数、粘滞阻力系数等参数)未知的情况下跟踪精度低的问题,而提出基于二元样条尺度函数的智能控制方法。
基于二元样条尺度函数的贴片机运动***智能控制方法,包括以下步骤:
步骤一、建立贴片机运动***沿横轴或纵轴运动的动力学模型,其中横轴用x来表示,纵轴用y来表示;
根据牛顿运动学第二定律,建立贴片机动平台沿横轴或纵轴方向运动时的动力学方程:
其中,M为贴片机运动平台的质量,t表示时间,x(t)为贴片机运动平台在t时刻的位移,为x(t)的一阶导数,表示贴片机运动平台在t时刻的运动速度,为x(t)的二阶导数,表示贴片机运动平台在t时刻的加速度,u(t)为贴片机运动***在t时刻的控制输入, B为贴片机运动平台的粘滞摩擦系数,Af为贴片机运动平台的库仑摩擦系数,表示库伦摩擦函数,C0表示贴片机运动***模型中的常数项,为贴片机运动***的未建模动态;
步骤二、构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架:
步骤三、根据步骤二中建立的框架,选择尺度,对步骤一中建立的模型中的未建模动态项进行函数逼近;
步骤四、根据步骤一中建立的模型以及步骤三中的逼近函数,设计智能控制算法。
本发明的有益效果为:
本发明方法是通过利用二元样条尺度函数的平移和伸缩变换得到的基函数来对贴片机运动***中的未建模信息进行函数拟合,从而对其进行控制器设计,实现了在贴片机运动***模型及参数未知的情况下的高精度跟踪,采用本发明设计的参考调节器,有效的解决了贴片机运动***在模型及参数(***模型中的质量、摩擦系数、粘滞阻力系数等参数) 未知的情况下高精度跟踪目标轨迹的问题,实现了贴片机运动平台的实时跟踪。图1、图 2、和图3分别给出的是采用基于二元样条尺度函数的智能控制器对贴片机运动***进行控制后的平台运动轨迹、跟踪误差以及控制输入大小,图4、图5、和图6分别给出的是采用传统鲁棒控制器对贴片机运动***进行控制后的平台运动轨迹、跟踪误差以及控制输入大小,可以看出在同一组控制器增益参数下,与传统鲁棒控制器相比基于二元样条尺度函数的智能控制方法最终的控制效果更好,精度更高。
附图说明
图1为采用基于二元样条尺度函数的智能控制器对贴片机运动***进行控制后的平台运动轨迹;
图2为采用基于二元样条尺度函数的智能控制器对贴片机运动***进行控制后的平台跟踪误差;
图3为采用基于二元样条尺度函数的智能控制器对贴片机运动***进行控制后的平台控制输入大小;
图4为采用鲁棒控制器对贴片机运动***进行控制后的平台运动轨迹;
图5为采用鲁棒控制器对贴片机运动***进行控制后的平台跟踪误差;
图6为采用鲁棒控制器对贴片机运动***进行控制后的平台控制输入大小。
具体实施方式
具体实施方式一:基于二元样条尺度函数的贴片机运动***的智能控制方法,包括以下步骤:
步骤一、建立贴片机运动***沿横轴或纵轴运动的动力学模型,其中横轴用x来表示,纵轴用y来表示;具体过程为:
仅考虑贴片机运动平台受到的粘滞摩擦力和库伦摩擦力,将贴片机运动***中其他未考虑到的模型信息等归为***的未建模动态,根据牛顿第二定律,建立贴片机动平台沿横轴方向或纵轴方向运动时的动力学方程,不失一般性,我们在考虑贴片机运动***沿横轴方向运动的动力学模型:
其中,M为贴片机运动平台的质量,t表示时间,x(t)为贴片机运动平台在t时刻的位移,为x(t)的一阶导数,表示贴片机运动平台在t时刻的运动速度,为x(t)的二阶导数,表示贴片机运动平台在t时刻的加速度,u(t)为贴片机运动***在t时刻的控制输入, B为贴片机运动平台的粘滞摩擦系数,Af为贴片机运动平台的库仑摩擦系数,表示库伦摩擦函数,C0表示贴片机运动***模型中的常数项,为贴片机运动***的未建模动态;
步骤二、构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架:
步骤三、根据步骤二中建立的框架,选择尺度,对步骤一中建立的模型中的未建模动态项进行函数逼近;
步骤四、根据步骤一中建立的模型以及步骤三中的逼近函数,设计智能控制算法,使贴片机运动***跟踪精度得到提高。
具体实施方式二:本实施方式与具体实施方式一不同的是:所述步骤二构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架;具体过程为:
根据构造的一元样条尺度函数,构造二元样条尺度函数如下:
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是:所述步骤三根据步骤二中建立的框架,选择合适的尺度,对步骤一中建立的模型中的未建模动态项进行函数逼近;具体过程为:
是平方可积函数空间上的一个框架,因此可以任意精度逼近未建模动态并且逼近精度只与尺度参数j的选择有关,当j→-∞时逼近精度会趋向于0,但会导致占用大量的储存空间,因此根据贴片机运动***的运行环境和性能要求等具体情况,选择合适的尺度参数j,使得逼近误差对***的控制性能影响远远小于测量噪声(传感器在测量平台位置、速度等信息时的噪声(误差))的影响即可,取函数族(这里没有对j的取值范围做出限定,实际上是中的子集,称其为函数族,而不是平方可积函数空间上的框架) 为基函数,记Vj为由函数族张成的函数空间,则未建模动态在Vj上的投影为:
将贴片机运动***模型进一步简化,得到:
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:所述步骤四根据步骤一中建立的模型以及步骤三中的逼近函数(步骤三中所述的平方可积函数空间上的一个框架),设计智能控制算法,使贴片机运动***跟踪精度得到提高;具体过程为:
假设贴片机运动平台的目标运动轨迹为xr(t),记e(t)为贴片机运动平台的跟踪误差,为贴片机运动***设计智能控制器如下:
其中,ua(t)为智能控制器中的前馈补偿项,us(t)为智能控制器中的反馈补偿项,表示t时刻时对M的估计值,表示t时刻时对W向量的估计向量,k1,k2>0,k1,k2为两个控制器参数,用来调整控制器增益大小,表示e(t)关于时间t的一阶导数,表示xr(t)关于时间t的一阶导数;
其它步骤及参数与具体实施方式一至三之一相同。
采用以下实施例验证本发明的有益效果:
实施例一:
所得到的由控制器和贴片机运动***组成的闭环控制***框图如图1所示。分别将所设计的基于二元样条尺度函数的智能控制器和鲁棒控制器应用到贴片机运动***上,取采样时间为0.125ms,参考轨迹为r(t)=100(1-cos(12.56t))(1-e-t),控制器增益参数为:k1=1000,k2=500。针对二元样条小波函数,取参数权值更新律步长为γM=10,Γ=5I,其中I为单位矩阵,图1和图4分别是两种控制方法下平台的运动轨迹,图2和图5分别是两种控制方法下平台的轨迹跟踪误差,图3和图6分别是两种控制方法下平台控制输入的大小,从实验结果中可以看出,在同一组控制器增益参数下,与传统鲁棒控制器相比基于二元样条尺度函数的智能控制方法最终的控制效果会更好,精度更高。
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (4)
1.基于二元样条尺度函数的贴片机运动***智能控制方法,其特征在于:所述基于样条二元样条尺度函数的贴片机运动***的智能控制方法包括以下步骤:
步骤一、建立贴片机运动***沿横轴或纵轴运动的动力学模型,其中横轴用x来表示,纵轴用y来表示;
根据牛顿运动学第二定律,建立贴片机动平台沿横轴或纵轴方向运动时的动力学方程:
其中,M为贴片机运动平台的质量,t表示时间,x(t)为贴片机运动平台在t时刻的位移,为x(t)的一阶导数,表示贴片机运动平台在t时刻的运动速度,为x(t)的二阶导数,表示贴片机运动平台在t时刻的加速度,u(t)为贴片机运动***在t时刻的控制输入,B为贴片机运动平台的粘滞摩擦系数,Af为贴片机运动平台的库仑摩擦系数,表示库伦摩擦函数,C0表示贴片机运动***模型中的常数项,为贴片机运动***的未建模动态;
步骤二、构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架:
步骤三、根据步骤二中建立的框架,选择尺度,对步骤一中建立的模型中的未建模动态项进行函数逼近;
步骤四、根据步骤一中建立的模型以及步骤三中的逼近函数,设计智能控制算法。
2.根据权利要求1所述基于二元样条尺度函数的贴片机运动***的智能控制方法,其特征在于,所述步骤二构造二元样条尺度函数,并将其进行平移和伸缩变换,建立二元平方可积函数空间上的框架;具体过程为:
根据构造的一元样条尺度函数,构造二元样条尺度函数如下:
3.根据权利要求2所述的基于二元样条尺度函数的贴片机运动***的智能控制方法,其特征在于:所述步骤三根据步骤二中建立的框架,选择合适的尺度,对步骤一中建立的模型中的未建模动态项进行函数逼近;具体过程为:
将贴片机运动***模型进一步简化,得到:
4.根据权利要求3所述的基于二元样条尺度函数的贴片机运动***的智能控制方法,其特征在于:所述步骤四根据步骤一中建立的模型以及步骤三中的逼近函数,设计智能控制算法;具体过程为:
假设贴片机运动平台的目标运动轨迹为xr(t),记e(t)为贴片机运动平台的跟踪误差,为贴片机运动***设计智能控制器如下:
其中,ua(t)为智能控制器中的前馈补偿项,us(t)为智能控制器中的反馈补偿项,表示t时刻时对M的估计值,表示t时刻时对W向量的估计向量,k1,k2>0,k1,k2为两个控制器参数,用来调整控制器增益大小,表示e(t)关于时间t的一阶导数,表示xr(t)关于时间t的一阶导数;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911384138.5A CN111061216B (zh) | 2019-12-28 | 2019-12-28 | 基于二元样条尺度函数的贴片机运动***智能控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911384138.5A CN111061216B (zh) | 2019-12-28 | 2019-12-28 | 基于二元样条尺度函数的贴片机运动***智能控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111061216A true CN111061216A (zh) | 2020-04-24 |
CN111061216B CN111061216B (zh) | 2022-11-15 |
Family
ID=70304327
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911384138.5A Active CN111061216B (zh) | 2019-12-28 | 2019-12-28 | 基于二元样条尺度函数的贴片机运动***智能控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111061216B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111273552A (zh) * | 2020-03-16 | 2020-06-12 | 哈尔滨工业大学 | 一种基于数学模型的贴片机运动控制方法及*** |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100030532A1 (en) * | 2008-06-12 | 2010-02-04 | Jasbir Arora | System and methods for digital human model prediction and simulation |
CN105773628A (zh) * | 2014-12-17 | 2016-07-20 | 齐鲁工业大学 | 一种led芯片上蜡机器人喷蜡控制方法 |
CN106054884A (zh) * | 2016-06-16 | 2016-10-26 | 哈尔滨工程大学 | 基于神经网络的l1自适应船舶动力定位双环控制*** |
CN106406085A (zh) * | 2016-03-15 | 2017-02-15 | 吉林大学 | 基于跨尺度模型的空间机械臂轨迹跟踪控制方法 |
CN107272422A (zh) * | 2017-08-10 | 2017-10-20 | 哈尔滨工业大学 | 基于参考调节器的贴片机驱动***的多变量约束控制方法 |
CN107450316A (zh) * | 2017-08-10 | 2017-12-08 | 哈尔滨工业大学 | 贴片机驱动***的采样自适应鲁棒控制方法 |
CN109164699A (zh) * | 2018-08-29 | 2019-01-08 | 浙江工业大学 | 一种贴片机机头运行位置精度控制方法 |
CN110134011A (zh) * | 2019-04-23 | 2019-08-16 | 浙江工业大学 | 一种倒立摆自适应迭代学习反演控制方法 |
-
2019
- 2019-12-28 CN CN201911384138.5A patent/CN111061216B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100030532A1 (en) * | 2008-06-12 | 2010-02-04 | Jasbir Arora | System and methods for digital human model prediction and simulation |
CN105773628A (zh) * | 2014-12-17 | 2016-07-20 | 齐鲁工业大学 | 一种led芯片上蜡机器人喷蜡控制方法 |
CN106406085A (zh) * | 2016-03-15 | 2017-02-15 | 吉林大学 | 基于跨尺度模型的空间机械臂轨迹跟踪控制方法 |
CN106054884A (zh) * | 2016-06-16 | 2016-10-26 | 哈尔滨工程大学 | 基于神经网络的l1自适应船舶动力定位双环控制*** |
CN107272422A (zh) * | 2017-08-10 | 2017-10-20 | 哈尔滨工业大学 | 基于参考调节器的贴片机驱动***的多变量约束控制方法 |
CN107450316A (zh) * | 2017-08-10 | 2017-12-08 | 哈尔滨工业大学 | 贴片机驱动***的采样自适应鲁棒控制方法 |
CN109164699A (zh) * | 2018-08-29 | 2019-01-08 | 浙江工业大学 | 一种贴片机机头运行位置精度控制方法 |
CN110134011A (zh) * | 2019-04-23 | 2019-08-16 | 浙江工业大学 | 一种倒立摆自适应迭代学习反演控制方法 |
Non-Patent Citations (3)
Title |
---|
BIN YAO等: "Adaptive Robust Precision Motion Control of a High-Speed Industrial Gantry With Cogging Force Compensations", 《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》 * |
KUO-HSIANG CHENG: "Self structuring fuzzy-neural backstepping control with a B-spline-based compensator", 《NEUROCOMPUTING》 * |
刘振忠: "多轴联动***的运动规划与结构变形补偿", 《中国博士学位论文全文数据库 工程科技Ⅰ辑》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111273552A (zh) * | 2020-03-16 | 2020-06-12 | 哈尔滨工业大学 | 一种基于数学模型的贴片机运动控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN111061216B (zh) | 2022-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Nguyen-Tuong et al. | Local gaussian process regression for real-time model-based robot control | |
CA2744444C (en) | Movement simulator | |
CN108388114B (zh) | 一种基于输出重定义的柔性机械臂复合控制方法 | |
CN110039542A (zh) | 具有速度方向控制的视觉伺服跟踪控制方法及机器人*** | |
Chen et al. | Observer-based backstepping control of a 6-dof parallel hydraulic manipulator | |
CN102707577B (zh) | 宏微双机构伺服控制***及其控制方法 | |
CN106052986B (zh) | 三向六自由度力位移混合控制方法 | |
Otto et al. | Real-time trajectory control of an overhead crane using servo-constraints | |
CN107577146A (zh) | 基于摩擦整体逼近的伺服***的神经网络自适应控制方法 | |
Wang et al. | Hierarchical sliding-mode control of spatial inverted pendulum with heterogeneous comprehensive learning particle swarm optimization | |
CN110802589A (zh) | 一种工业机器人单关节伺服控制的迟滞补偿方法 | |
CN111061216B (zh) | 基于二元样条尺度函数的贴片机运动***智能控制方法 | |
Hu et al. | Learning and generalization of compensative zero-moment point trajectory for biped walking | |
CN114474078B (zh) | 机械臂的摩擦力补偿方法、装置、电子设备及存储介质 | |
Hosseini et al. | Practical robust nonlinear PD controller for cable-driven parallel manipulators | |
da Silva et al. | Computer-aided integrated design for machines with varying dynamics | |
Helian et al. | Adaptive robust pressure control of variable displacement axial piston pumps with a modified reduced-order dynamic model | |
CN116909137B (zh) | 一种位置误差动态补偿的举升***闭环控制方法及装置 | |
CN114114903B (zh) | 一种基于变指数幂次趋近律的板球***积分终端滑模控制方法 | |
Sahu et al. | Vision‐based tip position tracking control of two‐link flexible manipulator | |
Huang et al. | Forwarding‐based dynamic surface control for antagonistic actuated robots | |
Liu et al. | Data learning‐based model‐free adaptive control and application to an NAO robot | |
CN114839874A (zh) | 一种面向***模型部分未知的平行控制方法及*** | |
Xie et al. | Vision-based trajectory tracking control of a pneumatic muscle actuator using a modified asymmetric generalized Prandtl-Ishlinskii model | |
Lu et al. | Research on Adaptive Robust Control Algorithm for Delta Parallel Robots |
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 |