CN105486296A - 一种基于fpga的动力调谐陀螺仪数字再平衡回路 - Google Patents

一种基于fpga的动力调谐陀螺仪数字再平衡回路 Download PDF

Info

Publication number
CN105486296A
CN105486296A CN201510727723.6A CN201510727723A CN105486296A CN 105486296 A CN105486296 A CN 105486296A CN 201510727723 A CN201510727723 A CN 201510727723A CN 105486296 A CN105486296 A CN 105486296A
Authority
CN
China
Prior art keywords
fpga
digital
circuit
gyro
loop
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201510727723.6A
Other languages
English (en)
Inventor
李海滨
牛红燕
罗麟经
朱毅
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Automation Control Equipment Institute BACEI
Original Assignee
Beijing Automation Control Equipment Institute BACEI
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Automation Control Equipment Institute BACEI filed Critical Beijing Automation Control Equipment Institute BACEI
Priority to CN201510727723.6A priority Critical patent/CN105486296A/zh
Publication of CN105486296A publication Critical patent/CN105486296A/zh
Pending legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G01C19/02—Rotary gyroscopes
    • G01C19/04—Details

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Gyroscopes (AREA)

Abstract

本发明属于动力调谐陀螺仪的回路的闭环控制技术领域，具体涉及一种基于FPGA的动力调谐陀螺仪数字再平衡回路。本发明包括陀螺仪本体层、硬件电路层、FPGA抽象层；可以使用单FPGA芯片实现数字再平衡控制回路的ADC采样控制，DAC输出控制和控制算法等，FPGA不仅做控制用，同时嵌入Nios？II处理器实现复杂的控制算法，使得再平衡电路尺寸大大减小，同时使用软件完成陷波器、积分器和校正算法等，使得调试变得更灵活。

Description

