一种室内无人机定位系统技术方案

本发明专利技术提出了一种室内无人机定位系统，旨在提供一种无人机在室内处于无或者弱GPS定位信号状态下的进行精准定位，且不需要外围辅助设备的方案，该系统包括：数据采集模块，包括惯性传感器、高度计、摄像头；底层飞控模块，利用姿态控制回路和增稳控制回路对飞行器的姿态角分别做角度控制和稳定控制；位置解算模块，采用的是互补滤波，将加速度计和高度计、光流计采集获得的数据融合，得到三维位置和速度，通过三个模块的协同调用与使用多种传感器，本发明专利技术可以使得在弱GPS定位状态与多干扰状态仍具有较好的定位效果。

An indoor UAV positioning system

【技术实现步骤摘要】
一种室内无人机定位系统
本专利技术涉及无人机领域，涉及一种室内无人机定位系统。
技术介绍
当前无人机应用于各行各业，给各行业发展带来许多便利，但目前室内弱GPS定位信号状态对于无人机在室内定位的影响仍然较大，虽然现有技术有一些解决的方案，但其在定位方式上仍有一些缺点。例如专利号201510888634.X公开的室内无人机导航方法及无人机,只使用了超声波传感器与陀螺仪，只是使用了超声波传感器，误差来源单一，专利号201410350665.5公开的一种微型无人机室内定位方法，该方案使用图像处理和机载IMU融合计算定位，环境光照度对其精度影响较大。
技术实现思路
为了克服上述现有技术的不足，本专利技术提供了一种室内无人机定位系统，能够使得无人机在室内没有GPS信号且在同时存在声音与光线干扰的环境下，按照预定线路进行精确飞行。本专利技术所采用的技术方案是：整体硬件平台设计如图2所示，惯性传感器MPU6050解算出姿态角通过I2C通信将数据传输给微控制器；气压计MS5611测出气压值通过I2C通信将数据传输给微控制器用作高度估计；PX4-Flow光流模块测得光流信号通过I2C通信将数据传输给微控制器；超声波XL-MaxSonar-EZ将测出的高度信息通过PWM波的形式传输给微控制器；无线传输模块NRF24L01P充当数传，用于连接飞控和地面站；遥控器发出的2.4GHz信号仅接收机解码后以PWM波形式输送给微控制器。为保证硬件的稳定性，所有模块均使用的模块化产品。整体软件设计，如图31)光流处理算法得出光流与实际速度值之间的转换关系，需建立摄像头图像坐标系与大地坐标系之间的转换模型。这里分两部分，分别是摄像机坐标系与大地坐标系之间的转换，摄像机坐标系与图像坐标系之间的转换。(1)摄像机坐标系与大地坐标系之间的转换，如图4P为地面上一点，摄像头坐标系下坐标为大地坐标系下坐标为两者之间的关系为：Tn表示两个坐标系之间的平动，表示两个坐标系之间的旋转矩阵。对两边求导可得：摄像机相对于地面运动，P为地面上一点固定不动，所以令得：展开得：(2)摄像机坐标系与成像平面坐标系之间的转换，如图5成像平面的x,y坐标轴与摄像机坐标系的x,y轴平行。Pc在成像平面中投影坐标为由投影关系可得：两边求导得：将(4)(5)带入(6)得：很小时(另一方面相对f也比较小)，并且忽略高阶项根据上述转换，可以得出光流与实际速度值之间的关系，并提供给飞控系统作为位置解算数据信息。2)姿态解算部分算法四元数法和欧拉角法，这两种姿态解算算法中都只需要角速度值就可解算出姿态，但因为对陀螺仪数据积分会造成累积误差，导致解算出的姿态误差很大。所以在使用上述两种算法的时候需要使用加速度计对陀螺仪的值进行修正，以得到相对准确的姿态。下面的互补滤波算法就是融合加速度计、陀螺仪数据的解算算法。将无人机看作暂稳态，在这种假设下，加速度计的测量值在NED坐标系下始终为(经过归一化处理)：经旋转矩阵转换到机体坐标系b系中(旋转矩阵为上一时刻解算得出)：在b系中，加速度计的测量值为现在和acc均表示在b系中的竖直向下的向量，两者之间的误差也就是说只要陀螺仪解算得出的姿态的XOY平面与加速度计得出的XOY不重合，上述误差就会一直存在。加速度计可以修正横滚叫和俯仰角但是不能修正偏航角。一般还需要用磁力计或GPS修正偏航角，因为暂时没有用到这两个传感器，所以不对偏航角进行修正。误差经PI控制器得到角速度的补偿值：ωPCorr＝Kp·Corr_rpωICorr＝ωPCorr+KI·Corr_rp·dtωCorr＝ωPCorr+ωICorr陀螺仪的测量值为校正后的角速度值为ω＝gyro+ωCorr将校正后的角速度带入求出角度变化量后，再带入下列式子(对四元数法更新旋转矩阵的微分方程)采用一阶近似毕卡算法求解获得的式子)即可解算出四元数，再将解算出得四元数带入下式即可得欧拉角。3)姿态控制部分姿态控制采用双环PID，如图6，期望角度＝遥控器输入/(遥控器最大值-遥控器最小值)×最大控制角度；期望角速度＝角度环输出/最大控制角度×最大控制角速度当前角度为姿态解算得出的角度；当前角速度为陀螺仪测量值。4)高度互补滤波部分高度解算采用的是互补滤波，将加速度计和超声波或是气压计的数据融合，得到高度。因为噪声和零偏的存在，加速度计测得的加速度值有误差，若直接积分得到速度和高度将会产生很大的累积误差。现利用超声波和气压计对加速度的测量进行校正。因为超声波的精度和稳定性远高于气压计，所有在超声波测量值有效的情况下，就采用超声波的值；超声波测量值无效时，则采用气压计的值，高度互补解算流程，如图7。5)高度控制部分高度控制采用串级PID。当油门位于油门中值附近时，启动定高模式，期望高度为进入定高模式的那个周期解算的高度值，期望速度为高度误差经PID调节得到。如果油门一直位于中值附近，则保持这个高度；如果油门偏离中值，则采用手动控制，定高失效，期望速度为油门值乘以一个比例系数。如图8使用渡越时间检测法作为超声波传感器的测速方法超声波传感器由强电脉冲信号激励，向外发射超声波，此时微控制器开始计时，超声波遇到被测物体后形成反射回波，超声波接收器接收到反射回波，停止计时，在这一过程中获得的时间即为超声波在媒质(空气)中传播的往返时间，通过这一时间可实现高度测量，时间与所测高度的关系见下式：h＝vct/2式中h——距离(m)；t——超声波往返时间(s)；vc——超声波在空气中的传播速度(m/s)。与现有技术相比，本专利技术的有益效果是增强了无人机在存在声音与光线混合干扰的情况下，相较于单一的依靠超声波传感器或者摄像头的定位方式，此方式能够提高无人机的定位稳定性。附图说明图1整体控制原理图；图2为整体硬件平台设计；性传感器MPU6050解算出姿态角通过I2C通信将数据传输给微控制器；气压计MS5611测出气压值通过I2C通信将数据传输给微控制器用作高度估计；PX4-Flow光流模块测得光流信号通过I2C通信将数据传输给微控制器；超声波XL-MaxSonar-EZ将测出的高度信息通过PWM波的形式传输给微控制器；无线传输模块NRF24L01P充当数传，用于连接飞控和地面站；遥控器发出的2.4GHz信号仅接收机解码后以PWM波形式输送给微控制器。图3为整体软件设计光流模块采集图像信号，对位置进行解算，读取加速度计和陀螺仪的测量数据使用互补解算的方法对姿态和部分三维位置进行解算，综合上述数据进行姿态控制，同时读取高度计和超声波传感器的数据进行高度解算，加速度计和陀螺仪数据也会参与这个高度解算的过程，修正高度误差；姿态控制和高度控制可以由遥控器参与控制，相应的姿态控制和高度控制信息经由混合器处理后，转换信号到电机上直接进行驱动调整。图4为光流处理算法中，摄像机坐标系与大地坐标系之间的转换示例P为地面上一点，Oc代表摄像头坐标系的原点，相应的Xc、Yc、Zc分别代表摄像头坐标系的X,Y,Z坐标轴，On代表大地坐标系的原点，相应的Xn、Yn、Zn分别代表大地坐标系的X,Y,Z坐标轴，摄像头坐标系下坐标为大地坐标系下坐标为两者之间的关系为：如图5为光流处理算法中，摄像机坐标系与成像平面坐标系之间的转换示例Oc代表摄像头坐标系的原点，相本文档来自技高网...

