CN202794886U - 一种陀螺速度稳定控制装置 - Google Patents

一种陀螺速度稳定控制装置 Download PDF

Info

Publication number
CN202794886U
CN202794886U CN 201220510649 CN201220510649U CN202794886U CN 202794886 U CN202794886 U CN 202794886U CN 201220510649 CN201220510649 CN 201220510649 CN 201220510649 U CN201220510649 U CN 201220510649U CN 202794886 U CN202794886 U CN 202794886U
Authority
CN
China
Prior art keywords
amplifier
input end
gyro
control device
microprocessor
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.)
Expired - Fee Related
Application number
CN 201220510649
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.)
Shenyang Institute of Automation of CAS
Original Assignee
Shenyang Institute of Automation of CAS
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 Shenyang Institute of Automation of CAS filed Critical Shenyang Institute of Automation of CAS
Priority to CN 201220510649 priority Critical patent/CN202794886U/zh
Application granted granted Critical
Publication of CN202794886U publication Critical patent/CN202794886U/zh
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Landscapes

  • Gyroscopes (AREA)

Abstract

本实用新型涉及一种陀螺速度稳定控制装置，包括：跟随器、第一放大器、比较器、微处理器、D/A、第二放大器、功率放大器和陀螺驱动；跟随器的输入端与传感器连接，其输出端与放大器的输入端连接；放大器的输出端与比较器的输入端连接；比较器的输出端与微处理器的输入端连接；微处理器输出端连接D/A输入端；D/A输出端与放大器输入端连接；放大器输出端与功率放大器的输入端连接；功率放大器与陀螺驱动的输入端连接；陀螺驱动输出端与陀螺连接。本实用新型实现了换向时机的最佳化；提高系统的控制精度，减少控制复杂性，提高了电源的效率，并减少了高频干扰。

Description