一种基于FPGA的动力调谐陀螺仪数字再平衡回路
技术领域
本发明属于动力调谐陀螺仪的回路的闭环控制技术领域，具体涉及一种基于FPGA的动力调谐陀螺仪数字再平衡回路。
背景技术
动力调谐陀螺仪再平衡回路一般由模拟电路完成，然后经过I/F转换电路提供对系统的数字接口。此种再平衡回路的输出为模拟电压量，且线路复杂、尺寸较大。
如果利用FPGA(现场可编程逻辑门阵列)芯片作为控制芯片，配合高速AD和DA芯片进行数字式再平衡回路控制，就可以不需经过外围转换电路，即可实现与输入速率成比例的数字量信息输出，且该电路尺寸较小、调试灵活。但是目前还没有关于这方面的技术方案的公开披露。
因此，亟需研制一种基于FPGA的动力调谐陀螺仪数字再平衡回路，从而灵活实现与输入速率成比例的数字量信息输出。
发明内容
本发明要解决的技术问题是提供一种基于FPGA的动力调谐陀螺仪数字再平衡回路，以解决现有的动力调谐陀螺仪再平衡回路线路复杂、尺寸较大等问题。
为了实现这一目的，本发明采取的技术方案是：
一种基于FPGA的动力调谐陀螺仪数字再平衡回路，包括陀螺仪本体层、硬件电路层、FPGA抽象层；
(1)陀螺仪本体层包括陀螺传感器及桥路和陀螺力矩器线圈；
动调陀螺传感器的激磁电源频率为系统设定值，当转子相对壳体发生位移时，陀螺传感器输出经过激磁电源频率调制的包含转子位置信息的交流信号，陀螺传感器输出的交流信号经过桥路进行放大；
(2)硬件电路层包括低通滤波器、ADC采样电路、DAC输出电路和V/I转换电路；FPGA抽象层包括NiosII处理器、Avalon总线、ADC采样控制模块和DAC控制模块；
陀螺传感器输出的交流信号经过桥路进行放大后进入低通滤波器，在低通滤波器中进行滤波，滤除噪声；
在FPGA抽象层中，ADC采样控制模块控制ADC采样电路以系统设定的固定频率对滤除噪声后的信号进行周期性采样，完成对转子位置信息的解调，得到的采样值为代表陀螺转子位置信息的直流电压值；
ADC采样电路每次采样结束后将采样值放入FPGA抽象层的存储区，并且触发一次中断；
NiosII处理器包括陷波器，数字积分器和校正算法；NiosII处理器接收到ADC采样电路触发的中断后进入中断服务程序，在中断服务程序中，通过Avalon总线读取ADC采样电路得到的采样值，经过陷波器将陀螺的噪声滤除，然后经过数字积分器和校正算法，得到校正后的数字量输出值，以此数字量输出值作为再平衡回路中与输入速率成比例的数字量信息输出，同时将该数字量输出值经过Avalon总线写入到DAC控制器模块中；
DAC控制模块收到校正后的数字量输出值后通过DAC输出电路将数字量输出值转换为模拟电压值，输出到V/I转换电路；模拟电压值经过V/I转换电路，转换为电流值并加入到陀螺力矩器线圈中，带动陀螺转子发生偏转，实现再平衡回路的闭环控制。
进一步的，如上所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路中，在不改动陀螺仪本体层和硬件电路层的条件下，通过改变NiosII处理器来调整控制算法和各项参数。
进一步的，如上所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路中，NiosII处理器中，使用C语言完成陷波器、数字积分器和校正算法的算法设计；使用双线性变换对陷波器进行Z变换，得到陷波器的系数，对超前校正网络进行Z变换，得到校正算法的系数。
进一步的，如上所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路中，动调陀螺传感器的激磁电源频率为43.2KHz，ADC采样电路的采样频率为21.6KHz。
本发明技术方案的有益效果在于：此发明可以使用单FPGA芯片实现数字再平衡控制回路的ADC采样控制，DAC输出控制和控制算法等，FPGA不仅做控制用，同时嵌入NiosII处理器实现复杂的控制算法，使得再平衡电路尺寸大大减小，同时使用软件完成陷波器、积分器和校正算法等，使得调试变得更灵活。
附图说明
图1是基于FPGA的数字再平衡回路层级结构图；
图2是硬件电路层—低通滤波器；
图3是硬件电路层—ADC采样电路；
图4是硬件电路层—DAC输出电路；
图5是硬件电路层—V/I转换电路。
具体实施方式
下面通过具体实施例对本发明技术方案进行进一步详细说明。
如图1所示，本发明一种基于FPGA的动力调谐陀螺仪数字再平衡回路，包括陀螺仪本体层、硬件电路层、FPGA抽象层；
(1)陀螺仪本体层包括陀螺传感器及桥路和陀螺力矩器线圈；
动调陀螺传感器的激磁电源频率为系统设定值，在本实施例中为43.2KHz；当转子相对壳体发生位移时，陀螺传感器输出经过43.2KHz调制的包含转子位置信息的交流信号，陀螺传感器输出的交流信号经过桥路进行放大；
(2)硬件电路层包括低通滤波器、ADC采样电路、DAC输出电路和V/I转换电路；FPGA抽象层包括NiosII处理器、Avalon总线、ADC采样控制模块和DAC控制模块；
陀螺传感器输出的交流信号经过桥路进行放大后进入如图2所示的低通滤波器，在低通滤波器中进行滤波，滤除噪声；
在FPGA抽象层中，ADC采样控制模块控制如图3所示的ADC采样电路以21.6KHz的固定频率对滤除噪声后的信号进行周期性采样，完成对转子位置信息的解调，得到的采样值为代表陀螺转子位置信息的直流电压值；
ADC采样电路每次采样结束后将采样值放入FPGA抽象层的存储区，并且触发一次中断；
NiosII处理器包括陷波器，数字积分器和校正算法；NiosII处理器接收到ADC采样电路触发的中断后进入中断服务程序，在中断服务程序中，通过Avalon总线读取ADC采样电路得到的采样值，经过陷波器将陀螺的噪声滤除，然后经过数字积分器和校正算法，得到校正后的数字量输出值，以此数字量输出值作为再平衡回路中与输入速率成比例的数字量信息输出，同时将该数字量输出值经过Avalon总线写入到DAC控制器模块中；
DAC控制模块收到校正后的数字量输出值后通过如图4所示的DAC输出电路将数字量输出值转换为模拟电压值，输出到如图5所示的V/I转换电路；模拟电压值经过V/I转换电路，转换为电流值并加入到陀螺力矩器线圈中，带动陀螺转子发生偏转，实现再平衡回路的闭环控制。
在本实施例中，使用C语言或其他汇编语言完成NiosII处理器中陷波器、数字积分器和校正算法的算法设计；使用双线性变换对陷波器进行Z变换，得到陷波器的系数，对超前校正网络进行Z变换，得到校正算法的系数。
在不改动陀螺仪本体层和硬件电路层的条件下，通过改变NiosII处理器来调整控制算法和各项参数。

