一种FSM远程实时控制时间补偿系统及方法技术方案

本发明专利技术提供了一种FSM远程实时控制时间补偿系统及方法，由硬件和软件组成，硬件中的位置传感器把获取的FSM位置信息通过数据采集模块与嵌入式处理平台最后送给远程PC端，同时记录下数据传递时间戳，通过时间戳计算出数据传递的时间差，PC端的GPU进行卡尔曼滤波计算出把数据传递回控制执行器时刻的位置信息并把该信息传递给嵌入式处理平台，在嵌入式处理平台进行数据的实时补偿校正，用计算控制信息控制FSM，同时用传回的时间戳计算传递的时间差平均值，并不断的用新时间差计算时间差平均值进行时间补偿；软件包含底层软件和控制软件。本发明专利技术实现了对FSM实时控制过程中的时间补偿，提升了控制性能，降低了成本，还减轻了设计的工作量和难度。

【技术实现步骤摘要】

本专利技术属于光电控制测量
具体涉及一种FSM远程实时控制时间补偿系统及方法。
技术介绍
随着技术的进步，信息技术与计算机技术得到了快速发展，快速倾斜反射镜，SPFSM,简称快反镜，其控制精度越来越高，对控制信息提出了更高的实时性要求。目前广泛应用的光电经纬仪的粗精跟踪方式很难适应人工手动控制高精度的实时性要求，特别是远程控制操作，对于时间要求越来越严格的FSM控制，远程控制FSM不具有时效性。中国专利文献库公布了一项名称为《基于目标反射信号的光束瞄准系统中三角扫描偏差校准方法》(专利申请号201110100694.2)的专利技术专利申请技术，该专利技术专利申请技术公开了一种基于目标反射信号的光束猫准系统中三角扫描偏差校准方法:(I)光束猫准时，目标相对于光束统计中心存在偏差b，采集目标反射信号，估计偏差大小，记为bl ; (2)瞄准系统驱动快反镜使光束沿X正轴偏转bl ; (3)采集信号，估计偏差，记为b2 ; (4)如果已瞄准，执行第I步；如果b2大于bl的1.9倍，执行第5步；否则执行第6步；(5)控制光束沿x轴负轴偏转b2 ；(6)根据b、bl、b2，求出偏差b2的方向；(7)控制光束沿估计出的方向角偏转b2 ; (8)采集信号，估计偏差，记为b3 ;(9)如果已瞄准，则执行第I步；否则执行第10步；(10)控制光束沿I轴负向偏转b3，执行第I步。专利技术申请在进行跟踪控制的时候时效性不高，不适合用于远程实时控制，当控制数据到达执行器的时候，该数据对应的时刻已经过去了，不能实现对快反镜的有效远程控制。
技术实现思路
本专利技术技术解决问题:为了克服FSM跟踪控制过程中时效性差的缺点，提供一种FSM远程实时控制时间补偿系统及方法，能够有效、实时远程控制FSM，提升FSM跟踪控制的能力，本专利技术技术解决方案:一种FSM远程实时控制时间补偿系统,包括:FSM1、信号调理模块2、数据采集模块3、嵌入式处理平台4、PC端5、以太网9、模拟驱动模块10、控制执行器11、电机12和位置传感器13 ;所述嵌入式处理平台4包括ARM7和DSP8，DSP8直接通过总线接口与数据采集模块3的接口相接；位置传感器13对FSMl的位置信息进行探测，将位置信息经过信号调理模块2调理，再把调理后的模拟电信号送给数据采集模块3进行采集，数据采集模块3把模拟电信号转换成数字信号后送给嵌入式处理平台4，嵌入式处理平台4中的ARM7通过以太网9把该信息传给远程的PC端5，PC端5获取到该位置信息后，把这些信息送给内部的GPU6，在GPU6中进行预测算法运算，利用FSMl每个新的位置和时间参数进行预测，从而产生超前的位置控制参数，然后通过PC端5与嵌入式处理平台4的以太网9传给DSP8，DSP8通过对直接从数据采集模块3送过来的数据进行分析与分组缓存滤波处理，然后利用PC端5传过来的预测控制信息补偿该结果或者直接利用其中的控制信息直接控制FSM1，从而产生相应的控制数据，并送给模拟驱动模块10，模拟驱动模块10根据控制数据向控制执行器11传递控制信息，控制执行器11通过所给的控制信息对FSMl进行跟踪控制。所述预测算法运算为卡尔曼滤波运算，要结合FSM控制系统模型，根据包含测量位置信息与控制数据在内的信息进行计算，算出预测的控制信息。所述DSP8将直接从数据采集模块3送过来的数据进行分组、每组数据采用FIFO缓存，然后对数据进行噪声滤波。所述信号调理模块2中的调理是对位置传感器13输出信号进行滤波、缩放。所述数据采集模块3采用分辨率大于14bit的高精度的A/D转换器，同时采用FPGA或者CPLD获取数据，并设计相应的接口与嵌入式处理平台4上的接口相连。所述总线接口为PCI总线或PCIe总线。所述ARM7和DSP8集成于ARM+DSP双核处理器，或采用ARM+DSP模式设计，ARM和DSP通过高速接口进行数据通信。所述PC端5采用的是X86架构的CPU，以实时性强的VxWorks操作系统为基础，同时采用能够并行处理的GPU6作为计算单元，GPU6直接进行硬件执行运算，速度很快，仅有纳米级的时间误差，时间确定，预测计算时，这些预测计算花费的时间可忽略或在本身计算时补偿到总的时间里，GPU6可以选用NVIDIA公司的GeForce GT640T，也可以选用其他产品，能用在X86架构上均可，该X86架构的CPU可以选择intel公司的双核或者多核处理器，具有相应的100M/1000M的MAC接口即可。一种FSM远程实时控制时间补偿方法，实现步骤如下:第一步，计算出FSMl的位置信息从位置传感器13到嵌入式处理平台4的传输时间，然后把这个时间段记录在嵌入式处理平台4中进行统一处理，此时At4为O ;第二步，当该位置信息传递到了嵌入式处理平台4后，在每个数据帧之后加时间戳，编码后通过以太网9送给PC端5，此处时间戳表示的是此时的时间信息；第三步，远程的PC端5接收到数据后，立刻记录当前的时间，计算出通过以太网9传递的时间延迟，即此时的时间减去数据帧的时间戳，得到Λ t2和FSMl位置数据帧，At2是以太网9传递的时间延迟；第四步，把Λ t2是以太网9传递的时间延迟Λ t2与FSMl位置数据帧一起发给PC端5中的GPU6，利用GPU6解算出位置数据，在GPU6进行预测算法运算，利用该算法进行FSMl的位置预测，通过已有的时间差Λ t2，预测出从此时刻tn再把预测信息传递过去的预估时间差Λ t5，即tn+Λ t5时刻的FSMl的预测控制信息；所述Λ t5为Λ t2和Λ t4的二分之一，即 Δ t5= ( Δ t2+ Δ t4) /2 ；第五步，把tn+At5时刻的FSMl预测控制信息加上此时的时间戳，编码组成一个数据帧；第六步，利用以太网9把第五步产生的数据帧传递给嵌入式处理平台4，记录下嵌入式处理平台4收到第五步产生的数据帧的时刻信息，通过此时的时刻减去第五步产生的数据帧包含的时间，得到从PC端5通过以太网9传给嵌入式处理平台4的时间At3 ；第七步，嵌入式处理平台4中的DSP8通过第五步产生的数据帧对从数据采集模块3传递过来的数据进行补偿，将补偿后的数据通过双环的闭环控制PID算法计算出控制数据，实现实时时间补偿控制计算，从而对FSMl进行实时控制；同时在ARM7中计算出加权时间差 At4，即 At4= ( At5+At3) /2 ；第八步，如果需要进行FSMl的控制，则返回第二步，否则结束。所述的控制执行器是直接驱动FSM中的控制电机的设备，直接利用控制执行器可以控制FSM的光电跟踪控制。本专利技术的FSMl由多轴控制，对每个位置的新息进行预测，根据实际的FSMl系统，获得系统状态，即目前tn时刻的位置信息X (k-Ι)和控制系数A, A为支撑FSMl控制轴的参数矩阵，此时的X (k-Ι)和控制系数A已知；设U (k)是预测的控制参数，B是控制系数，B是矩阵，此时U (k)和B已知；通过数据采集模块3获取目前tn时刻的数据Z (k-Ι)也是矩阵，Z (k)是tn+At5时亥Ij相应的数据，H是测量系数，H是矩阵为已知条件。建立系统微分方程如下:X (k) =A X (k-1) +B U (k) (I)Z (k) =H X (k) (2)根据实际情本文档来自技高网...