【技术保护点】
1.一种无人机室内定位系统，其特征在于：数据采集模块，包括惯性传感器(内含陀螺仪与加速度计)、高度计(内含超声波传感器和气压计等可以测量高度的模块)、摄像头；底层飞控模块，利用姿态控制回路和增稳控制回路对飞行器的姿态角分别做角度控制和稳定控制；位置解算模块，采用的是互补滤波，将加速度计和高度计、光流计采集获得的数据融合，得到三维位置和速度。

【技术特征摘要】
1.一种无人机室内定位系统，其特征在于：数据采集模块，包括惯性传感器(内含陀螺仪与加速度计)、高度计(内含超声波传感器和气压计等可以测量高度的模块)、摄像头；底层飞控模块，利用姿态控制回路和增稳控制回路对飞行器的姿态角分别做角度控制和稳定控制；位置解算模块，采用的是互补滤波，将加速度计和高度计、光流计采集获得的数据融合，得到三维位置和速度。2.根据权利要求1所示的底层飞控模块，其特征在于：还包括姿态控制回路根据飞行器回传的姿态角采用PID控制算法做角度控制,增稳控制回路根据回传的...

【专利技术属性】
技术研发人员：严萍，郑锆，罗云浩，张增贵，韩超，邹丽娇，朱名，罗小刚，
申请(专利权)人：南昌大学，
类型：发明
国别省市：江西,36