一种陀螺速度稳定控制装置
技术领域
本实用新型涉及陀螺控制技术，具体地说是一种陀螺速度稳定控制的装置，应用于频率测量和陀螺速度稳定以及电机速度控制等领域。
背景技术
陀螺仪是一种能够精确地确定运动物体的方位的仪器，它是现代航空、航海、航天和工业中广泛使用的一种惯性导航仪器，它的发展对一个国家的工业和其它高科技的发展具有十分重要的意义。位置和频率测量是陀螺速度稳定控制领域当中两个输入，只有准确的测量陀螺转子的位置和转动频率，才能准确高效、高精度的稳定控制陀螺的转速。模糊控制是用模糊数学的知识模仿人脑的思维方式，对模糊现象进行识别和判决，给出精确的控制量，对被控对象进行控制。PID（比例、积分和微分）控制方法是常用的随动控制方法。在实际应用中，由于微分项容易引起震荡，所以在应用中常常省去该项成为PI控制。
在现有的陀螺速度稳定控制的方法及装置中，将陀螺反馈进行整形、滤波后，得到与陀螺转速成正比的直流信号，这样就降低了陀螺转速测量的精度；控制电路采用比较的方法来决定当前应该加速还是减速，这样降低了控制的精度，驱动陀螺采用方波信号，这样谐波比较大，电源的应用效率不高，而且对其他设备的干扰比较大。
实用新型内容
针对现有技术的不足，本实用新型提供一种陀螺速度稳定控制的方法及装置。
本实用新型为实现上述目的所采用的技术方案是：一种陀螺速度稳定控制装置，包括：跟随器、第一放大器、比较器、微处理器、D/A、第二放大器、功率放大器和陀螺驱动；跟随器的输入端与传感器连接，其输出端与放大器的输入端连接；放大器的输出端与比较器的输入端连接；比较器的输出端与微处理器的输入端连接；微处理器输出端连接D/A输入端；D/A输出端与放大器输入端连接；放大器输出端与功率放大器的输入端连接；功率放大器与陀螺驱动的输入端连接；陀螺驱动输出端与陀螺连接。
所述传感器包括位置传感器和转速传感器。
所述跟随器采用TL082。
所述比较器采用LM393。
所述微处理器采用TMS320F2812。
本实用新型具有以下有益效果及优点：
1.本实用新型利用陀螺反馈信号测量陀螺转子的位置，实现了换向时机的最佳化。
2.本实用新型利用微控制器测量陀螺转子的速度，提高系统的控制精度。
3.本实用新型利用模糊控制理论结合PID控制方法对陀螺转子进行稳定控制，减少控制复杂性，提高控制精度。
4.本实用新型利用正弦波发生器对陀螺进行速度控制，由于没有谐波，提高了电源的效率，并减少了高频干扰。
附图说明
图1为本实用新型硬件原理示意图；
图2为本实用新型控制原理示意图；
图3为速度偏差及偏差变化率隶属度关系图；
图4为比例积分因子隶属度关系图；
图5为正弦波发生器原理示意图；
图6为陀螺速度稳定控制方法流程图。
具体实施方式
下面结合附图及实施例对本实用新型做进一步的详细说明。
本实用新型采用信号处理技术对陀螺反馈信号进行跟随、放大、比较等处理，然后该信号输入微处理器，通过处理和计算得当前时刻陀螺的位置和转速，利用模糊控制结合PID方法对速度进行控制并通过正弦波发生器形成输出控制信号，然后经过功率放大器进行输出，实现系统的稳定控制。
如图1所示，陀螺反馈信号经过电压跟随器、放大之后，进入比较器，将正弦的陀螺反馈信号正形成方波信号，微处理器接收该信号，并利用计时器测量脉冲宽度，然后计算出该信号的频率，作为模糊PID控制的输入，经过模糊PID控制算法后，通过正弦波发生器形成输出信号，并将处理后的陀螺反馈信号的上升沿作为输出信号的起点。该信号经过信号放大、功率放大等环节，推动陀螺持续旋转。跟随器采用TL082，比较器采用LM393，微处理器采用TMS320F2812。
如图2所示，输入转速即为陀螺的实际测量频率与设定转速做差，并对该差值进行离散差分，这两项为模糊控制的输入；模糊控制的输出为PI控制的系数，用于形成输出控制信号。
模糊控制采用双输入双输出形式，模糊控制的输入为速度偏差δω和速度偏差变化率δβ，模糊控制的输出量δkp，δki。模糊语言集定义为:{NB，NM，NS，ZO，PS，PM，PB}。其中，NB为负大，NM为负中，NS为负小，ZO为零，PS为正小，PM为正中，PB为正大。输入变量、输出变量的模糊子集论域为:{－8，－4，－2，0，2，4，8}。
隶属度函数采用梯形隶属度函数，速度偏差及偏差变化率的隶属度函数如图3所示，输出比例积分隶属度函数如图4所示。
根据速度的偏差及偏差变化率，及时调整PI的参数以实现自适应的控制。当偏差与偏差变化率同号时，被控量（转速）是偏离既定值（设定转速）方向变化，比例因子kp值取大值（如4～8），积分因子ki取小值（如-4～-8），可以尽快将控制量调整到期望值附近；当偏差变化率与偏差异号时，如果偏差比较大（偏差绝对值≥偏差变化率绝对值）时，比例因子kp值取小值（如-4～-8），积分因子ki取大值（如4～8），如果偏差比较（偏差绝对值＜偏差变化率绝对值）小，比例因子kp与积分因子ki均取小值（如-4～-8），以便被控制量快速收敛。
如图5所示，陀螺反馈为两部分，一部分是位置反馈，一部分为转速反馈。位置反馈用来调整输出正弦波的相角；转速反馈用来调整正弦波的幅度和频率。对于一个正弦波而言，频率、相位、幅度三要素可以完全确定该正弦波的特性，该正弦波即为陀螺转动控制信号。
如图6所示，系统上电后，首先要关闭所有输出，初始化所有参数，然后等待陀螺转子的转动周期到来，如果没有到来，则继续等待，如果到来则进行转速测量。接下来计算测量出的实际转速和设定转速的插值以及插值的增量，将这两项作为模糊控制的输入，经过隶属度变换，得出PI控制系数，最后利用该系数生成正弦波。

Claims (5)

