贴片机双驱龙门平台的多轴协同控制方法技术

贴片机双驱龙门平台的多轴协同控制方法，涉及贴片机龙门平台的运动控制技术领域。本发明专利技术是为了解决现有贴片机双驱龙门平台控制系统中，由于无法保证电机一致性、机械横梁同步运动与负载定位运动存在耦合动力学关系、以及外界干扰都会对系统的控制造成误差，导致系统不确定性风险高且控制难度大的问题。本发明专利技术所述的贴片机双驱龙门平台的多轴协同控制方法，分别设计期望模型补偿控制器、鲁棒反馈控制器和神经网络控制器，并将设计的控制器输出之和作为贴片机龙门平台的总控制信号，利用该总控制信号对贴片机龙门平台的X轴、Y1轴和Y2轴进行多轴协同控制。行多轴协同控制。行多轴协同控制。

【技术实现步骤摘要】
贴片机双驱龙门平台的多轴协同控制方法


[0001]本专利技术属于贴片机龙门平台的运动控制
，尤其涉及多轴协同控制。

技术介绍

[0002]双驱龙门平台是贴片机中典型的驱动结构，双驱龙门平台具有推力大，负载强，精度高等特点，在现代工业高端制造领域愈加受到关注和应用。在贴片机龙门平台系统中，机械横梁横跨在平台两端并由两直线电机共同驱动以实现Y轴方向进给运动，移动工作台在另一电机驱动下沿横梁所在X轴方向进行定位运动，通过两轴之间的密切配合与协调运动共同完成复杂的生产任务。需要注意的是，相比于工作台的单驱直线运动控制，XY多轴协同运动控制显得更为复杂和重要，其控制精度直接影响着贴片机龙门平台系统的运动性能和加工工艺。因此，研究贴片机双驱龙门平台多轴协同控制问题具有重要的实际意义。
[0003]在整个控制系统中，多个直线电机驱动方式能够使得系统获得较大推力和速度，但同时也给系统增加了不确定性风险和控制难度。这主要是由于两方面因素，其一，现实条件下很难保证三个直线电机具备完全相同的机械参数和机电特性；其二，机械横梁同步运动与负载定位运动相互影响且具有复杂的耦合动力学关系。另外，贴片机龙门平台系统中不可避免会存在参数不确定性及外界未知非线性扰动的问题，例如负载变化，推力波动，测量噪声等，这些都很容易造成较大的运动误差和系统震荡。严重时甚至会导致机械设备损坏，威胁操作人员的生命安全。

技术实现思路

