直线电机点到点定位装置的制造方法
【专利摘要】本实用新型公开了一种直线电机点到点定位装置，包括基于扩张状态观测时间最优控制器、第一求差电路、电流控制器、功率驱动放大器、电流传感器和位移传感器；基于扩张状态观测时间最优控制器包括时间最优控制器、第二求差电路和扩张状态观测器。本实用新型利用扩张状态观测器和时间最优控制器，在有效抑制系统参数变化、摩擦力、负载扰动力等系统非线性因素和不确定干扰影响的基础上，实现直线电机高速高精度点到点定位控制性能。
【专利说明】
直线电机点到点定位装置
技术领域
[0001] 本实用新型设及一种直线电机点到点定位装置，具体设及一种基于扩张状态观测 时间最优控制器的直线电机点到点定位装置，属于直线电机运动控制技术领域。
【背景技术】
[0002] 直线电机，又称"电磁直线执行器"，属于"直接驱动执行器"范畴。直线电机取消了 中间传动环节，具有结构简单、响应快、精度和效率高等优点，有利于实现高速高精度点到 点定位运动和高精度轨迹跟踪直线运动性能，在现代工业、民用、医疗、交通和军事等领域 具有广泛的应用前景。
[0003] 直线电机系统由于缺少中间传动环节的缓冲作用，因此更容易受到系统参数变 化、摩擦力、负载扰动力等系统非线性因素和不确定干扰的影响，给直线电机的高精度点到 点定位控制带来很大的难度。
[0004] 为实现直线电机的高精度点到点定位控制，各种先进的控制算法被用来进行直线 电机的运动控制研究，较具代表性的有重复迭代学习控制、自适应鲁棒控制和带前馈的比 例积分微分控制等。其中带前馈的比例积分微分控制具有系统实现简单、参数调节方便和 不需要精确的系统模型等优点，但其抑制和抵抗系统非线性因素和不确定干扰的能力不 强，无法较好地实现直线电机高速高精度点到点定位控制性能。 【实用新型内容】
[0005] 为了解决上述技术问题，本实用新型提供了一种直线电机点到点定位装置。
[0006] 为了达到上述目的，本实用新型所采用的技术方案是：
[0007] 直线电机点到点定位装置，包括基于扩张状态观测时间最优控制器、第一求差电 路、电流控制器、功率驱动放大器、电流传感器和位移传感器;所述基于扩张状态观测时间 最优控制器的输入端为所述装置的输入端，所述基于扩张状态观测时间最优控制器的输出 端与第一求差电路的输入端连接，所述第一求差电路的输出端与电流控制器的输入端连 接，所述电流控制器的输出端与功率驱动放大器的输入端连接，所述功率驱动放大器的输 出端外接直线电机，所述电流传感器的输入端与功率驱动放大器的输出端连接，所述电流 传感器的输出端与第一求差电路的输入端连接，所述位移传感器的输入端外接直线电机， 所述位移传感器的输出端与基于扩张状态观测时间最优控制器的输入端连接。
[000引所述基于扩张状态观测时间最优控制器包括时间最优控制器、第二求差电路和扩 张状态观测器;所述时间最优控制器的输入端为所述基于扩张状态观测时间最优控制器的 输入端，所述时间最优控制器的输出端与第二求差电路的输入端连接，所述第二求差电路 的输出端为所述基于扩张状态观测时间最优控制器的输出端，所述扩张状态观测器的输入 端分别与第二求差电路的输出端W及位移传感器的输出端连接，所述扩张状态观测器的输 出端分别与时间最优控制器的输入端W及第二求差电路的输入端连接。
[0009]本实用新型所达到的有益效果:本实用新型设计了一种基于扩张状态观测时间最 优控制器的直线电机点到点定位装置，利用扩张状态观测器和时间最优控制器，在有效抑 制系统参数变化、摩擦力、负载扰动力等系统非线性因素和不确定干扰影响的基础上，实现 直线电机高速高精度点到点定位控制性能。
【附图说明】
[0010] 图1为本实用新型的结构框图。
[0011] 图2是本实用新型中不同目标位置定位性能对比图。
[001^ 图3是本实用新型中对系统参数变化的抑制能力对比图。
[OOK]图4是本实用新型中对外部扰动的抑制能力对比图。
【具体实施方式】
[0014]下面结合附图对本实用新型作进一步描述。W下实施例仅用于更加清楚地说明本 实用新型的技术方案，而不能W此来限制本实用新型的保护范围。
[001引如图1所示，直线电机点到点定位装置，包括基于扩张状态观测时间最优控制器、 第一求差电路、电流控制器、功率驱动放大器、电流传感器和位移传感器。
[0016] 基于扩张状态观测时间最优控制器的输入端为所述装置的输入端，基于扩张状态 观测时间最优控制器的输出端与第一求差电路的输入端连接，第一求差电路的输出端与电 流控制器的输入端连接，电流控制器的输出端与功率驱动放大器的输入端连接，功率驱动 放大器的输出端外接直线电机，电流传感器的输入端与功率驱动放大器的输出端连接，电 流传感器的输出端与第一求差电路的输入端连接，位移传感器的输入端外接直线电机，位 移传感器的输出端与基于扩张状态观测时间最优控制器的输入端连接。
[0017] 基于扩张状态观测时间最优控制器包括时间最优控制器、第二求差电路和扩张状 态观测器。
[0018] 时间最优控制器的输入端为所述基于扩张状态观测时间最优控制器的输入端，时 间最优控制器的输出端与第二求差电路的输入端连接，第二求差电路的输出端为所述基于 扩张状态观测时间最优控制器的输出端，扩张状态观测器的输入端分别与第二求差电路的 输出端W及位移传感器的输出端连接，扩张状态观测器的输出端分别与时间最优控制器的 输入端W及第二求差电路的输入端连接。
[0019] 直线电机点到点定位装置的定位方法，包括W下步骤：
[0020] 步骤1，电流传感器采集直线电机的实际动子电流i。
[0021] 步骤2,位移传感器采集直线电机的实际运动位移X。
[0022] 步骤3,基于扩张状态观测时间最优控制器接收直线电机的目标位置yd和实际运 动位移X，输出中间控制量U1。
[0023] 基于扩张状态观测时间最优控制器的处理过程为，
[0024] A1)扩张状态观测器计算直线电机实际运动位移的估计值Z1、直线电机实际运动 速度的估计值Z2和系统总和扰动的估计值Z3 ;
[0025] 具体计算公式为，
[0026]
[0027]其中，eo为zi和X之间的误差，b为控制量增益，0日1、0日2、0日3为扩张状态观测器增益， 化1(6〇,0.25,5)为非线性函数，5为化1(6〇,0.25,5)中线性段的区间长度；
[002引fal(eo,0.25，S)的具体公式为，
[0029]
[0030] 其中，α为幕指数，sgn( ·)为符号函数；
[0031] A2)时间最优控制器接收直线电机的目标位置yd并进行处理；
[0032] 时间最优控制器的处理公式为，
[0036] 其中，r和ho为控制器参数，U0为时间最优控制器的输出量；
[0037] A3)第二求差电路接收时间最优控制器的输出量U0,计算出中间控制量m;
[0038] 计算公式为，
[0039] 山=(u〇-Z3)/b。
[0040] 步骤4,第一求差电路接收中间控制量m和实际动子电流i，将中间控制量m和实际 动子电流i比较后的误差值e发送到电流控制器处理，电流控制器输出实际电压控制量U。
[0041] 电流控制器中的计算公式为，
[0042] u=Kpi · e
[0043] 其中，Kpi为电流控制器的参数。
[0044] 步骤5,功率驱动放大器接收实际电压控制量U，控制直线电机的运行。
[0045] 在上述装置中，数据的流向为：电流传感器用于采集直线电机的实际动子电流i， 并传输至第一求差电路，位移传感器用于采集直线电机的实际运动位移X，并传输至扩张状 态观测器，扩张状态观测器利用直线电机的实际运动位移X和上一个采样时刻计算出的中 间控制量m计算出Ξ个状态变量，分别为直线电机实际运动位移的估计值Z1、直线电机实际 运动速度的估计值Z2和系统总和扰动的估计值Z3,其中Z1和Z2传输至时间最优控制器，Z3传 输至第二求差电路，时间最优控制器将目标位置yd和直线电机实际运动位移的估计值Z1、直 线电机实际运动速度的估计值Z2进行计算后，输出U0,并传输至第二求差电路，第二求差电 路将U0和系统总和扰动的估计值Z3进行比较计算，得出U1，并传输至第一求差电路，第一求 差电路将m和直线电机的实际动子电流i进行比较计算得出差值e，并传输至电流控制器， 电流控制器将m和e进行控制计算后得出实际电压控制量U，并传输至功率驱动放大器，功 率驱动放大器产生相应的电压信号，从而控制所述直线电机运行。
[0046] 图2反映的是当目标位置分别为8mm和32mm时，两种控制器的点到点定位响应对比 图，运两种控制器分别为带前馈比例积分微分控制器和基于扩张状态观测时间最优控制 器。从图中可W看出，基于扩张状态观测时间最优控制器的定位误差小、响应速度快、控制 精度高，实现直线电机的高速高精度点到点定位控制性能。
[0047] 图3反映的是在系统参数变化下两种控制器的点到点定位响应对比图，运里系统 参数（即运动部分的质量）由0.25kg变为10kg。从图中可W看出，基于扩张状态观测时间最 优控制器对系统参数变化具有较强的抑制能力，并且响应速度快，定位误差小。
[0048] 图4反映的是在外部扰动作用下两种控制器的点到点定位响应对比图，运里在 0.04 -0.06秒之间给系统施加1 ON的作用力，模拟突变的外部扰动作用。从图中可W看出，基 于扩张状态观测时间最优控制器的直线电机点到点定位装置对外部扰动同样具有很强的 抑制能力，同时响应速度快，定位误差小。
[0049] 本实用新型中扩张状态观测器用来估计系统参数变化和外部扰动等不确定因素， 并对其进行补偿;时间最优控制器W最短的时间实现定位控制。采用基于扩张状态观测时 间最优控制器能有效抑制了系统非线性因素和不确定干扰对系统性能的影响，实现直线电 机高速高精度点到点定位控制性能。
[0050] W上所述仅是本实用新型的优选实施方式，应当指出，对于本技术领域的普通技 术人员来说，在不脱离本实用新型技术原理的前提下，还可W做出若干改进和变形，运些改 进和变形也应视为本实用新型的保护范围。
【主权项】
1. 直线电机点到点定位装置，其特征在于:包括基于扩张状态观测时间最优控制器、第 一求差电路、电流控制器、功率驱动放大器、电流传感器和位移传感器； 所述基于扩张状态观测时间最优控制器的输入端为所述装置的输入端，所述基于扩张 状态观测时间最优控制器的输出端与第一求差电路的输入端连接，所述第一求差电路的输 出端与电流控制器的输入端连接，所述电流控制器的输出端与功率驱动放大器的输入端连 接，所述功率驱动放大器的输出端外接直线电机，所述电流传感器的输入端与功率驱动放 大器的输出端连接，所述电流传感器的输出端与第一求差电路的输入端连接，所述位移传 感器的输入端外接直线电机，所述位移传感器的输出端与基于扩张状态观测时间最优控制 器的输入端连接。2. 根据权利要求1所述的直线电机点到点定位装置，其特征在于:所述基于扩张状态观 测时间最优控制器包括时间最优控制器、第二求差电路和扩张状态观测器； 所述时间最优控制器的输入端为所述基于扩张状态观测时间最优控制器的输入端，所 述时间最优控制器的输出端与第二求差电路的输入端连接，所述第二求差电路的输出端为 所述基于扩张状态观测时间最优控制器的输出端，所述扩张状态观测器的输入端分别与第 二求差电路的输出端以及位移传感器的输出端连接，所述扩张状态观测器的输出端分别与 时间最优控制器的输入端以及第二求差电路的输入端连接。
【文档编号】H02P25/06GK205430117SQ201620150242
【公开日】2016年8月3日
【申请日】2016年2月29日
【发明人】施昕昕, 黄家才, 温秀兰
【申请人】南京工程学院