快速反射镜的控制系统及控制方法
【专利摘要】快速反射镜的控制系统及控制方法，涉及一种快速反射镜的控制方法，解决现有反射镜的控制方法存在电机串联时要求有较高的驱动电源并且机械加工及电机参数存在不一致性，导致同一轴上两台电机不能输出大小相等、方向相反的力，具有局限性等问题，本发明为双轴四电机驱动的快速反射镜，该控制方法采用双闭环控制，每个偏转轴包括一个位置环、两个电流环，其中内环为电流环，外环为位置环。由于快速反射镜的两个轴正交分布，理论上不存在耦合关系，因此每个偏转轴单独控制。本发明所述的控制系统可以灵活调整两个电流控制器输入端的比例系数，实现同一轴上的两台电机同步运动，使得快速反射镜的机械系统受力均匀，提高工作的稳定性和环境适应性。
【专利说明】快速反射镜的控制系统及控制方法
【技术领域】
[0001] 本发明涉及精密跟踪与精密控制领域，具体涉及一种音圈电机驱动的快速反射镜 的控制方法。
【背景技术】
[0002] 快速反射镜作为一种光束控制装置，具有谐振频率高、响应速度快、控制灵活等特 点，在天文望远镜、激光通信、自适应光学、精密跟踪控制等领域得到了广泛应用。
[0003] 目前快速反射镜的驱动元件主要有压电陶瓷和音圈电机两大类。本专利所述的控 制方法主要针对采用音圈电机驱动的快速反射镜。双轴型快速反射镜常采用四个驱动装置 来实现两个正交轴的偏转，其中，每个轴通过两个驱动器的推拉运动来控制反射镜的偏转， 这种驱动方法可以提高快速反射镜的响应速度，同时使得快速反射镜的机械系统受力均 匀，工作的稳定性和环境适应性较好。这种驱动方式一方面对机械加工和装配精度提出了 较高要求，另一方面对控制系统也提出了较高要求，要求一个轴上的两个电机出力大小相 等、方向相反，实现同步运动。在中国发明专利CNO1113669. 3的说明书中，提出了一种偏摆 镜的驱动控制方法，该方法采用的是将同一个轴上的两个音圈电机反相串联的方式，接入 一个电机功率放大器进行控制，该方法可以保证两台电机流过大小相等、方向相反的电流， 但是有两方面的不足：其一，电机串联后，系统的反电动势系数加倍，那么驱动器的供电电 压势必加倍，才能抵消反电动势的影响，这就要求有较高电压的驱动电源；其二，考虑到机 械加工以及电机参数本身的不一致性，该方法不能保证两台电机输出大小相等、方向相反 的力，具有一定的局限性。
【发明内容】
[0004] 本发明为解决现有反射镜的控制方法存在电机串联时要求有较高的驱动电源并 且机械加工及电机参数存在不一致性，导致同一轴上两台电机不能输出大小相等、方向相 反的力，具有局限性等问题，提供一种快速反射镜的控制方法。
[0005] 快速反射镜的控制系统，包括在快速反射镜的X轴和Y轴上分别设置一个位置环 和两个电流环，所述X轴和Y轴上的位置环分别包括位置控制器、位置信息处理单元和两个 位置传感器；所述X轴上的两个电流环分别由电流控制器、功率放大器、电流传感器、音圈 电机和比例放大器组成，Y轴上的两个电流环分别由电流控制器、功率放大器、电流传感器、 音圈电机和两个比例放大器组成；
[0006] 所述X轴和Y轴上的位置传感器同时测量快速反射镜两个轴的偏转位移信息，所 述位移信息分别经过对应的位置信息处理单元进行差分处理，获得X轴和Y轴的位置反馈 量，将X轴和Y轴的位置给定量与所述位置反馈量作差，获得对应X轴和Y轴的位置误差， 采用X轴和Y轴上的位置控制器对位置误差进行校正，得到X轴和Y轴的电流指令，所述X 轴和Y轴的电流指令分别经过对应的比例放大器后，作为X轴和Y轴上对应的电流控制器 的电流给定量；
[0007] 所述X轴和Y轴上对应的电流传感器采集对应音圈电机的电枢电流，将电枢电流 反馈量与所述电流给定量作差，获得对应X轴和Y轴的电流误差，所述电流误差分别经过 X轴和Y轴对应的电流控制器校正，校正结果经对应的功率放大器驱动控制音圈电机的电 流，实现控制音圈电机的输出力。
[0008] 所述X轴上的位置控制器的输出量通过两个符号相反的比例放大器分为两路，去 控制X轴上的两个电流控制器，实现控制X轴上的两个音圈电机；所述Y轴上的位置控制器 的输出量通过两个符号相反的比例放大器分为两路，去控制Y轴上的两个电流控制器，实 现控制Y轴上的两个音圈电机。
[0009] 所述X轴和Y轴对应的位置传感器为LVDT型传感器、直线光栅位移传感器或电涡 流位移传感器中的一种。
[0010] 快速反射镜的控制方法，该方法由以下步骤实现：
[0011] 步骤一、控制系统获得X轴和Y轴的位置给定量；X轴对应的位置信息处理单元将 X轴上两个位置传感器输出的X轴位置信息进行差分运算，获得X轴的位置反馈量；Y轴对 应的位置信息处理单元将Y轴上两个位置传感器输出的Y轴位置信息进行差分运算，获得 Y轴的位置反馈量；
[0012] 步骤二、控制系统将X轴和Y轴的位置给定量与对应的X轴和Y轴的位置反馈量 作差，获得对应X轴和Y轴位置误差，并采用X轴和Y轴对应的位置控制器将位置误差进行 校正，校正结果分别作为X轴和Y轴的电流指令；
[0013] 步骤三、所述步骤二中获得的X轴的电流指令分别经过X轴中符号相反的两个比 例放大器，Y轴的电流指令分别经过Y轴中符号相反的两个比例放大器后，获得对应X轴和 Y轴的电流给定量，所述电流给定量分别与X轴和Y轴对应的电流传感器获得的电流反馈量 作差，获得对应X轴和Y轴的电流误差；
[0014] 步骤四、将步骤三中获得的对应X轴和Y轴的电流误差送入X轴和Y轴对应的电 流控制器进行校正，通过对应X轴和Y轴的功率放大器放大，控制对应X轴和Y轴的音圈电 机的运动。
[0015] 本发明的有益效果：本发明所述的控制系统可以灵活调整两个电流控制器输入端 的比例系数，实现同一轴上的两台电机同步运动，使得快速反射镜的机械系统受力均匀，提 高工作的稳定性和环境适应性，另外，一个电机对应一个电机功率放大器，不需要对电机功 率放大器的驱动电压提出过高要求。本发明实现快速反射镜同一轴上的两台电机同步推拉 运动，且具有很尚的稳定性。
【专利附图】
【附图说明】
[0016] 图1是本发明的控制方法示意图。
[0017] 图中位置控制器1，比例放大器1，比例放大器2,电流控制器1，功率放大器1，电流 传感器1，电流控制器2,功率放大器2,电流传感器2,位置信息处理单元1，位置控制器2， 比例放大器3,比例放大器4,电流控制器3,功率放大器3,电流传感器3,电流控制器4,功 率放大器4,电流传感器4,位置信息处理单元2,以及快速反射镜平台，及其下面包含的四 个音圈电机和四个位置传感器，分别是X轴上的音圈电机1、音圈电机2、位置传感器1和位 置传感器2,Y轴上的音圈电机3、音圈电机4、位置传感器3和位置传感器4。
【具体实施方式】
【具体实施方式】 [0018] 一、结合图1说明本实施方式，快速反射镜的控制系统，包括四个音 圈电机，四个电机功率放大器、四个电流传感器、四个位置传感器，四个电流控制器、两个位 置控制器，另外，还有四个比例放大器。
[0019] 四个音圈电机的电枢电流分别由四个电流传感器采集，四个电流传感器采集的电 流作为电流反馈量，四个电流反馈量分别与四个电流给定量作差，其电流误差分别经过四 个电流控制器的运算校正，其计算结果分别给四个电机功率放大器，四个电机功率放大器 分别驱动控制四个音圈电机，共同构成四个电流闭环控制系统，分别控制四个音圈电机的 电流，进而达到控制音圈电机输出力的目的。
[0020] 两个轴上的四个位置传感器用来测量快速反射镜两个轴的偏转位移信息，其中， 每个轴上的两个位移传感器同时测量，其测量的位移量经过差分运算处理，得到每个轴的 位置反馈量，两个轴的位置给定量与对应的位置反馈量作差，其位置误差分别进入两个轴 的位置控制器进行运算校正，得到两个轴的电流指令，两个轴的电流指令分别经过四个比 例放大器后，作为四个电流控制器的电流给定量，其中，四个比例放大器分为两组，每个轴 对应一组，其中，同一组内的两个比例放大器的符号相反，这样保证同一轴上的两个音圈电 机的给定电流是相反的，从而实现同一轴上的两个音圈电机推拉运动的工作方式。
[0021] 本实施方式所述的控制系统中两个偏转轴共使用四个位置传感器，其中，同一轴 上的两个位置传感器以快速反射镜旋转中心为参考，对称放置，其测量结果经过差分运算 处理，可以提高测量精度。一个音圈电机对应一个电流控制器、一个电机功率放大器和一个 电流传感器，四个音圈电机对应四个电流控制器、四个电机功率放大器和四个电流传感器。 一个轴对应一个位置控制器，一个位置控制器的输出量通过两个符号相反的比例放大器分 为两路，去控制一个轴上的两个电流控制器，进而实现控制同一轴上的两个音圈电机。
[0022] 本实施方式通过调整同一轴上两个电流控制器输入端的比例放大器系数，可以控 制两个音圈电机电枢电流的大小，其意义在于：如果两台电机的参数不一致，或者系统结构 刚度有偏差，可以通过调整两个放大器的系数，来弥补扭力的不一致，其中，同一轴上的两 个比例放大器系数的符号相反，保证同一轴上的两个音圈电机的电流是相反的，从而实现 两个音圈电机推拉运动的工作方式。
[0023] 本实施方式中包括位置控制和电流控制，二者均通过闭环控制的方式自动完成， 其中，位置控制器、电流控制器可以通过软件的方式实现数字化控制，另外，电流控制器也 可以通过硬件电路实现。
【具体实施方式】 [0024] 二、结合图1说明本实施方式，快速反射镜的控制方法，主要针对双 轴四电机驱动的快速反射镜，该控制方法采用双闭环控制，每个偏转轴包括一个位置环、两 个电流环，其中内环为电流环，外环为位置环。由于快速反射镜的两个轴正交分布，理论上 不存在耦合关系，因此每个偏转轴可以单独控制。
[0025] X轴上的两个电流环主要由电流控制器1、功率放大器1、电流传感器1、音圈电机 1、电流控制器2、功率放大器2、电流传感器2、音圈电机2以及比例放大器1和比例放大器 2组成，外环为位置控制环，主要由位置控制器1、位置传感器1、位置传感器2和位置信息处 理单元1组成。X轴的控制过程如下：
[0026] 1.控制系统获得X轴的位置给定量Prx;
[0027] 2.位置信息处理单元1将位置传感器1和位置传感器2输出的X轴位置信息Pl 和P2,进行差分运算处理，算得X轴的位置反馈量Pbx;
[0028] 3.控制系统将位置给定量Prx与位置反馈量Pbx相减，并将位置误差值Epx送位 置控制器1校正，校正结果作为X轴的电流指令Irx;
[0029] 4.电流指令Irx分别经过符号相反的比例放大器1和比例放大器2,得到两个电 流给定量Irl和Ir2 ;
[0030] 5.电流给定量Irl和Ir2分别与电流传感器1、电流传感器2获得的电流反馈量 Ibl和Ib2相减，其电流误差Eil和Ei2分别送电流控制器1和电流控制器2校正，最终通 过功率驱动器1和功率放大器2的放大，控制音圈电机1和音圈电机2的运动，由于两个电 流给定量的符号相反，音圈电机1和音圈电机2的的运动方向也相反，从而实现X轴所需要 的推拉运动。
[0031] Y轴上的两个电流环主要由电流控制器3、功率放大器3、电流传感器3、音圈电机 3、电流控制器4、功率放大器4、电流传感器4、音圈电机4以及比例放大器3和比例放大器 4组成，外环为位置控制环，主要由位置控制器2、位置传感器3、位置传感器4和位置信息处 理单元2组成。Y轴的控制过程如下：
[0032] 1.控制系统获得Y轴的位置给定量Pry;
[0033] 2.位置信息处理单元2将位置传感器3和位置传感器4输出的Y轴位置信息P3 和P4,进行差分运算处理，算得Y轴的位置反馈量Pby;
[0034] 3.控制系统将位置给定量Pry与位置反馈量Pby相减，并将位置误差Epy送位置 控制器2校正，校正结果作为Y轴的电流指令Iry;
[0035] 4.电流指令Iry分别经过符号相反的比例放大器3和比例放大器4,得到两个电 流给定量Ir3和Ir4 ;
[0036] 5.电流给定量Ir3和Ir4分别与电流传感器3、电流传感器4获得的电流反馈量 Ib3和Ib4相减，其电流误差Ei3和Ei4分别送电流控制器3和电流控制器4校正，最终通 过功率驱动器3和功率放大器4的放大，控制音圈电机3和音圈电机4的运动，由于两个电 流设定值的符号相反，音圈电机3和音圈电机4的的运动方向也相反，从而实现Y轴所需要 的推拉运动。
[0037] 本实施方式所述的控制方法中，四个位置传感器可以是LVDT型传感器、直线光栅 位移传感器，也可以是电涡流位移传感器，传感器可以有多种多样，但是获得位移信息后的 处理算法都是一样的，本系统采用的是电涡流位移传感器；电流传感器是高精度电流采样 电阻；四个功率放大器是H桥型MOSFET放大器；由于电流环带宽高，采用模拟电路来实现， 而位置控制器、比例放大器，以及位置信息处理单元，都是在DSP内处理完成，DSP算得的四 个电流给定量通过DA转换为模拟量，送给四个电流控制器。
[0038] 本实施方式所述的控制方法中，要求电流环的设计具有较高的带宽，目的在于使 音圈电机输出力矩快速响应，在算法实现上常采用PI控制算法；位置环的设计在于使快速 反射镜按照指定的要求进行快速指向或者扫描运动，位置环控制器常采用PID控制算法。
[0039] 本实施方式所述的控制方法中，按照先电流环、后位置环的顺序进行参数整定。其 中，电流控制器按照设计带宽，选择合适的比例系数和积分系数，具体要和音圈电机的电枢 电阻、电感值相匹配。
[0040] 所述的位置信息处理单元采用的差分运算如下式所示，如果要将位置信息转换为 转角信息，还要将位置反馈量除以位置传感器到旋转中心的距离。位置信息处理的原则是 保证位置给定量的量纲要和位置反馈量的量纲保持一致。
【权利要求】
1. 快速反射镜的控制系统，其特征是，包括在快速反射镜的X轴和Y轴上分别设置一 个位置环和两个电流环，所述X轴和Y轴上的位置环分别包括位置控制器、位置信息处理单 元和两个位置传感器；所述X轴上的两个电流环分别由电流控制器、功率放大器、电流传感 器、音圈电机和比例放大器组成，Y轴上的两个电流环分别由电流控制器、功率放大器、电流 传感器、音圈电机和两个比例放大器组成； 所述X轴和Y轴上的位置传感器同时测量快速反射镜两个轴的偏转位移信息，所述位 移信息分别经过对应的位置信息处理单元进行差分处理，获得X轴和Y轴的位置反馈量，将 X轴和Y轴的位置给定量与所述位置反馈量作差，获得对应X轴和Y轴的位置误差，采用X 轴和Y轴上的位置控制器对位置误差进行校正，得到X轴和Y轴的电流指令，所述X轴和Y 轴的电流指令分别经过对应的比例放大器后，作为X轴和Y轴上对应的电流控制器的电流 给定量； 所述X轴和Y轴上对应的电流传感器采集对应音圈电机的电枢电流，将电枢电流反馈 量与所述电流给定量作差，获得对应X轴和Y轴的电流误差，所述电流误差分别经过X轴和 Y轴对应的电流控制器校正，校正结果经对应的功率放大器驱动控制音圈电机的电流，实现 控制音圈电机的输出力。 所述X轴上的位置控制器的输出量通过两个符号相反的比例放大器分为两路，去控制X轴上的两个电流控制器，实现控制X轴上的两个音圈电机；所述Y轴上的位置控制器的输 出量通过两个符号相反的比例放大器分为两路，去控制Y轴上的两个电流控制器，实现控 制Y轴上的两个音圈电机。
2. 根据权利要求1所述的快速反射镜的控制系统，其特征在于，所述X轴和Y轴对应的 位置传感器为LVDT型传感器、直线光栅位移传感器或电涡流位移传感器中的一种。
3. 根据权利要求1所述的快速反射镜的控制系统的控制方法，其特征是，该方法由以 下步骤实现： 步骤一、控制系统获得X轴和Y轴的位置给定量；X轴对应的位置信息处理单元将X轴 上两个位置传感器输出的X轴位置信息进行差分运算，获得X轴的位置反馈量；Y轴对应的 位置信息处理单元将Y轴上两个位置传感器输出的Y轴位置信息进行差分运算，获得Y轴 的位置反馈量； 步骤二、控制系统将X轴和Y轴的位置给定量与对应的X轴和Y轴的位置反馈量作差， 获得对应X轴和Y轴位置误差，并采用X轴和Y轴对应的位置控制器将位置误差进行校正， 校正结果分别作为X轴和Y轴的电流指令； 步骤三、所述步骤二中获得的X轴的电流指令分别经过X轴中符号相反的两个比例放 大器，Y轴的电流指令分别经过Y轴中符号相反的两个比例放大器后，获得对应X轴和Y轴 的电流给定量，所述电流给定量分别与X轴和Y轴对应的电流传感器获得的电流反馈量作 差，获得对应X轴和Y轴的电流误差； 步骤四、将步骤三中获得的对应X轴和Y轴的电流误差送入X轴和Y轴对应的电流控 制器进行校正，通过对应X轴和Y轴的功率放大器放大，控制对应X轴和Y轴的音圈电机的 运动。
【文档编号】H02P25/02GK104516086SQ201410788335
【公开日】2015年4月15日 申请日期:2014年12月17日 优先权日:2014年12月17日
【发明者】王帅, 曹玉岩, 孟浩然 申请人:中国科学院长春光学精密机械与物理研究所