专利名称：一种直流电机型力促动器的控制方法及电控装置的制作方法
技术领域：
本发明涉及天文望远镜主动光学系统，具体涉及一种力促动器的控制系统。
背景技术：
力促动器作为大型天文望远镜主动光学系统中的重要组成部分，它通过施加压力 或拉力实时改变主镜镜面的形状，以修正由于重力、温度和风力等因素造成的镜面形变。为 了达到所需要的面形精度，每个力促动器对镜面施加力的精度要求达到毫牛顿级(mN)，并 且要求的输出力在几分钟甚至十几分钟的时间内具有很高的稳定性。这种技术解决了大型天文望远镜主镜面的制造难题，但对控制系统提出了非常高的要求。现有力促动器按执行机构的不同，可分为直流电机型和步进电机型两种。一般直 流电机型力促动器需要配置位置传感器，以便进行电机位置、速度调节，例如VST望远镜主 动光学系统中的力促动器安装有LVDT位置传感器，VLT望远镜中的力促动器安装有编码 器，这两种方式无疑增加了系统的成本和复杂度；所述步进电机型力促动器充分利用步距 角可细分控制的优点，无需外部位置传感器即可实现力促动器输出力的平稳调节，但由于 步进电机本身的控制及驱动方式，也决定了该系统具有连线多、驱动电路复杂的缺点，例如 在中国发明专利申请号为01113669. 3，公开号(公告号)CN1343898，专利名称《大型天 文望远镜中力促动器的电控系统》的说明书中，提出了一种大型天文望远镜中力促动器的 电控系统，该系统采用的就是步进电机驱动，并且该步进电机型力促动器的控制采用开环 控制，或者是简单的力闭环控制，另外，在中国发明专利申请号为200510094193. 2，公开号 (公告号)Cm752791，专利名称《大型天文望远镜中力促动器的智能控制系统》的说明书 中，提出了一种包括控制系统软件在内的大型天文望远镜中力促动器的控制系统，该系统 仍采用的步进电机驱动，在算法实现上采用的也是单一的力闭环控制，且使用简单的比例 控制器，但是采用这种控制策略对系统中存在的非线性以及外界扰动的抑制是有限的。
发明内容
本发明为了解决现有步进电机作为力促动器时驱动电路复杂，在算法实现上采用 单一的力闭环控制，采用直流电机需要配置外部位置传感器，并且输出力的精度低、稳定性 差的问题，提供一种直流电机型力促动器的控制方法及电控装置。一种直流电机型力促动器的控制方法，该方法由以下步骤实现步骤一控制系统获得力设定值Fr ；步骤二 将力采集单元输出的力反馈值Fb送入控制系统；步骤三将步骤一获得的力设定值Fr与步骤二获得的力反馈值Fb进行减法操作， 获得力误差值ef，采用控制系统中的力控制器对所述力误差值ef进行校正，并将校正结果 作为控制系统中的力速度控制器的力速度设定值Vr ；步骤四控制系统将步骤二获得的力反馈值Fb与经过延迟单元获得的力反馈值 Fbl相减，然后将相减后获得的结果除以延迟单元产生的延迟时间T，获得力速度反馈值Vb ；步骤五将步骤三获得的力速度设定值Vr与步骤四获得的力速度反馈值Vb进行减法操作，获得差值ev，采用控制系统中的力速度控制器对所述差值ev进行校正，并将校 正结果作为直流电机的电流设定值Ir ；步骤六将步骤五获得的直流电机的电流设定值Ir与电流采样单元获得的电流 反馈值Ib进行减法操作，获得差值电流ei，采用电流控制器对所述差值电流ei进行校正， 采用功率放大器对校正后的结果进行放大，控制直流电机的旋转，对力促动器进行控制。实现本发明的直流电机型力促动器的电控装置，包括通信单元、通信单元、控制系 统、数模转换器、传感器接口、直流电机接口、数字接口 ；它还包括力采集单元、功率放大器、 电流控制器和电流采样单元；所述控制系统输入端分别与通信单元的输出端、数字接口的输出端、功率放大器 的输入端和力采集单元的输出端连接；控制系统分别通过通信单元读取力设定值，通过力 采集单元读取力反馈值对其进行操作，通过数字接口读取力促动器的输出力的限位状态信 息；数模转换器的输入端与控制系统的输出端连接，所述数模转换器将控制系统输出的电 流设定值由数字信号转换为模拟信号，以提供给电流控制器；所述电流控制器的输出端与 功率放大器的输入端连接，功率放大器的输出端分别与直流电机接口和电流采样单元连 接；所述电流采样单元用来采集电流控制器提供的电流反馈值，所述电流控制器用来控制 直流电机的电枢电流，保证电流的快速、稳定输出，提高力矩刚度，同时抑制外界扰动；功率 放大器用来将电流驱动信号放大，以驱动直流电机的转动；数字接口的输出端与功率放大 器的另一个输入端连接，数字接口用来接入力促动器的限位状态信息，保证力促动器在到 达限位位置后，及时停止直流电机的转动，避免力促动器的输出力超出规定的安全范围；所 述力采集单元的输入端与传感器接口连接，力采集单元通过传感器接口获得力促动器的输 出力；传感器接口与电源模块连接。本发明的有益效果本发明针对直流电机型力促动器采用的控制方法及电控装 置，无需使用额外的位置传感器，同时降低了力促动器电控系统的复杂度，有效的提高了力 促动器的控制精度和稳定性，本发明采用三闭环的控制策略对力促动器本身具有的非线性 及外界扰动起到了抑制作用。
图1是本发明控制方法原理图；图2为本发明电控装置的结构示意图。图中1、力控制器，2、力速度控制器，3、电流控制器，4、功率放大器，5、除法单元， 6、电流采集单元，7、延迟单元，8、力采集单元，8-1、模拟信号调理单元，8-2、模数转换器，9、 力促动器，9-1、直流电机，9-2、LoadCell (力传感器)，10、通信接口，11、电源接口，12、串 行通信转换器，13、电源滤波器，14、稳压电源，15、传感器接口，16、控制系统，17、数字接口， 18、数模转换器，19、直流电机接口，20、通信单元，21、电源模块。
具体实施例方式具体实施方式
一结合图1说明本实施方式，一种直流电机型力促动器的控制方法，该方法由以下步骤实现步骤一控制系统16获得力设定值Fr ；步骤二 将力采集单元8输出的力反馈值Fb送入控制系统16 ； 步骤三将步骤一获得的力设定值Fr与步骤二获得的力反馈值Fb进行减法操作，获得力误差值ef，采用控制系统16中的力控制器1对所述力误差值ef进行校正，并将校正 结果作为控制系统16中的力速度控制器2的力速度设定值Vr ；步骤四控制系统16将步骤二获得的力反馈值Fb与经过延迟单元7获得的力反 馈值Fbl相减，然后将相减后获得的结果除以延迟单元7产生的延迟时间T，获得力速度反 馈值Vb ；步骤五将步骤三获得的力速度设定值Vr与步骤四获得的力速度反馈值Vb进行 减法操作，获得差值ev，采用控制系统16中的力速度控制器2对所述差值ev进行校正，并 将校正结果作为直流电机9-1的电流设定值Ir ；步骤六将步骤五获得的直流电机9-1的电流设定值Ir与电流采样单元6获得的 电流反馈值Ib进行减法操作，获得差值电流ei，采用电流控制器3对所述差值电流ei进行 校正，采用功率放大器4对校正后的结果进行放大，控制直流电机9-1的旋转，对力促动器 9进行控制。本实施方式所述力控制器1、力速度控制器2和电流控制器3采用的是比例-积分 控制器或者纯比例控制器；所述的电流采样单元6由高精度电流采样电阻和运算放大器组 成；所述的力采集单元8用来采集LoadCell 9_2输出的力信号，电流采样单元6用来测量 直流电机9-1的电枢电流。本实施方式中的力控制、力速度控制和电流控制均通过闭环控制的方式自动完 成，其中，力控制器1、力速度控制器2和电流控制器3可以在数字控制器中通过软件编程实 现，其中，电流控制器3可以通过硬件电路实现；所述的力速度反馈值Vb不需要额外的传感 器，只需要一个产生固定延迟时间的延迟单元7，将当前力反馈值Fb与延迟采集的力反馈 值Fbl相减，再除以延迟时间T，获得力速度反馈值Vb，这种方法省却了现有技术中的位置 型传感器，同时便于数字实现。
具体实施方式
二结合图2说明本实施方式，用于实现本实施方式的一种直流电 机型力促动器的控制方法的电控装置，包括通信单元20、电源模块21、控制系统16、数模转 换器18、传感器接口 15、直流电机接口 19、数字接口 17 ；它还包括力采集单元8、功率放大 器4、电流控制器3和电流采样单元6 ；所述控制系统16输入端分别与通信单元20的输出端、数字接口 17的输出端、功 率放大器4的输入端和力采集单元8的输出端连接；控制系统16分别通过通信单元20读 取力设定值，通过力采集单元8读取力反馈值对其进行操作，通过数字接口 17读取输出力 的限位状态信息；控制系统16的输出端与数模转换器18的输入端连接，所述数模转换器 18将控制系统16输出的电流设定值由数字信号转换为模拟信号，以提供给电流控制器3 ； 所述电流控制器3的输出端与功率放大器4的输入端连接，功率放大器4的输出端分别与 直流电机接口 19和电流采样单元6连接；所述电流采样单元6用来采集电流控制器3提供 的电流反馈值，所述电流控制器3还用来控制直流电机的电枢电流，功率放大器4用来将电 流驱动信号放大，以驱动直流电机的转动；功率放大器4的另一个输入端与数字接口 17的输出端连接，数字接口 17用来接入力促动器的限位状态信息，保证力促动器在到达限位位 置后，及时停止直流电机的转动，避免力促动器的输出力超出规定的安全范围；所述力采集 单元8的输入端与传感器接口 15连接，力采集单元8通过传感器接口 15获得力促动器的 输出力；传感器接口 15与电源模块21连接。本实施方式所述的电流控制器3是由NPO电容、电阻和放大器0PA277组成的模拟 式比例_积分控制器。
本实施方式所述的数模转换器18采用AD7656，所述数模转换器18的分辨率为 十六位。本实施方式所述控制系统16作为电控装置的控制核心，主要包括力控制器1、延 迟单元7、除法单元5和力速度控制器2 ；所述力控制器1的输出端与力速度控制器2的输 入端连接，力控制器1的输入端分别与延迟单元7的输入端和除法单元5的输入端连接，延 迟单元7的输出端与除法单元5的另一个输入端连接，延迟单元7用来保存力采集单元8上 一时刻采集的力反馈值，除法单元5用来计算力速度反馈值，除法单元5的输出端与力速度 控制器2的另一个输入端连接，所述力速度控制器2的输出端作为控制系统16的输出端； 所述控制系统16主要完成控制算法校正。本实施方式所述的控制系统16可以是微处理器或者工控机；所述微处理器是DSP 或者单片机。本实施方式所述的力采集单元8由模数转换器8-2和模拟信号调理单元8-1组 成；所述模数转换器8-2的输入端与模拟信号调理单元8-1的模拟信号输出端连接；所述 模拟信号调理单元8-1的模拟信号输入端作为力采集单元8的信号输入端，模数转换器8-2 的输出端作为力采集单元8的信号输出端；所述模拟信号调理单元8-1用来将测LoadCell 输出的微弱电压信号放大，模数转换器8-2对放大后的电压信号进行采样，最终提供给控 制系统16作为力反馈值。本实施方式所述的模数转换器8-2采用AD7744，所述模数转换器8_2的分辨率为 十六位；所述的模拟信号调理单元8-1采用仪表放大器AD620。本实施方式所述的通信单元20由串行通信转换器、通信接口组成，可以实现所述 的控制系统16的串口控制，以及多台电控装置的组网控制。本实施方式所述的通信单元21由电源接口 10、电源滤波器13和稳压电源14组 成，电源接口 10接入外部供电电源，经电源滤波器13处理，为所述的电控装置提供稳定的 直流供电电源，稳压电源14与传感器接口 15连接，输出高精度的IOV电压信号，用于给测 LoadCell提供激励电压。
具体实施方式
三结合图1和图2说明本具体实施方式
，本实施方式为具体实施方 式一的实施例本实施例所述的控制系统16为DSP ；具体的实现过程为一、DSP通过串行通信转换器12读取上位机发送的力设定值 Fr ；二、DSP通过力采集单元8以Ims为固定采样周期采集力反馈值Fb ；三、DSP将力设定 值Fr与力反馈值Fb作差，并将力误差值ef送入力控制器1校正，校正结果作为力速度控 制器2的力速度设定值Vr ；四、DSP将已获得的力反馈值Fb与经过延迟单元7获得的力反 馈值Fbl相减，其差值除以采样周期T，获得力速度反馈值Vb ；五、DSP将力控制器1的校正结果，即力速度设定值Vr与力速度反馈值Vb相减，其差值ev送入力速度控制器2校正，校 正结果作为电流控制器3的电流设定值Ir ；六、电流设定值Ir与电流反馈值Ib相减，其差 值电流ei送电流控制器3校正，最终通过功率放大器4的放大，控制直流电机9-1的旋转， 从而产生所需要的输出力。本实施例所述的DSP具有限位保护功能，所述DSP通过数字接口 17读取限位状态 信息，控制功率放大器4的输出，保证力促动器在到达限位位置后，及时停止直流电机9-1 的转动，避免力促动器的输出力超出规定的安全范围。 本实施例中所述的调整过程，包括力控制、力速度控制、电流控制全部通过闭环控 制的方式自动完成，当力促动器9输出力满足设定力要求时，即力误差值ef小于一定阈值 时，关断功率放大器4的输出，从而降低直流电机9-1和功率放大器4本身的发热量，减少 力促动器对光学系统的影响，本系统阈值实际选取5mN，在保证力控制精度和稳定性的同 时，有效地避免了力促动器的频繁调节。本实施例的装置与具体实施方式
二所述装置及装置的连接方式相同；所述电源接口 11接入士 15V或+5V供电电源，经电源滤波器13处理，为所述的控 制系统16提供稳定的直流供电电源；DSP作为系统控制核心，其型号为TMS320F2812，主要 完成与外部通信、读取力反馈值Fb、控制算法校正、模拟电压输出，并且可以通过数字接口 17读取限位状态；其中，控制算法通过软件实现，(力控制器1和力速度控制器2)，从而使 力促动器成为一个三闭环控制系统16 ；所述的模数转换器8-2和数模转换器18分别采用 AD7656和AD7744，均为16位分辨率；力采集单元8为所述的控制系统16提供力反馈信号， 其中，模拟信号调理单元8-1主要采用仪表放大器AD620，所述传感器接口 15用于连接外 部LoadCell 9-2 ；稳压电源14选用LT1764，要求输出高精度的IOV电压信号，以便用于给 LoadCell 9_2提供激励电压；所述电流控制器3、电流采样单元6、功率放大器4构成硬件 电流环，驱动直流电机9-1的运转，其中，电流控制器3用于实现电流误差信号的校正，选择 合适的电阻、电容值，可以实现电流信号的快速稳定输出；所述的电流采样单元6主要通过 电流采样电阻将电流信号转换为电压信号，并经过运算放大器进行放大处理，为所述的电 流控制器3提供电流反馈信号；所述的功率放大器4采样线性功率放大器4，具有线性好、 死区小、无高频谐波等优点；DSP通过数模转换器18输出模拟电压信号，所述模拟电压信号 作为电流控制器3的输入信号，直接反映了直流电机9-1电枢电流的大小；串行通信转换器 12采用VP485芯片，主要实现RS485协议，DSP通过串行通信转换器12的VP485芯片与外 部进行数据通信，主要接收来自上位机的命令信息，以及向上位机发送所述的控制系统16 的当前状态信息，如当前输出力值、限位状态值等。本发明的原理本发明采用三闭环控制方式，分别为内环、中间环和外环，所述内 环为电流环，主要由电流控制器3、功率放大器4，电流采样单元6组成，电流环的控制方式 采用硬件电路实现；中间环为力速度环，主要由力速度控制器2、除法单元5、延迟单元7、力 采集单元8组成，外环为力控制环，主要由力控制器1和力采集单元8组成，其中，力控制器 1、力速度控制器2、除法单元5和延迟单元7均在控制系统16内通过软件实现。所述力速 度环的设计在于使输出力按照指定的要求变化，避免过快运动给系统带来冲击，或者过慢 调整达不到系统的控制要求；电流环用来控制直流电机的电枢电流，保证电流的快速、稳定 输出，提高力矩刚度，同时抑制外界扰动；力控制环的作用在于保证输出力的快速、准确和稳定。 本发明具体按照先电流环，后力速度环，最后是力控制环的顺序依次整定。其中，选择电流控制器3的比例系数和积分系数时，要和直流电机9-1的电枢电阻、电感值相匹 配，目的在于保证电流环的快速稳定跟踪；力速度控制器2选择合适的比例系数和积分系 数，目的在于保证力促动器输出力的变化要快速平稳；力控制器1选择合适的比例系数，目 的在于保证力促动器输出力的准确性和稳定性。在实现上，控制系统16通过力采集单元8 以IkHz采样频率采集力反馈值Fb，延迟单元7由存储器实现，存储上一采样周期获得的力 反馈值Fbl，力速度反馈值Vb是由当前力反馈值Fb和上一采样周期的力反馈值Fbl进行后 向差分运算获得，力速度环在控制上采用PI控制算法。考虑到力速度环到力环存在一个积 分环节，采用一个比例控制器就可以实现对阶跃响应的无静差跟踪，因此，力控制环可以采 用简单的比例控制器，也可以采用比例-积分控制算法，本发明实际采用的是比例控制器； 当力促动器输出力满足设定力要求时，可关断功率放大器4的电流输出，从而降低直流电 机9-1和功率放大器4本身的发热量，以减少力促动器对光学系统的影响；当改变设定力要 求或者力促动器受到外界扰动时，力促动器的输出力会偏离设定值，控制系统16将开启功 率放大器4，同时通过力控制器1、力速度控制器2和电流控制器3进行自动调节，保证输出 力的准确性和稳定性。
权利要求
一种直流电机型力促动器的控制方法，其特征是，它的具体步骤为步骤一控制系统(16)获得力设定值Fr；步骤二将力采集单元(8)获得力反馈值Fb送入控制系统(16)；步骤三将步骤一获得的力设定值Fr与步骤二获得的力反馈值Fb进行减法操作，获得力误差值ef，采用控制系统(16)中的力控制器(1)对所述力误差值ef进行校正，并将校正结果作为控制系统(16)中的力速度控制器(2)的力速度设定值Vr；步骤四控制系统(16)将步骤二获得的力反馈值Fb与经过延迟单元(7)获得的力反馈值Fb1相减，然后将相减后的结果除以延迟单元(7)产生的延迟时间T，获得力速度反馈值Vb；步骤五将步骤三获得的力速度设定值Vr与步骤四获得的力速度反馈值Vb进行减法操作，获得差值ev，采用控制系统(16)中的力速度控制器(2)对所述差值ev进行校正，并将校正结果作为直流电机(9-1)的电流设定值Ir；步骤六将步骤五获得的直流电机(9-1)的电流设定值Ir与电流采样单元(6)获得的电流反馈值Ib进行减法操作，获得差值电流ei，采用电流控制器(3)对所述差值电流ei进行校正，采用功率放大器(4)对校正后的结果进行放大，控制直流电机(9-1)的旋转，对力促动器(9)进行控制。
2.根据权利要求1所述的一种直流电机型力促动器的控制方法，其特征在于，所述力 控制器(1)、力速度控制器⑵和电流控制器⑶采用的是比例-积分控制器或者纯比例控 制器。
3.一种直流电机型力促动器的电控装置，包括通信单元(20)、电源模块(21)、控制系 统(16)、数模转换器(18)、传感器接口(15)、直流电机接口(19)、数字接口(17)；其特征 是，它还包括力采集单元(8)、功率放大器(4)、电流控制器(3)和电流采样单元(6)；所述控制系统(16)输入端分别与通信单元(20)的输出端、数字接口(17)的输出端、 功率放大器(4)的输入端和力采集单元(8)的输出端连接；控制系统(16)分别通过通信单 元(20)读取力设定值，通过力采集单元(8)读取力反馈值进行操作，通过数字接口(17)读 取力促动器的输出力的限位状态信息；数模转换器(18)的输入端与控制系统(16)的输出 端连接，所述数模转换器(18)将控制系统(16)输出的电流设定值由数字信号转换为模拟 信号，以提供给电流控制器(3)；所述电流控制器(3)的输出端与功率放大器(4)的输入端 连接，功率放大器(4)的输出端分别与直流电机接口(19)和电流采样单元(6)连接；所述 电流采样单元(6)用来采集电流控制器(3)提供的电流反馈值，所述电流控制器(3)用来 控制直流电机的电枢电流，功率放大器(4)用来将电流驱动信号放大，以驱动直流电机的 转动；数字接口(17)的输出端与功率放大器(4)的另一个输入端连接，数字接口(17)用来 接入力促动器的限位状态信息；所述力采集单元(8)的输入端与传感器接口(15)连接，力 采集单元(8)通过传感器接口(15)获得力促动器的输出力；传感器接口(15)与电源模块 (21)连接。
4.根据权利要求3所述的一种直流电机型力促动器的电控装置，其特征在于，所述 力采集单元(8)由模数转换器(8-2)和模拟信号调理单元(8-1)组成；所述模数转换器 (8-2)的输入端与模拟信号调理单元(8-1)的模拟信号输出端连接；所述模拟信号调理单 元(8-1)的模拟信号输入端作为力采集单元(8)的信号输入端，模数转换器(8-2)的输出端作为力采集单元(8)的信号输出端；所述模拟信号调理单元(8-1)将测LoadCell输出 的微弱电压信号放大，模数转换器(8-2)对放大后的电压信号进行采样，提供给控制系统 (16)作为力反馈值。
5.根据权利要求4所述的一种直流电机型力促动器的电控装置，其特征在于，所述模 拟信号调理单元(8-1)采用仪表放大器AD620。
6.根据权利要求3所述的一种直流电机型力促动器的电控装置，其特征在于，所述控 制系统(16)包括力控制器(1)、延迟单元(7)、除法单元(5)和力速度控制器(2)；所述力控 制器(1)的输出端与力速度控制器(2)的输入端连接，力控制器(1)的输入端分别与延迟 单元(7)的输入端和除法单元(5)的输入端连接，延迟单元(7)的输出端与除法单元(5)的 另一个输入端连接，延迟单元(7)用来保存力采集单元(8)采集的力反馈值，除法单元(5) 用来计算力速度反馈值，除法单元5的输出端与力速度控制器(2)的另一个输入端连接，所 述力速度控制器(2)的输出端作为控制系统(16)的输出端。
7.根据权利要求3所述的一种直流电机型力促动器的电控装置，其特征在于，控制系 统(16)是微处理器或者工控机。
8.根据权利要求7所述的一种直流电机型力促动器的电控装置，其特征在于，所述微 处理器是DSP或者单片机。
9.根据权利要求3所述的一种直流电机型力促动器的电控装置，其特征在于，所述电 流控制器⑶是由NPO电容、电阻和放大器0PA277组成的模拟式比例-积分控制器。
10.根据权利要求3所述的一种直流电机型力促动器的电控装置，其特征在于，所述电 流采样单元(6)由电阻和运算放大器组成。
全文摘要
一种直流电机型力促动器的控制方法及电控装置，涉及天文望远镜主动光学系统，为了解决现有步进电机作为力促动器时驱动电路复杂，在算法实现上采用单一的力闭环控制，采用直流电机需要配置外部位置传感器，并且输出力的精度低、稳定性差的问题。其控制方法为控制系统获得力设定值Fr与力反馈值Fb；将Fr与Fb相减后得力误差值ef，对ef校正，得力速度设定值Vr；控制系统将Fb与力反馈值Fb1相减后除以延迟时间T，得力速度反馈值Vb；将Vr与Vb相减，得差值ev，对ev进行校正后作为电流设定值Ir；将Ir与Ib相减，得差值电流ei，采用电流控制器对ei校正后输出。本发明装置适用于力促动器的控制领域。
文档编号G02B26/08GK101840064SQ201010152279
公开日2010年9月22日 申请日期2010年4月22日 优先权日2010年4月22日
发明者张丽敏, 张斌, 李洪文, 王帅, 阴玉梅 申请人:中国科学院长春光学精密机械与物理研究所