1、关于MS5611的基本介绍

2、通过IIC获取气压计数据

3、转化为相对高度

我选择这个气压计做定高的高度测量模块呢？因为我也很无奈，飞控上用的是，咱也没办法。
先介绍一下这个模块吧，该模块有着SPI和IIC总线接口的高分辨率气压传感器，其包括一个高线性度的压力传感器和一个超低功耗的24位模数转换器MS5611提供了一个精确的24位数字压力值和温度值以及不同的操作模式，可以提高转换速度并优化电流消耗，分辨率可达10CM，说是10cm，我感觉还是挺大的，有一个spl06，精度要比Ms5611要好，不过问题不大，关于MS5611的外围电路原理图：
其实气压计收外界因素的影响还是很大的，还很多，比如受温度啊，所以气压计在读取数据的时候要读取温度，进行二阶的一个温度补偿，不过这个温度可不是MPU6050读取的温度值，MPU6050读取的温度值是这个芯片的温度值，而MS5611采集的温度是外界环境温度，气压计还会受风力的影响，因为风大的时候大气压强是不一样的，光照强度也会对气压计有影响，所以一些飞控会对飞控板这些容易受到外界因素影响的模块做一个封闭的壳子，这样可以减少外界因素的影响，并且在气压计上面使用黑色海绵压着。
对于气压计的初始化就不贴代码了，使用IIC或者SPI都可以的，发送对应的命令先去对传感器进行复位，并且从PROM读取出厂校准数据。

PROM寄存器值，只需要读取一次。第一个是厂商信息，2-7是六个系数信息，8是CRC校验信息，这些数据都是厂家出厂时就校准好的，之后也不会更改。每个气压计参数都是不一样的，所以不用怀疑为什么和别人的不一样。

通过IIC获取压力数据和温度数据进行拼接：

MS5611_TEM = (t_rxbuf[0] << 16) | (t_rxbuf[1] << 8)|t_rxbuf[2];//算出温度值
MS5611_PRE = (p_rxbuf[0] << 16) | (p_rxbuf[1] << 8)|p_rxbuf[2];//算出气压值

通过出厂设置的值进行校准：

dT = MS5611_TEM - ((uint32_t)Cal_C[5] << 8);
OFF = ((uint32_t)Cal_C[2] << 16) + ((int64_t)dT * Cal_C[4])/128.0f;
SENS = ((uint32_t)Cal_C[1] << 15) + ((int64_t)dT * Cal_C[3])/256.0f;
temperature = 2000 + ((int64_t)dT * Cal_C[6])/8388608.0f;//得出温度

此时需要对温度进行二阶补偿

if (temperature < 2000) {Aux =  (temperature - 2000) *  (temperature - 2000);OFF2 = 2.5 * Aux;SENS2 = 1.25f * Aux;if (temperature < -1500) { Aux = (temperature + 1500) * (temperature + 1500);OFF2  += 7.0f * Aux;SENS2 += 5.5f * Aux;}}OFF  -= OFF2; SENS -= SENS2;MS5611_Pressure=(((MS5611_PRE*SENS )/2097152.0f)-OFF)/32768.0f;alt_3 = (101000 - MS5611_Pressure)/1000.0f;MS5611_Pressure=0.82f*alt_3*alt_3*alt_3+0.09f*(101000- MS5611_Pressure)*100.0f ;//算出气压值

