CN106444809B - 一种无人机飞行控制器 - Google Patents
一种无人机飞行控制器 Download PDFInfo
- Publication number
- CN106444809B CN106444809B CN201610890066.1A CN201610890066A CN106444809B CN 106444809 B CN106444809 B CN 106444809B CN 201610890066 A CN201610890066 A CN 201610890066A CN 106444809 B CN106444809 B CN 106444809B
- Authority
- CN
- China
- Prior art keywords
- flight controller
- matrix
- vector
- gesture
- aerial vehicle
- 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
- 238000013016 damping Methods 0.000 claims abstract description 44
- 239000003381 stabilizer Substances 0.000 claims abstract description 24
- 239000011159 matrix material Substances 0.000 claims description 107
- 239000013598 vector Substances 0.000 claims description 85
- 238000012937 correction Methods 0.000 claims description 40
- 239000003985 ceramic capacitor Substances 0.000 claims description 17
- 238000000034 method Methods 0.000 claims description 13
- 230000002093 peripheral effect Effects 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000010606 normalization Methods 0.000 claims description 9
- 230000004927 fusion Effects 0.000 claims description 6
- 239000000853 adhesive Substances 0.000 claims description 4
- 230000001070 adhesive effect Effects 0.000 claims description 4
- VYPSYNLAJGMNEJ-UHFFFAOYSA-N Silicium dioxide Chemical compound O=[Si]=O VYPSYNLAJGMNEJ-UHFFFAOYSA-N 0.000 claims description 3
- 238000011084 recovery Methods 0.000 claims description 3
- 239000000741 silica gel Substances 0.000 claims description 3
- 229910002027 silica gel Inorganic materials 0.000 claims description 3
- 229910000679 solder Inorganic materials 0.000 claims description 2
- 239000007787 solid Substances 0.000 claims description 2
- 230000035945 sensitivity Effects 0.000 description 16
- 238000004519 manufacturing process Methods 0.000 description 7
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000001276 controlling effect Effects 0.000 description 3
- 230000007547 defect Effects 0.000 description 3
- 238000007499 fusion processing Methods 0.000 description 3
- 239000003292 glue Substances 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000007667 floating Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 229910052744 lithium Inorganic materials 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000003466 welding Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 239000004480 active ingredient Substances 0.000 description 1
- 238000007630 basic procedure Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- PCHJSUWPFVWCPO-UHFFFAOYSA-N gold Chemical compound [Au] PCHJSUWPFVWCPO-UHFFFAOYSA-N 0.000 description 1
- 239000010931 gold Substances 0.000 description 1
- 229910052737 gold Inorganic materials 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 230000001568 sexual effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种无人机飞行控制器,包括飞行控制器顶盖(1),上层减震海绵(2),IMU模块(3),下层减震海绵(5),飞行控制器底板(9);飞行控制器顶盖(1),上层减震海绵(2),IMU模块(3),下层减震海绵(5)和飞行控制器底板(9)从上到下依次排列连接;IMU模块(3)包裹于上层减震海绵(2)和下层减震海绵(5)之间。所述的无人机飞行控制器还包括设置于飞行控制器底板(9)上的内置电源;内置电源包括开关稳压器和线性稳压器;开关稳压器的输入端经电池连接线接电池,输出端接线性稳压器,线性稳压器的输出端为飞行控制器的内部设备供电。本发明的无人机飞行控制器所受干扰小,姿态解算和控制稳定。
Description
所属技术领域
本发明涉及无人机飞行控制领域,具体涉及一种无人机飞行控制器。
背景技术
无人机飞行控制器是无人机的核心控制部件,其任务是接收来自内部传感器(陀螺仪、加速度计、磁力计、气压计、温度计、电压计)和外部传感器(GNSS定位装置、外部磁力计)的数据,通过特定的飞行控制算法转换成电子调速器所需的控制信号,从而改变和控制无人机的姿态(俯仰/横滚/航向情况)、地理位置和高度。
目前,大多数无人机飞行控制器通过外部供电模块进行供电,外部供电模块供电电压噪声和波动较大,同时由于地线与飞行控制器的距离较远,容易对飞行控制器造成干扰;大多数无人机飞行控制器采用IMU(Inertial measurement unit,惯性测量单元)硬连接,由于无人机飞行时螺旋桨产生的震动,将导致IMU采集的数据容易受到干扰,从而造成姿态解算的不稳定性。
目前主流的飞行姿态解算方法的输出量是是欧拉角,而飞行控制方法是以欧拉角作为内部控制对象对机体的姿态进行控制,欧拉角具有万向锁缺陷,不能适用于全姿态的控制,限制了无人机的运动幅度,同时由于包含三角函数运算,增加了处理器负担,降低了控制的实时性。
发明内容
本发明所解决的技术问题是,针对现有技术的不足,提供一种无人机飞行控制器,所受干扰小,姿态解算和控制稳定。
本发明解决技术问题所采用的技术方案是:
一种无人机飞行控制器,包括飞行控制器顶盖1,上层减震海绵2,IMU模块3,下层减震海绵5,飞行控制器底板9;
飞行控制器顶盖1,上层减震海绵2,IMU模块3,下层减震海绵5和飞行控制器底板9从上到下依次排列;IMU模块3包裹于上层减震海绵2和下层减震海绵5之间。
IMU模块中集成有三轴加速度计、三轴磁力计和三轴陀螺仪;IMU模块的测量数据传输到飞行控制器底板上的CPU进行姿态解算。
所述飞行控制器顶盖1,上层减震海绵2,IMU模块3,下层减震海绵5和飞行控制器底板9从上到下依次排列连接,连接介质均为双面不导电胶。
所述上层减震海绵2与下层减震海绵5的面积均大于IMU模块3的面积;IMU模块3设置于上层减震海绵2与下层减震海绵5之间的中心位置;上层减震海绵2与下层减震海绵5对应于IMU模块3之外的部分相连接;连接介质为双面不导电胶。
所述无人机飞行控制器,还包括设置于飞行控制器底板9上的内置电源;
所述内置电源包括开关稳压器和线性稳压器;开关稳压器的输入端经电池连接线接电池,输出端接线性稳压器,线性稳压器的输出端为飞行控制器的内部设备(包括飞行控制器底板9上面的CAN收发器、CPU、辅助CPU、通信缓冲器、非易失性存储器和LED指示器和IMU模块3等)供电。
所述开关稳压器为Buck型DC-DC开关稳压器TPS54160;所述线性稳压器为高精度低压差SPX1117M3线性稳压器;Buck型DC-DC开关稳压器TPS54160的5V输出连接线通过内部线路连接至线性稳压器SPX1117M3,输出高精度低纹波的3.3V直流电压;
TPS54160Buck型DC-DC开关稳压器的环路补偿部分采用一颗102K-1%电阻和一颗2.2nF/50V低ESR陶瓷电容串联,再并联一颗1.5pF/50V低ESR陶瓷电容;TPS54160Buck型DC-DC开关稳压器的输出反馈电阻设置为52.6K和10K串联,输出调整为5V直流;
SPX1117M3线性稳压器的输入端,即5V输出连接线上并联有一颗4.7uF/10V陶瓷电容,SPX1117M3线性稳压器的输出端与飞行控制器内部设备的电源端之间并联有一颗100uF/10V低ESR陶瓷电容和一颗100nF/16V陶瓷电容。
所述无人机飞行控制器,还包括电子调速器信号输出插座板6和外部传感器和外设模块信号插座板7;
电子调速器信号输出插座板6和外部传感器和外设模块信号插座板7;的底部均与飞行控制器底板9垂直连接,连接点分别处于飞行控制器底板9相对两侧的边缘;
电子调速器信号输出插座板6和外部传感器和外设模块信号插座板7的顶部均与飞行控制器顶盖1垂直连接,连接点分别处于飞行控制器顶盖1相对两侧的边缘;
连接介质采用固态焊锡膏。
飞行控制器底板9与电子调速器信号输出插座板6通过它们之间连接处的金手指焊接相连,飞行控制器底板6与外部传感器和外部信号插座板7通过它们之间连接处的金手指焊接相连。
所述电子调速器信号输出插座板6和外部传感器和外设模块信号插座板7的接插件为2.54mm镀金排针8,其中电子调速器信号输出插座板6包含两排排针,每排18根,外部传感器和外设模块信号插座板7包含两排排针,每排17根。
所述电池连接线分为两段,前面一段位于电池和飞行控制器之间,为硅胶导线,通过外部传感器和外设模块信号插座板7与飞行控制器相连;第二段位于飞行控制器内部的印刷电路板上,第二段导线上串联有500mA自恢复型保险丝;500mA自恢复型保险丝的电流输出端还经4.7uF/50V低ESR陶瓷电容连接飞行控制器内部的公共地。
所述飞行控制器底板9上设有印刷电路板和CPU11;CPU与印刷电路板通过电子线路连接;IMU模块3与飞行控制器底板9上分别设置有IMU模块14P上接翻盖式FPC座4和主控底板14P上接翻盖式FPC座10;IMU模块3与飞行控制器底板9通过FPC座及FPC软排线连接。
所述无人机飞行控制器,其姿态解算方法以空间姿态矢量为控制对象,具体包括以下步骤:
1)对原始三轴加速度计数据进行误差修正和规范化,得到修正后的三轴加速度计数据记为:aXN,aYN,aZN;
2)对原始三轴磁力计数据进行误差修正和规范化,得到修正后的三轴磁力计数据记为:mXN,mYN,mZN;
3)对步骤1)和2)中的两组修正后的数据进行融合,得到第一姿态矩阵;
4)对原始三轴陀螺仪数据进行误差修正,得到修正后的三轴陀螺仪数据记为gX、gY、gZ;
将修正后的三轴陀螺仪数据与上一个控制周期得到的第三姿态矩阵进行融合,得到第二姿态矩阵;第三姿态矩阵的初始值等于第一个控制周期得到的第一姿态矩阵的值;
5)将第一姿态矩阵和第二姿态矩阵进行融合,得到该控制周期的第三姿态矩阵,即融合后的方向余弦矩阵。
所述无人机飞行控制器,在进行姿态解算后,通过以下步骤进行姿态控制:
从第三姿态矩阵中提取出平衡矢量B和航向矢量Y;
其中平衡矢量为第三姿态矩阵中第三行元素构成的向量:(c31,c32,c33)
航向矢量为第三姿态矩阵第一行第一列的元素与第二行第一列的元素构成的向量:(c11,c21)。
再利用期望平衡矢量与实际平衡矢量之差来控制机体平衡;当期望平衡矢量不等于实际平衡矢量时,计算平衡矢量差;然后将平衡矢量差转换成电机矩阵控制量,最后将电机矩阵控制量解耦为各个电机的控制量。
利用期望航向矢量与实际航向矢量之差来控制机体航向;当期望航向矢量不等于实际航向矢量时,计算航向矢量差;然后将航向矢量差转换成电机矩阵控制量,最后将电机矩阵控制量解耦为各个电机的控制量。
有益效果:
本发明采用了内置DC-DC和线性稳压器供电方式,供电***采用内置的高效率小封装,Buck型DC-DC开关降压稳压器,将7.2V至30V的外部电压转换成5V,然后使用了1%精度的超低噪声线性稳压器进一步将5V转换成3.3V,为CPU和IMU模块供电。该方式不仅提高了供电质量和供电稳定性,纹波电压小,不存在地线干扰问题,而且简化了飞行控制器的安装。能有效克服现有的飞行控制器供电质量差和纹波电压较大的问题。
本发明IMU采用了独立安装方式,并且采用性减震海绵包覆IMU模块。上层减震海绵和下层减震海绵均采用高弹减震海绵。该方式解决了现有的飞行控制器IMU硬连接易受震动干扰的问题,减弱了IMU模块受到的震动,从而降低了IMU原始输出数据的波动,大大提高了IMU的稳定性,降低了IMU所受到的震动影响,从而提高飞行控制稳定性。
本发明的设计了基于姿态空间矢量为控制对象的姿态解算方法,该方法克服了现有的飞行控制器以欧拉角作为控制对象导致的万象锁缺陷,不存在万象锁问题,可以实现全姿态运动的解算,完全释放了无人机的机动能力,使得全姿态运动成为可能,同时去除了三角函数的运算过程,大大降低了CPU的负担。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1是本发明飞行控制器组装结构图。
图2是本发明的内置电源连接示意图。
图3是本发明开关稳压器电路结构图。
图4是本发明姿态解算方法示意图。
图5是本发明姿态控制方法流程图。
附图标记说明:
1.飞行控制器顶盖,2.上层减震海绵,3.IMU模块,4.IMU模块14P上接翻盖式FPC座,5.下层减震海绵,6.电子调速器信号输出插座板,7.外部传感器和外设模块信号插座板,8.2.54mm间距镀金排针,9.飞行控制器底板,10.主控底板14P上接翻盖式FPC座,11.CPU。
具体实施方式
以下结合附图和具体实施方式对本发明进行进一步具体说明。
如图1所示,展示了一种优选的无人机飞行控制器内部结构。
如图1所示,本发明公开的无人机飞行控制器包括飞行控制器顶盖1,上层减震海绵2,IMU模块3,下层减震海绵5,飞行控制器底板9,电子调速器信号输出插座板6,外部传感器和外设模块信号插座板7。
如图1所示,从上至下的叠层安装顺序是,飞行控制器顶盖1与上层减震海绵2相连接,连接介质采用双面不导电胶,上层减震海绵2与IMU模块3相连接,连接介质采用双面不导电胶,IMU模块3和下层减震海绵5相连接,同时上层减震海绵2也与下层减震海绵5相连接,下层减震海绵5与飞行控制器底板9相连接,连接介质采用双面不导电胶,电子调速器信号输出插座板6与飞行控制器底板9垂直连接,连接点处于电子调速器信号输出插座板6底部与飞行控制器底板9最左侧边缘,外部传感器和外设模块信号插座板7与飞行控制器底板9垂直连接,连接点处于外部传感器和外设模块信号插座板7底部与飞行控制器底板9最右侧边缘。
如图1所示,飞行控制器顶盖的体积是52mm×42mm×1.2mm,上层减震海绵的装配前体积是48mm×40mm×6mm,上层减震海绵的装配后体积是48mm×40mm×5mm,IMU模块的体积是25mm×22mm×1mm,下层减震海绵的装配前体积是48mm×40mm×6mm,下层减震海绵的装配后体积是48mm×40mm×5mm,飞行控制器底板的安装元器件前体积是52mm×42mm×1.2mm,飞行控制器底板的安装元器件后体积是52mm×42mm×3.5m,电子调速器信号输出插座板的体积是42mm×15mm×1mm,外部传感器和外设模块信号插座板的体积是42mm×15mm×1mm。
如图1所示,电子调速器信号输出插座板和外部传感器和外设模块信号插座板采用的接插件是2.54mm镀金排针8,其中电子调速器信号输出插座板包含18×2根排针,外部传感器和外设模块信号插座板包含17×2根排针。
无人机飞行控制器还包括内置电源。如图2和图3所示,无人机专用锂电池通过一段硅胶导线和接插件与飞行控制器相连接,在飞行控制器内部输入到Buck型DC-DC开关稳压器,开关稳压器采用集成Buck型DC-DC控制器TPS54160,该控制器输入段串联500mA自恢复型保险丝,并联一颗4.7uF/50V低ESR陶瓷电容,输出端并联一颗100uF/10V低ESR陶瓷电容和一颗100nF/10V低ESR陶瓷电容,环路补偿部分(即COMP引脚)采用一颗102K-1%电阻和一颗2.2nF/50V串联,再并联一颗1.5pF/50V低ESR陶瓷电容。输出反馈部分为:输出端经串联的输出反馈电阻(R4和R9)52.6K和10K电阻接地,VSENSE引脚接两个电阻的连接点。通过将输出反馈电阻设置为52.6K和10K串联,可将DC-DC开关稳压器输出调整为5V直流。
在图2中,开关稳压器的5V输出通过内部线路连接至高精度低压差线性稳压器SPX1117M3,该稳压器输入端添加一颗4.7uF/10V陶瓷电容,输出端并联一颗100uF/10V低ESR陶瓷电容和一颗100nF/16V陶瓷电容,即可输出高精度低纹波的3.3V直流电压,该直流电压为大多数飞行控制器内部设备和传感器供电。
如图4所示,展示了基于姿态空间矢量为控制对象的姿态解算方法的基本过程。
如图4所示,原始三轴加速度计数据首先进行零偏、灵敏度误差修正,原始三轴磁力计数据进行零偏、灵敏度误差和椭圆误差修正,这两组融合数据进行融合后得到第一姿态矩阵,原始三轴陀螺仪数据进行零偏、灵敏度误差修正得到修正后的三轴陀螺仪数据,该数据再与上一个控制周期得到的第三姿态矩阵进行融合,得到第二姿态矩阵,第一姿态矩阵和第二姿态矩阵进行融合后得到第三姿态矩阵,第三姿态矩阵中包含平衡矢量和航向矢量的信息,从第三姿态矩阵中提取出平衡矢量B和航向矢量Y。
如图4所示,原始三轴加速度计数据、原始三轴磁力计数据、原始三轴陀螺仪数据均从IMU模块读取而来,在每个控制周期进行更新。
如图4所示,加速度计原始数据的零偏修正是在原始数据的基础上减去偏移值常量实现的,该偏移值常量是由该加速度计生产过程中的误差决定的,加速度计原始数据的灵敏度误差修正是在原始数据的基础上乘以灵敏度修正系数实现的,该修正系数是由该加速度计生产过程中的误差决定的。
如图4所示,原始磁力计数据的零偏修正是在原始数据的基础上减去偏移值常量实现的,该偏移值常量是由该磁力计生产过程中的误差决定的,原始磁力计数据的灵敏度误差修正是在原始数据的基础上乘以灵敏度修正系数实现的,该修正系数是由该磁力计生产过程中的误差决定的,原始磁力计数据的椭圆修正是在原始数据的基础上进行二次多项式拟合实现的。
如图4所示,原始陀螺仪数据的零偏修正是在原始数据的基础上减去偏移值常量实现的,该偏移值常量是由该陀螺仪生产过程中的误差决定的,原始陀螺仪数据的灵敏度误差修正是在原始数据的基础上乘以灵敏度修正系数实现的,该修正系数是由该陀螺仪生产过程中的误差决定的。
如图4所示,三轴加速度计和三轴磁力计的修正后数据通过融合得到第一姿态矩阵,该融合过程将原始三轴加速度计数据和原始三轴磁力计数据组合成完整的姿态矩阵。
如图4所示,三轴陀螺仪经修正后的数据与上一个控制周期得到的第三姿态矩阵进行融合得到第二姿态矩阵,该融合过程将原始三轴陀螺仪数据和上一个控制周期得到的第三姿态矩阵组合成完整的姿态矩阵。
如图4所示,第一姿态矩阵和第二姿态矩阵通过融合得到第三姿态矩阵,该融合过程消除了第一姿态矩阵和第二姿态矩阵的大部分误差,得到更为准确的姿态信息,保存在第三姿态矩阵。
所述无人机飞行控制器,其姿态解算方法以空间姿态矢量为控制对象,具体包括以下步骤:
1)对原始三轴加速度计数据进行误差修正和规范化,得到修正后的三轴加速度计数据记为:aXN,aYN,aZN;
2)对原始三轴磁力计数据进行误差修正和规范化,得到修正后的三轴磁力计数据记为:mXN,mYN,mZN;
3)对步骤1)和2)中的两组修正后的数据进行融合,得到第一姿态矩阵;
4)对原始三轴陀螺仪数据进行误差修正,得到修正后的三轴陀螺仪数据记为gX、gY、gZ;
将修正后的三轴陀螺仪数据与上一个控制周期得到的第三姿态矩阵进行融合,得到第二姿态矩阵;第三姿态矩阵的初始值等于第一个控制周期得到的第一姿态矩阵的值;
5)将第一姿态矩阵和第二姿态矩阵进行融合,得到该控制周期的第三姿态矩阵,即融合后的方向余弦矩阵。
所述步骤1)具体为:
读取加速度计(aX、aY、aZ)。
根据以下公式对原始三轴加速度计数据进行零偏修正和灵敏度误差修正:
aXZ=aX-zoaX
aYZ=(aY-zoaY)*saY
aZZ=(aZ-zoaZ)*saZ
其中,zoaX,zoaY和zoaZ分别为三轴加速度计偏移值常量,saY和saZ分别为Y轴和Z轴加速度计灵敏度修正系数与X轴灵敏度修正系数的相对值;偏移值常量和灵敏度修正系数是由该仪器生产过程中的误差决定的;
再对三轴加速度计数据进行水平-磁偏角校正:
aXH=h11*aXZ+h12*aY+h13*aZ
aYH=h21*aXZ+h22*aY+h23*aZ
aZH=h31*aXZ+h32*aY+h33*aZ
其中,水平-磁偏角校正矩阵通过校准测量得到;
对三轴加速度计数据进行规范化处理:
所述步骤2)具体为:
读取原始三轴磁力计数据(magX、magY、magZ)。
先根据以下公式对原始三轴磁力计数据进行零偏修正和灵敏度误差修正:
mXZ=magX-zomX
mYZ=(magY-zomY)*smY
mZZ=(magZ-zomZ)*smZ
其中,zomX,zomY和zomZ分别为三轴磁力计偏移值常量,smY和smZ分别为Y轴和Z轴磁力计灵敏度修正系数与X轴磁力计灵敏度修正系数的相对值;【再对三轴磁力计数据进行椭圆修正,即将三轴磁力计数据进行二次多项式拟合;二次多项式是预先校准磁力计时得到的,得到实际的三轴磁力计数据后,用二次多项式曲线上与之距离最近的点,替换三轴磁力计数据;】
再对三轴磁力计数据进行水平-磁偏角校正:
mXH=h11*mXZ+h12*mYZ+h13*mZZ
mYH=h21*mXZ+h22*mYZ+h23*mZZ
mZH=h31*mXZ+h32*mYZ+h33*mZZ
然后对三轴磁力计数据进行规范化处理【后面有规范化,本来这里可以不用,但是考虑到浮点运算过程中数量级接近的浮点数之间运算的结果精度更高,因此这里执行规范化)】:
所述步骤3)中,第一姿态矩阵记为:
其中,第三行元素为:
a31=aXN,a32=aYN,a33=aZN;
第一行元素为:
其中,v为垂直化因子,v=mXN*aXN+mYN*aYN+mZN*aZN;
第二行元素为:
a21=a13*a32-a12*a33
a22=a11*a33-a31*a13
a23=a31*a12-a11*a32
上述第一姿态矩阵第一行元素与第二行元素计算原理为:
对修正后的三轴磁力计数据mXN,mYN,mZN进行垂直化处理;
由于磁力计不与加速度计垂直,需要垂直化处理,需要在磁力计添加一个K*加速度计矢量,再根据相互垂直的向量点积为0原理有:
(mX-v*aX,mY-v*aY,mZ-v*aZ)*(aX,aY,aZ)=0
可得垂直化因子:
对磁力计数据进行垂直化处理:
mXV=mXN-v*aXN
mYV=mYN-v*aYN
mZV=mZN-v*aZN
再次规范化处理:
得到第一姿态矩阵第一行元素为:
a11=mXVN
a12=mYVN
a13=mZVN
由方向余弦矩阵正交特性求出第一姿态矩阵第二行元素为:
a21=a13*a32-a12*a33
a22=a11*a33-a31*a13
a23=a31*a12-a11*a32。
所述步骤4)中,第二姿态矩阵记为:
第三姿态矩阵记为:
第二姿态矩阵的计算过程为:
首先将修正后的三轴陀螺仪数据分别乘以更新周期T,得到三轴角矢量αX、αY、αZ:
αX=gX*T
αY=gY*T
αZ=gZ*T
计算四元数更新因子(r0、r1、r2、r3):
r0=1-sSquareSum/8
其中,sSquareSum=αX2+αY2+αZ2
将上一控制周期得到的第三姿态矩阵转换成四元数:
若q0≠0,则有:
若q0=0,则有:
规范化上述四元数:
更新四元数:
q0=q0N*r0-q1N*r1-q2N*r2-q3N*r3
q1=q1N*r0+q0N*r1-q3N*r2+q2N*r3
q2=q2N*r0+q3N*r1+q0N*r2-q1N*r3
q3=q3N*r0-q2N*r1+q1N*r2+q0N*r3
对上述更新的四元数进行规范化处理【将四元数的各个分量分别除以各个分量的平方和的开方】,得到新的q0N,q1N,q2N和q3N:
将其转换成第二姿态矩阵【陀螺仪方向余弦矩阵】:
b11=q0N2+q1N2-q2N2-q3N2
b12=2*q1N*q2N-2*q0N*q3N
b13=2*q1N*q3N+2*q0N*q2N
b21=2*q1N*q2N+2*q0N*q3N
b22=q0N2-q1N2+q2N2-q3N2
b23=2*q2N*q3N-2*q0N*q1N
b31=2*q1n*q3N-2*q0N*q2N
b32=2*q2N*q3N+2*q0N*q1N
b33=q0N2-q1N2-q2N2+q3N2。
所述步骤5)中,该控制周期的第三姿态矩阵【融合后的方向余弦矩阵】计算方法为:
计算修正后的三轴加速度计数据与第二姿态矩阵第三行元素的偏差向量:
dX3=aXN-b31
dY3=aYN-b32
dZ3=aZN-b33
乘以一个比例系数m3,得到用于修正的矢量:
cX3=dX3*m3
cY3=dY3*m3
cZ3=dZ3*m3
计算修正后的三轴加速度计数据与第二姿态矩阵第三行融合后的矢量:
vX3=b31+cX3
vY3=b32+cY3
vZ3=b33+cZ3
对融合后的矢量规范化:
计算修正后的三轴磁力计数据与第二姿态矩阵第一行元素的偏差向量:
dX1=mXN-b11
dY1=mYN-b12
dZ1=mZN-b13
乘以一个比例系数m1得到用于修正的矢量:
cX1=dX1*m1
cY1=dY1*m1
cZ1=dZ1*m1
计算修正后的三轴磁力计数据与第二姿态矩阵第一行融合后的矢量:
vX1=b11+cX1
vY1=b12+cY1
vZ1=b13+cZ1
由于矢量(vX1,vY1,vZ1)不与(vX3N,vY3N,vZ3N)垂直,需要垂直化处理,需要在该矢量添加一个k*(vX3N,vY3N,vZ3N);再根据相互垂直的向量点积为0原理有:
(vX1-k*vX3N,vY1-k*vY3N,vZ1-k*vZ3N)*(vX3N,vY3N,vZ3N)=0
可得垂直化因子:
对磁力计融合矢量垂直化:
vX1V=vX1-k*vX3N
vY1V=vY1-k*vY3N
vZ1V=vZ1-k*vZ3N
其中,k为垂直化因子;k=vX1*vX3N+vY1*vY3N+vZ1*vZ3N;
对垂直化后的磁力计融合矢量规范化:
得到第三姿态矩阵第一行元素和第三行元素:
c11=vX1N,c12=vY1N,c13=vZ1N;
c31=vX3N,c32=vY3N,c33=vZ3N;
由方向余弦矩阵的正交特性求出第三姿态矩阵第二行元素:
c21=c13*c32-c12*c33
c22=c11*c33-c31*c13
c23=c31*c12-c11*c32。
如图4所示,第三姿态矩阵由于包含了较为精确的姿态信息,可以直接提取出平衡矢量B和航向矢量Y。
如图5所示,展示了基于姿态空间矢量为控制对象的姿态解算方法的程序流程。
如图5所示,利用期望平衡矢量与实际平衡矢量之差来控制机体平衡,当期望平衡矢量不等于实际平衡矢量时,计算平衡矢量差并进行规范化处理,规范化处理后的矢量差转换成电机矩阵控制量,最后输入到姿态控制单元进行处理。
如图5所示,利用期望航向矢量与实际航向矢量之差来控制机体平衡,当期望航向矢量不等于实际航向矢量时,计算航向矢量差并进行规范化处理,规范化处理后的矢量差转换成电机矩阵控制量,最后输入到姿态控制单元进行处理。
无人机飞行控制器根据第三姿态矩阵对无人机飞行器的姿态进行控制,具体包括以下步骤:
(A)计算三轴位移自由度控制因子(mX,mY,mZ);
令mX=0;
mY=0;
将遥控器的输入信号油门控制因子throttleController直接赋给Z轴位移自由度的控制因子:
mZ=throttleController;
(B)计算三轴旋转自由度控制因子(sX,sY,sZ):
步骤B1:由第三姿态矩阵的转置矩阵左乘期望姿态矩阵E得到变换矩阵D:D=C^T*E:
步骤B2:将变换矩阵D转化为四元数:
p0=0.5*(1+d11+d22+d33)^(0.5);
p1=0.25/p0*(d32-d23);
p2=0.25/p0*(d13-d31);
p3=0.25/p0*(d21-d12);
步骤B3:计算当前角度偏差(期望旋转角度)θ:
θ=arccos(p0)*2,θ∈[0,π];
步骤B4:将当前角度偏差(期望旋转角度)θ分配到三个旋转自由度上,得到三轴的当前角度偏差:
θX=θ*p1;
θY=θ*p2;
θZ=θ*p3;
步骤B5:计算三轴预测角速度、三轴预测角度偏差、三轴期望角速度、三轴预测角速度偏差
B5.1)计算三轴预测角速度:
每一轴的预测角速度=该轴当前角速度(陀螺仪直接测量得到,即修正后的三轴陀螺仪数据记为gX、gY、gZ)+滞后时间段(其取值是预先给定的,取值范围为:0.1~0.3;)内该轴旋转控制因子作用时间(积分得到,正负方向抵消)的百分比乘以该轴旋转控制因子角速度增量系数(其取值是预先给定的,取值范围为:5~10;):(对滞后时间段内,旋转控制因子的符号(大于0为1,小于0为-1)进行积分,再除以滞后时间,得到控制因子作用时间的百分比)
B5.2)计算三轴预测角度偏差:
每一轴的预测角度偏差=该轴当前角度偏差-(该轴当前角速度+该轴预测角速度)/2*(2*滞后时间;
B5.3)计算三轴期望角速度:
每一轴的期望角速度=该轴预测角度偏差*该轴角度偏差角速度系数(其取值是预先给定的,取值范围为:10~20)+该轴最小期望角速度(其取值是预先给定的,取值范围为:0~0.2;);
B5.4)计算三轴预测角速度偏差:
每一轴的预测角速度偏差=该轴期望角速度-该轴预测角速度;
步骤B6:计算三轴超速控制因子:
每一轴的超速控制因子=该轴超速控制因子预设值(其取值是预先给定的,取值范围为:0.05~0.2;)*该轴预测角速度偏差;
步骤B7:计算三轴旋转控制因子(sX,sY,sZ)
每一轴的旋转控制因子=该轴超速控制因子:
(C)根据实际机型,将6个自由度的控制因子转换成各个电机的控制量;
对于X4机型,其4个电机的控制量分别为:
m1=-sX+sY+sZ+mZ;
m2=-sX-sY-sZ+mZ;
m3=sX-sY+sZ+mZ;
m4=sX+sY-sZ+mZ;
对于X6机型,其6个电机的控制量分别为::
m1=-0.5*sX+sY+sZ+mZ;
m2=-sX+sZ*-1+mZ;
m3=-0.5*sX-sY+sZ+mZ;
m4=0.5*sX-sY+sZ+mZ;
m5=sX+sZ+mZ;
m6=0.5*sX+sY-sZ+mZ。
当然,以上仅为本发明的较佳实施例而已,非因此即局限本发明的专利范围,凡运用本发明说明书及图式内容所为之简易修饰及等效结构变化,均应同理包含于本发明的专利保护范围之内。
Claims (9)
1.一种无人机飞行控制器,其特征在于,包括飞行控制器顶盖(1),上层减震海绵(2),IMU模块(3),下层减震海绵(5),飞行控制器底板(9);
飞行控制器顶盖(1),上层减震海绵(2),IMU模块(3),下层减震海绵(5)和飞行控制器底板(9)从上到下依次排列;IMU模块(3)包裹于上层减震海绵(2)和下层减震海绵(5)之间;
其姿态解算方法,以空间姿态矢量为控制对象,具体包括以下步骤:
1)对原始三轴加速度计数据进行误差修正和规范化,得到修正后的三轴加速度计数据记为:aXN,aYN,aZN;
2)对原始三轴磁力计数据进行误差修正和规范化,得到修正后的三轴磁力计数据记为:mXN,mYN,mZN;
3)对步骤1)和2)中的两组修正后的数据进行融合,得到第一姿态矩阵;
4)对原始三轴陀螺仪数据进行误差修正,得到修正后的三轴陀螺仪数据记为gX、gY、gZ;
将修正后的三轴陀螺仪数据与上一个控制周期得到的第三姿态矩阵进行融合,得到第二姿态矩阵;第三姿态矩阵的初始值等于第一个控制周期得到的第一姿态矩阵的值;
5)将第一姿态矩阵和第二姿态矩阵进行融合,得到该控制周期的第三姿态矩阵,即融合后的方向余弦矩阵;
所述步骤3)中,第一姿态矩阵记为:
其中,第三行元素为:
a31=aXN,a32=aYN,a33=aZN;
第一行元素为:
其中,v为垂直化因子,v=mXN*aXN+mYN*aYN+mZN*aZN;
第二行元素为:
a21=a13*a32-a12*a33
a22=a11*a33-a31*a13
a23=a31*a12-a11*a32;
所述步骤4)中,第二姿态矩阵记为:
第三姿态矩阵记为:
第二姿态矩阵的计算过程为:
首先将修正后的三轴陀螺仪数据分别乘以更新周期T,得到三轴角矢量αX、αY、αZ:
αX=gX*T
αY=gY*T
αZ=gZ*T
计算四元数更新因子(r0、r1、r2、r3):
r0=1-sSquareSum/8
其中,sSquareSum=αX2+αY2+αZ2
将上一控制周期得到的第三姿态矩阵转换成四元数:
若q0≠0,则有:
若q0=0,则有:
规范化上述四元数:
更新四元数:
q0=q0N*r0-q1N*r1-q2N*r2-q3N*r3
q1=q1N*r0+q0N*r1-q3N*r2+q2N*r3
q2=q2N*r0+q3N*r1+q0N*r2-q1N*r3
q3=q3N*r0-q2N*r1+q1N*r2+q0N*r3对上述更新的四元数进行规范化处理,得到新的q0N,q1N,q2N和q3N;将其转换成第二姿态矩阵:
b11=q0N2+q1N2-q2N2-q3N2
b12=2*q1N*q2N-2*q0N*q3N
b13=2*q1N*q3N+2*q0N*q2N
b21=2*q1N*q2N+2*q0N*q3N
b22=q0N2-q1N2+q2N2-q3N2
b23=2*q2N*q3N-2*q0N*q1N
b31=2*q1N*q3N-2*q0N*q2N
b32=2*q2N*q3N+2*q0N*q1N
b33=q0N2-q1N2-q2N2+q3N2;
所述步骤5)中,该控制周期的第三姿态矩阵计算方法为:
计算修正后的三轴加速度计数据与第二姿态矩阵第三行元素的偏差向量:
dX3=aXN-b31
dY3=aYN-b32
dZ3=aZN-b33
乘以一个比例系数m3,得到用于修正的矢量:
cX3=dX3*m3
cY3=dY3*m3
cZ3=dZ3*m3
计算修正后的三轴加速度计数据与第二姿态矩阵第三行融合后的矢量:
vX3=b31+cX3
vY3=b32+cY3
vZ3=b33+cZ3
对融合后的矢量规范化:
计算修正后的三轴磁力计数据与第二姿态矩阵第一行元素的偏差向量:
dX1=mXN-b11
dY1=mYN-b12
dZ1=mZN-b13
乘以一个比例系数m1得到用于修正的矢量:
cX1=dX1*m1
cY1=dY1*m1
cZ1=dZ1*m1
计算修正后的三轴磁力计数据与第二姿态矩阵第一行融合后的矢量:
vX1=b11+cX1
vY1=b12+cY1
vZ1=b13+cZ1
对磁力计融合矢量垂直化:
vX1V=vX1-k*vX3N
vY1V=vY1-k*vY3N
vZ1V=vZ1-k*vZ3N
其中,k为垂直化因子;k=vX1*vX3N+vY1*vY3N+vZ1*vZ3N;
对垂直化后的磁力计融合矢量规范化:
得到第三姿态矩阵第一行元素和第三行元素:
c11=vX1N,c12=vY1N,c13=vZ1N;
c31=vX3N,c32=vY3N,c33=vZ3N;
由方向余弦矩阵的正交特性求出第三姿态矩阵第二行元素:
c21=c13*c32-c12*c33
c22=c11*c33-c31*c13
c23=c31*c12-c11*c32。
2.根据权利要求1所述的无人机飞行控制器,其特征在于,飞行控制器顶盖(1),上层减震海绵(2),IMU模块(3),下层减震海绵(5)和飞行控制器底板(9)从上到下依次排列连接,连接介质均为双面不导电胶。
3.根据权利要求2所述的无人机飞行控制器,其特征在于,上层减震海绵(2)与下层减震海绵(5)的面积均大于IMU模块(3)的面积;IMU模块(3)设置于上层减震海绵(2)与下层减震海绵(5)之间的中心位置;上层减震海绵(2)与下层减震海绵(5)对应于IMU模块(3)之外的部分相连接;连接介质为双面不导电胶。
4.根据权利要求1所述的无人机飞行控制器,其特征在于,还包括设置于飞行控制器底板(9)上的内置电源;
所述内置电源包括开关稳压器和线性稳压器;开关稳压器的输入端经电池连接线接电池,输出端接线性稳压器,线性稳压器的输出端为飞行控制器的内部设备供电。
5.根据权利要求4所述的无人机飞行控制器,其特征在于,所述开关稳压器为Buck型DC-DC开关稳压器TPS54160;所述线性稳压器为SPX1117M3线性稳压器;Buck型DC-DC开关稳压器TPS54160的5V输出连接线通过内部线路连接至线性稳压器SPX1117M3,输出3.3V直流电压;
SPX1117M3线性稳压器的输入端,即5V输出连接线上并联有一颗4.7uF/10V陶瓷电容,SPX1117M3线性稳压器的输出端与飞行控制器内部设备的电源端之间并联有一颗100uF/10V低ESR陶瓷电容和一颗100nF/16V陶瓷电容。
6.根据权利要求5所述的无人机飞行控制器,其特征在于,还包括电子调速器信号输出插座板(6)和外部传感器和外设模块信号插座板(7);
电子调速器信号输出插座板(6)和外部传感器和外设模块信号插座板(7);的底部均与飞行控制器底板(9)垂直连接,连接点分别处于飞行控制器底板(9)相对两侧的边缘;
电子调速器信号输出插座板(6)和外部传感器和外设模块信号插座板(7)的顶部均与飞行控制器顶盖(1)垂直连接,连接点分别处于飞行控制器顶盖(1)相对两侧的边缘;
连接介质采用固态焊锡膏。
7.根据权利要求6所述的无人机飞行控制器,其特征在于,所述电池连接线分为两段,前面一段位于电池和飞行控制器之间,为硅胶导线,通过外部传感器和外设模块信号插座板(7)与飞行控制器相连;第二段位于飞行控制器内部的印刷电路板上,第二段导线上串联有500mA自恢复型保险丝;500mA自恢复型保险丝的电流输出端还经4.7uF/50V低ESR陶瓷电容连接飞行控制器内部的公共地。
8.根据权利要求1~7中任一项所述的无人机飞行控制器,其特征在于,飞行控制器底板(9)上设有印刷电路板和CPU(11);CPU与印刷电路板通过电子线路连接;IMU模块(3)与飞行控制器底板(9)上分别设置有IMU模块14P上接翻盖式FPC座(4)和主控底板14P上接翻盖式FPC座(10);IMU模块(3)与飞行控制器底板(9)通过FPC座及FPC软排线连接。
9.根据权利要求1所述的无人机飞行控制器,在进行姿态解算后,通过以下步骤进行姿态控制:
从第三姿态矩阵中提取出平衡矢量B和航向矢量Y;
其中平衡矢量为第三姿态矩阵中第三行元素构成的向量:(c31,c32,c33)
航向矢量为第三姿态矩阵第一行第一列的元素与第二行第一列的元素构成的向量:(c11,c21);
再利用期望平衡矢量与实际平衡矢量之差来控制机体平衡;当期望平衡矢量不等于实际平衡矢量时,计算平衡矢量差;然后将平衡矢量差转换成电机矩阵控制量,最后将电机矩阵控制量解耦为各个电机的控制量;
利用期望航向矢量与实际航向矢量之差来控制机体航向;当期望航向矢量不等于实际航向矢量时,计算航向矢量差;然后将航向矢量差转换成电机矩阵控制量,最后将电机矩阵控制量解耦为各个电机的控制量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610890066.1A CN106444809B (zh) | 2016-10-12 | 2016-10-12 | 一种无人机飞行控制器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610890066.1A CN106444809B (zh) | 2016-10-12 | 2016-10-12 | 一种无人机飞行控制器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106444809A CN106444809A (zh) | 2017-02-22 |
CN106444809B true CN106444809B (zh) | 2024-04-16 |
Family
ID=58173726
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610890066.1A Active CN106444809B (zh) | 2016-10-12 | 2016-10-12 | 一种无人机飞行控制器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106444809B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107957730B (zh) | 2017-11-01 | 2020-02-18 | 华南理工大学 | 一种无人飞行器稳定飞行控制方法 |
CN107908258B (zh) * | 2017-12-17 | 2019-12-13 | 安徽心里程科技有限公司 | 一种具有防振动功能的嵌入式cpu连接装置 |
CN107943102A (zh) * | 2017-12-28 | 2018-04-20 | 南京工程学院 | 一种基于视觉伺服的飞行器及其自主追踪*** |
CN109451692A (zh) * | 2018-12-18 | 2019-03-08 | 向隆 | 一种无人驾驶汽车的制动控制器 |
CN110377056B (zh) * | 2019-08-19 | 2022-09-20 | 深圳市道通智能航空技术股份有限公司 | 无人机航向角初值选取方法及无人机 |
Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2300081C1 (ru) * | 2005-11-07 | 2007-05-27 | Александр Викторович Захарин | Способ определения инструментальных погрешностей измерителей инерциальной навигационной системы на этапе начальной выставки |
CN201858979U (zh) * | 2010-09-25 | 2011-06-08 | 中国航天科工集团第二研究院二一○所 | 一种激光陀螺惯性测量装置的减振装置 |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航***及其导航定位方法 |
AU2011244873B1 (en) * | 2011-04-29 | 2012-09-06 | Zepp Labs, Inc. | Method of confirming motion parameters, apparatus for the same, and motion assisting device |
CN102795551A (zh) * | 2012-08-03 | 2012-11-28 | 高德(无锡)电子有限公司 | 桥式起重机及其减少垂直化金线和镀金线工件带出量的方法 |
CN202579804U (zh) * | 2012-05-31 | 2012-12-05 | 中冶集团武汉勘察研究院有限公司 | 无人机用内外夹层式相机减震装置 |
CN103363992A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 |
CN103712598A (zh) * | 2013-12-31 | 2014-04-09 | 渤海大学 | 一种小型无人机姿态确定***与确定方法 |
CN103759730A (zh) * | 2014-01-16 | 2014-04-30 | 南京师范大学 | 一种基于导航信息双向融合的行人与智能移动载体的协同导航***及其导航方法 |
CN104748751A (zh) * | 2013-12-29 | 2015-07-01 | 刘进 | 姿态矩阵的计算方法及基于姿态矩阵的定位导航方法 |
CN104898681A (zh) * | 2015-05-04 | 2015-09-09 | 浙江工业大学 | 一种采用三阶近似毕卡四元数的四旋翼飞行器姿态获取方法 |
CN104914874A (zh) * | 2015-06-09 | 2015-09-16 | 长安大学 | 一种基于自适应互补融合的无人机姿态控制***及方法 |
CN105203098A (zh) * | 2015-10-13 | 2015-12-30 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN205239905U (zh) * | 2015-12-08 | 2016-05-18 | 陈蜀乔 | 一种自发电油电混合动力多旋翼飞行器 |
CN105700540A (zh) * | 2016-03-09 | 2016-06-22 | 哈尔滨工业大学深圳研究生院 | 基于fpga的无人机飞行控制电路 |
CN205384513U (zh) * | 2016-01-11 | 2016-07-13 | 致导科技(北京)有限公司 | 一种飞行控制器 |
CN105841698A (zh) * | 2016-03-28 | 2016-08-10 | 中国船舶重工集团公司第七研究所 | 一种无需调零的auv舵角精确实时测量*** |
CN105955305A (zh) * | 2016-07-07 | 2016-09-21 | 苏州大学 | 一种四轴无人机 |
CN105955300A (zh) * | 2016-06-12 | 2016-09-21 | 浙江大学 | 一种智能农作物检测*** |
CN205608525U (zh) * | 2016-03-18 | 2016-09-28 | 吴李海 | 一种持续续航的互联网无人机 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2955934B1 (fr) * | 2010-01-29 | 2012-03-09 | Eurocopter France | Estimation stabilisee en virage des angles d'assiettes d'un aeronef |
CN102607557B (zh) * | 2012-02-29 | 2014-07-02 | 西安费斯达自动化工程有限公司 | 一种基于gps/imu的飞行器姿态直接积分校正方法 |
US8998131B1 (en) * | 2013-10-17 | 2015-04-07 | The Boeing Company | Differential throttling control enhancement |
CN105928513B (zh) * | 2016-04-12 | 2018-06-15 | 北京航空航天大学 | 一种基于位置姿态测量***的机载合成孔径雷达运动参数测量方法 |
-
2016
- 2016-10-12 CN CN201610890066.1A patent/CN106444809B/zh active Active
Patent Citations (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2300081C1 (ru) * | 2005-11-07 | 2007-05-27 | Александр Викторович Захарин | Способ определения инструментальных погрешностей измерителей инерциальной навигационной системы на этапе начальной выставки |
CN201858979U (zh) * | 2010-09-25 | 2011-06-08 | 中国航天科工集团第二研究院二一○所 | 一种激光陀螺惯性测量装置的减振装置 |
AU2011244873B1 (en) * | 2011-04-29 | 2012-09-06 | Zepp Labs, Inc. | Method of confirming motion parameters, apparatus for the same, and motion assisting device |
CN102445200A (zh) * | 2011-09-30 | 2012-05-09 | 南京理工大学 | 微小型个人组合导航***及其导航定位方法 |
CN202579804U (zh) * | 2012-05-31 | 2012-12-05 | 中冶集团武汉勘察研究院有限公司 | 无人机用内外夹层式相机减震装置 |
CN102795551A (zh) * | 2012-08-03 | 2012-11-28 | 高德(无锡)电子有限公司 | 桥式起重机及其减少垂直化金线和镀金线工件带出量的方法 |
CN103363992A (zh) * | 2013-06-29 | 2013-10-23 | 天津大学 | 基于梯度下降的四旋翼无人机姿态航向参考***解算方法 |
CN104748751A (zh) * | 2013-12-29 | 2015-07-01 | 刘进 | 姿态矩阵的计算方法及基于姿态矩阵的定位导航方法 |
CN103712598A (zh) * | 2013-12-31 | 2014-04-09 | 渤海大学 | 一种小型无人机姿态确定***与确定方法 |
CN103759730A (zh) * | 2014-01-16 | 2014-04-30 | 南京师范大学 | 一种基于导航信息双向融合的行人与智能移动载体的协同导航***及其导航方法 |
CN104898681A (zh) * | 2015-05-04 | 2015-09-09 | 浙江工业大学 | 一种采用三阶近似毕卡四元数的四旋翼飞行器姿态获取方法 |
CN104914874A (zh) * | 2015-06-09 | 2015-09-16 | 长安大学 | 一种基于自适应互补融合的无人机姿态控制***及方法 |
CN105203098A (zh) * | 2015-10-13 | 2015-12-30 | 上海华测导航技术股份有限公司 | 基于九轴mems传感器的农业机械全姿态角更新方法 |
CN205239905U (zh) * | 2015-12-08 | 2016-05-18 | 陈蜀乔 | 一种自发电油电混合动力多旋翼飞行器 |
CN205384513U (zh) * | 2016-01-11 | 2016-07-13 | 致导科技(北京)有限公司 | 一种飞行控制器 |
CN105700540A (zh) * | 2016-03-09 | 2016-06-22 | 哈尔滨工业大学深圳研究生院 | 基于fpga的无人机飞行控制电路 |
CN205608525U (zh) * | 2016-03-18 | 2016-09-28 | 吴李海 | 一种持续续航的互联网无人机 |
CN105841698A (zh) * | 2016-03-28 | 2016-08-10 | 中国船舶重工集团公司第七研究所 | 一种无需调零的auv舵角精确实时测量*** |
CN105955300A (zh) * | 2016-06-12 | 2016-09-21 | 浙江大学 | 一种智能农作物检测*** |
CN105955305A (zh) * | 2016-07-07 | 2016-09-21 | 苏州大学 | 一种四轴无人机 |
Non-Patent Citations (5)
Title |
---|
倾斜轨道上的三级倒立摆数学模型的建立与可控性研究;柏桂珍, 梅晓榕, 王述一;电机与控制学报;20030630(02);第170-173页 * |
关越魏 ; 何波贤 ; 于仁清 ; 丁广威 ; .基于四元数解算陀螺仪姿态角算法的实现.电脑编程技巧与维护.2015,(09),第32-34页. * |
唐长虹.《航空武器装备经济性与效费分析》.航空工业出版社,2018,第180-183页. * |
庄晓明 ; 李涛 ; 付龙 ; .基于四旋翼无人机的单目建模***.计算机技术与发展.2016,(07),第104-108页. * |
张杰 ; 王道波 ; 盛汉霖 ; .基于MEMS传感器的四元数微型捷联航姿***研究.伺服控制.2012,(03),第70-85页. * |
Also Published As
Publication number | Publication date |
---|---|
CN106444809A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106444809B (zh) | 一种无人机飞行控制器 | |
US8239162B2 (en) | Miniaturized inertial measurement unit and associated methods | |
CN112630813B (zh) | 基于捷联惯导和北斗卫星导航***的无人机姿态测量方法 | |
US7526402B2 (en) | Miniaturized inertial measurement unit and associated methods | |
US6813584B2 (en) | Micro azimuth-level detector based on micro electro-mechanical systems and a method for determination of attitude | |
CN106569500B (zh) | 一种无人机飞行控制器姿态解算和控制方法 | |
US20160047675A1 (en) | Inertial Measurement and Navigation System And Method Having Low Drift MEMS Gyroscopes And Accelerometers Operable In GPS Denied Environments | |
CN110017837B (zh) | 一种姿态抗磁干扰的组合导航方法 | |
CN108731676B (zh) | 一种基于惯性导航技术的姿态融合增强测量方法及*** | |
CN108225313B (zh) | 基于冗余mems传感器的航姿仪 | |
CN108645404B (zh) | 一种小型多旋翼无人机姿态解算方法 | |
CN112945225A (zh) | 基于扩展卡尔曼滤波的姿态解算***及解算方法 | |
CN107247459B (zh) | 抗干扰飞行控制方法及装置 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN112082574A (zh) | 星敏感器的校正方法及*** | |
Sahawneh et al. | Development and calibration of low cost MEMS IMU for UAV applications | |
US11293816B2 (en) | Inertial measurement apparatus and method with improved thermal and noise performance | |
CN115560778A (zh) | 基于谐振式惯性器件的惯性测量***误差实时补偿方法 | |
CN112729280B (zh) | 一种基于多面体式阵列结构的微惯性姿态测量装置及方法 | |
CN111780787B (zh) | 一种基于光纤惯性辅助的mems惯组标定方法 | |
JPH11248456A (ja) | 3軸姿勢検出装置 | |
CN206096944U (zh) | 一种无人机飞行控制器 | |
CN113126642A (zh) | 基于多mems惯性传感器的偏航角测量***、方法和飞控*** | |
CN206740142U (zh) | 一种捷联惯性导航*** | |
CN212254120U (zh) | 基于arm处理器的行人导航定位*** |
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 |