[0004]本专利技术是为了解决现有贴片机双驱龙门平台控制系统中，由于无法保证电机一致性、机械横梁同步运动与负载定位运动存在耦合动力学关系、以及外界干扰都会对系统的控制造成误差，导致系统不确定性风险高且控制难度大的问题，现提供贴片机双驱龙门平台的多轴协同控制方法。
[0005]贴片机双驱龙门平台的多轴协同控制方法，分别设计期望模型补偿控制器、鲁棒反馈控制器和神经网络控制器，并将设计的控制器输出之和作为贴片机龙门平台的总控制信号，利用该总控制信号对贴片机龙门平台的X轴、Y1轴和Y2轴进行多轴协同控制；
[0006]所述期望模型补偿控制器表达式为：
[0007][0008]其中，υ
a
为期望模型补偿控制器的输出，Φ
d
为含有期望信息的回归量矩阵，为的估计值，为贴片机龙门平台系统耦合动力学模型中不确定参数构成的系数矩阵，
[0009][0010]其中，M
hk
为归一化后贴片机中移动工作台的质量，B
xk
为归一化后贴片机龙门平台X轴处的粘滞摩擦系数，A
xk
为归一化后贴片机龙门平台X轴处的库仑摩擦系数，M
yk
为归一化后贴片机龙门平台中横梁的总质量，B
yk
为归一化后贴片机龙门平台Y1轴和Y2轴导轨处的粘
滞摩擦系数之和，A
yk
为归一化后贴片机龙门平台Y1轴和Y2轴导轨处的库仑摩擦系数之和，J
k
为归一化后的转动惯量，K
αk
为归一化后的等效旋转刚度，B
sk
为归一化后贴片机龙门平台Y2轴和Y1轴导轨处的粘滞摩擦系数之差，A
sk
为归一化后贴片机龙门平台Y2轴和Y1轴导轨处的库仑摩擦系数之差，和分别为归一化后贴片机龙门平台X轴和Y轴动力学中非线性扰动的常值，为归一化后贴片机龙门平台旋转动力学中非线性扰动的常值；
[0011]所述鲁棒反馈控制器表达式为：
[0012]υ
e
＝
‑
M
q
Z
‑1G
‑
K
d
s
‑
K
e
ε，
[0013]其中，υ
e
为鲁棒反馈控制器的输出，M
q
为归一化后贴片机龙门平台的惯性矩阵，s为滑模变量，Z＝diag[z1,z2,z3]，
[0014]S
i
为误差转换函数且有：
[0015][0016]ε＝[ε1,ε2,ε3]为无约束的转换误差，中间变量r
i
＝e
i
(t)/ρ
i
(t)，e
i
(t)为t时刻的误差矢量，e
i
(0)为误差矢量初始值，为超调量调节系数，
[0017]ρ
i
为性能函数且表达式如下：
[0018][0019]ρ
i0
为稳态误差初始值，ρ
i∞
为稳态误差最大值，为误差收敛速率，
[0020]λ为控制增益矩阵，K
d
为比例反馈矩阵，K
e
为鲁棒增益矩阵；
[0021]所述神经网络控制器表达式为：
[0022][0023]其中，υ
nn
为神经网络控制器的输出，为神经网络权重矢量，χ为神经网络输入矢量，χ＝[χ1,χ2,...,χ
m
]，m为神经网络的神经元总层数，j＝1,2,...,m，R(χ)为神经网络多层神经元的总输出，η为鲁棒项系数，sign(
·
)表示符号函数；
[0024]所述贴片机龙门平台的总控制信号v＝[v1,v2,v3]：
[0025]v＝υ
a
+υ
e
+υ
nn
。
[0026]进一步的，根据下式利用贴片机龙门平台的总控制信号实现对贴片机龙门平台X轴、Y1轴和Y2轴的协同控制：
[0027][0028]其中，S
m
为贴片机龙门平台横梁两侧电机之间的距离，α为贴片机龙门平台横梁的实际旋转角度，K
xk
为归一化后的X轴电机推力常数，K
my
＝K2/K1，K1和K2分别为贴片机龙门平台Y1轴和Y2轴电机推力常数，u
x
、u1和u2分别为X轴、Y1轴和Y2轴的控制输入。
[0029]进一步的，上述贴片机龙门平台系统耦合动力学模型为：
[0030][0031]其中，C
q
、B
q
、K
q
和A
q
分别为归一化后的科氏力矩阵、粘滞摩擦矩阵、等效刚度矩阵和库伦摩擦矩阵，q为贴片机龙门平台系统状态矢量矩阵且q＝[x(t),y(t),α(t)]，x(t)和y(t)分别为t时刻贴片机龙门平台X轴和Y轴的实际位移，α(t)为t时刻贴片机龙门平台系统横梁的实际旋转角度，和分别为贴片机龙门平台系统轴运动的速度和加速度矢量矩阵，非线性函数非线性函数和分别为归一化后非线性扰动的常值矩阵和时变矩阵。
[0032]进一步的，上述贴片机龙门平台系统的误差矢量e
i
(t)的约束条件为：
[0033][0034]其中，e
i
(t)＝q
‑
q
d
＝[x(t)
‑<本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.贴片机双驱龙门平台的多轴协同控制方法，其特征在于，分别设计期望模型补偿控制器、鲁棒反馈控制器和神经网络控制器，并将设计的控制器输出之和作为贴片机龙门平台的总控制信号，利用该总控制信号对贴片机龙门平台的X轴、Y1轴和Y2轴进行多轴协同控制；所述期望模型补偿控制器表达式为：其中，υ
a
为期望模型补偿控制器的输出，Φ
d
为含有期望信息的回归量矩阵，为θ的估计值，θ为贴片机龙门平台系统耦合动力学模型中不确定参数构成的系数矩阵，其中，M
hk
为归一化后贴片机中移动工作台的质量，B
xk
为归一化后贴片机龙门平台X轴处的粘滞摩擦系数，A
xk
为归一化后贴片机龙门平台X轴处的库仑摩擦系数，M
yk
为归一化后贴片机龙门平台中横梁的总质量，B
yk
为归一化后贴片机龙门平台Y1轴和Y2轴导轨处的粘滞摩擦系数之和，A
yk
为归一化后贴片机龙门平台Y1轴和Y2轴导轨处的库仑摩擦系数之和，J
k
为归一化后的转动惯量，K
αk
为归一化后的等效旋转刚度，B
sk
为归一化后贴片机龙门平台Y2轴和Y1轴导轨处的粘滞摩擦系数之差，A
sk
为归一化后贴片机龙门平台Y2轴和Y1轴导轨处的库仑摩擦系数之差，和分别为归一化后贴片机龙门平台X轴和Y轴动力学中非线性扰动的常值，为归一化后贴片机龙门平台旋转动力学中非线性扰动的常值；所述鲁棒反馈控制器表达式为：υ
e
＝
‑
M
q
Z
‑1G
‑
K
d
s
‑
K
e
ε，其中，υ
e
为鲁棒反馈控制器的输出，M
q
为归一化后贴片机龙门平台的惯性矩阵，s为滑模变量，Z＝diag[z1,z2,z3]，i＝1,2,3，S
i
为误差转换函数且有：ε＝[ε1,ε2,ε3]为无约束的转换误差，中间变量r
i
＝e
i
(t)ρ
i
(t)，e
i
(t)为t时刻的误差矢量，e
i
(0)为误差矢量初始值，为超调量调节系数，ρ
i
为性能函数且表达式如下：ρ
i
(t)＝(ρ
i0
‑
ρ
i∞
)e
‑
lt
+ρ
i∞
，ρ
i0
为稳态误差初始值，ρ
i∞
为稳态误差最大值，l为误差收敛速率，λ为控制增益矩阵，K
d
为比例反馈矩阵，K
e
为鲁棒增益矩阵；所述神经网络控制器表达式为：
其中，υ
nn
为神经网络控制器的输出，为神经网络权重矢量，χ为神经网络输入矢量，χ＝[χ1,χ2,...,χ
m
]，m为神经网络的神经元总层数，j＝1,2,...,m，R(χ)为神经网络多层神经元的总输出，η为鲁棒项系数，sign(
·
)表示符号函数；所述贴片机龙门平台的总控制信号v...

【专利技术属性】
技术研发人员：于兴虎，史朋威，龚见素，赵宇哲，孙昊，
申请(专利权)人：宁波亦唐智能科技有限公司，
类型：发明
国别省市：