那么问题来了，其实现在算出的是绝对高度，如果使用绝对高度，对于无人机的定高来说是恨不准确的，因为如果想要设定无人机的高度，使用绝对高度是无法获知的，那么我们应该计算出相对高度，怎么计算呢？给大家提供一个思路， ==我们先舍去气压计的前300个数据，因为气压计刚上电的数据很不稳定，错误数据也很多，所以我们大概丢弃掉刚上电的数据，将丢弃后的数据后获取的第一个数据作为基础气压值，将随后获取到的气压值减去基础气压值算出了相对气压值，这样通过相对气压值就可以算出相对高度。

  if( baro_start < 100 ){baro_start++;LPF_relative_height = 0;if(baro_start > 50) {BARO_Bisic += MS5611_Pressure;  //上电后的气压值作为基础气压if(baro_start == 100){BARO_Bisicpressue = BARO_Bisic/50.0f;}}} else{BARO_height = Median(mo_av_baro,MO_LEN ,&moavcnt,(s32)(MS5611_Pressure - BARO_Bisicpressue)); //计算绝对高度LPF_1_(1.0f,0.03f,BARO_height,LPF_relative_height);//通过后期的绝对高度减去刚上电的初始高度算出相对高度}

一般想要做更精确的高度定高还需要一个更精确地传感器，可以用超声波模块或者激光测距传感器。

基于STM32F407四旋翼无人机---MS5611气压计（三）相关推荐

基于STM32F407四旋翼无人机---AK8975磁力计（四）
基于STM32F407四旋翼无人机---AK8975磁力计(四) 磁力计基本介绍 1.2.磁力计原理图 2.磁力计数据获取 3.磁力计椭球拟合校准 3.1.简单介绍椭球拟合磁力计基本介绍该模块采用 ...
基于STM32F407四旋翼无人机 --- 姿态解算讲解（四元数）（叉积法融合陀螺仪数据和加速度数据）（五）
基于STM32F407四旋翼无人机 --- 姿态解算讲解(五) 姿态解算姿态解算定义欧拉角四元数四元数性质方向余弦矩阵四元数方向余弦矩阵叉积法融合陀螺仪数据和加速度数据叉积运算一阶龙 ...
【飞行器】基于matlab四旋翼无人机几何跟踪控制【含Matlab源码 2270期】
⛄一.获取代码方式获取代码方式1: 完整代码已上传我的资源:[飞行器]基于matlab四旋翼无人机几何跟踪控制[含Matlab源码 2270期] 点击上面蓝色字体,直接付费下载,即可. 获取代码方式 ...
基于ESP32四旋翼无人机如何根据PID算法进行电机的PWM duty补偿
1.计算模型电机位置和补偿输出的关系,需要求解的是C1,C2,C3,C4的电机输出补偿值.分别对应M1,M2,M3,M4四个电机. 2.推导过程(可以跳过不看,直接到第三步) 3. 四个电机的PID ...
基于ESP32四旋翼无人机同蓝牙遥控器通信处理方式
1.蓝牙初始化在app_main调用函数初始化蓝牙 inf_ble_gatt_init(); 2.判断蓝牙是否链接在dandelion_task中调用函数inf_ble_gatt_connecte ...
基于数据融合和串级PID的小型四旋翼无人机高度测量与控制系统
作者:Tomy 摘要:简单介绍了一种基于 Mahony 算法无人机姿态解算算法,并在这个的基础上设计了一种融合惯导加速度计和气压计的小型无人机高度测量系统, 同时利用该高度测量系统设计了基于串级 ...
基于STM32的四旋翼无人机项目（二）：MPU6050姿态解算（含上位机3D姿态显示教学）
前言:本文为手把手教学飞控核心知识点之一的姿态解算--MPU6050 姿态解算(飞控专栏第2篇).项目中飞行器使用 MPU6050 传感器对飞行器的姿态进行解算(四元数方法),搭配设计的卡尔曼滤波器与 ...
基于STM32的四旋翼无人机开发设计
已知技术参数和设计要求: 1．功能要求本次课程设计涉及的四旋翼无人机设计方案,采用STM32F103为上位机,外加直流电机.WIFI模块.MPU6050九轴运动处理传感器等实现四旋翼无人机飞行及其控 ...
四旋翼无人机建模与实现（三）
四旋翼无人机建模与实现(三) 本文是对GitHub上的一个开源的四旋翼无人机建模与编程实现的学习笔记,因为原作者的文档使用英文写的,花了很长的时间才看懂,因此,我觉得用自己的语言将这个开源项目分享出来 ...
四旋翼无人机仿真之hector_quadrotor无人机（ROS + Gazebo）（三）传感器数据读取与复现（IMU、GPS）
系列文章目录文章1:四旋翼无人机仿真之hector_quadrotor无人机(ROS + Gazebo) 文章2:四旋翼无人机仿真之hector_quadrotor(二)键盘teleop_twist ...

基于STM32F407四旋翼无人机---MS5611气压计（三）

基于STM32F407四旋翼无人机---MS5611气压计（三）

1、关于MS5611的基本介绍

2、通过IIC获取气压计数据

3、转化为相对高度

基于STM32F407四旋翼无人机---MS5611气压计（三）相关推荐

最新文章

热门文章

基于STM32F407四旋翼无人机---MS5611气压计（三）

基于STM32F407四旋翼无人机---MS5611气压计（三）

1、关于MS5611的基本介绍

2、通过IIC获取气压计数据

3、 转化为相对高度

基于STM32F407四旋翼无人机---MS5611气压计（三）相关推荐

最新文章

热门文章

3、转化为相对高度