专利名称：一种集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统的制作方法
技术领域：
一种集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，用'于双框架磁悬浮控制力' 矩陀螺转子的高精度悬浮控制，能够实现与框架控制系统之间进行快速、无干扰的信号 传输，将控制参数进行高速数据采集和在线监控，并且在线修改关键变量值，适用于高 精度、高集成度的伺服机构控制系统。
背景技术：
控制力矩陀螺(Control Moment Gyrosc叩e, CMG)是一类用于航天器姿态控制的 执行机构。相比传统的喷气推力器、动量轮等姿态控制机构，控制力矩陀螺具有控制范 围大、精度高、输出力矩大、只需要电能即可工作等显著优点，因此被应用于空间站等 大型航天器。双框架磁悬浮控制力矩陀螺(Double Gimbal Magnetic Suspended CMG， DGMSCMG)具有磁悬浮的无接触、无摩擦、无需润滑、高精度、转子转速高、长寿命等 优点。而且双框架控制力矩陀螺相对单框架力矩陀螺可以绕2个框架轴旋转，，增加了运 动自由度，进入奇异状态(即无法产生输出力矩的框架角组合)的可能性大大降低，简化 了控制律的设计，是航天器执行机构的一个重要的发展方向。
现有的磁轴承控制系统缺乏与框架控制系统之间的通讯接口，模块单一，功能不全 面。磁轴承为有间隙的弹性支承方式，CMG的框架转动时，对于陀螺转子的作用等效于 一个广义扰动力矩，转子径向位移将显著增大，不仅威胁磁悬浮系统稳定，且降低了输 出力矩的精度。DGMSCMG有两个框架转动，其耦合程度加剧，对磁轴承而言多了一个扰 动，更需要将框架转动的位置和速度值传送给磁轴承控制系统，使磁轴承控制器能够根 据框架运动进行预先补偿。降时，框架控制系统和磁轴承控制系统是两套不同的数字电 路和模拟电路相结合的系统，必须设计可靠的通讯接口，保证两者之间不会产生信号干 扰，保持框架信号的完整性。
现有的磁轴承控制系统没有集成数据釆集和在线监控功能，若需要实现数据采集和 在线监控功能，需要添置外部的数据采集器，进行模数转换之后进入上位机。其体积庞 大、造价昂贵且使用不便，不利于设备实验和现场调试。磁轴承控制系统所关心的位移 和电流值有对应的阈值，只要求在此范围内的高精度；而外部数据采集器是通用型的， 为适应各种测试环境，对应的模数转换范围比较宽，浪费采集通道的精度资源，即产生了对数据采集做优化配置的需求。此外，外部数据采集器不能记录控制器运算过程中的 数字量，而这些控制量结合陀螺转子运动状态的分析将有利于改进控制器，提高控制器 的性能指标。
在线修改关键控制变量值是设计控制系统的重要环节，其作用在于能根据当前磁轴 承的工作状态，及时调整和修改基本控制器的控制参数、交叉反馈通道的比例系数，更 加方便实验含有不同控制参数的控制器，同时灵活的调试增强了磁轴承的稳定性。现有 的控制系统没有提出一整套对控制过程中的参数进行在线调试和修改的解决方案。
发明内容
本发明的技术解决问题是克服现有的磁轴承控制系统、数据采集系统和在线监控 相分离以及内外框架转动时轴承稳定性变差的缺点，提供一种集控制、通讯、数据采集 和在线监控于一体的高速、高精度双框架磁悬浮控制力矩陀螺磁轴承控制系统。
本发明的技术解决方案是 一种集成化双框架磁悬浮控制力矩陀螺磁轴承控制系 统，由控制电路、采集电路和通讯接口、上位机构成，其中，控制电路包括DSP楱块、 FPGA模块、Flash、 SRAM、转速测量模块和晶振；采集电路包括D/A模块、A/D模块、 双框架转速/位置接口电路、位移传感器接口电路和电流传感器接口电路；通讯接口包 括USB接口、 RS232和SPI接口
在控制电路中FPGA模块接收A/D模块的电流值、位移值、内外两个框架各自的转 速和位置值，通过总线与DSP模块连接，交换控制过程中上述各数据量；接收转速测量 模块对霍尔传感器传送的转速信号经过滤波整形后的转速值，同时向D/A模块发送磁轴 承的控制量；FPGA模块与FLASH和SRAM之间通过数据和地址总线连接，交换需要存储 的数据；FPGA模块接收由DSP模块对晶振倍频后的时钟信号，并提供时钟源给A/D模块； DSP模块根据FPGA模块送来的电流值、位移值、转速值、内外两个框架各自的转速和位 置值，分别采用基本控制算法、交叉反馈算法和前馈控制算法计算总控制量，并传回给 FPGA模块，同时根据需要在线修改上述各控制算法中的参数；FPGA模块根据总控制量 输出控制电压的PWM信号，驱动功放模块产生控制电流，实现陀螺转子稳定悬浮；
在采集电路中A/D模块接收电流传感器接口电路调理的电流值，接收位移传感器 接口电路调理的位移值，接收双框架转速/位置接口电路调理的内外两个框架各自的位 置和转速值；D/A模块接收FPGA模块发送的陀螺转子信息，并发送给框架控制系统；
在通讯接口中USB接口和RS232与FPGA模块通过双向工作的总线实现与上位机之 间的数据交换；SPI接口在DSP模块控制下向框架控制系统发送陀螺转子的转动信息， 并接收补偿内外两个框架不平衡振动各自的控制量。所述的DSP模块首先根据位移参考中心值及电流参考值求取位移偏移值；电流偏差 值，调用基本控制算法计算基本控制量；根据转速值调用交叉反馈算法计算交叉反馈量； 根据内外两个框架各自的速度、位置值采用前馈控制算法对框架转动引起的转子位移跳 动量计算前馈补偿量；将基本控制量、交叉反馈量和前馈补偿量合成为总控制量，并做 限幅处理，再传回给FPGA模块；同时根据上位机的需要在线修改控制算法中,的参数。
所述的集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统与框架控制系统之间采 取两套通讯回路FPGA模块利用D/A模块发送和A/D模块接收的功能，通讯已转成模拟 量的磁轴承位移量与内外两个框架位置、转速值；SPI接口连接DSP模块的SPI同步串 口，采用RS422差分传输协议，与框架控制系统之间传送数字的控制量，实现系统数字 通讯接口的扩展和对外界噪声的隔离功能。
所述的上位机以串行方式接收由FPGA模块、USB模块构成的数据采集部分发送来的 磁轴承位移值、电流值和总控制量，采用普通的串口调试工具即可实现在线监测和采集 功能；上位机对DSP模块中需要修改的算法参数编写地址，形成串口通讯协议，通过RS232 采用串口方式查询与修改控制参数，包括基本控制器中的比例、积分和微分量，以及交 叉反馈算法中低通和高通截止频率与交叉反馈比例系数。
所述的DSP模块、FPGA模块和A/D模块只用一个固定的晶振做外部时钟源，其中， DSP模块内部的锁相环将外部时钟倍频后输出成为系统时钟，提供给FPGA模块成为其时 钟源，A/D模块的时钟源再由FPGA模块时钟分频得到。
本发明的原理是本发明控制系统通过控制电路、采集电路实现了基本控制功能。 如说明书附图2，为本发明控制系统的原理框图。FPGA模块和DSP模块构成的控制电路 为核心部分。FPGA模块接收A/D模块的电流值、位移值和框架转速/位置值，通过总线 与DSP模块连接，交换控制过程中各数据量；接收转速测量模块对霍尔传感器传来的转 速信号滤波整形之后的数据，同时向D/A模块发送磁轴承的控制量；FPGA模块与FLASH 和SRAM之间通过数据和地址总线连接，交换需要存储的数据。DSP模块中根据位移值和 电流值、转速值、框架转速/位置信号，分别采用附图2中的基本控制算法、交叉反馈 算法和前馈控制算法计算总控制量，并传回给FPGA模块，同时根据需要在线修改控制 算法中的参数；FPGA模块根据总控制量输出PWM信号，驱动功放模块产生控制电流，实 现陀螺转子稳定悬浮。
本发明中，框架控制系统为控制DGMSCMG内外两个框架转动的系统，由于运动学耦 合且有两个框架自由度，需要与磁轴承之间交换运动信息，补偿磁轴承和框架相对运动 造成的等效运动干扰。
6本发明控制系统采甩了两套回路实现框架通讯数据的传送i一是使用D/A模块和'A/rr 模块双向传送陀螺转子转动与框架位置和速度信号，在数据线中的是模拟量值，易受到
高频干扰，但使连线简单可靠，确保存在信号交换，通过滤波算法等即可得到原始信号； 二是使用DSP的同步串口 SPI功能，并且采用抑制噪声性能较好的RS422差分传输协议， 数据线中是数字电平，实现系统数字通讯接口的扩展和对外界噪声的隔离功能，保证了 框架信号高速、完整的传送，正确补偿框架转动的影响。两套回路互为冗余备份，信息 相互补充，可靠的完成与框架控制系统之间的信息交换功能。
本发明控制系统利用控制电路和通讯接口实现数据采集和监控，并且在上位机中通 过在线监测和数据采集算法完成对数据的采集与在线修改功能。
本发明控制系统采用FPGA模块和USB模块，实现在线监测和数据采集功能。FPGA 模块内采集数据的算法先将位移值、电流值和控制量等数据进行采集、整理和打包，然 后控制USB模块将数据向上位机传送，在上位机中显示各通道的位移、电流波形情况以 便观察，同时显示基本控制量和交叉反馈量值及前馈补偿量。并且具备存储功能，满足 后续的分析需求。本控制系统中，FPGA模块采用并行采集、串行发送的方式处理数据， 上位机采用普通的串口调试工具即可实现功能，简化了上位机工作，增强了通用性能。
本发明控制系统利用FPGA模块和RS232模块实现在线修改功能。编写串口协议， 实现上位机査询与修改控制参数，包括基本控制器中的比例、积分和微分量，以及交叉 反馈中的低通和高通截止频率与交叉比例系数。串口协议包括了对串口的设置，即设定 串口号和串口传输的速率；在文本框内显示控制量值；改变操作的控制量值的功能；通 过对数据和地址的匹配校验，保证数据传送的可靠性，实现对DSP运算中控制量的在线 修改。
本发明的方案与现有技术相比的主要优点在于
(1) 本发明将控制电路r采集电路和通讯接口集成在单个电路板系统上，实现闭 环控制功能；与框架控制系统通过A/D模块、D/A模块传送模拟量、通过SPI接口传送 数字量，保证可靠通讯获取框架信息，能够补偿框架运动提高控制精度；利用USB接口 高速和RS232灵活的特点，简化上位机控制，普通串口程序即可完成数据的采集和在线 修改功能，增强了系统功能，因此本发明是集控制、通讯、数据采集和在线监控于一体 的高速、高精度双框架磁悬浮控制力矩陀螺磁轴承控制系统。
(2) 本发明控制系统扩展DSP的同步串口 SPI功能，采用RS422协议实现与框架 控制系统之间的数字通讯，充分利用DSP芯片资源，增强了数字信号对外界噪声的抑制 作用。(3) 本发明的FPGA模块扩展了外部串口，向上位机发送控制量，接受上位机修改 后的控制量；FPGA模块扩展了 USB的接口，发送在控制过程中产生的各项控制量和状态 中间量，上位机接收、存储并用于后续分析。
(4) 本发明利用一套系统实现磁轴承的控制、数据采集、在线监控于一体的功能， 省掉了数据采集设备，成本低、体积小、重量轻，使用方便。
(5) 本发明整套系统只使用一个外部晶振，提高了控制系统各模块间通讯的同步性。
总之，本发明的这种控制系统更加集成化，实现了磁悬浮双框架控制力矩陀螺全数 字化控制。本发明的控制方式扩展了系统的性能，能可靠的接收框架控制系统的运动状 态信息，有效抑制内外框架转动时对转子悬浮位置的扰动，提高了陀螺转子控制系统的 精度。对于数字控制量采集和在线监测，以及在线修改方面提出了一整套解决方案，拓 展并完善了控制系统的功能。
图l为本发明的结构组成框图2为本发明的控制原理框图3为本发明的FPGA模块程序流程图4为本发明的DSP模块程序流程图5为本发明的陀螺转子本体示意图； ^
图6为本发明中框架控制系统示意图7为本发明的DSP模块电路原理图8为本发明的FPGA模块电路原理图9为本发明的电流传感器接口电路图IO.为本发明的位置传感器接口电路图11为本发明的转子转速测量电路图12为本发明的A/D模块电路图13为本发明的D/A模块电路图14a为本发明的RS232、图14b为本发明的USB接口图15为本发明的数据采集与监测流程图16为本发明的在线修改设计流程图。
具体实施例方式
如图1所示，本发明集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，它由控制电路3、采集电路4和通讯接口 2构成，其中控制电路3包括DSP模块仰GA模块— 32和Flash33、 SRAM34、转速测量模块35;采集电路4包括D/A模块41、 A/D模块42 和双框架转速/位置接口电路43、位移传感器接口电路44、电流传感器接口电路45;通 讯接口 2包括USB接口 21、 RS232及SPI接口 23:
FPGA模块32控制A/D模块42以7kHz的采样频率接收电流值、位移值.、.内外两个 框架各自的转速和位置值。位移传感器11传来的位移电压信号最大值是6V，最小值是 4V，而A/D模块42能接受的电压信号范围在0 5V，经过电压偏移和倍数缩小后才能送 入A/D模块42。电流传感器接口电路45采取同样方式处理。双框架转速/位置接口电路 43由高速光耦和运放组成的跟随器构成，实现信号的隔离和跟随功能。转速测量模块 35对霍尔传感器传来的转子转速滤波整形，FPGA模块32接收处理后的转速值。
FPGA模块32将接收到的数据通过总线向DSP模块31发送，FPGA模块32根据DSP 模块31中算法形成的总控制量输出PWM信号，驱动功放模块12产生控制电流，实现陀 螺转子8稳定悬浮。FPGA模块32通过D/A模块41向框架控制系统5发送陀螺转子8的 转动状态和转速值。FPGA模块32与上位机1之间由RS232连接，接收上位机1发送的 控制量，再转发给DSP模块31以修改基本控制器中的比例、积分和微分系数，以及交 叉反馈中的低通和高通截止频率与交叉比例系数。FPGA模块32采集控制中变量值，包 括被控量参数信号、由DSP模块31计算的总控制量、输入的位移值与电流值，利用USB 接口21发送到上位机。DSP模块31采用同步串口 SPI功能，采用RS422差分传输协议 与框架控制系统5之间传送补偿动框架效应所需的控制量。
SRAM34存储在运算和控制中的临时数据，选用IS61LV512，为512KX16bit;FLASH33 存储系统的启动和故障情况，系统启动时间、启动后达到的最大转速与最大框架转速情 况，选用SST39VF400,为256KXl6bit。
DSP模块31、 FPGA模块32、 A/D模块42只用一个1.5M的晶振36做外部时钟源，系 统时钟由DSP模块31内部锁相环将15M外部时钟5倍频后得到并由Hl脚输出，FPGA模 块32的时钟源由DSP模块31的H1脚提供，A/D模块42的时钟源由FPGA模块32时钟 三分频得到。
如图2所示为本发明的控制原理框图，框图中的基本控制器、交叉反馈控制和前馈 控制器在控制电路3中实现，功放模块12将电流转换成电压值经过采集电路2和控制 电路3后形成电流闭环。位移传感器11检测的转子位移值经过采集电路2和控制电路3 后在对应算法下形成位置闭环得到基本控制量和交叉反馈量。同时，控制电路3接受内 框架、外框架的速度和位置值，在DSP模块31抑制动框架效应的算法下得到补偿框架
9转动的前馈补偿量，加上位置闭环控制算法后的量值得到总控制量，驱动功放模紫12 输出控制电流使磁轴承10产生电磁力，实现陀螺转子S稳定、高精度悬浮控制。
如图3所示，为本发明的FPGA模块32的程序流程，FPGA模块32完成加载配置信 息后并行工作，同时进行6项任务(a)转速测量。根据系统分频时钟，对转速信号 进行计数，用16位除法器将计数值除以16,得到转速值；(b) PWM信号输浙。根据DSP 模块31通过总线传来的总控制量，计算占空比，加上死区时间，再根据过流保护的原 则限制占空比小于90%，形成PWM信号输出；(c)控制A/D模块42。以7kHz定时启动 A/D模块42，采样各个通道的数据，得到陀螺转子8位移值和电流值，再将结果平均滤 波后发送给DSP模块31; (d)控制D/A模块41。以10kHz的频率启动D/A模块41，向 框架控制系统5发送陀螺转子8位移值和电流值；(e)总线控制。在总线上输出数据 和地址信号，首先实现与DSP模块31的通讯，发送转子位移值和电流值，并接受DSP 模块31计算的总控制量；其次向FLASH33、 SRAM34读取和发送数据，包括运算和控制 中的临时数据、系统启动时间、启动后达到的最高转速与框架最大转速情况。(f)数 据采集。根据上位机1传来的命令，对数据按照格式打包，加上帧头和帧尾，并启动USB 模块21，通过USB21模块将打包好的数据传送给上位机1。
如图4所示，为本发明的DSP程序流程，控制算法都在DSP模块中完成。DSP开始 工作后，首先进行初始化工作，然后进入定时中断等待时间，如果有定时中断启动则进 入服务程序调用相关算法。首先读取总线上传来的位移值、电流值、转速和框架位置、 速度值，根据设定的参考中心值求取位移偏差值、电流偏差值；输入位移偏差值，调用 基本控制算法计算基本控制量；输入转速值，调用交叉反馈算法计算不同转速下的交叉 反馈量；输入框架位置、速度信号，调用前馈控制算法对框架转动引起的转子位移跳动 量进行补偿计算得到前馈补偿量；根据电流环的反馈将基本控制量、交叉反馈量和前馈 补偿量合成为总控制量，并根据占空比不超过90%的原则将控制量限幅在2000;随后判 断上位机是否要求修改控制量，如果需要则更新执行控制算法参数；最后完成向FPGA 模块发送总控制量，便于其实现控制、数据采集和在线监测功能。
本发明的基本控制算法使用改进型的分散PID算法，即积分分离和不完全微分PID 算法。其传递函数为<formula>formula see original document page 10</formula>
其中，A;为比例系数，n为积分系数，r。为微分系数，7",为加入到微分环节中的惯性环节的时间常数。
本发明使用的交叉反馈算法公式如下<formula>formula see original document page 11</formula>
其中，/^为交叉反馈在A端X轴上的分量，A,、 A,、 /^依次类推；夂为交叉反馈抑
制进动的系数、&为交叉反馈抑制章动的系数；力z为A端X轴向位移量低通滤波的结果，
A〃、 Iffi、 义朋、力工、力"、J>i、 》w依次类推。
本发明使用前馈控制算法的公式为-4 /m
其中，G为采用的前馈环节，厶为电磁铁中心到转子中心的水平距离、A为电流刚 度、t为功放直流放大倍数，^为磁轴承的转子角动量。
如图5所示，为陀螺转子示意图，陀螺转子8分为A、 B两端，A端有一对沿径向正 交放置磁轴承IO和位移传感器11，且后者在前者的外侧；陀螺转子8的B端配置与A 端完全对称。
如图6所示，为框架控制系统5示意图，框架控制系统5包含驱动、数据接口、通 讯模块和控制器四个部分。控制器控制驱动输出内框架、外框架控制信号，通过数据接 口接受陀螺转子信号和发送框架信号，并通过通讯模块与磁轴承控制系统的DSP模块31 通讯。
如图7、8所示，为本发明的DSP模块31和FPGA模块32控制模块的主控芯片。DSP31 采用选用TI公司的.TMS320VC33芯片，主频最高可达到150MHz,字长为32位，扩展精 度为40位。FPGA模块32的硬件部分选用Xilinx的Spartan-3系列XC3S400芯片，此 芯片集成40万门电路，满足管理控制外设所需的资源，1/0端口供电电压为3.3V，内 核供电电压为1.2V，采用JTAG下载方式。
如图9所示，为本发明的电流传感器接口电路，通过调节电位器阻值，改变信号的 放大倍数和电压偏移量，实现信号的调零调偏，将信号范围整理进入A/D模块电压范围。 调理电路功放选用i5V供电的TLC2254，并组成有源二阶低通电路对信号滤波，截止频 率为5kHz，由压差为0.2V的1N5817组成过压保护电路，限制输入量在A/D模块范围之 内。如图10所示，.为本发明的位移传感器接曰电路，该龟路实现对位移电祸流传感器' 传送来的信号进行调理。其工作原理与电流传感器接口电路相同，选择TLC2254构成调 理和滤波电路，1N5817组成过压保护电路。
如图11所示，为本发明的转速测量电路，检测转速值。转速值经过高速光耦隔离 驱动，在斯密特触发器74HC14的触发下形成标准方波进.入.,FPGA模块。高速。光耦选用TI 的6N137，最高开关时间为75ns。
如图12所示，为本发明的A/D转换电路。A/D转换芯片选用TI公司的AD7938，该 芯片精度为12位，并行输出，可8通道同时采样。选用两片AD7938,输入有16通道， 单通道采样率为183kHz，满足DGMSCMG轴承控制所需采样率(10KHz)的需求。A/D芯片 输出电压选用3.3V，省去与FPGA连接时所需的电平转换电路。
如图13所示，为本发明的D/A电路，实现向框架提供前馈所需信息的功能。DA芯 片采用TI公司的TLV5614。 TLV5614基准电压由超精密电源芯片MAX6126提供，其输出 电压精度为0. 001V。
如图14所示，为本发明的RS232接口、 USB接口，该电路实现FPGA模块与上位机 通讯。RS232的芯片选用MAX232，采用+5V供电。USB芯片选用FT245BM,在内部硬件逻 辑的作用下实现USB串行与并行数据格式的双向转换。上位机通过USB接口与FT245BM 进行数据交换，FT245BM则通过串行方式与下位控制器通信。本系统用FPGA模块控制 FT245BM握手信号实现USB芯片上位机数据传输。
如图15所示，为本发明的数据采集与监测流程图，在启用数据采集与监测之后， 按照流程图进行数据采集
(1) 在上位机中设定串口通道号和存储的文件夹与文件名称。上位机和USB接口 通过USB线或串口线连接。如果上位机通过USB线与控制系统连接，则设置虚拟串口将 连接的USB 口设定为串口通道3;如果上位机通过串口线与控制系统连接，则设置为串 口通道1。本软件设定的默认文件夹在安装文件夹下，默认为按照日期形成文件名为"年 -月-日-时"的.txt文件。将数据以矩阵形式记录，按照采样时间顺序依次以列向量连 续记录，矩阵的行向量数据中间以2个空格隔开，分别为转子的位移值、电流值、控制 器输出值和交叉反馈计算值共4组数据，每组对应径向的AX、 AY、 BX、 BY端和轴向Z 端的5个数据，共20个。
(2) 在FPGA模块中进行参数初始化，包括开辟并清空FPGA模块中的临时存储区 域，关联需要存储的变量到存储区域中；设定采样参数，为设定采集数据的采样频率。 采样频率在7kHz 100kHz之间最低值是根据奈奎斯特采样定律选定的有效采样频率，而过高的采样频率会挤占控制器的运算时间。
(3) FPGA模块进行数据采集工作。FPGA模块分别采集A、 B端各自的x、 y轴向与 z轴的位移、电流值共10路信号，每一路为16bit;采集当前转速值有一路，为8bit; 采集控制器中的控制器数字输出量共5路，分别为16bit;采集交叉反馈的低通和高通 为2路，分别为16bit。数据存入数据暂存区，按照时间顺序依次编排。-
(4) 在FPGA模块中，采集的数据进行打包处理。对存储区的数据按照先入先出的 原则加上帧头帧尾；有效数据总共为488bit,帧头为从时间开始的帧数编号和鉴别帧有 效的开始位，为16bit。帧尾为帧结束位和校验和位，包括32位。
(5) FPGA模块驱动USB接口正常工作，以时间顺序、串行方式向上位机发送经过 整理之后的数据；
(6) 上位机通过串口调试工具接收数据，并按照设定的文件夹路径和文件名称， 以规定的格式存储数据；
(7) 在上位机中，可以对数据进行实时显示有"波形显示"和"数字显示"两 种，还可以显示经过分析算法之后的波形情况，有"FFT变换"和"李沙育图形"两种。
(7.1)"波形显示"将选择的通道值以波形的形式显示出来，反映了陀螺转子当前时 刻的位置情况；(7.2)"数字显示"将控制器中的数字变量在数字显示框中显示，可 以显示"控制器输出量"和"交叉反馈量"两项。控制器输出量无单位，显示为控制器 中计算的量值，为整型6个数字；交叉反馈量与控制器输出量枏伺-显示。(7.3) "FFT 变换"在波形显示窗口附加显示快速傅立叶变换。通过快速傅立叶变换，可以看到指定 通道的频率组成，及每个频率所占的分贝数大小。(7.4)"李沙育图形"显示转子A 端或者B端的位移情况，选择显示A端时，则将AX通道的波形数据作为波形显示的X 轴分量，而将AY通道的波形数据作为波形显示的Y轴分量。反映了当前时刻陀螺转子A 端整体的位置情况。对于B端情况块此类推。 —
如图16，为本发明的在线修改的设计流程图，实现修改DSP控制算法中的量值，达 到实时改变控制算法的目的。
(1) 流程功能开始，设定串口属性，包括上位机与控制器连接对应的串口，选择 "函l"或者"coni2"，设定波特率，有4800、 9600、 19200bit/s三种。
(2) 操作的控制量包括交叉高通值、交叉低通值、比例系数、微分系数、积分系 数这5项，上述控制量值在DSP中对应依次递增的地址空间，根据上位机发送来的地址 即可识别不同的控制量；
(3) 上位机显示选中的控制量之后，通过查询功能，将选中的控制量发送给FPGA模块，FPGA模块再将此控制量在DSP算法中的值提取并返回给上位机;'则在文本框中显 示选中的控制量当前值。
(4) 上位机如果修改当前控制量，则将此控制量的名称与修改的值发送给FPGA模 块，并且加入校验和。FPGA模块在校验正确之后，将修改后的值通过总线发送给DSP修 改其算法中的值，实现改变控制算法，修改算法在线调试系统的目的。修改腔制量只有 -1和+1两个选择，即将选中的控制量进行加、减一个单位值。
(5) 上位机中有可以继续操作和退出的功能。继续操作可以重复显示控制值和修 改控制值，或者选择新的控制量进行操作。退出将退出在线修改系统。
本发明虽为双框架磁悬浮控制力矩陀螺磁悬浮轴承控制系统，但也可以作为一种通 用的控制器，应用者可以根据其特殊的应用领域通过修改软件来灵活方便地实现其功 能。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
1权利要求
1、一种集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，其特征在于由控制电路(3)、采集电路(4)和通讯接口(2)、上位机(1)构成，其中，控制电路(3)包括DSP模块(31)、FPGA模块(32)、Flash(33)、SRAM(34)、转速测量模块(35)和晶振(36)；采集电路(4)包括D/A模块(41)、A/D模块(42)、双框架转速/位置接口电路(43)、位移传感器接口电路(44)和电流传感器接口电路(45)；通讯接口(2)包括USB接口(21)、RS232(22)和SPI接口(23)(a)在控制电路(3)中FPGA模块(32)接收A/D模块(42)的电流值、位移值、内外两个框架各自的转速和位置值，通过总线与DSP模块(31)连接，交换控制过程中上述各数据量；接收转速测量模块(35)对霍尔传感器(9)传送的转速信号经过滤波整形后的转速值，同时向D/A模块(41)发送磁轴承的控制量；FPGA模块(32)与FLASH(33)和SRAM(34)之间通过数据和地址总线连接，交换需要存储的数据；FPGA模块(32)接收由DSP模块(31)对晶振(36)倍频后的时钟信号，并提供时钟源给A/D模块(42)；DSP模块(31)根据FPGA模块(32)送来的电流值、位移值、转速值、内外两个框架各自的转速和位置值，分别采用基本控制算法、交叉反馈算法和前馈控制算法计算总控制量，并传回给FPGA模块(32)，同时根据需要在线修改上述各控制算法中的参数；FPGA模块(32)根据总控制量输出PWM信号，驱动功放模块(12)产生控制电流，实现陀螺转子(8)稳定悬浮；(b)在采集电路(4)中A/D模块(42)接收电流传感器接口电路(45)调理的电流值，接收位移传感器接口电路(44)调理的位移值，接收双框架转速/位置接口电路(43)调理的内外两个框架各自的位置和转速值；D/A模块(41)接收FPGA模块(32)发送的陀螺转子(8)信息，并发送给框架控制系统(5)；(c)在通讯接口(2)中USB接口(21)和RS232(22)与FPGA模块(32)通过双向工作的总线实现与上位机(1)之间的数据交换；SPI接口(23)在DSP模块(31)控制下向框架控制系统(5)发送陀螺转子(8)的转动信息，并接收补偿内外两个框架不平衡振动各自的控制量。
2、根据权利要求1所述的集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，其 特征在于所述的DSP模块(31)首先根据位移参考中心值及电流参考值求取位移偏差 值、电流偏差值，调用基本控制算法计算基本控制量；根据转速值调用交叉反馈算法计算交叉反馈量；根据内外两个框架各自的速度、位置值采用前馈控制算法对框架转动引' 起的转子位移跳动量计算前馈补偿量；将基本控制量、交叉反馈量和前馈补偿量合成为 总控制量，并做限幅处理，再传回给FPGA模块(32);同时根据上位机(1)的需要在线修改控制算法中的参数。
3、 根据权利要求1所述的集成化的双框架磁悬浮控制力矩陀螺磁轴承控制系统， 其特征在于磁轴承控制系统与框架控制系统(5)之间采取两套通讯回路FPGA模块(32)利用D/A模块(41)发送和A/D模块(42)接收的功能，相互通讯已转成模拟量 的陀螺转子(8)位移量与内外两个框架位置、转速值；SPI接口 (23)连接DSP模块(31) 的SPI同歩串口，采用RS422差分传输协议，与框架控制系统(5)之间传送数字控制 量，实现系统数字通讯接口的扩展和对外界噪声的隔离功能。
4、 根据权利要求书1所述的集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统， 其特征在于所述的上位机(1)以串行方式接收由FPGA模块(32) 、 USB模块(21) 构成的数据采集功能部分发送的磁轴承位移、电流和控制量数据，采用普通的串口调试 工具即可实现在线监测和釆集功能；上位机(1)对DSP模块(31)中需要修改的算法 参数编写地址，形成串口通讯协议，通过RS232 (22)采用串口方式査询与修改控制参 数，包括基本控制器中的比例、积分和微分量，以及交叉反馈算法中低通和高通截止频 率与交叉反馈比例系数。
5、 根据权利要求1所述的集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，其 特征在于所述的DSP模块(31) 、 FPGA模块(32)和A/D模块(42)只用一个固定的 晶振(36)做外部时钟源，其中，DSP模块(31)的内部锁相环将外部时钟倍频后输出 成为系统时钟，提供给FPGA模块(32)成为其时钟源，A/D模块(42)的时钟由FPGA 模块(32)时钟分频得到。
全文摘要
一种集成化双框架磁悬浮控制力矩陀螺磁轴承控制系统，包括控制电路、采集电路和通讯接口，控制电路包括FPGA模块，DSP模块等；采集电路包括电流、位移传感器接口电路，双框架转速/位置接口电路，A/D模块，D/A模块；通讯接口包括USB接口，RS232，及SPI接口，系统的控制电路接收采集电路处理的陀螺转子信号，控制其稳定悬浮，把控制量通过通讯接口传送到上位机，在上位机控制下，实现对陀螺转子悬浮情况的在线监测和数据采集，并且对控制参数在线修改。本发明能有效通讯高精度控制时所需的内框架、外框架转动信号，实现了控制系统与测控系统的集成化设计，满足数据采集和在线监控的速度和精度要求。
文档编号F16C32/04GK101599670SQ20091008571
公开日2009年12月9日 申请日期2009年5月27日 优先权日2009年5月27日
发明者力 丁, 房建成, 灿 王, 王英广, 郑世强, 冬 陈 申请人:北京航空航天大学