CN106441257B - 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 - Google Patents
基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 Download PDFInfo
- Publication number
- CN106441257B CN106441257B CN201610854616.4A CN201610854616A CN106441257B CN 106441257 B CN106441257 B CN 106441257B CN 201610854616 A CN201610854616 A CN 201610854616A CN 106441257 B CN106441257 B CN 106441257B
- Authority
- CN
- China
- Prior art keywords
- output
- module
- circuit
- input
- signal
- 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.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 72
- XUIMIQQOPSSXEZ-UHFFFAOYSA-N Silicon Chemical compound [Si] XUIMIQQOPSSXEZ-UHFFFAOYSA-N 0.000 title claims abstract description 24
- 229910052710 silicon Inorganic materials 0.000 title claims abstract description 24
- 239000010703 silicon Substances 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title claims abstract description 11
- 238000013467 fragmentation Methods 0.000 title abstract 2
- 238000006062 fragmentation reaction Methods 0.000 title abstract 2
- 230000003321 amplification Effects 0.000 claims abstract description 141
- 238000003199 nucleic acid amplification method Methods 0.000 claims abstract description 141
- 230000006835 compression Effects 0.000 claims description 131
- 238000007906 compression Methods 0.000 claims description 131
- 230000003750 conditioning effect Effects 0.000 claims description 131
- 238000005070 sampling Methods 0.000 claims description 78
- 238000006243 chemical reaction Methods 0.000 claims description 75
- 238000009499 grossing Methods 0.000 claims description 36
- 230000011218 segmentation Effects 0.000 claims description 15
- 238000001914 filtration Methods 0.000 claims description 14
- 238000005516 engineering process Methods 0.000 claims description 8
- 230000009286 beneficial effect Effects 0.000 abstract description 3
- 238000005265 energy consumption Methods 0.000 abstract 1
- 239000000203 mixture Substances 0.000 abstract 1
- 230000002093 peripheral effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 238000005259 measurement Methods 0.000 description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- 230000001808 coupling effect Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 239000000284 extract Substances 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 238000011896 sensitive detection Methods 0.000 description 1
- 238000007493 shaping process Methods 0.000 description 1
- 238000003786 synthesis reaction Methods 0.000 description 1
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
本发明公开一种基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,包括硅微动调陀螺仪的两组力矩反馈电极,两组信号敏感电极,以及两组闭环控制电路组成。每组闭环控制电路包括检测接口模拟处理电路、AD采样电路、FPGA控制算法、DA输出接口电路、直接数字式频率合成器。该硅微动调陀螺仪高精度数字闭环检测电路具有数字化控制和输出的优点,便于与外设接口相连;四路级联放大电路和AD采样电路的配合使用,拓宽了AD的采样范围,有益于提升对微弱信号的检测精度;DA输入信号的分级放大操作有益于充分发挥高精度DA的输出精度;控制算法在FPGA内实现,具有集成度高,体积小,功耗低等优点。
Description
技术领域
本发明涉及一种基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,属于微机电系统(MEMS)和微惯性器件测量领域。
背景技术
微机电陀螺仪是指利用微机电系统(MEMS)技术,并依据哥式效应原理工作的一类陀螺仪。根据工作方式的不同,微机电陀螺仪可分为振动式、转子式和介质类。转子式微陀螺仪能够实现较高的精度(导航级),且都是二自由度陀螺。调谐式转子微陀螺仪最先由美国CSDL的L.J.Jenkins等人于2002年提出,它结合了硅微陀螺仪和动力调谐陀螺仪各自的优点,理论分析表明,该种陀螺仪的测量精度可达0.005°/h。调谐转子式陀螺仪摒弃了目前硅微机电陀螺仪通用的高频振动驱动方式,采用了高速旋转驱动的自由转子方式,从而能有效克服振动陀螺仪的一系列弊病,较大幅度地提升了微机电陀螺仪的测量精度。该种陀螺仪信号器采用电容检测和静电力矩反馈形式,目前的动力调谐陀螺仪大多数采用电感信号器和动铁式力矩器,不仅体积大、质量大,而且在较高速率下工作时发热量很大。
发明内容
发明目的:为克服现有技术不足,本发明旨于提供一种基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路。
技术方案:为解决上述技术问题,本发明采用如下技术方案:
一种基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,包括硅微动调陀螺仪的第一力矩反馈电极(Ad)、第二力矩反馈电极(Bd)、第一信号敏感电极(As)、第二信号敏感电极(Bs)、第一闭环控制电路、第二闭环控制电路和直流升压模块;
第一信号敏感电极(As)的输出作为第一闭环控制电路的输入,第一闭环控制电路的输出作为第一力矩反馈电极(Ad)的输入;
第二信号敏感电极(Bs)的输出作为第二闭环控制电路的输入,第二闭环控制电路的输出作为第二力矩反馈电极(Bd)的输入;
直流升压模块的输出分别作为第一力矩反馈电极(Ad)和第二力矩反馈电极(Bd)的输入。
本申请第一闭环控制电路和第二闭环控制电路结构相同。
调谐转子式微陀螺仪采用平衡环结构,为采用电容检测和静电力反馈结构创造了条 件。
本申请基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路提交小、集成度高、质量轻、功耗低。
为了进一步提高检测精度,第一闭环控制电路包括第一检测接口模拟处理电路、第一AD采样电路、第一FPGA控制算法、第一DA输出接口电路和第一直接数字式频率合成器;
第一信号敏感电极(As)的输出作为第一检测接口模拟处理电路的输入,第一检测接口模拟处理电路的输出作为第一AD采样电路的输入,第一AD采样电路的输出经过第一FPGA控制算法作为第一DA输出接口电路和第一直接数字式频率合成器的输入,第一DA输出接口电路和第一直接数字式频率合成器的输出均作为第一力矩反馈电极(Ad)的输入,第一直接数字式频率合成器的输出还作为第一检测接口模拟处理电路的输入;
第二闭环控制电路包括第二检测接口模拟处理电路、第二AD采样电路、第二FPGA控制算法、第二DA输出接口电路和第二直接数字式频率合成器;
第二信号敏感电极(Bs)的输出作为第二检测接口模拟处理电路的输入,第二检测接口模拟处理电路的输出作为第二AD采样电路的输入,第二AD采样电路的输出经过第二FPGA控制算法作为第二DA输出接口电路和第二直接数字式频率合成器的输入,第二DA输出接口电路和第二直接数字式频率合成器的输出均作为第二力矩反馈电极(Bd)的 输入,第二直接数字式频率合成器的输出还作为第二检测接口模拟处理电路的输入。
为了抑制两轴间的耦合作用,有效提取两轴检测电容信号,控制电路采用了两组不同频率的载波信号对检测电容信号进行调制解调。两组载波信号由直接数字式频率合成器产生,其控制信号由主控芯片FPGA发出。
为了更进一步提高检测精度,第一检测接口模拟处理电路包括第一前置放大器、第一 带通选频放大器、第一相敏解调器和第一低通滤波器;
第一信号敏感电极(As)的输出作为第一前置放大器的输入,第一前置放大器的输出作为第一带通选频放大器的输入,第一带通选频放大器的输出作为第一相敏解调器的输入,第一相敏解调器的输出作为第一低通滤波器的输入,第一低通滤波器的输出作为第一AD采样电路的输入,第一直接数字式频率合成器的输出作为第一相敏解调器输入;
第二检测接口模拟处理电路包括第二前置放大器、第二带通选频放大器、第二相敏解 调器和第二低通滤波器;
第二信号敏感电极(Bs)的输出作为第二前置放大器的输入,第二前置放大器的输出作为第二带通选频放大器的输入,第二带通选频放大器的输出作为第二相敏解调器的输入,第二相敏解调器的输出作为第二低通滤波器的输入,第二低通滤波器的输出作为第二AD采样电路的输入,第二直接数字式频率合成器的输出作为第二相敏解调器输入。
上述前置放大器与信号敏感电极相连,实现对检测信号的放大;带通选频放大器用于将放大器输出的两轴混合信号分开并相应放大;相敏解调器的参考信号来自直接数字式频率合成器,相敏解调器的输入信号为带通选频放大器的输出;相敏解调器的输出信号作为 低通滤波器的输入;滤波后的信号将作为AD采样电路的输入信号。
为了进一步提高检测精度,第一FPGA控制算法包括第一AD信号调理模块、第一PI比例-积分控制器、第一平滑滤波模块、第一DA输出预调理模块和第一控制信号产生模块;
第一AD信号调理模块的输出作为第一PI比例-积分控制器的输入,第一PI比例-积分控制器的输出作为第一平滑滤波模块的输入,第一平滑滤波模块的输出作为第一DA输出预调理模块的输入,第一DA输出预调理模块的输出作为第一DA输出接口电路的输入,第一控制信号产生模块的输出作为第一直接数字式频率合成器的输入;
第二FPGA控制算法包括第二AD信号调理模块、第二PI比例-积分控制器、第二平滑滤波模块、第二DA输出预调理模块和第二控制信号产生模块;
第二AD信号调理模块的输出作为第二PI比例-积分控制器的输入,第二PI比例-积分控制器的输出作为第二平滑滤波模块的输入,第二平滑滤波模块的输出作为第二DA输出预调理模块的输入,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入,第二控制信号产生模块的输出作为第二直接数字式频率合成器的输入。
AD信号调理模块用以将输入的四路AD采样信号进行拼接整合,拼接整合后的信号作为PI控制模块的输入;PI处理后的信号作为平滑滤波模块的输入,进行相应的平滑去噪处理。DA输出预调理模块将平滑滤波后的信号进行分级处理,以便与后级DA输出调理电路联合使用。
AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为AD信号调理模块的输出。该操作保证了AD级联采样电路在不同幅度输入信号的情况下,通过选择合适的放大倍数,以及后续的扩位取位操作,使得处理后的采样有效位数保持一致。
AD信号调理模块的输出信号作为PI控制模块的输入,同时,AD信号调理模块将信号处理时所包含的倍数信息、取位信息传递给PI控制模块作为PI处理时进行倍数补偿的控制信号。
PI控制模块的输出信号作为平滑滤波模块的输入,平滑滤波模块采用去峰值滑动平均算法,滑动长度为M,每次处理时去掉最大值、最小值,取剩余M-2个数据的平均值,滑动平均使用先进先出算法,每个控制周期运行一次;平滑滤波模块主要将AD信号调理 模块、PI控制模块在进行拼接操作时产生的噪声滤除,平滑运算结果。
为提高对检测信号的采样精度,第一AD采样电路使用四路级联AD采样,单路采样回路包括第一信号放大模块一、第一信号放大模块二、第一信号放大模块三、第一信号放大模块四、第一偏置电路一、第一偏置电路二、第一偏置电路三、第一偏置电路四、第一 AD芯片一、第一AD芯片二、第一AD芯片三和第一AD芯片四;
第一信号放大模块一、第一信号放大模块二、第一信号放大模块三和第一信号放大模 块四依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第一信号放大模块一、第一偏置电路一、第一AD芯片一和第一AD信号调理模块顺序相接;第一信号放大模块二、第一偏置电路二、第一AD芯片二和第一AD信号调理模块顺序相接; 第一信号放大模块三、第一偏置电路三、第一AD芯片三和第一AD信号调理模块顺序相 接;第一信号放大模块四、第一偏置电路四、第一AD芯片四和第一AD信号调理模块顺序相接;第一低通滤波器的输出作为第一信号放大模块一的输入;
第二AD采样电路使用四路级联AD采样,单路采样回路包括第二信号放大模块一、第二信号放大模块二、第二信号放大模块三、第二信号放大模块四、第二偏置电路一、第 二偏置电路二、第二偏置电路三、第二偏置电路四、第二AD芯片一、第二AD芯片二、 第二AD芯片三和第二AD芯片四;
第二信号放大模块一、第二信号放大模块二、第二信号放大模块三和第二信号放大模块四依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第二信号放大模块一、第二偏置电路一、第二AD芯片一和第二AD信号调理模块顺序相接;第 二信号放大模块二、第二偏置电路二、第二AD芯片二和第二AD信号调理模块顺序相接; 第二信号放大模块三、第二偏置电路三、第二AD芯片三和第二AD信号调理模块顺序相 接;第二信号放大模块四、第二偏置电路四、第二AD芯片四和第二AD信号调理模块顺 序相接;第二低通滤波器的输出作为第二信号放大模块一的输入。
四路AD芯片对不同放大倍数的输入信号采样后,其结果作为AD信号调理模块的输入,做进一步处理。
为了进一步提高检测精度,第一AD信号调理模块包括第一AD转换结果一、第一 AD转换结果二、第一AD转换结果三、第一AD转换结果四、第一位数扩展模块一、第一位数扩展模块二、第一位数扩展模块三、第一位数扩展模块四、第一位数压缩模块一、第一位数压缩模块二、第一位数压缩模块三、第一位数压缩模块四、第一比较器和第一多 路选择器;
第一AD转换结果一、第一AD转换结果二、第一AD转换结果三、第一AD转换结果四分别与第一位数扩展模块一、第一位数扩展模块二、第一位数扩展模块三、第一位数 扩展模块四相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第一位数扩展模块一、第一位数扩展模块二、第一位数扩展模块三、第一位数扩展模 块四分别与第一位数压缩模块一、第一位数压缩模块二、第一位数压缩模块三、第一位数 压缩模块四相连,将有用的数字信号量提取出来;第一位数压缩模块一、第一位数压缩模块二、第一位数压缩模块三、第一位数压缩模块四均与第一比较器相连,第一位数压缩模块一、第一位数压缩模块二、第一位数压缩模块三、第一位数压缩模块四的输出量作为第一比较器的输入,第一比较器将四路数字信号分别与预设阈值相比较,得到选择控制量;第一位数压缩模块一、第一位数压缩模块二、第一位数压缩模块三、第一位数压缩模块四 均与第一多路选择器相连,第一比较器与第一多路选择器相连,第一比较器的输出作为第 一多路选择器的控制信号;
第一AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第一AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第一AD信号调理模块 的输出。
该操作保证了AD级联采样电路在不同幅度输入信号的情况下,通过选择合适的放大倍数,以及后续的扩位取位操作,使得处理后的采样有效位数保持一致。
为了进一步提高检测精度,第二AD信号调理模块包括第二AD转换结果一、第二 AD转换结果二、第二AD转换结果三、第二AD转换结果四、第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四、第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四、第二比较器和第二多路选择器;
第二AD转换结果一、第二AD转换结果二、第二AD转换结果三、第二AD转换结果四分别与第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四分别与第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四相连,将有用的数字信号量提取出来;第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四均与第二比较器相连,第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四的输出量作为第二比较器的输入,第二比较器将四路数字信号分别与预设阈值相比较,得到选择控制量;第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四均与第二多路选择器相连,第二比较器与第二多路选择器相连,第二比较器的输出作为第二多路选择器的控制信号;
第二AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第二AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第二AD信号调理模块 的输出。
为了进一步提高检测精度,第一DA输出预调理模块包括第一比较器一、第一增益选择器和第一乘法器;第一平滑滤波模块的输出作为第一比较器一和第一乘法器的输入,第一比较器一的输出结果作为第一增益选择器的输入,第一增益选择器的输出与第一平滑滤波模块的输出相乘,所得结果作为第一DA输出预调理模块的输出,第一DA输出预调理模块的输出作为第一DA输出接口电路的输入;
第二DA输出预调理模块包括第二比较器一、第二增益选择器和第二乘法器;第二平 滑滤波模块的输出作为第二比较器一和第二乘法器的输入,第二比较器一的输出结果作为 第二增益选择器的输入,第二增益选择器的输出与第二平滑滤波模块的输出相乘,所得结 果作为第二DA输出预调理模块的输出,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入。
平滑滤波模块的输出信号作为DA输出预调理模块的输入,从闭环控制回路整体来看,平滑滤波模块的输出信号为反馈信号,为提高反馈信号的控制精度,充分发挥高精度DA的输出精度,DA输出预调理模块需要将输入信号进行分级放大后再送入DA输出。平滑滤波模块的输出作为比较器和乘法器的输入,比较器的输出结果作为增益选择器的输入,增益选择器的输出与平滑滤波模块的输出相乘,所得结果作为DA输出预调理模块的输出。该模块将输入信号按照幅值大小分成四个部分,即[0,F/N3]、[F/N3, F/N2]、[F/N2, F/N]、[F/N,F],其中N为设定分割倍数,F代表饱和值。然后将落在上述四个范围内的数字量信号分别放大N3、N2、N、1倍。
为了进一步提高检测精度,第一DA输出接口电路包括第一DA转换电路、第一DA 输出缩放电路一、第一DA输出缩放电路二、第一DA输出缩放电路三、第一DA输出缩 放电路四、第一多路信号选择器和第一功率放大器;
第一DA输出预调理模块的输出信号作为第一DA转换电路的输入,第一DA转换电路的输出作为第一DA输出缩放电路一的输入,第一DA输出缩放电路一、第一DA输出 缩放电路二、第一DA输出缩放电路三和第一DA输出缩放电路四依次相连,第一DA输 出缩放电路一、第一DA输出缩放电路二、第一DA输出缩放电路三、第一DA输出缩放 电路四和第一DA输出预调理模块分别与第一多路信号选择器相连,第一多路信号选择器 的输出作为第一功率放大器的输入,第一功率放大器的输出作为第一力矩反馈电极(Ad) 的输入;
第二DA输出接口电路包括第二DA转换电路、第二DA输出缩放电路一、第二DA 输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四、第二多路信号选择器和第二功率放大器;
第二DA输出预调理模块的输出信号作为第二DA转换电路的输入,第二DA转换电路的输出作为第二DA输出缩放电路一的输入,第二DA输出缩放电路一、第二DA输出 缩放电路二、第二DA输出缩放电路三和第二DA输出缩放电路四依次相连,第二DA输出缩放电路一、第二DA输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四和第二DA输出预调理模块分别与第二多路信号选择器相连,第二多路信号选择器 的输出作为第二功率放大器的输入,第二功率放大器的输出作为第二力矩反馈电极(Bd) 的输入。
上述DA输出与DA输出缩放电路的输入相连,DA输出缩放电路采用级联缩放电路,对输入信号依次放大1/N3、1/N2、1/N、1倍。多路信号选择器的输入信号为DA级联缩放电路的四路输出信号,DA输出预调理模块在做分级放大时,将分级信息输出至多路信号选择器作为其控制信号,多路信号选择器的输出与功率放大器相连。DA输出预调理模块、DA 转换电路、DA级联缩放电路以及多路信号选择器的配合使用在保证数模信号转换的同时,通过相应放大缩小,使得高精度DA转换电路充分发挥其高精度输出作用,提高了反馈信号的控制精度。功率放大器的输出与反馈电极Ad相连,直流升压模块提供用于加载 在反馈电极Ad上高电压,实现闭环反馈控制。
本发明未提及的技术均为现有技术。
本发明硅微动调陀螺仪高精度数字闭环检测电路具有如下有益效果:
(1)具有数字化控制和输出的优点,便于与外设接口相连;
(2)基于分段技术的四路级联放大电路和AD采样电路的配合使用,拓宽了AD的采样范围,尤其是提高了对小信号的提取能力,有益于提升对微弱信号的检测精度;
(3)对DA输入信号的分级放大操作使得DA的输出始终保持在较高输出电压附近,有益于充分发挥高精度DA的输出精度;
(4)控制算法在FPGA内实现,具有集成度高,体积小,功耗低等优点。
附图说明
图1是本发明的基于分段技术的硅微动调陀螺仪高精度数字闭环检测系统框图;
图2是本发明的检测接口模拟处理电路框图;
图3是本发明的FPGA处理算法框图;
图4是本发明的AD采样电路框图;
图5是本发明的AD信号调理模块框图;
图6是本发明的DA输出预调理模块框图;
图7是本发明的DA输出调理模块框图。
具体实施方式
为了更好地理解本发明,下面结合实施例进一步阐明本发明的内容,但本发明的内容 不仅仅局限于下面的实施例。
如图1所述,基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,包括硅微动 调陀螺仪2的第一力矩反馈电极Ad、第二力矩反馈电极Bd、第一信号敏感电极As、第 二信号敏感电极Bs、第一闭环控制电路、第二闭环控制电路和直流升压模块1;
第一信号敏感电极As的输出作为第一闭环控制电路的输入,第一闭环控制电路的输出作为第一力矩反馈电极Ad的输入;
第二信号敏感电极Bs的输出作为第二闭环控制电路的输入,第二闭环控制电路的输出作为第二力矩反馈电极Bd的输入;
直流升压模块1的输出分别作为第一力矩反馈电极Ad和第二力矩反馈电极Bd的输入;
第一闭环控制电路包括第一检测接口模拟处理电路3、第一AD采样电路4、第一FPGA控制算法5、第一DA输出接口电路6和第一直接数字式频率合成器7;
第一信号敏感电极As的输出作为第一检测接口模拟处理电路3的输入,第一检测接 口模拟处理电路3的输出作为第一AD采样电路4的输入,第一AD采样电路4的输出经 过第一FPGA控制算法5作为第一DA输出接口电路6和第一直接数字式频率合成器7 的输入,第一DA输出接口电路6和第一直接数字式频率合成器7的输出均作为第一力矩反馈电极Ad的输入,第一直接数字式频率合成器7的输出还作为第一检测接口模拟处理电路3的输入;
第二闭环控制电路包括第二检测接口模拟处理电路8、第二AD采样电路9、第二FPGA控制算法10、第二DA输出接口电路11和第二直接数字式频率合成器12;
第二信号敏感电极Bs的输出作为第二检测接口模拟处理电路8的输入,第二检测接口模拟处理电路8的输出作为第二AD采样电路9的输入,第二AD采样电路9的输出经 过第二FPGA控制算法10作为第二DA输出接口电路11和第二直接数字式频率合成器 12的输入,第二DA输出接口电路11和第二直接数字式频率合成器12的输出均作为第二力矩反馈电极Bd的输入,第二直接数字式频率合成器12的输出还作为第二检测接口模拟处理电路8的输入。
上述两组闭环控制回路在结构上一致,只是为了抑制两轴间的耦合作用,有效区分提 取两轴敏感检测电容信号,控制电路采用了两组不同频率的载波信号对检测电容信号进行调制解调。两组载波信号由直接数字式频率合成器产生,其控制信号由主控芯片FPGA 发出。为方便叙述,下面以其中一组闭环控制回路做进一步解释。信号敏感电极As与检 测接口模拟处理电路相连,实现对检测信号的初步放大、解调、滤波处理。检测接口模拟处理电路需要完成相敏解调功能,其参考信号来自于直接数字式频率合成器的输出信号。检测接口模拟处理电路的输出作为AD采样电路的输入,AD采样电路完成采样后,将其得到的数字信号输入FPGA控制算法模块,FPGA控制算法模块实现对采样信号的变换、整形、拆解、合成以及后续的PI控制和平滑处理。FPGA控制算法模块与DA输出接口电路和直接数字式频率合成器相连,分别将所需的控制信号送入两个模块。
如图2所示,第一检测接口模拟处理电路3包括第一前置放大器13、第一带通选频放大器14、第一相敏解调器15和第一低通滤波器16;
第一信号敏感电极As的输出作为第一前置放大器13的输入,第一前置放大器13的输出作为第一带通选频放大器14的输入,第一带通选频放大器14的输出作为第一相敏解调器15的输入,第一相敏解调器15的输出作为第一低通滤波器16的输入,第一低通滤 波器16的输出作为第一AD采样电路4的输入,第一直接数字式频率合成器7的输出作为第一相敏解调器15输入;
第二检测接口模拟处理电路8包括第二前置放大器、第二带通选频放大器、第二相敏解调器和第二低通滤波器;
第二信号敏感电极Bs的输出作为第二前置放大器的输入,第二前置放大器的输出作为第二带通选频放大器的输入,第二带通选频放大器的输出作为第二相敏解调器的输入,第二相敏解调器的输出作为第二低通滤波器的输入,第二低通滤波器的输出作为第二AD 采样电路9的输入,第二直接数字式频率合成器12的输出作为第二相敏解调器输入。
上述前置放大器与信号敏感电极As相连,实现对检测信号的放大;带通选频放大器 用于将放大器输出的两轴混合信号分开并相应放大;相敏解调器的参考信号来自直接数字 式频率合成器,输入信号为带通选频放大器的输出;相敏解调器的输出信号作为低通滤波 器的输入;滤波后的信号将作为AD采样电路的输入信号。
如图3所示,第一FPGA控制算法5包括第一AD信号调理模块17、第一PI比例- 积分控制器18、第一平滑滤波模块19、第一DA输出预调理模块20和第一控制信号产生模块21;
第一AD信号调理模块17的输出作为第一PI比例-积分控制器18的输入,第一PI 比例-积分控制器18的输出作为第一平滑滤波模块19的输入,第一平滑滤波模块19的输 出作为第一DA输出预调理模块20的输入,第一DA输出预调理模块20的输出作为第一 DA输出接口电路6的输入,第一控制信号产生模块21的输出作为第一直接数字式频率合成器7的输入;
第二FPGA控制算法10包括第二AD信号调理模块、第二PI比例-积分控制器、第 二平滑滤波模块、第二DA输出预调理模块和第二控制信号产生模块;
第二AD信号调理模块的输出作为第二PI比例-积分控制器的输入,第二PI比例-积分控制器的输出作为第二平滑滤波模块的输入,第二平滑滤波模块的输出作为第二DA输出预调理模块的输入,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入, 第二控制信号产生模块的输出作为第二直接数字式频率合成器的输入。
AD信号调理模块用以将输入的四路AD采样信号进行拼接整合,拼接整合后的信号作为PI控制模块的输入。PI处理后的信号作为平滑滤波模块的输入,进行相应的平滑去噪处理。DA输出预调理模块20将平滑滤波后的信号进行分级处理,以便与后级DA输出调理电路联合使用。AD信号调理模块的输出信号作为PI控制模块的输入,同时,AD 信号调理模块将信号处理时所包含的倍数信息、取位信息传递给PI控制模块作为PI处理时进行倍数补偿的控制信号。PI控制模块的输出信号作为平滑滤波模块的输入,平滑滤波模块采用去峰值滑动平均算法,滑动长度为M,每次处理时去掉最大值、最小值,取剩余M-2个数据的平均值,滑动平均使用先进先出算法,每个控制周期运行一次。平滑滤波模块主要将AD信号调理模块、PI控制模块在进行拼接操作时产生的噪声滤除,平滑运算结果。平滑滤波模块的输出信号作为DA输出预调理模块的输入,从闭环控制回路 整体来看,平滑滤波模块的输出信号为反馈信号,为提高反馈信号的控制精度,充分发挥高精度DA的输出精度,DA输出预调理模块需要将输入信号进行分级放大后再送入DA 输出。直接数字式频率合成器与其控制信号产生模块相连。
如图4所示,第一AD采样电路4使用四路级联AD采样,单路采样回路包括第一信 号放大模块一22、第一信号放大模块二25、第一信号放大模块三28、第一信号放大模块四31、第一偏置电路一23、第一偏置电路二26、第一偏置电路三29、第一偏置电路四32、第一AD芯片一24、第一AD芯片二27、第一AD芯片三30和第一AD芯片四33;
第一信号放大模块一22、第一信号放大模块二25、第一信号放大模块三28和第一信 号放大模块四31依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第一信号放大模块一22、第一偏置电路一23、第一AD芯片一24和第一AD信号调理模块17顺序相接;第一信号放大模块二25、第一偏置电路二26、第一AD芯片二 27和第一AD信号调理模块17顺序相接;第一信号放大模块三28、第一偏置电路三29、第一AD芯片三30和第一AD信号调理模块17顺序相接;第一信号放大模块四31、第一偏置电路四32、第一AD芯片四33和第一AD信号调理模块17顺序相接;第一低通滤波器16的输出作为第一信号放大模块一22的输入;
第二AD采样电路9使用四路级联AD采样,单路采样回路包括第二信号放大模块一、第二信号放大模块二、第二信号放大模块三、第二信号放大模块四、第二偏置电路一、第 二偏置电路二、第二偏置电路三、第二偏置电路四、第二AD芯片一、第二AD芯片二、 第二AD芯片三和第二AD芯片四;
第二信号放大模块一、第二信号放大模块二、第二信号放大模块三和第二信号放大模 块四依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第二信号放大模块一、第二偏置电路一、第二AD芯片一和第二AD信号调理模块顺序相接;第二信号放大模块二、第二偏置电路二、第二AD芯片二和第二AD信号调理模块顺序相接;第二信号放大模块三、第二偏置电路三、第二AD芯片三和第二AD信号调理模块顺序相接;第二信号放大模块四、第二偏置电路四、第二AD芯片四和第二AD信号调理模块顺 序相接;第二低通滤波器的输出作为第二信号放大模块一的输入。
四路AD芯片对不同放大倍数的输入信号采样后,其结果作为AD信号调理模块的输入,做进一步处理。
如图5所示,第一AD信号调理模块17包括第一AD转换结果一34、第一AD转换 结果二37、第一AD转换结果三40、第一AD转换结果四43、第一位数扩展模块一35、 第一位数扩展模块二38、第一位数扩展模块三41、第一位数扩展模块四44、第一位数压 缩模块一36、第一位数压缩模块二39、第一位数压缩模块三42、第一位数压缩模块四45、 第一比较器46和第一多路选择器47;
第一AD转换结果一34、第一AD转换结果二37、第一AD转换结果三40、第一 AD转换结果四43分别与第一位数扩展模块一35、第一位数扩展模块二38、第一位数扩 展模块三41、第一位数扩展模块四44相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第一位数扩展模块一35、第一位数扩展模块二38、第一位数扩展模块三41、第一位数扩展模块四44分别与第一位数压缩模块一36、第一位数压缩模块二39、第一位数压缩 模块三42、第一位数压缩模块四45相连,将有用的数字信号量提取出来;第一位数压缩 模块一36、第一位数压缩模块二39、第一位数压缩模块三42、第一位数压缩模块四45 均与第一比较器46相连,第一位数压缩模块一36、第一位数压缩模块二39、第一位数压缩模块三42、第一位数压缩模块四45的输出量作为第一比较器46的输入,第一比较器 46将四路数字信号分别与预设阈值相比较,得到选择控制量;第一位数压缩模块一36、 第一位数压缩模块二39、第一位数压缩模块三42、第一位数压缩模块四45均与第一多路选择器47相连,第一比较器46与第一多路选择器47相连,第一比较器46的输出作为第一多路选择器47的控制信号;
第一AD信号调理模块17首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第一AD信号调理模块17对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第一AD信号调理模块17的输出。
第二AD信号调理模块包括第二AD转换结果一、第二AD转换结果二、第二AD转 换结果三、第二AD转换结果四、第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四、第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四、第二比较器和第二多路选择器;
第二AD转换结果一、第二AD转换结果二、第二AD转换结果三、第二AD转换结果四分别与第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将 根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四分别与第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四相连,将有用的数字信号量提取出来;第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四均与第二比较器相连,第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四的输出量作为第二比较器的输入,第二比较器将四路数字信号分别与预设阈值相比较,得到选择控制量; 第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四 均与第二多路选择器相连,第二比较器与第二多路选择器相连,第二比较器的输出作为第 二多路选择器的控制信号;
第二AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第二AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第二AD信号调理模块的输出。
四路AD转换结果分别与四路位数扩展模块相连,前期已经知道四路AD所采信号对应 的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,主要 思想是将小的数字量放大,大的数字量不变;位数扩展模块与位数压缩模块相连,将有用 的数字信号量提取出来;位数压缩模块与比较器相连,压缩模块的输出量作为比较器的输入,比较器将四路数字信号分别与预设阈值相比较,得到选择控制量;位数压缩模块与多路选择器相连,比较器与多路选择器相连,比较器的输出作为多路选择器的控制信号。AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放 大倍数的不同进行相应的压缩取位;AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为AD信号调理模块的输出。该操作保证了AD级联采样电路在不同幅度输入信号的情况下,通过选择合适的放大倍数,以及后续的 扩位取位操作,使得处理后的采样有效位数保持一致。
如图6所示,第一DA输出预调理模块20包括第一比较器一48、第一增益选择器49和第一乘法器50;第一平滑滤波模块19的输出作为第一比较器一48和第一乘法器50的 输入,第一比较器一48的输出结果作为第一增益选择器49的输入,第一增益选择器49 的输出与第一平滑滤波模块19的输出相乘,所得结果作为第一DA输出预调理模块20 的输出,第一DA输出预调理模块20的输出作为第一DA输出接口电路6的输入;
第二DA输出预调理模块包括第二比较器一、第二增益选择器和第二乘法器;第二平 滑滤波模块的输出作为第二比较器一和第二乘法器的输入,第二比较器一的输出结果作为 第二增益选择器的输入,第二增益选择器的输出与第二平滑滤波模块的输出相乘,所得结 果作为第二DA输出预调理模块的输出,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入。
如图7所示,第一DA输出接口电路6包括第一DA转换电路51、第一DA输出缩 放电路一52、第一DA输出缩放电路二53、第一DA输出缩放电路三54、第一DA输出缩放电路四55、第一多路信号选择器56和第一功率放大器57;
第一DA输出预调理模块20的输出信号作为第一DA转换电路51的输入,第一DA 转换电路51的输出作为第一DA输出缩放电路一52的输入,第一DA输出缩放电路一52、第一DA输出缩放电路二53、第一DA输出缩放电路三54和第一DA输出缩放电路 四55依次相连,第一DA输出缩放电路一52、第一DA输出缩放电路二53、第一DA输出缩放电路三54、第一DA输出缩放电路四55和第一DA输出预调理模块20分别与第一多路信号选择器56相连,第一多路信号选择器56的输出作为第一功率放大器57的输入,第一功率放大器57的输出作为第一力矩反馈电极Ad的输入;
第二DA输出接口电路包括第二DA转换电路、第二DA输出缩放电路一、第二DA 输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四、第二多路信号选 择器和第二功率放大器;
第二DA输出预调理模块的输出信号作为第二DA转换电路的输入,第二DA转换电路的输出作为第二DA输出缩放电路一的输入,第二DA输出缩放电路一、第二DA输出 缩放电路二、第二DA输出缩放电路三和第二DA输出缩放电路四依次相连,第二DA输 出缩放电路一、第二DA输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四和第二DA输出预调理模块分别与第二多路信号选择器相连,第二多路信号选择器 的输出作为第二功率放大器的输入,第二功率放大器的输出作为第二力矩反馈电极Bd的 输入。
上述DA输出预调理模块的输出信号作为DA转换电路的输入,DA输出与DA输出 缩放电路的输入相连,DA输出缩放电路采用级联缩放电路,对输入信号依次放大1/N3、1/N2、1/N、1倍。多路信号选择器的输入信号为DA级联缩放电路的四路输出信号,DA输出预调理模块在做分级放大时,将分级信息输出至多路信号选择器作为其控制信号,多路信号选择器的输出与功率放大器相连。DA输出预调理模块、DA转换电路、DA级联缩放电路以及多路信号选择器的配合使用在保证数模信号转换的同时,通过相应放大缩小,使得高精度DA转换电路充分发挥其高精度输出作用,提高了反馈信号的控制精度。功率放大器的输出与反馈电极Ad相连,将反馈信号施加在反馈电极上。
以上仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以对各设施位置进行调整,这些调整也应视为本发明 的保护范围。
Claims (7)
1.一种基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:包括硅微动调陀螺仪(2)的第一力矩反馈电极(Ad)、第二力矩反馈电极(Bd)、第一信号敏感电极(As)、第二信号敏感电极(Bs)、第一闭环控制电路、第二闭环控制电路和直流升压模块(1);第一信号敏感电极(As)的输出作为第一闭环控制电路的输入,第一闭环控制电路的输出作为第一力矩反馈电极(Ad)的输入;第二信号敏感电极(Bs)的输出作为第二闭环控制电路的输入,第二闭环控制电路的输出作为第二力矩反馈电极(Bd)的输入;直流升压模块(1)的输出分别作为第一力矩反馈电极(Ad)和第二力矩反馈电极(Bd)的输入;其中,
第一闭环控制电路包括第一检测接口模拟处理电路(3)、第一AD采样电路(4)、第一FPGA控制算法(5)、第一DA输出接口电路(6)和第一直接数字式频率合成器(7),
第一信号敏感电极(As)的输出作为第一检测接口模拟处理电路(3)的输入,第一检测接口模拟处理电路(3)的输出作为第一AD采样电路(4)的输入,第一AD采样电路(4)的输出经过第一FPGA控制算法(5)作为第一DA输出接口电路(6)和第一直接数字式频率合成器(7)的输入,第一DA输出接口电路(6)和第一直接数字式频率合成器(7)的输出均作为第一力矩反馈电极(Ad)的输入,第一直接数字式频率合成器(7)的输出还作为第一检测接口模拟处理电路(3)的输入;
第二闭环控制电路包括第二检测接口模拟处理电路(8)、第二AD采样电路(9)、第二FPGA控制算法(10)、第二DA输出接口电路(11)和第二直接数字式频率合成器(12),
第二信号敏感电极(Bs)的输出作为第二检测接口模拟处理电路(8)的输入,第二检测接口模拟处理电路(8)的输出作为第二AD采样电路(9)的输入,第二AD采样电路(9)的输出经过第二FPGA控制算法(10)作为第二DA输出接口电路(11)和第二直接数字式频率合成器(12)的输入,第二DA输出接口电路(11)和第二直接数字式频率合成器(12)的输出均作为第二力矩反馈电极(Bd)的输入,第二直接数字式频率合成器(12)的输出还作为第二检测接口模拟处理电路(8)的输入;
第一AD采样电路(4)使用四路级联AD采样,单路采样回路包括第一信号放大模块一(22)、第一信号放大模块二(25)、第一信号放大模块三(28)、第一信号放大模块四(31)、第一偏置电路一(23)、第一偏置电路二(26)、第一偏置电路三(29)、第一偏置电路四(32)、第一AD芯片一(24)、第一AD芯片二(27)、第一AD芯片三(30)和第一AD芯片四(33),
第一信号放大模块一(22)、第一信号放大模块二(25)、第一信号放大模块三(28)和第一信号放大模块四(31)依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第一信号放大模块一(22)、第一偏置电路一(23)、第一AD芯片一(24)和第一AD信号调理模块(17)顺序相接;第一信号放大模块二(25)、第一偏置电路二(26)、第一AD芯片二(27)和第一AD信号调理模块(17)顺序相接;第一信号放大模块三(28)、第一偏置电路三(29)、第一AD芯片三(30)和第一AD信号调理模块(17)顺序相接;第一信号放大模块四(31)、第一偏置电路四(32)、第一AD芯片四(33) 和第一AD信号调理模块(17)顺序相接;第一低通滤波器(16)的输出作为第一信号放大模块一(22)的输入;
第二AD采样电路(9)使用四路级联AD采样,单路采样回路包括第二信号放大模块一、第二信号放大模块二、第二信号放大模块三、第二信号放大模块四、第二偏置电路一、第二偏置电路二、第二偏置电路三、第二偏置电路四、第二AD芯片一、第二AD芯片二、第二AD芯片三和第二AD芯片四,
第二信号放大模块一、第二信号放大模块二、第二信号放大模块三和第二信号放大模块四依次顺序相连,实现对输入信号的级联放大,每级放大倍数固定为E,E>2;第二信号放大模块一、第二偏置电路一、第二AD芯片一和第二AD信号调理模块顺序相接;第二信号放大模块二、第二偏置电路二、第二AD芯片二和第二AD信号调理模块顺序相接;第二信号放大模块三、第二偏置电路三、第二AD芯片三和第二AD信号调理模块顺序相接;第二信号放大模块四、第二偏置电路四、第二AD芯片四和第二AD信号调理模块顺序相接;第二低通滤波器的输出作为第二信号放大模块一的输入。
2.如权利要求1所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第一检测接口模拟处理电路(3)包括第一前置放大器(13)、第一带通选频放大器(14)、第一相敏解调器(15)和第一低通滤波器(16);
第一信号敏感电极(As)的输出作为第一前置放大器(13)的输入,第一前置放大器(13)的输出作为第一带通选频放大器(14)的输入,第一带通选频放大器(14)的输出作为第一相敏解调器(15)的输入,第一相敏解调器(15)的输出作为第一低通滤波器(16)的输入,第一低通滤波器(16)的输出作为第一AD采样电路(4)的输入,第一直接数字式频率合成器(7)的输出作为第一相敏解调器(15)输入;
第二检测接口模拟处理电路(8)包括第二前置放大器、第二带通选频放大器、第二相敏解调器和第二低通滤波器;
第二信号敏感电极(Bs)的输出作为第二前置放大器的输入,第二前置放大器的输出作为第二带通选频放大器的输入,第二带通选频放大器的输出作为第二相敏解调器的输入,第二相敏解调器的输出作为第二低通滤波器的输入,第二低通滤波器的输出作为第二AD采样电路(9)的输入,第二直接数字式频率合成器(12)的输出作为第二相敏解调器输入。
3.如权利要求1所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第一FPGA控制算法(5)包括第一AD信号调理模块(17)、第一PI比例-积分控制器(18)、第一平滑滤波模块(19)、第一DA输出预调理模块(20) 和第一控制信号产生模块(21);
第一AD信号调理模块(17)的输出作为第一PI比例-积分控制器(18)的输入,第一PI比例-积分控制器(18)的输出作为第一平滑滤波模块(19)的输入,第一平滑滤波模块(19)的输出作为第一DA输出预调理模块(20)的输入,第一DA输出预调理模块(20)的输出作为第一DA输出接口电路(6)的输入,第一控制信号产生模块(21)的输出作为第一直接数字式频率合成器(7)的输入;
第二FPGA控制算法(10)包括第二AD信号调理模块、第二PI比例-积分控制器、第二平滑滤波模块、第二DA输出预调理模块和第二控制信号产生模块;
第二AD信号调理模块的输出作为第二PI比例-积分控制器的输入,第二PI比例-积分控制器的输出作为第二平滑滤波模块的输入,第二平滑滤波模块的输出作为第二DA输出预调理模块的输入,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入,第二控制信号产生模块的输出作为第二直接数字式频率合成器的输入。
4.如权利要求3所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第一AD信号调理模块(17)包括第一AD转换结果一(34)、第一AD转换结果二(37)、第一AD转换结果三(40)、第一AD转换结果四(43)、第一位数扩展模块一(35)、第一位数扩展模块二(38)、第一位数扩展模块三(41)、第一位数扩展模块四(44)、第一位数压缩模块一(36)、第一位数压缩模块二(39)、第一位数压缩模块三(42)、第一位数压缩模块四(45)、第一比较器(46)和第一多路选择器(47);
第一AD转换结果一(34)、第一AD转换结果二(37)、第一AD转换结果三(40)、第一AD转换结果四(43)分别与第一位数扩展模块一(35)、第一位数扩展模块二(38)、第一位数扩展模块三(41)、第一位数扩展模块四(44)相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第一位数扩展模块一(35)、第一位数扩展模块二(38)、第一位数扩展模块三(41)、第一位数扩展模块四(44)分别与第一位数压缩模块一(36)、第一位数压缩模块二(39)、第一位数压缩模块三(42)、第一位数压缩模块四(45)相连,将有用的数字信号量提取出来;第一位数压缩模块一(36)、第一位数压缩模块二(39)、第一位数压缩模块三(42)、第一位数压缩模块四(45)均与第一比较器(46)相连,第一位数压缩模块一(36)、第一位数压缩模块二(39)、第一位数压缩模块三(42)、第一位数压缩模块四(45)的输出量作为第一比较器(46)的输入,第一比较器(46)将四路数字信号分别与预设阈值相比较,得到选择控制量;第一位数压缩模块一(36)、第一位数压缩模块二(39)、第一位数压缩模块三(42)、第一位数压缩模块四(45)均与第一多路选择器(47)相连,第一比较器(46)与第一多路选择器(47)相连,第一比较器(46)的输出作为第一多路选择器(47)的控制信号;
第一AD信号调理模块(17)首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第一AD信号调理模块(17)对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第一AD信号调理模块(17)的输出。
5.如权利要求4所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第二AD信号调理模块包括第二AD转换结果一、第二AD转换结果二、第二AD转换结果三、第二AD转换结果四、第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四、第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四、第二比较器和第二多路选择器;
第二AD转换结果一、第二AD转换结果二、第二AD转换结果三、第二AD转换结果四分别与第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四相连,前期已经知道四路AD所采信号对应的放大倍数,四路位数扩展模块将根据前期的放大倍数对应的与相应的数字量相乘,将小的数字量放大,大的数字量不变;
第二位数扩展模块一、第二位数扩展模块二、第二位数扩展模块三、第二位数扩展模块四分别与第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四相连,将有用的数字信号量提取出来;第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四均与第二比较器相连,第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四的输出量作为第二比较器的输入,第二比较器将四路数字信号分别与预设阈值相比较,得到选择控制量;第二位数压缩模块一、第二位数压缩模块二、第二位数压缩模块三、第二位数压缩模块四均与第二多路选择器相连,第二比较器与第二多路选择器相连,第二比较器的输出作为第二多路选择器的控制信号;
第二AD信号调理模块首先将四路不同放大倍数的AD采样信号进行位数扩展,然后再根据前期放大倍数的不同进行相应的压缩取位;第二AD信号调理模块对四路采样信号进行超阈值判断,选择没超阈值并且放大倍数最大的一路数据作为第二AD信号调理模块的输出。
6.如权利要求3所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第一DA输出预调理模块(20)包括第一比较器一(48)、第一增益选择器(49)和第一乘法器(50);第一平滑滤波模块(19)的输出作为第一比较器一(48)和第一乘法器(50)的输入,第一比较器一(48)的输出结果作为第一增益选择器(49)的输入,第一增益选择器(49)的输出与第一平滑滤波模块(19)的输出相乘,所得结果作为第一DA输出预调理模块(20)的输出,第一DA输出预调理模块(20)的输出作为第一DA输出接口电路(6)的输入;
第二DA输出预调理模块包括第二比较器一、第二增益选择器和第二乘法器;第二平滑滤波模块的输出作为第二比较器一和第二乘法器的输入,第二比较器一的输出结果作为第二增益选择器的输入,第二增益选择器的输出与第二平滑滤波模块的输出相乘,所得结果作为第二DA输出预调理模块的输出,第二DA输出预调理模块的输出作为第二DA输出接口电路的输入。
7.如权利要求3所述的基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路,其特征在于:第一DA输出接口电路(6)包括第一DA转换电路(51)、第一DA输出缩放电路一(52)、第一DA输出缩放电路二(53)、第一DA输出缩放电路三(54)、第一DA输出缩放电路四(55)、第一多路信号选择器(56)和第一功率放大器(57);
第一DA输出预调理模块(20)的输出信号作为第一DA转换电路(51)的输入,第一DA转换电路(51)的输出作为第一DA输出缩放电路一(52)的输入,第一DA输出缩放电路一(52)、第一DA输出缩放电路二(53)、第一DA输出缩放电路三(54)和第一DA输出缩放电路四(55)依次相连,第一DA输出缩放电路一(52)、第一DA输出缩放电路二(53)、第一DA输出缩放电路三(54)、第一DA输出缩放电路四(55)和第一DA输出预调理模块(20)分别与第一多路信号选择器(56)相连,第一多路信号选择器(56)的输出作为第一功率放大器(57)的输入,第一功率放大器(57)的输出作为第一力矩反馈电极(Ad)的输入;
第二DA输出接口电路包括第二DA转换电路、第二DA输出缩放电路一、第二DA输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四、第二多路信号选择器和第二功率放大器;
第二DA输出预调理模块的输出信号作为第二DA转换电路的输入,第二DA转换电路的输出作为第二DA输出缩放电路一的输入,第二DA输出缩放电路一、第二DA输出缩放电路二、第二DA输出缩放电路三和第二DA输出缩放电路四依次相连,第二DA输出缩放电路一、第二DA输出缩放电路二、第二DA输出缩放电路三、第二DA输出缩放电路四和第二DA输出预调理模块分别与第二多路信号选择器相连,第二多路信号选择器的输出作为第二功率放大器的输入,第二功率放大器的输出作为第二力矩反馈电极(Bd)的输入。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610854616.4A CN106441257B (zh) | 2016-09-27 | 2016-09-27 | 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610854616.4A CN106441257B (zh) | 2016-09-27 | 2016-09-27 | 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106441257A CN106441257A (zh) | 2017-02-22 |
CN106441257B true CN106441257B (zh) | 2019-06-18 |
Family
ID=58170613
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610854616.4A Active CN106441257B (zh) | 2016-09-27 | 2016-09-27 | 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106441257B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4452092A (en) * | 1981-03-27 | 1984-06-05 | Sperry Corporation | Torque feedback control for two degree of freedom rate sensor |
CN102353366A (zh) * | 2011-06-29 | 2012-02-15 | 东南大学 | 硅微动调混合陀螺仪闭环检测装置 |
CN102735230A (zh) * | 2012-06-08 | 2012-10-17 | 东南大学 | 微机电混合陀螺仪的电路系统 |
CN204228166U (zh) * | 2014-11-14 | 2015-03-25 | 重庆天箭惯性科技有限公司 | 动力调谐陀螺仪再平衡电路 |
CN104976994A (zh) * | 2014-04-02 | 2015-10-14 | 北京自动化控制设备研究所 | 一种用于动力调谐陀螺仪再平衡回路的数字式解调电路 |
CN105486296A (zh) * | 2015-10-30 | 2016-04-13 | 北京自动化控制设备研究所 | 一种基于fpga的动力调谐陀螺仪数字再平衡回路 |
-
2016
- 2016-09-27 CN CN201610854616.4A patent/CN106441257B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4452092A (en) * | 1981-03-27 | 1984-06-05 | Sperry Corporation | Torque feedback control for two degree of freedom rate sensor |
CN102353366A (zh) * | 2011-06-29 | 2012-02-15 | 东南大学 | 硅微动调混合陀螺仪闭环检测装置 |
CN102735230A (zh) * | 2012-06-08 | 2012-10-17 | 东南大学 | 微机电混合陀螺仪的电路系统 |
CN104976994A (zh) * | 2014-04-02 | 2015-10-14 | 北京自动化控制设备研究所 | 一种用于动力调谐陀螺仪再平衡回路的数字式解调电路 |
CN204228166U (zh) * | 2014-11-14 | 2015-03-25 | 重庆天箭惯性科技有限公司 | 动力调谐陀螺仪再平衡电路 |
CN105486296A (zh) * | 2015-10-30 | 2016-04-13 | 北京自动化控制设备研究所 | 一种基于fpga的动力调谐陀螺仪数字再平衡回路 |
Non-Patent Citations (3)
Title |
---|
"A Closed-Loop Digitally Controlled MEMS Gyroscope With Unconstrained Sigma-Delta Force-Feedback";J.Raman 等,;《IEEE SENSORS JOURNAL》;20090331;第9卷(第3期);297-305页 |
"基于分段技术的高性能数模转换器设计";韩建明 等,;《电子器件》;20040630;第27卷(第2期);316-319,302页 |
"混合式陀螺仪的闭环检测技术研究";朱熙 等,;《传感技术学报》;20100831;第23卷(第8期);1084-1087页 |
Also Published As
Publication number | Publication date |
---|---|
CN106441257A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5286676B2 (ja) | 検出装置、センサ及び電子機器 | |
EP2447671B1 (en) | Angular velocity sensor, and synchronous detection circuit used therein | |
CN110160514B (zh) | 一种硅mems陀螺仪多回路数字化闭环控制装置 | |
CN102947673B (zh) | 具有正交抑制的速度传感器 | |
US9602117B2 (en) | Detection device, sensor, electronic apparatus, and moving object | |
CN109029409B (zh) | 一种可调谐栅结构微机械陀螺中的参量放大方法及其装置 | |
CN203014748U (zh) | 微机械陀螺仪闭环驱动自动增益控制电路 | |
CN104197923B (zh) | 一种基于载波检出的微电容陀螺信号检测方法 | |
CN103822623A (zh) | 一种振动式硅微机械陀螺正交误差闭环补偿电路 | |
CN106597839B (zh) | 一种基于负刚度效应的mems陀螺自动模态匹配控制装置及方法 | |
JP2008064663A (ja) | 検出装置、センサ及び電子機器 | |
WO2007011454A2 (en) | Agc circuit for the reduction of harmonics in the drive signal | |
JP4518461B2 (ja) | 電子評価装置の位相ロックループを調整する方法及び電子評価装置 | |
CN101937198B (zh) | 一种振动状态控制装置及其控制方法 | |
CN105716597B (zh) | 采用dsp与fpga的微半球谐振陀螺控制及信号检测系统和方法 | |
CN106441257B (zh) | 基于分段技术的硅微动调陀螺仪高精度数字闭环检测电路 | |
CN100368773C (zh) | 电容式微陀螺敏感信号的单路谐波提取方法及提取装置 | |
CN105716596A (zh) | 压电半球谐振微陀螺仪的数字控制检测系统 | |
JP2007327944A (ja) | 検出装置、ジャイロセンサ及び電子機器 | |
CN113639734B (zh) | Mems电容式陀螺仪的数字馈通取消系统 | |
CN113765516B (zh) | 一种mems谐振器闭环控制方法及控制结构 | |
CN108387755B (zh) | 基于毛发结构的谐振式流速传感器测控装置 | |
KR20140086541A (ko) | 자이로센서의 구동 장치 | |
CN106323263A (zh) | 硅微陀螺机电结合带通sigma‑delta闭环检测电路 | |
CN109168116A (zh) | 一种提高mems陀螺静态和线性度指标的角速率闭环方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |