CN106843294A - 一种消除云台航向轴漂移以及电机磁场干扰的方法 - Google Patents
一种消除云台航向轴漂移以及电机磁场干扰的方法 Download PDFInfo
- Publication number
- CN106843294A CN106843294A CN201710173043.3A CN201710173043A CN106843294A CN 106843294 A CN106843294 A CN 106843294A CN 201710173043 A CN201710173043 A CN 201710173043A CN 106843294 A CN106843294 A CN 106843294A
- Authority
- CN
- China
- Prior art keywords
- motor
- rotor
- course
- magnetometer
- axle
- 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.)
- Withdrawn
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
- G05D3/20—Control of position or direction using feedback using a digital comparing device
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2203/00—Indexing scheme relating to controlling arrangements characterised by the means for detecting the position of the rotor
- H02P2203/03—Determination of the rotor position, e.g. initial rotor position, during standstill or low speed operation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
本方法所涉及装置包括无刷电机，电机转子角度传感器，处理器，电机驱动，三轴磁力计，三轴陀螺仪，三轴加速度计，电机底座连轴柄。该方法包括：三轴磁力计三轴加速度计在轴柄下方远离电机强磁场影响范围，三轴陀螺仪固定放置在电机转子上面，电机转子角度传感器采集电机转子位置，各个传感器数据传输至处理器，通过本发明的方法实现云台航向轴的控制，消除了航向轴漂移，以及电机磁场的影响，更完美体现了陀螺仪增稳的效果，弥补了传统三轴增稳云台的航向轴长时间存在严重漂移的问题。
Description
技术领域
本发明涉及增稳设备的控制与姿态解算方法，常见应用与手持三轴增稳云台、飞行器增稳云台航向角控制领域中。
背景技术
目前的增稳设备中航向角往往因为电机磁场的影响，或者加速度计解算不出航向角的原因，往往只采用陀螺仪来进行增稳设备的航向轴的姿态解算，其结果是可以满足动态响应的要求，但是在静止情况下由于陀螺仪的零漂往往会造成航向轴严重漂移的问题，因此需要一个既可以消除电机磁场影响又可以解决陀螺仪零漂的方法。
发明内容
本发明的目的是针对上述现有技术中的不足，提出了一种增稳设备中航向角姿态解算的方法。
本发明是通过以下技术方案实现的：陀螺仪检测转子的角速度，加速度计检测电机底座连接柄所处的加速度参数，磁力计检测电机底座连接柄所处的磁场参数，加速度计参数和磁力计参数融合计算之后可以得到准确的电机底座连接柄航向角数据MagAngle，由于电机底座与转子并不同轴，所以只靠电机底座连接柄的航向角数据MagAngle并不能得到电机转子的航向角数据YAW，引入电机转子位置传感器检测电机转子相对于电机底座的位置MotorAngle，电机底座连接柄航向角数据MagAngle与电机转子位置MotorAngle相结合以后就可以得到电机转子的航向角YAW，由于MagAngle和MotorAngle融合得到的航向角YAW存在噪声所以引入了电机转子的角速度Gyro,YAW再与Gyro进行角度融合滤波即可以得到准确的航向轴数据RealYAW，然后参与控制器的计算。计算逻辑如下：增稳设备启动时记录下来此时磁力计与加速度计解算出来的角度MagAngle和电机转子初始位置MotorAngle，并将MotorAngle角度数据归零，接着根据电机转子位置MotorAngle的增量和MagAngle的值解算出电机转子相对地球磁场的真正航向角RealYAW，再结合转子角速度Gyro进行一阶滤波或者卡尔曼滤波得到比较准确无噪声的航向角。
本发明中的转子位置检测传感器可以有多种方式检测：霍尔传感器，电位器，磁性编码器等等。
本方案中的原始航向角和陀螺仪角速度的角度融合算法可以用一阶互补滤波，卡尔曼滤波，或者AHRS融合算法。
本发明中的陀螺仪放置在转子位置，磁力计加速度计放置在电机底座连接柄的末端远离了电机磁场，有与传统方式不一样的机械结构和传感器放置位置。
本发明中与只用磁力计加速度计陀螺仪来获取航向角的传统方法不一样，引入了电机转子位置传感器，再结合磁力计加速度计进行间接的角度转换再融合陀螺仪角速度得到航向角。
附图说明
图1是本发明的机械电子结构结构示意图，***中包括无刷电机，转子位置传感器，电机驱动，控制器，处理器，三轴陀螺仪，三轴加速度计，三轴磁力计。图 2是本发明的一个实例应用***结构图。
具体实施方式
下面结合附图及实施例对本发明作进一步说明附图1为***结构图:，图2为具体实现时用的具体器件。图2中控制器1为Ti公司的数字信号处理器DSP，电机驱动的控制器2为ST公司的32位单片机，电机转子位置检测传感器3为磁性旋转编码器或者旋转电位器，无刷电机4，电机驱动电路5为以MOS管搭建的三路全桥驱动，放置在转子上的三轴陀螺仪6，放置在电机底座连接柄末端的三轴加速度计三轴磁力计7。
本实例中的控制器是采用DSP，具有数字信号处理能力强特点，驱动电路是采用常见的经典无刷电机驱动电路，驱动电路的控制器采用ST公司的STM32处理器，磁性旋转编码器可以实时检测电机转子角度，有效数据输出频率可达10kHZ，能完全达到实时性的要求，分辨率为12位可达0.08度，MPU6050采用MEMS技术可以采集三轴加速度数据三轴陀螺仪数据，输出速率可达1KHZ满足控制频率，三轴磁力计输出可达10HZ。控制器DSP28335通过I2C协议与处理器连接传输数据，磁性编码器通过SPI协议与处理器通信，三轴加速度数据三轴陀螺仪通过I2C协议与DSP通信，最终各方数据在DSP里融合计算输出给STM32，STM32将驱动信号传输至电机驱动实现控制***的正常运行。
使用该方案时将磁性编码器放置在电机轴中央检测转子，或者转子连接旋转电位器进行转子位置检测。
该方案的机械结构与传统方式不同，磁力计加速度计放置在电机底座连接柄的末端，原理电机磁场干扰，并且航向角的解算又引入了转子位置数据，通过间接的运算测量，得到转子的航向角。
以上是本发明的较佳实施例子，凡依本发明技术方案所作的改变，所产生的功能作用未超出本发明技术方案的范围时，均属于本发明的保护范围。
Claims (5)
1.一种消除云台航向轴漂移以及电机磁场干扰的方法，所述方法包括至少一个无刷电机，电机驱动，转子位置检测传感器，处理器，三轴陀螺仪，三轴加速度计，三轴磁力计，电机底座连轴柄。
2.如权利要求1所述的方法，其特征在于：无刷电机作为增稳设备的航向轴驱动电机，电机驱动接受处理器的驱动信号驱动电机转动，转子位置传感器检测无刷电机转子的位置，三轴磁力计和三轴加速度计检测柄的所处重力场以及磁场，三轴陀螺仪检测电机转子的角速度，所有传感器数据传输至CPU处理器，解算航向轴姿态。陀螺仪放置电机转子位置，三轴加速度计和三轴磁力计放置在电机底座连接柄的尾端远离了电机磁场影响范围。
3.如权利要求2所述的方法，其特征在于：陀螺仪检测转子的角速度，加速度计检测电机底座连接柄所处的加速度参数，磁力计检测电机底座连接柄所处的磁场参数，加速度计参数和磁力计参数融合计算之后可以得到准确的电机底座连接柄航向角数据MagAngle，由于电机底座与转子并不同轴，所以只靠电机底座连接柄的航向角数据MagAngle并不能得到电机转子的航向角数据YAW，引入电机转子位置传感器检测电机转子相对于电机底座的位置MotorAngle，电机底座连接柄航向角数据MagAngle与电机转子位置MotorAngle相结合以后就可以得到电机转子的航向角YAW，由于MagAngle和MotorAngle融合得到的航向角YAW存在噪声所以引入了电机转子的角速度Gyro,YAW再与Gyro进行角度融合滤波即可以得到准确的航向轴数据RealYAW，然后参与控制器的计算。本方法没有采用三轴磁力计三轴陀螺仪三轴加速度计集成一起放在转子上的原因是电机磁场严重影响磁力计。因此采用磁力计加速度计与陀螺仪分离的模式，并且引入电机转子位置传感器参与航向角的计算。
4.如权利要求3所述的方法，其特征在于：若传感器，处理器，电机驱动，控制器正常工作且通信正常，上述的转子航向角RealYAW计算有如下逻辑，增稳设备启动时记录下来此时磁力计与加速度计解算出来的角度MagAngle和电机转子初始位置MotorAngle，并将MotorAngle角度数据归零，接着根据电机转子位置MotorAngle的增量和MagAngle的值解算出电机转子相对地球磁场的真正航向角RealYAW，再结合转子角速度Gyro进行一阶滤波或者卡尔曼滤波得到比较准确无噪声的航向角。Gyro弥补了原始航向角的噪声与不稳定性，而原始航向角数据则消除陀螺仪的零漂，二者结合互相弥补对方的缺陷。
5.如权利要求4所述的方法，其特征在于：引入了电机转子位置传感器和磁力计，再结合加速度计陀螺仪，并且按照磁力计放置在电机底座连接柄尾端远离电机磁场的方法，由处理器解算出电机转子的航向角数据。完美解决了三轴增稳设备中航向角长时间存在严重漂移的问题。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710173043.3A CN106843294A (zh) | 2017-03-22 | 2017-03-22 | 一种消除云台航向轴漂移以及电机磁场干扰的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710173043.3A CN106843294A (zh) | 2017-03-22 | 2017-03-22 | 一种消除云台航向轴漂移以及电机磁场干扰的方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN106843294A true CN106843294A (zh) | 2017-06-13 |
Family
ID=59130110
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710173043.3A Withdrawn CN106843294A (zh) | 2017-03-22 | 2017-03-22 | 一种消除云台航向轴漂移以及电机磁场干扰的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN106843294A (zh) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109101019A (zh) * | 2018-07-31 | 2018-12-28 | 安徽灵翔智能机器人技术有限公司 | 一种基于信息融合的确定智能割草机行走位置的方法 |
| CN109258059A (zh) * | 2018-07-17 | 2019-01-25 | 南京航空航天大学 | 一种割草机位置的确定方法和装置 |
| CN109510377A (zh) * | 2018-12-10 | 2019-03-22 | 宁波意和智能科技有限公司 | 一种防抖动的电机 |
| WO2020107884A1 (zh) * | 2018-11-29 | 2020-06-04 | 南京懂玫驱动技术有限公司 | 一种电动自行车用旋变传感器电路 |
-
2017
- 2017-03-22 CN CN201710173043.3A patent/CN106843294A/zh not_active Withdrawn
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109258059A (zh) * | 2018-07-17 | 2019-01-25 | 南京航空航天大学 | 一种割草机位置的确定方法和装置 |
| CN109258059B (zh) * | 2018-07-17 | 2021-06-22 | 南京航空航天大学 | 一种割草机位置的确定方法和装置 |
| CN109101019A (zh) * | 2018-07-31 | 2018-12-28 | 安徽灵翔智能机器人技术有限公司 | 一种基于信息融合的确定智能割草机行走位置的方法 |
| CN109101019B (zh) * | 2018-07-31 | 2021-07-30 | 安徽灵翔智能机器人技术有限公司 | 一种基于信息融合的确定智能割草机行走位置的方法 |
| WO2020107884A1 (zh) * | 2018-11-29 | 2020-06-04 | 南京懂玫驱动技术有限公司 | 一种电动自行车用旋变传感器电路 |
| CN109510377A (zh) * | 2018-12-10 | 2019-03-22 | 宁波意和智能科技有限公司 | 一种防抖动的电机 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106843294A (zh) | 一种消除云台航向轴漂移以及电机磁场干扰的方法 | |
| WO2020113727A1 (zh) | 一种基于电动升降桌防碰撞控制***及其防碰撞方法 | |
| CN107147341A (zh) | 用于控制电机转动的矢量控制方法及控制***及稳定云台 | |
| CN104634367B (zh) | 一种大中心孔结构的磁电式绝对位置传感器及测量绝对位置的方法 | |
| CN110986988A (zh) | 融合多传感器数据的轨迹推算方法、介质、终端和装置 | |
| CN103743921A (zh) | 基于惯性传感器的自适应转速测量***及方法 | |
| CN105915127A (zh) | 一种电机转子位置冗余测量方法、***及电子设备 | |
| CN108885124A (zh) | 旋转角度检测器和扭矩传感器 | |
| CN110344468A (zh) | 中央回转接头和检测方法 | |
| CN106441277A (zh) | 一种基于编码器与惯性导航单元的机器人位姿估计方法 | |
| CN106767617A (zh) | 基于加速度测量的游梁式抽油机光杆位移传感器及方法 | |
| CN203629581U (zh) | 基于惯性传感器的自适应转速测量*** | |
| CN105240305A (zh) | 一种控制电风扇摇头角度的电路及方法 | |
| CN104546391A (zh) | 一种用于盲杖的陀螺稳定装置及其互补滤波方法 | |
| EP1364859A3 (en) | Rotational angle detecting apparatus and torque detecting apparatus | |
| CN107219863A (zh) | 稳定云台转动的控制方法及控制***及稳定云台 | |
| CN104089646B (zh) | 用于检测旋转体参数的检测***和检测方法 | |
| CN206117402U (zh) | 一种大尺寸低惯量连续旋转的中空轴系 | |
| CN104613990A (zh) | 一种双旋转变压器解码***和方法 | |
| CA2962868A1 (en) | Sensor system for measuring a parameter | |
| CN107203223A (zh) | 驱动控制***及具有该控制***的稳定云台 | |
| CN109163723A (zh) | 一种手机在口袋中摆动时的角度测量方法 | |
| CN207234700U (zh) | 一种驱动控制***及稳定云台 | |
| CN106685277A (zh) | 一种自动增强稳定控制***中无刷电机的驱动方法 | |
| CN109428455B (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 | ||
| WW01 | Invention patent application withdrawn after publication | ||
| WW01 | Invention patent application withdrawn after publication |
Application publication date: 20170613 |