【技术保护点】
一种FSM远程实时控制时间补偿系统，其特征在于包括：FSM（1）、信号调理模块（2）、数据采集模块（3）、嵌入式处理平台（4）、PC端（5）、以太网（9）、模拟驱动模块（10）、控制执行器（11）、电机（12）和位置传感器（13）；所述嵌入式处理平台（4）包括ARM（7）和DSP（8），DSP（8）直接通过总线接口与数据采集模块（3）的接口相接；位置传感器（13）对FSM（1）位置信息进行探测，将该信息经过信号调理模块（2）调理，再把调理后的模拟电信号送给数据采集模块（3）进行采集，数据采集模块（3）把模拟电信号转换成数字信号后送给嵌入式处理平台（4），嵌入式处理平台（4）中的ARM（7）通过以太网（9）把该信息传给远程的PC端（5），PC端（5）获取到该信息后，把这些信息送给内部的GPU（6），在GPU（6）中进行预测算法运算，利用FSM（1）每个新的位置和时间参数进行预测，从而产生超前的针对FSM（1）位置信息的控制参数，然后通过PC端（5）与嵌入式处理平台（4）的以太网（9）传给DSP（8），DSP（8）通过对直接从数据采集模块（3）送过来的数据进行分析与分组缓存滤波处理，然后利用PC端（5）传过来的预测控制信息补偿该结果或者直接利用其中的控制信息直接控制FSM（1），从而产生相应的控制数据，并送给模拟驱动模块（10），模拟驱动模块（10）根据控制数据向控制执行器（11）传递控制信息，控制执行器（11）通过所给的控制信息对FSM（1）进行控制。...

