7d7345a620
Use the macro CONFIG_SENSORS_BMP180_UORB to enable the uorb feature. Signed-off-by: likun17 <likun17@xiaomi.com>
392 lines
10 KiB
C
392 lines
10 KiB
C
/****************************************************************************
|
|
* drivers/sensors/bmp180_base.c
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/* Character driver for the Freescale BMP1801 Barometer Sensor */
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include "bmp180_base.h"
|
|
|
|
#if defined(CONFIG_I2C) && defined(CONFIG_SENSORS_BMP180)
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Private Type Definitions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Private Function Prototypes
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Private Data
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_getreg8
|
|
*
|
|
* Description:
|
|
* Read from an 8-bit BMP180 register
|
|
*
|
|
****************************************************************************/
|
|
|
|
uint8_t bmp180_getreg8(FAR struct bmp180_dev_s *priv, uint8_t regaddr)
|
|
{
|
|
struct i2c_config_s config;
|
|
uint8_t regval = 0;
|
|
int ret;
|
|
|
|
/* Set up the I2C configuration */
|
|
|
|
config.frequency = priv->freq;
|
|
config.address = priv->addr;
|
|
config.addrlen = 7;
|
|
|
|
/* Write the register address */
|
|
|
|
ret = i2c_write(priv->i2c, &config, ®addr, 1);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: i2c_write failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
/* Read the register value */
|
|
|
|
ret = i2c_read(priv->i2c, &config, ®val, 1);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: i2c_read failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
return regval;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_getreg16
|
|
*
|
|
* Description:
|
|
* Read two 8-bit from a BMP180 register
|
|
*
|
|
****************************************************************************/
|
|
|
|
uint16_t bmp180_getreg16(FAR struct bmp180_dev_s *priv, uint8_t regaddr)
|
|
{
|
|
struct i2c_config_s config;
|
|
uint16_t msb;
|
|
uint16_t lsb;
|
|
uint16_t regval = 0;
|
|
int ret;
|
|
|
|
/* Set up the I2C configuration */
|
|
|
|
config.frequency = priv->freq;
|
|
config.address = priv->addr;
|
|
config.addrlen = 7;
|
|
|
|
/* Register to read */
|
|
|
|
ret = i2c_write(priv->i2c, &config, ®addr, 1);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: i2c_write failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
/* Read register */
|
|
|
|
ret = i2c_read(priv->i2c, &config, (uint8_t *)®val, 2);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: i2c_read failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
/* MSB and LSB are inverted */
|
|
|
|
msb = (regval & 0xff);
|
|
lsb = (regval & 0xff00) >> 8;
|
|
|
|
regval = (msb << 8) | lsb;
|
|
|
|
return regval;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_putreg8
|
|
*
|
|
* Description:
|
|
* Write to an 8-bit BMP180 register
|
|
*
|
|
****************************************************************************/
|
|
|
|
void bmp180_putreg8(FAR struct bmp180_dev_s *priv, uint8_t regaddr,
|
|
uint8_t regval)
|
|
{
|
|
struct i2c_config_s config;
|
|
uint8_t data[2];
|
|
int ret;
|
|
|
|
/* Set up the I2C configuration */
|
|
|
|
config.frequency = priv->freq;
|
|
config.address = priv->addr;
|
|
config.addrlen = 7;
|
|
|
|
data[0] = regaddr;
|
|
data[1] = regval;
|
|
|
|
/* Write the register address and value */
|
|
|
|
ret = i2c_write(priv->i2c, &config, (uint8_t *) &data, 2);
|
|
if (ret < 0)
|
|
{
|
|
snerr("ERROR: i2c_write failed: %d\n", ret);
|
|
return;
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_checkid
|
|
*
|
|
* Description:
|
|
* Read and verify the BMP180 chip ID
|
|
*
|
|
****************************************************************************/
|
|
|
|
int bmp180_checkid(FAR struct bmp180_dev_s *priv)
|
|
{
|
|
uint8_t devid = 0;
|
|
|
|
/* Read device ID */
|
|
|
|
devid = bmp180_getreg8(priv, BMP180_DEVID);
|
|
sninfo("devid: 0x%02x\n", devid);
|
|
|
|
if (devid != (uint16_t)DEVID)
|
|
{
|
|
/* ID is not Correct */
|
|
|
|
snerr("ERROR: Wrong Device ID!\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_updatecaldata
|
|
*
|
|
* Description:
|
|
* Update Calibration Coefficient Data
|
|
*
|
|
****************************************************************************/
|
|
|
|
void bmp180_updatecaldata(FAR struct bmp180_dev_s *priv)
|
|
{
|
|
/* AC1 */
|
|
|
|
priv->bmp180_cal_ac1 = (int16_t) bmp180_getreg16(priv, BMP180_AC1_MSB);
|
|
|
|
/* AC2 */
|
|
|
|
priv->bmp180_cal_ac2 = (int16_t) bmp180_getreg16(priv, BMP180_AC2_MSB);
|
|
|
|
/* AC3 */
|
|
|
|
priv->bmp180_cal_ac3 = (int16_t) bmp180_getreg16(priv, BMP180_AC3_MSB);
|
|
|
|
/* AC4 */
|
|
|
|
priv->bmp180_cal_ac4 = bmp180_getreg16(priv, BMP180_AC4_MSB);
|
|
|
|
/* AC5 */
|
|
|
|
priv->bmp180_cal_ac5 = bmp180_getreg16(priv, BMP180_AC5_MSB);
|
|
|
|
/* AC6 */
|
|
|
|
priv->bmp180_cal_ac6 = bmp180_getreg16(priv, BMP180_AC6_MSB);
|
|
|
|
/* B1 */
|
|
|
|
priv->bmp180_cal_b1 = (int16_t) bmp180_getreg16(priv, BMP180_B1_MSB);
|
|
|
|
/* B2 */
|
|
|
|
priv->bmp180_cal_b2 = (int16_t) bmp180_getreg16(priv, BMP180_B2_MSB);
|
|
|
|
/* MB */
|
|
|
|
priv->bmp180_cal_mb = (int16_t) bmp180_getreg16(priv, BMP180_MB_MSB);
|
|
|
|
/* MC */
|
|
|
|
priv->bmp180_cal_mc = (int16_t) bmp180_getreg16(priv, BMP180_MC_MSB);
|
|
|
|
/* MD */
|
|
|
|
priv->bmp180_cal_md = (int16_t) bmp180_getreg16(priv, BMP180_MD_MSB);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_read_press_temp
|
|
*
|
|
* Description:
|
|
* Read raw pressure and temperature from BMP180 and store it in the
|
|
* bmp180_dev_s structure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void bmp180_read_press_temp(FAR struct bmp180_dev_s *priv)
|
|
{
|
|
uint8_t oss = CURRENT_OSS;
|
|
|
|
/* Issue a read temperature command */
|
|
|
|
bmp180_putreg8(priv, BMP180_CTRL_MEAS, BMP180_READ_TEMP);
|
|
|
|
/* Wait 5ms */
|
|
|
|
nxsig_usleep(5000);
|
|
|
|
/* Read temperature */
|
|
|
|
priv->bmp180_utemp = bmp180_getreg16(priv, BMP180_ADC_OUT_MSB);
|
|
|
|
/* Issue a read pressure command */
|
|
|
|
bmp180_putreg8(priv, BMP180_CTRL_MEAS, (BMP180_READ_PRESS | oss));
|
|
|
|
/* Delay 25.5ms (to OverSampling 8X) */
|
|
|
|
nxsig_usleep(25500);
|
|
|
|
/* Read pressure */
|
|
|
|
priv->bmp180_upress = bmp180_getreg16(priv, BMP180_ADC_OUT_MSB) << 8;
|
|
priv->bmp180_upress |= bmp180_getreg8(priv, BMP180_ADC_OUT_XLSB);
|
|
priv->bmp180_upress = priv->bmp180_upress >> (8 - (oss >> 6));
|
|
|
|
sninfo("Uncompensated temperature = %" PRId32 "\n", priv->bmp180_utemp);
|
|
sninfo("Uncompensated pressure = %" PRId32 "\n", priv->bmp180_upress);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: bmp180_getpressure
|
|
*
|
|
* Description:
|
|
* Calculate the Barometric Pressure using the temperature compensated
|
|
* See Freescale AN3785 and BMP1801 data sheet for details
|
|
*
|
|
****************************************************************************/
|
|
|
|
int bmp180_getpressure(FAR struct bmp180_dev_s *priv,
|
|
FAR float *temperature)
|
|
{
|
|
int32_t x1;
|
|
int32_t x2;
|
|
int32_t x3;
|
|
int32_t b3;
|
|
int32_t b5;
|
|
int32_t b6;
|
|
int32_t press;
|
|
int32_t temp;
|
|
uint32_t b4;
|
|
uint32_t b7;
|
|
uint8_t oss = (CURRENT_OSS >> 6);
|
|
|
|
/* Check if coefficient data were read correctly */
|
|
|
|
if ((priv->bmp180_cal_ac1 == 0) || (priv->bmp180_cal_ac2 == 0) ||
|
|
(priv->bmp180_cal_ac3 == 0) || (priv->bmp180_cal_ac4 == 0) ||
|
|
(priv->bmp180_cal_ac5 == 0) || (priv->bmp180_cal_ac6 == 0) ||
|
|
(priv->bmp180_cal_b1 == 0) || (priv->bmp180_cal_b2 == 0) ||
|
|
(priv->bmp180_cal_mb == 0) || (priv->bmp180_cal_mc == 0) ||
|
|
(priv->bmp180_cal_md == 0))
|
|
{
|
|
bmp180_updatecaldata(priv);
|
|
}
|
|
|
|
/* Read temperature and pressure */
|
|
|
|
bmp180_read_press_temp(priv);
|
|
|
|
/* Feed raw sensor data to entropy pool */
|
|
|
|
add_sensor_randomness((priv->bmp180_utemp << 16) ^ priv->bmp180_upress);
|
|
|
|
/* Calculate true temperature */
|
|
|
|
x1 = ((priv->bmp180_utemp - priv->bmp180_cal_ac6) *
|
|
priv->bmp180_cal_ac5) >> 15;
|
|
x2 = (priv->bmp180_cal_mc << 11) / (x1 + priv->bmp180_cal_md);
|
|
b5 = x1 + x2;
|
|
|
|
temp = (b5 + 8) >> 4;
|
|
sninfo("Compensated temperature = %" PRId32 "\n", temp);
|
|
|
|
if (temperature != NULL)
|
|
*temperature = temp;
|
|
|
|
/* Calculate true pressure */
|
|
|
|
b6 = b5 - 4000;
|
|
x1 = (priv->bmp180_cal_b2 * ((b6 * b6) >> 12)) >> 11;
|
|
x2 = (priv->bmp180_cal_ac2 * b6) >> 11;
|
|
x3 = x1 + x2;
|
|
b3 = (((((int32_t) priv->bmp180_cal_ac1) * 4 + x3) << oss) + 2) >> 2;
|
|
x1 = (priv->bmp180_cal_ac3 * b6) >> 13;
|
|
x2 = (priv->bmp180_cal_b1 * ((b6 * b6) >> 12)) >> 16;
|
|
x3 = ((x1 + x2) + 2) >> 2;
|
|
b4 = (priv->bmp180_cal_ac4 * (uint32_t) (x3 + 32768)) >> 15;
|
|
b7 = ((uint32_t) (priv->bmp180_upress - b3) * (50000 >> oss));
|
|
|
|
if (b7 < 0x80000000)
|
|
{
|
|
press = (b7 << 1) / b4;
|
|
}
|
|
else
|
|
{
|
|
press = (b7 / b4) << 1;
|
|
}
|
|
|
|
x1 = (press >> 8) * (press >> 8);
|
|
x1 = (x1 * 3038) >> 16;
|
|
x2 = (-7357 * press) >> 16;
|
|
|
|
press = press + ((x1 + x2 + 3791) >> 4);
|
|
|
|
sninfo("Compressed pressure = %" PRId32 "\n", press);
|
|
return press;
|
|
}
|
|
|
|
#endif /* CONFIG_I2C && CONFIG_SENSORS_BMP180 */
|