CN114253179B - 基于共用离散电极的振动陀螺控制系统及分时控制方法 - Google Patents
基于共用离散电极的振动陀螺控制系统及分时控制方法 Download PDFInfo
- Publication number
- CN114253179B CN114253179B CN202111355549.9A CN202111355549A CN114253179B CN 114253179 B CN114253179 B CN 114253179B CN 202111355549 A CN202111355549 A CN 202111355549A CN 114253179 B CN114253179 B CN 114253179B
- Authority
- CN
- China
- Prior art keywords
- gyroscope
- circuit
- driving
- time
- detection
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
Abstract
本发明提供一种基于共用离散电极的振动陀螺控制电路,包括:陀螺表头电极、模拟开关电路、电容检测电路、陀螺数字控制电路和陀螺驱动电路;陀螺表头电极与模拟开关电路互连,模拟开关电路连接至电容检测电路,电容检测电路连接至陀螺数字控制电路,陀螺数字控制电路连接至陀螺驱动电路,陀螺驱动电路连接至所述模拟开关电路,陀螺数字控制电路还连接至模拟开关电路的选择端SEL,控制模拟开关在陀螺表头电极和电容检测电路、陀螺驱动电路间的通断。基于上述电路,本发明还提供一种振动陀螺的检测驱动分时控制方法。本发明能够使陀螺检测点和驱动点的相位达至理想状态,使交变的驱动信号对检测无耦合。
Description
技术领域
本发明涉及振动陀螺控制系统技术领域,特别涉及一种基于共用离散电极的振动陀螺控制系统及分时控制方法。
背景技术
陀螺的控制首先需要检测到振动信号,即检测陀螺当前的物理振动大小,然后再去驱动控制,使陀螺的物理振动维持在需要的目标大小,这样才能完成所需要的角度或者角速度测量。
现有的离散电极的振动陀螺的检测和驱动电极是相互独立的,陀螺振动的检测和驱动是同时的独立进行的,这导致陀螺振动的检测点和陀螺振动的驱动点的相位极难达至理想状态,且交变的驱动信号耦合至检测会导致检测信号畸变。
发明内容
本发明的目的是提供一种基于共用离散电极的振动陀螺控制系统及分时控制方法,使陀螺检测点和驱动点的相位达至理想状态,使交变的驱动信号对检测无耦合。
为了实现以上目的,本发明通过以下技术方案实现:
一种基于共用离散电极的振动陀螺控制电路,包括:陀螺表头电极、模拟开关电路、电容检测电路、陀螺数字控制电路和陀螺驱动电路;
所述陀螺表头电极与所述模拟开关电路互连,所述模拟开关电路连接至所述电容检测电路,所述电容检测电路连接至陀螺数字控制电路,所述陀螺数字控制电路连接至所述陀螺驱动电路,所述陀螺驱动电路连接至所述模拟开关电路,所述陀螺数字控制电路还连接至所述模拟开关电路的选择端SEL,控制模拟开关在所述陀螺表头电极和所述电容检测电路、所述陀螺驱动电路间的通断。
进一步的,当所述陀螺表头电极和所述电容检测电路连通时,所述陀螺表头电极和所述陀螺驱动电路断开,当所述陀螺表头电极和所述陀螺驱动电路连通时,所述陀螺表头电极和所述电容检测电路断开。
一种振动陀螺的检测驱动分时控制方法,采用如上文所述的基于共用离散电极的振动陀螺控制电路实现,在一个软件控制周期内依次执行如下步骤:
S1、在检测时间T1内,所述陀螺表头电极与所述陀螺驱动电路断开、与所述电容检测电路连通,所述电容检测电路完成所述振动陀螺的振动信号检测;
S2、在驱动时间T2,所述陀螺表头电极与所述电容检测电路断开、与所述陀螺驱动电路连通,所述陀螺驱动电路完成对所述振动陀螺的驱动控制;
S3、在检测等待时间T3内,所述陀螺表头电极与所述陀螺驱动电路断开,所述陀螺表头电极与所述电容检测电路连通。
进一步的,在一个软件控制周期执行完毕后,执行下一软件控制周期,依次循环检测时间T1、驱动时间T2、检测等待时间T3。
进一步的,在驱动时间T2内,所述陀螺数字控制电路持续输出交流驱动信号,以控制所述陀螺驱动电路。
进一步的,在检测时间T1和检测等待时间T3内,所述陀螺数字控制电路保持所述交流驱动信号的中值直流电平不变。
与现有技术相比,本发明具有如下优点:
本发明可用于离散电极的振动陀螺共用一个电极完成陀螺信号的检测和陀螺的驱动控制,通过陀螺数字控制电路连接至模拟开关电路的选择端SEL,控制模拟开关在陀螺表头电极和电容检测电路、陀螺驱动电路间的通断,将检测和驱动分时进行,使得陀螺检测点和驱动点的相位达至理想状态,交变的驱动信号对检测无耦合。
附图说明
为了更清楚地说明本发明的技术方案,下面将对描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图是本发明的一个实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图:
图1为本发明一实施例提供的基于共用离散电极的检测驱动分时控制的振动陀螺控制系统的结构图;
图2为本发明一实施例提供的基于共用离散电极的检测驱动分时控制的振动陀螺的控制周期图。
具体实施方式
以下结合附图和具体实施方式对本发明提出的方案作进一步详细说明。根据下面说明,本发明的优点和特征将更清楚。需要说明的是,附图采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施方式的目的。为了使本发明的目的、特征和优点能够更加明显易懂,请参阅附图。须知,本说明书所附图式所绘示的结构、比例、大小等,均仅用以配合说明书所揭示的内容,以供熟悉此技术的人士了解与阅读,并非用以限定本发明实施的限定条件,故不具技术上的实质意义,任何结构的修饰、比例关系的改变或大小的调整,在不影响本发明所能产生的功效及所能达成的目的下,均应仍落在本发明所揭示的技术内容能涵盖的范围内。
如图1所示,本发明提供的基于共用离散电极的振动陀螺控制电路,包括陀螺表头电极1,模拟开关电路2,电容检测电路3,陀螺数字控制电路4,陀螺驱动电路5。所述陀螺表头电极1与所述模拟开关电路2互连,所述模拟开关电路2连接至所述电容检测电路3,所述电容检测电路3连接至陀螺数字控制电路4,所述陀螺数字控制电路4连接至所述陀螺驱动电路5,所述陀螺驱动电路5连接至模拟开关电路2,所述陀螺数字控制电路4还连接至所述模拟开关电路2的选择端SEL,控制模拟开关在所述陀螺表头电极1和所述电容检测电路3、所述陀螺驱动电路5间的通断。具体的,当陀螺表头电极1和电容检测电路3连通时,陀螺表头电极1和陀螺驱动电路5断开,当陀螺表头电极1和陀螺驱动电路5连通时,陀螺表头电极1和电容检测电路3断开。
如图2所示,是振动陀螺的检测驱动分时控制方法的软件控制周期图。一个软件控制周期T包括:一个检测时间T1、一个驱动时间T2、一个检测等待时间T3,检测时间T1、驱动时间T2、检测等待时间T3依次发生,当一个完整的软件控制周期T发生后,继续循环发生下一个软件控制周期T。
具体的,一个软件控制周期T内的检测驱动分时控制方法如下:
S1、在检测时间T1内,所述陀螺表头电极与所述陀螺驱动电路断开、与所述电容检测电路连通,所述电容检测电路完成所述振动陀螺的振动信号检测;
S2、在驱动时间T2,所述陀螺表头电极与所述电容检测电路断开、与所述陀螺驱动电路连通,所述陀螺驱动电路完成对所述振动陀螺的驱动控制;
S3、在检测等待时间T3内,所述陀螺表头电极与所述陀螺驱动电路断开、与所述电容检测电路连通。
即,检测等待时间T3为振动陀螺在时间T3内既不检测也不驱动,在检测等待时间T3内,所述陀螺表头电极与所述电容检测电路连通,等待所述电容检测电路稳定,然后再进入检测时间T1进行检测;检测时间T1、驱动时间T2、检测等待时间T3在时间轴t上是连续的,共同组成一个完整的软件控制周期T,相邻两个软件控制周期T在时间轴t上是连续的。
当处于检测时间T1时,振动陀螺不受驱动,当处于驱动时间T2,检测停止,驱动时间T2完成后,检测等待时间T3后再进入下一个软件控制周期T,依次循环检测时间T1、驱动时间T2、检测等待时间T3。在驱动时间T2内,所述陀螺数字控制电路持续输出交流驱动信号,以控制所述陀螺驱动电路。为减小功耗同时减小对检测电路的干扰,在检测时间T1和检测等待时间T3内,所述陀螺数字控制电路保持所述交流驱动信号的中值直流电平不变,即向所述陀螺驱动电路输出直流电平。
本发明适用于离散电极的振动陀螺电极数量少,需要高精度检测的检测驱动点完全理想重合等应用场合。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (6)
1.一种基于共用离散电极的振动陀螺控制电路,其特征在于,包括:陀螺表头电极、模拟开关电路、电容检测电路、陀螺数字控制电路和陀螺驱动电路;
所述陀螺表头电极与所述模拟开关电路互连,所述模拟开关电路连接至所述电容检测电路,所述电容检测电路连接至陀螺数字控制电路,所述陀螺数字控制电路连接至所述陀螺驱动电路,所述陀螺驱动电路连接至所述模拟开关电路,所述陀螺数字控制电路还连接至所述模拟开关电路的选择端SEL,控制模拟开关在所述陀螺表头电极和所述电容检测电路、所述陀螺驱动电路间的通断。
2.如权利要求1所述的基于共用离散电极的振动陀螺控制电路,其特征在于,当所述陀螺表头电极和所述电容检测电路连通时,所述陀螺表头电极和所述陀螺驱动电路断开,当所述陀螺表头电极和所述陀螺驱动电路连通时,所述陀螺表头电极和所述电容检测电路断开。
3.一种振动陀螺的检测驱动分时控制方法,其特征在于,采用如权利要求1~2任一项所述的基于共用离散电极的振动陀螺控制电路实现,在一个软件控制周期内依次执行如下步骤:
S1、在检测时间T1内,所述陀螺表头电极与所述陀螺驱动电路断开、与所述电容检测电路连通,所述电容检测电路完成所述振动陀螺的振动信号检测;
S2、在驱动时间T2,所述陀螺表头电极与所述电容检测电路断开、与所述陀螺驱动电路连通,所述陀螺驱动电路完成对所述振动陀螺的驱动控制;
S3、在检测等待时间T3内,所述陀螺表头电极与所述陀螺驱动电路断开,所述陀螺表头电极与所述电容检测电路连通。
4.如权利要求3所述的振动陀螺的检测驱动分时控制方法,其特征在于,在一个软件控制周期执行完毕后,执行下一软件控制周期,依次循环检测时间T1、驱动时间T2、检测等待时间T3。
5.如权利要求3所述的振动陀螺的检测驱动分时控制方法,其特征在于,在驱动时间T2内,所述陀螺数字控制电路持续输出交流驱动信号,以控制所述陀螺驱动电路。
6.如权利要求5所述的振动陀螺的检测驱动分时控制方法,其特征在于,在检测时间T1和检测等待时间T3内,所述陀螺数字控制电路保持所述交流驱动信号的中值直流电平不变。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111355549.9A CN114253179B (zh) | 2021-11-16 | 2021-11-16 | 基于共用离散电极的振动陀螺控制系统及分时控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111355549.9A CN114253179B (zh) | 2021-11-16 | 2021-11-16 | 基于共用离散电极的振动陀螺控制系统及分时控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114253179A CN114253179A (zh) | 2022-03-29 |
CN114253179B true CN114253179B (zh) | 2023-10-20 |
Family
ID=80792561
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111355549.9A Active CN114253179B (zh) | 2021-11-16 | 2021-11-16 | 基于共用离散电极的振动陀螺控制系统及分时控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114253179B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115143946B (zh) * | 2022-08-30 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 半球谐振陀螺用开关的切换设计方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001304866A (ja) * | 2000-04-19 | 2001-10-31 | Murata Mfg Co Ltd | ジャイロ装置及びそのクロストーク低減方法 |
JP2002372420A (ja) * | 2001-06-13 | 2002-12-26 | Matsushita Electric Ind Co Ltd | 振動ジャイロの駆動検出回路 |
JP2006329634A (ja) * | 2005-05-23 | 2006-12-07 | Matsushita Electric Works Ltd | 角速度検出装置 |
JP2006329637A (ja) * | 2005-05-23 | 2006-12-07 | Matsushita Electric Works Ltd | 角速度検出装置 |
JP2007285958A (ja) * | 2006-04-19 | 2007-11-01 | Denso Corp | ジャイロセンサのセンサ回路 |
CN102278982A (zh) * | 2011-07-13 | 2011-12-14 | 中国人民解放军国防科学技术大学 | 四质量块硅微机械陀螺耦合误差的抑制方法 |
JP2013050851A (ja) * | 2011-08-31 | 2013-03-14 | Citizen Holdings Co Ltd | 演算回路、それを用いた物理量センサ及び検波回路 |
CN104515516A (zh) * | 2014-11-28 | 2015-04-15 | 上海新跃仪表厂 | 一种基于力平衡模式的半球谐振陀螺数字控制电路 |
JP2017092684A (ja) * | 2015-11-09 | 2017-05-25 | セイコーエプソン株式会社 | 複合スイッチ回路、物理量検出装置、電子機器および移動体 |
CN109708664A (zh) * | 2018-12-11 | 2019-05-03 | 上海航天控制技术研究所 | 一种固体振动陀螺频差与耗散角检测电路及其检测方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101237604B1 (ko) * | 2011-09-02 | 2013-02-26 | 한국기술교육대학교 산학협력단 | 자이로 센서 구동 장치 및 그 방법 |
KR20140086541A (ko) * | 2012-12-28 | 2014-07-08 | 삼성전기주식회사 | 자이로센서의 구동 장치 |
-
2021
- 2021-11-16 CN CN202111355549.9A patent/CN114253179B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001304866A (ja) * | 2000-04-19 | 2001-10-31 | Murata Mfg Co Ltd | ジャイロ装置及びそのクロストーク低減方法 |
JP2002372420A (ja) * | 2001-06-13 | 2002-12-26 | Matsushita Electric Ind Co Ltd | 振動ジャイロの駆動検出回路 |
JP2006329634A (ja) * | 2005-05-23 | 2006-12-07 | Matsushita Electric Works Ltd | 角速度検出装置 |
JP2006329637A (ja) * | 2005-05-23 | 2006-12-07 | Matsushita Electric Works Ltd | 角速度検出装置 |
JP2007285958A (ja) * | 2006-04-19 | 2007-11-01 | Denso Corp | ジャイロセンサのセンサ回路 |
CN102278982A (zh) * | 2011-07-13 | 2011-12-14 | 中国人民解放军国防科学技术大学 | 四质量块硅微机械陀螺耦合误差的抑制方法 |
JP2013050851A (ja) * | 2011-08-31 | 2013-03-14 | Citizen Holdings Co Ltd | 演算回路、それを用いた物理量センサ及び検波回路 |
CN104515516A (zh) * | 2014-11-28 | 2015-04-15 | 上海新跃仪表厂 | 一种基于力平衡模式的半球谐振陀螺数字控制电路 |
JP2017092684A (ja) * | 2015-11-09 | 2017-05-25 | セイコーエプソン株式会社 | 複合スイッチ回路、物理量検出装置、電子機器および移動体 |
CN109708664A (zh) * | 2018-12-11 | 2019-05-03 | 上海航天控制技术研究所 | 一种固体振动陀螺频差与耗散角检测电路及其检测方法 |
Non-Patent Citations (1)
Title |
---|
半球谐振陀螺技术;刘付成, 等;《导航与控制》;第19卷(第4/5期);208-215 * |
Also Published As
Publication number | Publication date |
---|---|
CN114253179A (zh) | 2022-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114253179B (zh) | 基于共用离散电极的振动陀螺控制系统及分时控制方法 | |
JP3958289B2 (ja) | 電子コンパスの自動補正方法 | |
US20170131099A1 (en) | Physical quantity detection circuit, electronic device, and moving object | |
US9733842B2 (en) | Detection device, sensor, electronic apparatus, and moving object | |
WO2019126957A1 (zh) | 端云结合定位方法、装置及电子设备、计算机程序产品 | |
CN111220263A (zh) | 一种检测马达谐振频率的方法和系统 | |
JPH0224254Y2 (zh) | ||
JP2018163543A (ja) | 検出装置、物理量測定装置、検出システム、電子機器及び移動体 | |
CN105716597A (zh) | 采用dsp与fpga的微半球谐振陀螺控制及信号检测系统和方法 | |
CN103344228A (zh) | 摇动质量体声波固体波动微陀螺驱动与检测电路 | |
CN107702731A (zh) | 一种对未知参数陀螺仪的测试方法 | |
EP2818836B1 (en) | Sensor device with sampling function, and sensor data processing system using same | |
CN117490729B (zh) | 一种半球谐振陀螺仪的正交漂移误差检测方法 | |
US10082404B1 (en) | Electronic self calibration design for disk resonator gyroscopes using electrode time multiplexing | |
CN109945849B (zh) | 一种基于mems陀螺仪的闭环锁相驱动电路结构 | |
JP5501900B2 (ja) | サンプリング機能付きセンサデバイス及びそれを用いたセンサデータ処理システム | |
CN105583801A (zh) | 带虚拟现实功能的机器人头部控制系统 | |
US20120167680A1 (en) | Apparatus for driving multi-axial angular velocity sensor | |
CN113746394B (zh) | 基于磁性传感器的自纠错运动控制方法及系统 | |
EP3043146A3 (en) | Approach for control redistribution of coriolis vibratory gyroscope ("cvg") for performance improvement | |
RU2011128218A (ru) | Оптико-электронный следящий координатор | |
CN209446067U (zh) | 一种闭环锁相驱动电路结构 | |
KR20150089305A (ko) | 자이로 센서의 구동회로 및 그 제어방법 | |
WO2022120818A1 (zh) | 用于传感器的控制装置、方法、可移动平台和存储介质 | |
CN112333679B (zh) | 蓝牙自动连接方法、系统、设备及计算机可读存储介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |