405 lines
16 KiB
C
405 lines
16 KiB
C
#include "app_config.h"
|
||
#include "asm/clock.h"
|
||
#include "system/timer.h"
|
||
#include "bmp280.h"
|
||
#include "asm/cpu.h"
|
||
#include "generic/typedef.h"
|
||
#include "generic/gpio.h"
|
||
|
||
#if defined(TCFG_BMP280_DEV_ENABLE) && TCFG_BMP280_DEV_ENABLE
|
||
|
||
#undef LOG_TAG_CONST
|
||
#define LOG_TAG "[bmp280]"
|
||
#define LOG_ERROR_ENABLE
|
||
#define LOG_INFO_ENABLE
|
||
#include "debug.h"
|
||
|
||
struct _bmp280_dev_platform_data *bmp280_iic_info;
|
||
|
||
#if TCFG_BMP280_USER_IIC_TYPE
|
||
#define iic_init(iic) hw_iic_init(iic)
|
||
#define iic_uninit(iic) hw_iic_uninit(iic)
|
||
#define iic_start(iic) hw_iic_start(iic)
|
||
#define iic_stop(iic) hw_iic_stop(iic)
|
||
#define iic_tx_byte(iic, byte) hw_iic_tx_byte(iic, byte)
|
||
#define iic_rx_byte(iic, ack) hw_iic_rx_byte(iic, ack)
|
||
#define iic_read_buf(iic, buf, len) hw_iic_read_buf(iic, buf, len)
|
||
#define iic_write_buf(iic, buf, len) hw_iic_write_buf(iic, buf, len)
|
||
#define iic_suspend(iic) hw_iic_suspend(iic)
|
||
#define iic_resume(iic) hw_iic_resume(iic)
|
||
#else
|
||
#define iic_init(iic) soft_iic_init(iic)
|
||
#define iic_uninit(iic) soft_iic_uninit(iic)
|
||
#define iic_start(iic) soft_iic_start(iic)
|
||
#define iic_stop(iic) soft_iic_stop(iic)
|
||
#define iic_tx_byte(iic, byte) soft_iic_tx_byte(iic, byte)
|
||
#define iic_rx_byte(iic, ack) soft_iic_rx_byte(iic, ack)
|
||
#define iic_read_buf(iic, buf, len) soft_iic_read_buf(iic, buf, len)
|
||
#define iic_write_buf(iic, buf, len) soft_iic_write_buf(iic, buf, len)
|
||
#define iic_suspend(iic) soft_iic_suspend(iic)
|
||
#define iic_resume(iic) soft_iic_resume(iic)
|
||
#endif
|
||
/* extern void delay(unsigned int cnt);//eeprom */
|
||
extern void delay_2ms(int cnt);//fm
|
||
|
||
static bool bmp280_read_buf(u8 reg, u8 *buf, u8 len)
|
||
{
|
||
iic_start(bmp280_iic_info->iic_hdl);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, BMP280_I2C_ADDR << 1 | 0)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 read fail1!\n");
|
||
return false;
|
||
}
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, reg)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 read fail2!\n");
|
||
return false;
|
||
}
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
iic_start(bmp280_iic_info->iic_hdl);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, BMP280_I2C_ADDR << 1 | 1)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 read fail3!\n");
|
||
return false;
|
||
}
|
||
|
||
for (u8 i = 0; i < len - 1; i++) {
|
||
buf[i] = iic_rx_byte(bmp280_iic_info->iic_hdl, 1);
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
}
|
||
buf[len - 1] = iic_rx_byte(bmp280_iic_info->iic_hdl, 0);
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
return true;
|
||
}
|
||
|
||
static bool bmp280_write_byte(u8 reg, u8 data)
|
||
{
|
||
iic_start(bmp280_iic_info->iic_hdl);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, BMP280_I2C_ADDR << 1)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 write fail1!\n");
|
||
return false;
|
||
}
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, reg)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 write fail2!\n");
|
||
return false;
|
||
}
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
if (0 == iic_tx_byte(bmp280_iic_info->iic_hdl, data)) {
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
log_error("bmp280 write fail3!\n");
|
||
return false;
|
||
}
|
||
iic_stop(bmp280_iic_info->iic_hdl);
|
||
delay_2ms(bmp280_iic_info->iic_delay);
|
||
return true;
|
||
}
|
||
|
||
//设置BMP过采样因子 MODE
|
||
//BMP280_SLEEP_MODE||BMP280_FORCED_MODE||BMP280_NORMAL_MODE
|
||
bool bmp280_set_temoversamp(bmp_oversample_mode *oversample_mode)
|
||
{
|
||
u8 regtmp;
|
||
regtmp = ((oversample_mode->t_osample) << 5) |
|
||
((oversample_mode->p_osample) << 2) |
|
||
((oversample_mode)->workmode);
|
||
/* log_info("init reg:%x",regtmp); */
|
||
|
||
return bmp280_write_byte(BMP280_CTRLMEAS_REG, regtmp);
|
||
}
|
||
//设置保持时间和滤波器分频因子
|
||
bool bmp280_set_standby_filter(bmp_config *bmp_config)
|
||
{
|
||
u8 regtmp;
|
||
regtmp = ((bmp_config->t_sb) << 5) |
|
||
((bmp_config->filter_coefficient) << 2) |
|
||
((bmp_config->spi_en));
|
||
/* log_info("init config reg:%x",regtmp); */
|
||
|
||
return bmp280_write_byte(BMP280_CONFIG_REG, regtmp);
|
||
}
|
||
//设置bmp280工作模式
|
||
void bmp280_set_work_mode(BMP280_WORK_MODE workmode)
|
||
{
|
||
u8 ctrl_maes_data = 0;
|
||
bmp280_read_buf(BMP280_CTRLMEAS_REG, &ctrl_maes_data, 1);
|
||
/* log_info("old ctrl_maes_data:%x ",ctrl_maes_data); */
|
||
ctrl_maes_data &= ~(BIT(1) | BIT(0));
|
||
ctrl_maes_data += (workmode << 0);
|
||
/* log_info("nem ctrl_maes_data:%x ",ctrl_maes_data); */
|
||
bmp280_write_byte(BMP280_CTRLMEAS_REG, ctrl_maes_data);
|
||
}
|
||
//bmp280 复位
|
||
bool bmp280_reset() //return 1:ok; 0:fail
|
||
{
|
||
return bmp280_write_byte(BMP280_RESET_REG, BMP280_RESET_VALUE);
|
||
}
|
||
|
||
bmp280_params bmp280_par;
|
||
bool bmp280_init(void *priv)
|
||
{
|
||
u8 bmp280_id;
|
||
if (priv == NULL) {
|
||
log_info("bmp280 init fail(no priv)\n");
|
||
return false;
|
||
}
|
||
bmp280_iic_info = (struct _bmp280_dev_platform_data *)priv;
|
||
|
||
if (bmp280_read_buf(BMP280_CHIPID_REG, &bmp280_id, 1)) {
|
||
log_info("bmp280 id:%x", bmp280_id);
|
||
} else {
|
||
log_error("read bmp280 id fail!");
|
||
return false;
|
||
}
|
||
/********************读矫正参数*********************/
|
||
u8 temp[24] = {0};
|
||
bmp280_read_buf(BMP280_DIG_T1_LSB_REG, temp, 24);
|
||
//温度传感器的矫正值
|
||
bmp280_par.t1 = (((u16)temp[1]) << 8) + temp[0];
|
||
bmp280_par.t2 = (temp[3] << 8) + temp[2];
|
||
bmp280_par.t3 = (temp[5] << 8) + temp[4];
|
||
//大气压传感器的矫正值
|
||
bmp280_par.p1 = (((u16)temp[7]) << 8) + temp[6];
|
||
bmp280_par.p2 = (temp[9] << 8) + temp[8];
|
||
bmp280_par.p3 = (temp[11] << 8) + temp[10];
|
||
bmp280_par.p4 = (temp[13] << 8) + temp[12];
|
||
bmp280_par.p5 = (temp[15] << 8) + temp[14];
|
||
bmp280_par.p6 = (temp[17] << 8) + temp[16];
|
||
bmp280_par.p7 = (temp[19] << 8) + temp[18];
|
||
bmp280_par.p8 = (temp[21] << 8) + temp[20];
|
||
bmp280_par.p9 = (temp[23] << 8) + temp[22];
|
||
/* log_info("%d,%d,%d;%d,%d,%d,%d,%d,%d,%d,%d,%d",bmp280_par.t1,bmp280_par.t2,bmp280_par.t3,bmp280_par.p1,bmp280_par.p2,bmp280_par.p3,bmp280_par.p4,bmp280_par.p5,bmp280_par.p6,bmp280_par.p7,bmp280_par.p8,bmp280_par.p9); */
|
||
|
||
/******************************************************/
|
||
if (!(bmp280_write_byte(BMP280_RESET_REG, BMP280_RESET_VALUE))) { //往复位寄存器写入给定值
|
||
log_error("bmp280 reset error!\n");
|
||
return false;
|
||
}
|
||
|
||
bmp_config bmp_configstr;
|
||
bmp_configstr.t_sb = BMP280_T_SB1;
|
||
bmp_configstr.filter_coefficient = BMP280_FILTER_MODE_4;
|
||
bmp_configstr.spi_en = DISABLE;
|
||
if (!(bmp280_set_standby_filter(&bmp_configstr))) {
|
||
log_error("bmp280 init mode error!\n");
|
||
return false;
|
||
}
|
||
|
||
bmp_oversample_mode bmp_oversample_modestr;
|
||
bmp_oversample_modestr.t_osample = BMP280_T_MODE_1;
|
||
bmp_oversample_modestr.p_osample = BMP280_P_MODE_3;
|
||
bmp_oversample_modestr.workmode = BMP280_NORMAL_MODE;
|
||
if (!(bmp280_set_temoversamp(&bmp_oversample_modestr))) {
|
||
log_error("bmp280 init mode error!\n");
|
||
return false;
|
||
}
|
||
|
||
return true;
|
||
}
|
||
|
||
/*****************算法*******************/
|
||
/************计算补偿值***************/
|
||
s32 t_fine; //用于计算补偿
|
||
#if USE_FIXED_POINT_COMPENSATE //使用定点补偿
|
||
// Returns temperature in DegC, resolution is 0.01 DegC. Output value of “5123” equals 51.23 DegC.
|
||
// t_fine carries fine temperature as global value
|
||
static s32 bmp280_compensate_t_int32(s32 adc_T)
|
||
{
|
||
s32 var1, var2, T;
|
||
var1 = (((adc_T >> 3) - ((s32)bmp280_par.t1 << 1)) * ((s32)bmp280_par.t2)) >> 11;
|
||
var2 = (((((adc_T >> 4) - ((s32)bmp280_par.t1)) * ((adc_T >> 4) - ((s32)bmp280_par.t1))) >> 12) * ((s32)bmp280_par.t3)) >> 14;
|
||
t_fine = var1 + var2;
|
||
T = (t_fine * 5 + 128) >> 8;
|
||
return T;
|
||
}
|
||
|
||
// Returns pressure in Pa as unsigned 32 bit integer in Q24.8 format (24 integer bits and 8 fractional bits).
|
||
// Output value of “24674867” represents 24674867/256 = 96386.2 Pa = 963.862 hPa
|
||
static u32 bmp280_compensate_p_int64(s32 adc_P)
|
||
{
|
||
s64 var1, var2, p;
|
||
var1 = ((s64)t_fine) - 128000;
|
||
var2 = var1 * var1 * (s64)bmp280_par.p6;
|
||
var2 = var2 + ((var1 * (s64)bmp280_par.p5) << 17);
|
||
var2 = var2 + (((s64)bmp280_par.p4) << 35);
|
||
var1 = ((var1 * var1 * (s64)bmp280_par.p3) >> 8) + ((var1 * (s64)bmp280_par.p2) << 12);
|
||
var1 = (((((s64)1) << 47) + var1)) * ((s64)bmp280_par.p1) >> 33;
|
||
if (var1 == 0) {
|
||
return 0; // avoid exception caused by division by zero
|
||
}
|
||
p = 1048576 - adc_P;
|
||
p = (((p << 31) - var2) * 3125) / var1;
|
||
var1 = (((s64)bmp280_par.p9) * (p >> 13) * (p >> 13)) >> 25;
|
||
var2 = (((s64)bmp280_par.p8) * p) >> 19;
|
||
p = ((p + var1 + var2) >> 8) + (((s64)bmp280_par.p7) << 4);
|
||
return (u32)p;
|
||
}
|
||
|
||
#else //使用浮点补偿
|
||
// Returns temperature in DegC, double precision. Output value of “51.23” equals 51.23 DegC.
|
||
// t_fine carries fine temperature as global value
|
||
static double bmp280_compensate_t_double(s32 adc_T)
|
||
{
|
||
double var1, var2, T;
|
||
var1 = (((double)adc_T) / 16384.0 - ((double)bmp280_par.t1) / 1024.0) * ((double)bmp280_par.t2);
|
||
var2 = ((((double)adc_T) / 131072.0 - ((double)bmp280_par.t1) / 8192.0) * (((double)adc_T) / 131072.0 - ((double) bmp280_par.t1) / 8192.0)) * ((double)bmp280_par.t3);
|
||
t_fine = (s32)(var1 + var2);
|
||
T = (var1 + var2) / 5120.0;
|
||
return T;
|
||
}
|
||
|
||
// Returns pressure in Pa as double. Output value of “96386.2” equals 96386.2 Pa = 963.862 hPa
|
||
static double bmp280_compensate_p_double(s32 adc_P)
|
||
{
|
||
double var1, var2, p;
|
||
var1 = ((double)t_fine / 2.0) - 64000.0;
|
||
var2 = var1 * var1 * ((double)bmp280_par.p6) / 32768.0;
|
||
var2 = var2 + var1 * ((double)bmp280_par.p5) * 2.0;
|
||
var2 = (var2 / 4.0) + (((double)bmp280_par.p4) * 65536.0);
|
||
var1 = (((double)bmp280_par.p3) * var1 * var1 / 524288.0 + ((double)bmp280_par.p2) * var1) / 524288.0;
|
||
var1 = (1.0 + var1 / 32768.0) * ((double)bmp280_par.p1);
|
||
if (var1 == 0.0) {
|
||
return 0; // avoid exception caused by division by zero
|
||
}
|
||
p = 1048576.0 - (double)adc_P;
|
||
p = (p - (var2 / 4096.0)) * 6250.0 / var1;
|
||
var1 = ((double)bmp280_par.p9) * p * p / 2147483648.0;
|
||
var2 = p * ((double)bmp280_par.p8) / 32768.0;
|
||
p = p + (var1 + var2 + ((double)bmp280_par.p7)) / 16.0;
|
||
return p;
|
||
}
|
||
#endif
|
||
|
||
//获取BMP当前状态
|
||
//status_flag = BMP280_MEASURING
|
||
// BMP280_IM_UPDATE
|
||
static u8 bmp280_getstatus(u8 status_flag)
|
||
{
|
||
u8 flag;
|
||
bmp280_read_buf(BMP280_STATUS_REG, &flag, 1);
|
||
if (flag & status_flag) {
|
||
return 1;
|
||
} else {
|
||
return 0;
|
||
}
|
||
}
|
||
//温度值-℃(实际值的100倍(定点法)或实际值(浮点法))
|
||
static bmp_temperature_data bmp280_get_temperature(void)
|
||
{
|
||
u8 tem_data[3] = {0};
|
||
long signed bit32;
|
||
bmp280_read_buf(BMP280_TEMPERATURE_MSB_REG, tem_data, 3);
|
||
bit32 = ((long)(tem_data[0] << 12)) | ((long)(tem_data[1] << 4)) | (tem_data[2] >> 4);
|
||
/* log_info("tembit32:%ld",bit32); */
|
||
#if USE_FIXED_POINT_COMPENSATE //使用定点补偿
|
||
return bmp280_compensate_t_int32(bit32);
|
||
#else //使用浮点补偿
|
||
return bmp280_compensate_t_double(bit32);
|
||
#endif
|
||
}
|
||
//获取大气压值-Pa(实际值的100倍(定点法)或实际值(浮点法))
|
||
static bmp_pressure_data bmp280_get_pressure(void)
|
||
{
|
||
u8 tem_data[3] = {0};
|
||
long signed bit32;
|
||
bmp280_read_buf(BMP280_PRESSURE_MSB_REG, tem_data, 3);
|
||
bit32 = ((long)(tem_data[0] << 12)) | ((long)(tem_data[1] << 4)) | (tem_data[2] >> 4);
|
||
/* log_info("prebit32:%ld,t_fine:%d",bit32,t_fine); */
|
||
#if USE_FIXED_POINT_COMPENSATE //使用定点补偿
|
||
u32 pressure = bmp280_compensate_p_int64(bit32);
|
||
pressure = pressure * 100 / 256;
|
||
#else //使用浮点补偿
|
||
double pressure = bmp280_compensate_p_double(bit32);
|
||
#endif
|
||
return pressure;
|
||
}
|
||
/*
|
||
* 仅在BMP280被设置为normal mode时，
|
||
* 可使用该接口直接读取温度和气压。
|
||
* (实际值的100倍(定点法)或实际值(浮点法))
|
||
*/
|
||
void bmp280_get_temperature_and_pressure(bmp_temperature_data *temperature, bmp_pressure_data *pressure)
|
||
{
|
||
while (bmp280_getstatus(BMP280_MEASURING));
|
||
while (bmp280_getstatus(BMP280_IM_UPDATE));
|
||
*temperature = bmp280_get_temperature(); //必须先读温度再度气压
|
||
*pressure = bmp280_get_pressure();
|
||
}
|
||
|
||
/**
|
||
* 当BMP280被设置为forced mode时，
|
||
* 可使用该接口直接读取温度和气压。
|
||
* (实际值的100倍(定点法)或实际值(浮点法))
|
||
*/
|
||
void bmp280_forced_mode_get_temperature_and_pressure(bmp_temperature_data *temperature, bmp_pressure_data *pressure)
|
||
{
|
||
bmp280_set_work_mode(BMP280_FORCED_MODE);
|
||
bmp280_get_temperature_and_pressure(temperature, pressure);
|
||
}
|
||
|
||
//计算高度, 返回海拔高度: (m)
|
||
#include "math.h"
|
||
#define SEA_LEVEL_PRESSURE 1013.23f
|
||
float bmp280_get_altitude(bmp_temperature_data temperature, bmp_pressure_data pressure)
|
||
{
|
||
/* log_info("temperature:%d,pressure:%d",(s32)temperature,(u32)pressure); */
|
||
#if USE_FIXED_POINT_COMPENSATE //使用定点补偿
|
||
/* return 44330 * (1.0 - pow(pressure/10000 / SEA_LEVEL_PRESSURE, 0.1903)); */
|
||
//计算公式温度用实际值，压强用实际值的百分之一
|
||
return ((float)powf(SEA_LEVEL_PRESSURE / ((float)pressure / 10000.0), 0.190223f) - 1.0f) * ((float)temperature / 100.0 + 273.15f) / 0.0065f; // Calculate the altitude in metres
|
||
#else //使用浮点补偿
|
||
/* return 44330 * (1.0 - pow(pressure/100 / SEA_LEVEL_PRESSURE, 0.1903)); */
|
||
//计算公式温度用实际值，压强用实际值的百分之一
|
||
return ((float)powf(SEA_LEVEL_PRESSURE / ((float)pressure / 100.0), 0.190223f) - 1.0f) * ((float)temperature + 273.15f) / 0.0065f; // Calculate the altitude in metres
|
||
#endif
|
||
}
|
||
|
||
/*************************test*************************/
|
||
#if 0
|
||
static struct _bmp280_dev_platform_data bmp280_iic_info_test = {
|
||
.iic_hdl = 0,
|
||
.iic_delay = 0
|
||
};
|
||
#define _portio 0
|
||
void bmp280_init_read_test()
|
||
{
|
||
u16 i = 0, iii = 40;
|
||
bmp_pressure_data bmp_pressure;
|
||
bmp_temperature_data bmp_temperature;
|
||
float bmp280_altitude = 0;
|
||
/* JL_PORTA->DIR &= ~(BIT(0)|BIT(9)|BIT(10)); */
|
||
/* JL_PORTA->OUT &= ~(BIT(0)|BIT(9)|BIT(10)); */
|
||
iic_init(0);
|
||
|
||
log_info("bmp280 init***************************\n");
|
||
if (bmp280_init(&bmp280_iic_info_test)) {
|
||
log_info("bmp280 init ok!***************************\n");
|
||
while (iii--) {
|
||
bmp280_get_temperature_and_pressure(&bmp_temperature, &bmp_pressure);
|
||
/* bmp280_forced_mode_get_temperature_and_pressure(&bmp_temperature , &bmp_pressure); */
|
||
bmp280_altitude = bmp280_get_altitude(bmp_temperature, bmp_pressure);
|
||
#if USE_FIXED_POINT_COMPENSATE //使用定点补偿
|
||
|
||
log_info("bmp280 fixed Pressure %ld.%02dpa,temperature:%d.%02dc,alti:%d.%02dm\n", bmp_pressure / 100, bmp_pressure % 100, bmp_temperature / 100, bmp_temperature % 100, (s32)bmp280_altitude, (u32)((s32)(bmp280_altitude * 100) % 100));
|
||
#else //使用浮点补偿
|
||
|
||
log_info("bmp280 float Pressure %d.%02dpa,temperature:%d.%02dc,alti:%d.%02dm\n", (s32)bmp_pressure, (s32)(bmp_pressure * 100) % 100, (s32)bmp_temperature, (s32)(bmp_temperature * 100) % 100, (s32)bmp280_altitude, (u32)((s32)(bmp280_altitude * 100) % 100));
|
||
#endif
|
||
os_time_dly(50);
|
||
}
|
||
} else {
|
||
log_error("bmp280 init fail!***************************\n");
|
||
}
|
||
while (1);
|
||
}
|
||
|
||
#endif
|
||
|
||
|
||
|
||
#endif
|