1.一种陀螺速度稳定控制装置，其特征在于包括：跟随器、第一放大器、比较器、微处理器、D/A、第二放大器、功率放大器和陀螺驱动；跟随器的输入端与传感器连接，其输出端与放大器的输入端连接；放大器的输出端与比较器的输入端连接；比较器的输出端与微处理器的输入端连接；微处理器输出端连接D/A输入端；D/A输出端与放大器输入端连接；放大器输出端与功率放大器的输入端连接；功率放大器与陀螺驱动的输入端连接；陀螺驱动输出端与陀螺连接。
2.根据权利要求1所述的一种陀螺速度稳定控制装置，其特征在于：
所述传感器包括位置传感器和转速传感器。
3.根据权利要求1所述的一种陀螺速度稳定控制装置，其特征在于：
所述跟随器采用TL082。
4.根据权利要求1所述的一种陀螺速度稳定控制装置，其特征在于：
所述比较器采用LM393。
5.根据权利要求1所述的一种陀螺速度稳定控制装置，其特征在于：
所述微处理器采用TMS320F2812。
CN 201220510649 2012-09-29 2012-09-29 一种陀螺速度稳定控制装置 Expired - Fee Related CN202794886U (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201220510649 CN202794886U (zh) 2012-09-29 2012-09-29 一种陀螺速度稳定控制装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201220510649 CN202794886U (zh) 2012-09-29 2012-09-29 一种陀螺速度稳定控制装置

Publications (1)

Publication Number Publication Date
CN202794886U true CN202794886U (zh) 2013-03-13

Family

ID=47822121

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201220510649 Expired - Fee Related CN202794886U (zh) 2012-09-29 2012-09-29 一种陀螺速度稳定控制装置

Country Status (1)

Country Link
CN (1) CN202794886U (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104848847A (zh) * 2014-02-19 2015-08-19 无锡华润上华半导体有限公司 一种陀螺仪传感器控制电路和电子装置

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104848847A (zh) * 2014-02-19 2015-08-19 无锡华润上华半导体有限公司 一种陀螺仪传感器控制电路和电子装置
CN104848847B (zh) * 2014-02-19 2017-11-03 无锡华润上华科技有限公司 一种陀螺仪传感器控制电路和电子装置

Similar Documents

Publication Publication Date Title
CN100517945C (zh) 基于n个霍尔传感器的磁悬浮飞轮电机的低速高精度控制系统
CN100420145C (zh) 一种集成磁悬浮飞轮直流无刷电动机控制系统
CN101852818B (zh) 一种基于旋转机构的加速度计误差标定与补偿方法
CN103472730A (zh) 一种基于谐波减速器扭转刚度迟滞模型的双框架控制力矩陀螺高精度框架速率伺服系统
CN103213666B (zh) 一种基于位置环换向的电动舵机装置和控制方法
CN103414427A (zh) 无刷直流电机控制方法
CN101592677A (zh) 一种用于石英挠性加速度计的数字闭环伺服电路
Liu et al. Two-wheel self-balanced car based on Kalman filtering and PID algorithm
Saidonr et al. A differential steering control with proportional controller for an autonomous mobile robot
CN103607149A (zh) 一种超声电机舵伺服系统及其控制方法
CN202794886U (zh) 一种陀螺速度稳定控制装置
CN105973270B (zh) 一种陀螺定向仪角动量检测及补偿方法
CN106817060A (zh) 一种永磁同步电机转动惯量在线辨识方法
CN106059413B (zh) 一种直流电机驱动的飞轮系统转速控制方法
CN104270046B (zh) 基于转速‑电流二维模糊模型自学习的电机控制方法
CN106335584A (zh) 一种双轮平衡车控制系统
CN103713518B (zh) 一种陀螺速度稳定控制装置和方法
CN102790584A (zh) 一种伺服驱动系统及其速度环参数整定系统
CN104811106B (zh) 直流电机闭环控制的方法和系统
CN204882016U (zh) 一种具有零位自适应跟踪功能的振动控制系统
CN204807089U (zh) 一种陀螺仪检测电路、陀螺仪及电子设备
CN104238359B (zh) 一种大型机电混合惯量系统控制方法
CN204215226U (zh) 一种环形倒立摆稳摆控制器
CN116069019A (zh) 多功能智能平衡小车的控制系统及其模糊自适应pid方法
CN206960957U (zh) 双红外精确校准与充电平台对接角度的机器人

Legal Events

Date Code Title Description
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20130313

Termination date: 20150929

EXPY Termination of patent right or utility model