Claims (4)

1.一种基于FPGA的动力调谐陀螺仪数字再平衡回路，其特征在于：包括陀螺仪本体层、硬件电路层、FPGA抽象层；
(1)陀螺仪本体层包括陀螺传感器及桥路和陀螺力矩器线圈；
动调陀螺传感器的激磁电源频率为系统设定值，当转子相对壳体发生位移时，陀螺传感器输出经过激磁电源频率调制的包含转子位置信息的交流信号，陀螺传感器输出的交流信号经过桥路进行放大；
(2)硬件电路层包括低通滤波器、ADC采样电路、DAC输出电路和V/I转换电路；FPGA抽象层包括NiosII处理器、Avalon总线、ADC采样控制模块和DAC控制模块；
陀螺传感器输出的交流信号经过桥路进行放大后进入低通滤波器，在低通滤波器中进行滤波，滤除噪声；
在FPGA抽象层中，ADC采样控制模块控制ADC采样电路以系统设定的固定频率对滤除噪声后的信号进行周期性采样，完成对转子位置信息的解调，得到的采样值为代表陀螺转子位置信息的直流电压值；
ADC采样电路每次采样结束后将采样值放入FPGA抽象层的存储区，并且触发一次中断；
NiosII处理器包括陷波器，数字积分器和校正算法；NiosII处理器接收到ADC采样电路触发的中断后进入中断服务程序，在中断服务程序中，通过Avalon总线读取ADC采样电路得到的采样值，经过陷波器将陀螺的噪声滤除，然后经过数字积分器和校正算法，得到校正后的数字量输出值，以此数字量输出值作为再平衡回路中与输入速率成比例的数字量信息输出，同时将该数字量输出值经过Avalon总线写入到DAC控制器模块中；
DAC控制模块收到校正后的数字量输出值后通过DAC输出电路将数字量输出值转换为模拟电压值，输出到V/I转换电路；模拟电压值经过V/I转换电路，转换为电流值并加入到陀螺力矩器线圈中，带动陀螺转子发生偏转，实现再平衡回路的闭环控制。
2.如权利要求1所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路，其特征在于：在不改动陀螺仪本体层和硬件电路层的条件下，通过改变NiosII处理器来调整控制算法和各项参数。
3.如权利要求1所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路，其特征在于：NiosII处理器中，使用C语言完成陷波器、数字积分器和校正算法的算法设计；使用双线性变换对陷波器进行Z变换，得到陷波器的系数，对超前校正网络进行Z变换，得到校正算法的系数。
4.如权利要求1所述的一种基于FPGA的动力调谐陀螺仪数字再平衡回路，其特征在于：动调陀螺传感器的激磁电源频率为43.2KHz，ADC采样电路的采样频率为21.6KHz。
CN201510727723.6A 2015-10-30 2015-10-30 一种基于fpga的动力调谐陀螺仪数字再平衡回路 Pending CN105486296A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510727723.6A CN105486296A (zh) 2015-10-30 2015-10-30 一种基于fpga的动力调谐陀螺仪数字再平衡回路

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510727723.6A CN105486296A (zh) 2015-10-30 2015-10-30 一种基于fpga的动力调谐陀螺仪数字再平衡回路

Publications (1)

Publication Number Publication Date
CN105486296A true CN105486296A (zh) 2016-04-13

Family

ID=55673433

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510727723.6A Pending CN105486296A (zh) 2015-10-30 2015-10-30 一种基于fpga的动力调谐陀螺仪数字再平衡回路

Country Status (1)

Country Link
CN (1) CN105486296A (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106441257A (zh) * 2016-09-27 2017-02-22 东南大学 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路
CN109631869A (zh) * 2018-12-11 2019-04-16 西安航天精密机电研究所 一种高精度二维线位移传感器系统
CN111583765A (zh) * 2020-05-28 2020-08-25 星酉(天津)智能科技有限公司 基于cdio测控电路的软硬件交互式综合实验箱及方法
CN112880657A (zh) * 2021-01-15 2021-06-01 清华大学 用于mems谐振式陀螺仪信号解调及控制的片上系统

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060009946A1 (en) * 2003-06-30 2006-01-12 Uwe Betz Rotational speed sensor comprising a vibrating gyroscope and method for equalising the rotational speed sensor
CN202304840U (zh) * 2011-11-10 2012-07-04 河北汉光重工有限责任公司 挠性陀螺再平衡回路板
CN204228166U (zh) * 2014-11-14 2015-03-25 重庆天箭惯性科技有限公司 动力调谐陀螺仪再平衡电路
CN104976994A (zh) * 2014-04-02 2015-10-14 北京自动化控制设备研究所 一种用于动力调谐陀螺仪再平衡回路的数字式解调电路

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060009946A1 (en) * 2003-06-30 2006-01-12 Uwe Betz Rotational speed sensor comprising a vibrating gyroscope and method for equalising the rotational speed sensor
CN202304840U (zh) * 2011-11-10 2012-07-04 河北汉光重工有限责任公司 挠性陀螺再平衡回路板
CN104976994A (zh) * 2014-04-02 2015-10-14 北京自动化控制设备研究所 一种用于动力调谐陀螺仪再平衡回路的数字式解调电路
CN204228166U (zh) * 2014-11-14 2015-03-25 重庆天箭惯性科技有限公司 动力调谐陀螺仪再平衡电路

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
肖琦: "动力调谐陀螺仪再平衡回路的数字控制器的设计与分析", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106441257A (zh) * 2016-09-27 2017-02-22 东南大学 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路
CN106441257B (zh) * 2016-09-27 2019-06-18 东南大学 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路
CN109631869A (zh) * 2018-12-11 2019-04-16 西安航天精密机电研究所 一种高精度二维线位移传感器系统
CN109631869B (zh) * 2018-12-11 2021-06-15 西安航天精密机电研究所 一种高精度二维线位移传感器系统
CN111583765A (zh) * 2020-05-28 2020-08-25 星酉(天津)智能科技有限公司 基于cdio测控电路的软硬件交互式综合实验箱及方法
CN112880657A (zh) * 2021-01-15 2021-06-01 清华大学 用于mems谐振式陀螺仪信号解调及控制的片上系统
CN112880657B (zh) * 2021-01-15 2023-02-07 清华大学 用于mems谐振式陀螺仪信号解调及控制的片上系统

Similar Documents

Publication Publication Date Title
CN105486296A (zh) 一种基于fpga的动力调谐陀螺仪数字再平衡回路
CN107077580B (zh) 具有可编程模拟子系统的集成电路设备
CN101893465B (zh) 一种基于dsp的电磁流量计信号处理系统
CN202304840U (zh) 挠性陀螺再平衡回路板
CN103776469B (zh) 一种基于fpga的硅微陀螺仪温控温补电路装置
US8854126B2 (en) Semiconductor device and offset voltage correcting method
CN104931077B (zh) 一种减小集成霍尔传感器残余失调的电路
EP3079133A1 (en) Sensor control circuit and electronic apparatus
CN103134484A (zh) 调节电容式mems陀螺仪检测端谐振频率的电路和方法
CN105065452A (zh) 一种集成化磁悬浮惯性稳定平台磁轴承数字控制系统
CN104360146A (zh) 一种双极性模拟量输入检测电路
CN102707128B (zh) 一种基于微控制器的交流信号采集电路及方法
WO2016008801A1 (en) Position sensor device and method for providing a filtered position signal
CN100492243C (zh) 基于dsp的快速反射镜实时主动振动控制系统
CN203324462U (zh) 一种对磁传感器进行检测和标定的系统
CN103472751B (zh) 纯电动汽车用ad采样电路
CN104569675B (zh) 一种电能计量芯片中的闪变检测电路及检测方法
CN203104409U (zh) 一种市电精确检测跟踪数字锁相的系统
CN104539264B (zh) 应用于eps电源系统的滤波方法及滤波电路
CN111964655B (zh) 一种石英音叉陀螺仪数字驱动电路
CN203550961U (zh) 一种低成本挠性陀螺力平衡电路
CN107508520B (zh) 一种永磁电机控制方法和装置
CN108627146A (zh) 一种三浮陀螺磁悬浮控制电路
CN110780250B (zh) 一种剩余电流检测的自动校准系统及方法
CN102158144B (zh) 一种数字胃肠机自动光圈的微电机驱动电路

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20160413

RJ01 Rejection of invention patent application after publication