【技术特征摘要】
1.一种FSM远程实时控制时间补偿系统，其特征在于包括:FSM(1)、信号调理模块(2)、数据采集模块(3)、嵌入式处理平台(4)、PC端(5)、以太网(9)、模拟驱动模块(10)、控制执行器(11)、电机(12)和位置传感器(13);所述嵌入式处理平台(4)包括ARM (7)和DSP (8)，DSP (8)直接通过总线接口与数据采集模块(3)的接口相接；位置传感器(13)对FSM (I)位置信息进行探测，将该信息经过信号调理模块(2 )调理，再把调理后的模拟电信号送给数据采集模块(3)进行采集，数据采集模块(3)把模拟电信号转换成数字信号后送给嵌入式处理平台(4)，嵌入式处理平台(4)中的ARM (7)通过以太网(9)把该信息传给远程的PC端(5),PC端(5)获取到该信息后，把这些信息送给内部的GPU (6)，在GPU (6)中进行预测算法运算，利用FSM (I)每个新的位置和时间参数进行预测，从而产生超前的针对FSM (I)位置信息的控制参数，然后通过PC端(5)与嵌入式处理平台(4)的以太网(9)传给DSP (8)，DSP (8)通过对直接从数据采集模块(3)送过来的数据进行分析与分组缓存滤波处理，然后利用PC端(5)传过来的预测控制信息补偿该结果或者直接利用其中的控制信息直接控制FSM (1)，从而产生相应的控制数据，并送给模拟驱动模块(10)，模拟驱动模块(10)根据控制数据向控制执行器(11)传递控制信息，控制执行器(11)通过所给的控制信息对FSM (I)进行控制。2.根据权利要求1所述的FSM远程实时控制时间补偿系统，其特征在于:所述预测算法运算结合FSM (I)控制系统模型，根据包含测量位置信息与控制数据在内的信息进行卡尔曼滤波运算，预测FSM (I)的位置信息，然后根据该预测信息计算出控制信息。3.根据权利要求1所述的FSM远程实时控制时间补偿系统，其特征在于:所述DSP(S)将直接从数据采集模块(3)送过来的数据进行分组、每组数据采用FIFO缓存，然后对数据进行噪声滤波。4.根据权利要求1所述的FSM远程实时控制时间补偿系统，其特征在于:所述信号调理模块(2)中的调理是对位置传感器(13)输出信号进行滤波、缩放。5.根据权利要求1所述的FSM远程实时控制时间补偿系统，其特征在于:所述数据采集模块(3)采用分辨率大于14bit高精度的A/D转换器，同时采用FPGA或者CPLD获取数据，并设计相应的接口与嵌入式处理平台(4)上的接口相连。6.根据权利要求1所述的FSM远程实时控制时间补偿系统，其特征在于:所述总线接口为PCI总线或PC...

【专利技术属性】
技术研发人员：苏艳蕊，严发宝，王强，黄永梅，杜升平，柳万胜，
申请(专利权)人：中国科学院光电技术研究所，
类型：发明
国别省市：