sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
309beae2cd
nuttx/drivers/sensors/ms58xx.c

1121 lines
29 KiB
C
Raw Blame History

/****************************************************************************
* drivers/sensors/ms58xx.c
* Character driver for MEAS MS58XX Altimeters
*
* Copyright (C) 2015 Omni Hoverboards Inc. All rights reserved.
* Author: Paul Alexander Patience <paul-a.patience@polymtl.ca>
* Updated by: Karim Keddam <karim.keddam@polymtl.ca>
*
* Copyright (C) 2016 Gregory Nutt. All rights reserved.
* Author: Gregory Nutt <gnutt@nuttx.org>
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in
* the documentation and/or other materials provided with the
* distribution.
* 3. Neither the name NuttX nor the names of its contributors may be
* used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <errno.h>
#include <debug.h>
#include <stdlib.h>
#include <nuttx/kmalloc.h>
#include <nuttx/fs/fs.h>
#include <nuttx/arch.h>
#include <nuttx/i2c/i2c_master.h>
#include <nuttx/sensors/ms58xx.h>
#if defined(CONFIG_I2C) && defined(CONFIG_MS58XX)
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#ifndef CONFIG_MS58XX_I2C_FREQUENCY
# define CONFIG_MS58XX_I2C_FREQUENCY 400000
#endif
/* Register Definitions *****************************************************/
/* Register Addresses */
#define MS58XX_RESET_REG 0x1e /* Reset Register */
#define MS58XX_PRESS_REG 0x40 /* Pressure Register */
#define MS58XX_TEMP_REG 0x50 /* Temperature Register */
#define MS58XX_ADC_REG 0x00 /* ADC Register */
#define MS58XX_PROM_REG 0xa0 /* PROM Register */
/* PROM Definitions *********************************************************/
#define MS58XX_PROM_LEN 8
/****************************************************************************
* Private Types
****************************************************************************/
struct ms58xx_dev_s
{
FAR struct i2c_master_s *i2c; /* I2C interface */
uint8_t addr; /* I2C address */
enum ms58xx_model_e model;
uint8_t crcindex;
uint8_t crcshift;
int32_t temp; /* Uncompensated temperature (degrees Centigrade) */
int32_t press; /* Uncompensated pressure (millibar) */
uint8_t osr; /* Oversampling ratio bits */
useconds_t delay; /* Oversampling ratio delay */
/* Calibration coefficients */
uint16_t c1;
uint16_t c2;
uint16_t c3;
uint16_t c4;
uint16_t c5;
uint16_t c6;
uint8_t c7;
uint8_t c8;
/* Constants used when calculating the temperature and the pressure */
uint8_t c1s;
uint8_t c2s;
uint8_t c3s;
uint8_t c4s;
uint8_t diffmull;
uint8_t diffdivls;
uint8_t offmull;
uint8_t offdivls;
uint8_t sensmull;
uint8_t sensdivls;
uint8_t offmulvl;
uint8_t sensmulvl;
uint8_t diffmulh;
uint8_t diffdivhs;
uint8_t offmulh;
uint8_t offdivhs;
uint8_t sensmulh;
uint8_t sensdivhs;
uint8_t pressdivs;
};
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
/* CRC Calculation */
static uint8_t ms58xx_crc(FAR uint16_t *src, uint8_t crcIndex);
/* I2C Helpers */
static int ms58xx_i2c_write(FAR struct ms58xx_dev_s *priv,
FAR const uint8_t *buffer, int buflen);
static int ms58xx_i2c_read(FAR struct ms58xx_dev_s *priv,
FAR uint8_t *buffer, int buflen);
static int ms58xx_readu16(FAR struct ms58xx_dev_s *priv, uint8_t regaddr,
FAR uint16_t *regval);
static int ms58xx_readadc(FAR struct ms58xx_dev_s *priv, FAR uint32_t *adc);
static int ms58xx_setosr(FAR struct ms58xx_dev_s *priv, uint16_t osr);
static int ms58xx_reset(FAR struct ms58xx_dev_s *priv);
static int ms58xx_readprom(FAR struct ms58xx_dev_s *priv);
static int ms58xx_convert(FAR struct ms58xx_dev_s *priv, uint8_t regaddr,
FAR uint32_t *regval);
static int ms58xx_measure(FAR struct ms58xx_dev_s *priv);
/* Character Driver Methods */
static int ms58xx_open(FAR struct file *filep);
static int ms58xx_close(FAR struct file *filep);
static ssize_t ms58xx_read(FAR struct file *filep, FAR char *buffer,
size_t buflen);
static ssize_t ms58xx_write(FAR struct file *filep, FAR const char *buffer,
size_t buflen);
static int ms58xx_ioctl(FAR struct file *filep, int cmd,
unsigned long arg);
/****************************************************************************
* Private Data
****************************************************************************/
static const struct file_operations g_fops =
{
ms58xx_open,
ms58xx_close,
ms58xx_read,
ms58xx_write,
NULL,
ms58xx_ioctl
#ifndef CONFIG_DISABLE_POLL
, NULL
#endif
#ifndef CONFIG_DISABLE_PSEUDOFS_OPERATIONS
, NULL
#endif
};
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: ms58xx_crc
*
* Description:
* Calculate the CRC.
*
****************************************************************************/
static uint8_t ms58xx_crc(FAR uint16_t *src, uint8_t crcIndex)
{
uint16_t cnt;
uint16_t n_rem;
uint16_t crc_read;
uint8_t n_bit;
n_rem = 0x00;
crc_read = src[crcIndex];
src[crcIndex] = (0xff00 & (src[7]));
for (cnt = 0; cnt < 16; cnt++)
{
if (cnt % 2 == 1)
{
n_rem ^= (uint16_t)((src[cnt >> 1]) & 0x00ff);
}
else
{
n_rem ^= (uint16_t)(src[cnt >> 1] >> 8);
}
for (n_bit = 8; n_bit > 0; n_bit--)
{
if (n_rem & (0x8000))
{
n_rem = (n_rem << 1) ^ 0x3000;
}
else
{
n_rem = (n_rem << 1);
}
}
}
n_rem = (0x000F & (n_rem >> 12));
src[crcIndex] = crc_read;
return (n_rem ^ 0x00);
}
/****************************************************************************
* Name: ms58xx_i2c_write
*
* Description:
* Write to the I2C device.
*
****************************************************************************/
static int ms58xx_i2c_write(FAR struct ms58xx_dev_s *priv,
FAR const uint8_t *buffer, int buflen)
{
struct i2c_msg_s msg;
/* Setup for the transfer */
msg.frequency = CONFIG_MS58XX_I2C_FREQUENCY,
msg.addr = priv->addr;
msg.flags = 0;
msg.buffer = (FAR uint8_t *)buffer; /* Override const */
msg.length = buflen;
/* Then perform the transfer. */
return I2C_TRANSFER(priv->i2c, &msg, 1);
}
/****************************************************************************
* Name: ms58xx_i2c_read
*
* Description:
* Read from the I2C device.
*
****************************************************************************/
static int ms58xx_i2c_read(FAR struct ms58xx_dev_s *priv,
FAR uint8_t *buffer, int buflen)
{
struct i2c_msg_s msg;
/* Setup for the transfer */
msg.frequency = CONFIG_MS58XX_I2C_FREQUENCY,
msg.addr = priv->addr,
msg.flags = I2C_M_READ;
msg.buffer = buffer;
msg.length = buflen;
/* Then perform the transfer. */
return I2C_TRANSFER(priv->i2c, &msg, 1);
}
/****************************************************************************
* Name: ms58xx_readu16
*
* Description:
* Read from a 16-bit register.
*
****************************************************************************/
static int ms58xx_readu16(FAR struct ms58xx_dev_s *priv, uint8_t regaddr,
FAR uint16_t *regval)
{
uint8_t buffer[2];
int ret;
sndbg("addr: %02x\n", regaddr);
/* Write the register address */
ret = ms58xx_i2c_write(priv, &regaddr, sizeof(regaddr));
if (ret < 0)
{
sndbg("i2c_write failed: %d\n", ret);
return ret;
}
/* Restart and read 16 bits from the register */
ret = ms58xx_i2c_read(priv, buffer, sizeof(buffer));
if (ret < 0)
{
sndbg("i2c_read failed: %d\n", ret);
return ret;
}
*regval = (uint16_t)buffer[0] << 8 | (uint16_t)buffer[1];
sndbg("value: %04x ret: %d\n", *regval, ret);
return ret;
}
/****************************************************************************
* Name: ms58xx_readadc
*
* Description:
* Read from the ADC register.
*
****************************************************************************/
static int ms58xx_readadc(FAR struct ms58xx_dev_s *priv, FAR uint32_t *adc)
{
uint8_t regaddr;
uint8_t buffer[3];
int ret;
regaddr = MS58XX_ADC_REG;
sndbg("addr: %02x\n", regaddr);
/* Write the register address */
ret = ms58xx_i2c_write(priv, &regaddr, sizeof(regaddr));
if (ret < 0)
{
sndbg("i2c_write failed: %d\n", ret);
return ret;
}
/* Restart and read 24 bits from the register */
ret = ms58xx_i2c_read(priv, buffer, sizeof(buffer));
if (ret < 0)
{
sndbg("i2c_read failed: %d\n", ret);
return ret;
}
*adc = (uint32_t)buffer[0] << 16 |
(uint32_t)buffer[1] << 8 |
(uint32_t)buffer[2];
sndbg("adc: %06x ret: %d\n", *adc, ret);
return ret;
}
/****************************************************************************
* Name: ms58xx_setosr
*
* Description:
* Set the oversampling ratio.
*
****************************************************************************/
static int ms58xx_setosr(FAR struct ms58xx_dev_s *priv, uint16_t osr)
{
int ret = OK;
sndbg("osr: %04x\n", osr);
switch (osr)
{
case 256:
priv->delay = 600;
break;
case 512:
priv->delay = 1170;
break;
case 1024:
priv->delay = 2280;
break;
case 2048:
priv->delay = 4540;
break;
case 4096:
priv->delay = 9040;
break;
case 8192:
switch (priv->model)
{
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5837_30:
priv->delay = 18080;
break;
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_07:
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5806_02:
default:
ret = -EINVAL;
break;
}
break;
default:
ret = -EINVAL;
break;
}
if (ret == OK)
{
priv->osr = (osr / 256 - 1) * 2;
}
return ret;
}
/****************************************************************************
* Name: ms58xx_readprom
*
* Description:
* Read from the PROM.
*
****************************************************************************/
static int ms58xx_readprom(FAR struct ms58xx_dev_s *priv)
{
uint16_t prom[MS58XX_PROM_LEN];
uint8_t crc;
uint8_t crcindex;
uint8_t crcshift;
uint16_t crcmask;
int ret;
int i;
int len = MS58XX_PROM_LEN;
switch (priv->model)
{
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5837_30:
prom[MS58XX_PROM_LEN-1] = 0;
len--;
crcindex = 0;
crcshift = 12;
break;
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_07:
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5806_02:
default:
crcindex = 7;
crcshift = 0;
break;
}
/* We have to wait before the prom is ready is be read */
up_udelay(10000);
for (i = 0; i < len; i++)
{
ret = ms58xx_readu16(priv, MS58XX_PROM_REG + i * 2, prom + i);
if (ret < 0)
{
sndbg("ms58xx_readu16 failed: %d\n", ret);
return ret;
}
}
crcmask = (uint16_t)0xf << crcshift;
crc = (uint8_t)((prom[crcindex] & crcmask) >> crcshift);
if (crc != ms58xx_crc(prom, crcindex))
{
sndbg("crc mismatch\n");
return -ENODEV;
}
priv->c1 = prom[1];
priv->c2 = prom[2];
priv->c3 = prom[3];
priv->c4 = prom[4];
priv->c5 = prom[5];
priv->c6 = prom[6];
switch (priv->model)
{
case MS58XX_MODEL_MS5803_07:
priv->c7 = (uint8_t)((prom[7] & 0x03f0) >> 4);
priv->c8 = (uint8_t)((prom[7] & 0xf700) >> 10);
break;
case MS58XX_MODEL_MS5806_02:
priv->c7 = (uint8_t)((prom[7] & 0x0ff0) >> 4);
priv->c8 = 0;
break;
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5837_30:
default:
priv->c7 = 0;
priv->c8 = 0;
break;
}
return ret;
}
/****************************************************************************
* Name: ms58xx_reset
*
* Description:
* Reset the device.
*
****************************************************************************/
static int ms58xx_reset(FAR struct ms58xx_dev_s *priv)
{
uint8_t regaddr;
int ret;
regaddr = MS58XX_RESET_REG;
sndbg("addr: %02x\n", regaddr);
/* Write the register address */
ret = ms58xx_i2c_write(priv, &regaddr, sizeof(regaddr));
if (ret < 0)
{
sndbg("i2c_write failed: %d\n", ret);
return ret;
}
/* Check the CRC and read the calibration coefficients */
ret = ms58xx_readprom(priv);
if (ret < 0)
{
sndbg("ms58xx_readprom failed: %d\n", ret);
}
return ret;
}
/****************************************************************************
* Name: ms58xx_convert
*
* Description:
* Measure the uncompensated temperature or the uncompensated pressure.
*
****************************************************************************/
static int ms58xx_convert(FAR struct ms58xx_dev_s *priv, uint8_t regaddr,
FAR uint32_t *regval)
{
int ret;
regaddr |= priv->osr;
sndbg("addr: %02x\n", regaddr);
/* Write the register address */
ret = ms58xx_i2c_write(priv, &regaddr, sizeof(regaddr));
if (ret < 0)
{
sndbg("i2c_write failed: %d\n", ret);
}
/* Wait for the conversion to end */
up_udelay(priv->delay);
/* Read the value from the ADC */
ret = ms58xx_readadc(priv, regval);
if (ret < 0)
{
sndbg("ms58xx_readadc failed: %d\n", ret);
return ret;
}
return ret;
}
/****************************************************************************
* Name: ms58xx_measure
*
* Description:
* Measure the compensated temperature and the compensated pressure.
*
****************************************************************************/
static int ms58xx_measure(FAR struct ms58xx_dev_s *priv)
{
uint32_t rawpress;
uint32_t rawtemp;
int32_t diff;
int32_t temp;
int64_t off;
int64_t sens;
int32_t press;
int64_t diffmul;
int64_t diffdiv;
int64_t offmula;
int64_t offdiva;
int64_t sensmula;
int64_t sensdiva;
int64_t offmulb;
int64_t sensmulb;
int64_t tm;
int64_t tp;
int ret;
ret = ms58xx_convert(priv, MS58XX_PRESS_REG, &rawpress);
if (ret < 0)
{
sndbg("ms58xx_convert failed: %d\n", ret);
return ret;
}
ret = ms58xx_convert(priv, MS58XX_TEMP_REG, &rawtemp);
if (ret < 0)
{
sndbg("ms58xx_convert failed: %d\n", ret);
return ret;
}
diff = (int32_t)rawtemp - (int32_t)priv->c5 * ((int32_t)1 << 8);
temp = (int32_t)((int64_t)2000 +
(int64_t)diff * (int64_t)priv->c6 / ((int64_t)1 << 23));
off = (int64_t)priv->c2 * ((int64_t)1 << priv->c2s) +
(int64_t)priv->c4 * (int64_t)diff / ((int64_t)1 << priv->c4s);
sens = (int64_t)priv->c1 * ((int64_t)1 << priv->c1s) +
(int64_t)priv->c3 * (int64_t)diff / ((int64_t)1 << priv->c3s);
if (temp < 2000)
{
diffmul = (int64_t)priv->diffmull;
diffdiv = (int64_t)1 << priv->diffdivls;
offmula = (int64_t)priv->offmull;
offdiva = (int64_t)1 << priv->offdivls;
sensmula = (int64_t)priv->sensmull;
sensdiva = (int64_t)1 << priv->sensdivls;
if (temp < -1500)
{
offmulb = (int64_t)priv->offmulvl;
sensmulb = (int64_t)priv->sensmulvl;
}
else
{
offmulb = 0;
sensmulb = 0;
}
}
else
{
diffmul = (int64_t)priv->diffmulh;
diffdiv = (int64_t)1 << priv->diffdivhs;
offmula = (int64_t)priv->offmulh;
offdiva = (int64_t)1 << priv->offdivhs;
sensmula = (int64_t)priv->sensmulh;
sensdiva = (int64_t)1 << priv->sensdivhs;
offmulb = 0;
sensmulb = 0;
}
tm = (int64_t)temp - (int64_t)2000;
tm *= tm;
tp = (int64_t)temp + (int64_t)1500;
tp *= tp;
off -= offmula * tm / offdiva + offmulb * tp;
sens -= sensmula * tm / sensdiva + sensmulb * tp;
temp -= (int32_t)(diffmul * (int64_t)diff * (int64_t)diff / diffdiv);
press = (int32_t)(((int64_t)rawpress * sens / ((int64_t)1 << 21) - off) /
((int64_t)1 << priv->pressdivs));
switch (priv->model)
{
case MS58XX_MODEL_MS5803_07:
if (press > 110000)
{
press += (int32_t)((((int64_t)priv->c7 - ((int64_t)1 << 5)) *
(int64_t)100 * ((int64_t)1 << 2) -
((int64_t)priv->c8 - ((int64_t)1 << 5)) *
((int64_t)temp - (int64_t)2000) /
((int64_t)1 << 4)) *
((int64_t)press - (int64_t)110000) /
(int64_t)49000000);
}
break;
case MS58XX_MODEL_MS5806_02:
#if CONFIG_MS58XX_VDD >= 22 && CONFIG_MS58XX_VDD <= 30
press += (int32_t)(((int64_t)30 - (int64_t)CONFIG_MS58XX_VDD) *
(int64_t)priv->c7 /
(((int64_t)1 << 6) * (int64_t)10));
#endif
break;
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5837_30:
break;
}
priv->temp = temp;
priv->press = press;
return ret;
}
/****************************************************************************
* Name: ms58xx_open
*
* Description:
* This method is called when the device is opened.
*
****************************************************************************/
static int ms58xx_open(FAR struct file *filep)
{
return OK;
}
/****************************************************************************
* Name: ms58xx_close
*
* Description:
* This method is called when the device is closed.
*
****************************************************************************/
static int ms58xx_close(FAR struct file *filep)
{
return OK;
}
/****************************************************************************
* Name: ms58xx_read
*
* Description:
* A dummy read method.
*
****************************************************************************/
static ssize_t ms58xx_read(FAR struct file *filep, FAR char *buffer,
size_t buflen)
{
return 0;
}
/****************************************************************************
* Name: ms58xx_write
*
* Description:
* A dummy write method.
*
****************************************************************************/
static ssize_t ms58xx_write(FAR struct file *filep, FAR const char *buffer,
size_t buflen)
{
return -ENOSYS;
}
/****************************************************************************
* Name: ms58xx_ioctl
*
* Description:
* The standard ioctl method.
*
****************************************************************************/
static int ms58xx_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
{
FAR struct inode *inode = filep->f_inode;
FAR struct ms58xx_dev_s *priv = inode->i_private;
int ret = OK;
/* Handle ioctl commands */
switch (cmd)
{
/* Measure the temperature and the pressure. Arg: None. */
case SNIOC_MEASURE:
DEBUGASSERT(arg == 0);
ret = ms58xx_measure(priv);
break;
/* Return the temperature last measured. Arg: int32_t* pointer. */
case SNIOC_TEMPERATURE:
{
FAR int32_t *ptr = (FAR int32_t *)((uintptr_t)arg);
DEBUGASSERT(ptr != NULL);
*ptr = priv->temp;
sndbg("temp: %08x\n", *ptr);
}
break;
/* Return the pressure last measured. Arg: int32_t* pointer. */
case SNIOC_PRESSURE:
{
FAR int32_t *ptr = (FAR int32_t *)((uintptr_t)arg);
DEBUGASSERT(ptr != NULL);
*ptr = priv->press;
sndbg("press: %08x\n", *ptr);
}
break;
/* Reset the device. Arg: None. */
case SNIOC_RESET:
DEBUGASSERT(arg == 0);
ret = ms58xx_reset(priv);
break;
/* Change the oversampling ratio. Arg: uint16_t value. */
case SNIOC_OVERSAMPLING:
ret = ms58xx_setosr(priv, (uint16_t)arg);
sndbg("osr: %04x ret: %d\n", *(uint16_t *)arg, ret);
break;
/* Unrecognized commands */
default:
sndbg("Unrecognized cmd: %d arg: %ld\n", cmd, arg);
ret = -ENOTTY;
break;
}
return ret;
}
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: ms58xx_register
*
* Description:
* Register the MS58XX character device as 'devpath'.
*
* Input Parameters:
* devpath - The full path to the driver to register, e.g., "/dev/press0".
* i2c - An I2C driver instance.
* addr - The I2C address of the MS58XX.
* osr - The oversampling ratio.
* model - The MS58XX model.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
****************************************************************************/
int ms58xx_register(FAR const char *devpath, FAR struct i2c_master_s *i2c,
uint8_t addr, uint16_t osr, enum ms58xx_model_e model)
{
FAR struct ms58xx_dev_s *priv;
int ret;
/* Sanity check */
DEBUGASSERT(i2c != NULL);
DEBUGASSERT((model == MS58XX_MODEL_MS5803_02 ||
model == MS58XX_MODEL_MS5803_05 ||
model == MS58XX_MODEL_MS5803_07 ||
model == MS58XX_MODEL_MS5803_14 ||
model == MS58XX_MODEL_MS5803_30 ||
model == MS58XX_MODEL_MS5806_02) &&
(addr == MS58XX_ADDR0 || addr == MS58XX_ADDR1) ||
(model == MS58XX_MODEL_MS5805_02 ||
model == MS58XX_MODEL_MS5837_30) &&
addr == MS58XX_ADDR0);
/* Initialize the device's structure */
priv = (FAR struct ms58xx_dev_s *)kmm_malloc(sizeof(*priv));
if (priv == NULL)
{
sndbg("Failed to allocate instance\n");
return -ENOMEM;
}
priv->i2c = i2c;
priv->addr = addr;
priv->model = model;
priv->temp = 0;
priv->press = 0;
switch (priv->model)
{
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5806_02:
default:
priv->c1s = 16;
priv->c2s = 17;
priv->c3s = 7;
priv->c4s = 6;
break;
case MS58XX_MODEL_MS5803_05:
priv->c1s = 17;
priv->c2s = 18;
priv->c3s = 7;
priv->c4s = 5;
break;
case MS58XX_MODEL_MS5803_07:
priv->c1s = 17;
priv->c2s = 18;
priv->c3s = 6;
priv->c4s = 5;
break;
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5837_30:
priv->c1s = 15;
priv->c2s = 16;
priv->c3s = 8;
priv->c4s = 7;
break;
}
switch (priv->model)
{
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5806_02:
priv->diffmull = 1;
priv->diffdivls = 31;
priv->offmull = 61;
priv->offdivls = 4;
priv->sensmull = 2;
priv->sensdivls = 0;
priv->offmulvl = 20;
priv->sensmulvl = 12;
priv->diffmulh = 0;
priv->diffdivhs = 0;
priv->offmulh = 0;
priv->offdivhs = 0;
priv->sensmulh = 0;
priv->sensdivhs = 0;
break;
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_07:
priv->diffmull = 3;
priv->diffdivls = 33;
priv->offmull = 3;
priv->offdivls = 3;
priv->sensmull = 7;
priv->sensdivls = 3;
priv->offmulvl = 0;
priv->sensmulvl = 3;
priv->diffmulh = 0;
priv->diffdivhs = 0;
priv->offmulh = 0;
priv->offdivhs = 0;
priv->sensmulh = 0;
priv->sensdivhs = 0;
break;
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5803_30:
priv->diffmull = 3;
priv->diffdivls = 33;
priv->offmull = 3;
priv->offdivls = 1;
priv->sensmull = 5;
priv->sensdivls = 3;
priv->offmulvl = 7;
priv->sensmulvl = 4;
priv->diffmulh = 7;
priv->diffdivhs = 37;
priv->offmulh = 1;
priv->offdivhs = 4;
priv->sensmulh = 0;
priv->sensdivhs = 0;
break;
case MS58XX_MODEL_MS5805_02:
priv->diffmull = 11;
priv->diffdivls = 35;
priv->offmull = 31;
priv->offdivls = 3;
priv->sensmull = 63;
priv->sensdivls = 5;
priv->offmulvl = 0;
priv->sensmulvl = 0;
priv->diffmulh = 0;
priv->diffdivhs = 0;
priv->offmulh = 0;
priv->offdivhs = 0;
priv->sensmulh = 0;
priv->sensdivhs = 0;
break;
case MS58XX_MODEL_MS5837_30:
priv->diffmull = 3;
priv->diffdivls = 33;
priv->offmull = 3;
priv->offdivls = 1;
priv->sensmull = 5;
priv->sensdivls = 3;
priv->offmulvl = 7;
priv->sensmulvl = 4;
priv->diffmulh = 2;
priv->diffdivhs = 37;
priv->offmulh = 1;
priv->offdivhs = 4;
priv->sensmulh = 0;
priv->sensdivhs = 0;
break;
}
switch (priv->model)
{
case MS58XX_MODEL_MS5803_02:
case MS58XX_MODEL_MS5803_05:
case MS58XX_MODEL_MS5803_14:
case MS58XX_MODEL_MS5805_02:
case MS58XX_MODEL_MS5806_02:
default:
priv->pressdivs = 15;
break;
case MS58XX_MODEL_MS5803_30:
case MS58XX_MODEL_MS5837_30:
priv->pressdivs = 13;
break;
}
ret = ms58xx_setosr(priv, osr);
if (ret < 0)
{
sndbg("ms58xx_setosr failed: %d\n", ret);
goto err;
}
ret = ms58xx_reset(priv);
if (ret < 0)
{
sndbg("ms58xx_reset failed: %d\n", ret);
goto err;
}
/* Register the character driver */
ret = register_driver(devpath, &g_fops, 0666, priv);
if (ret < 0)
{
sndbg("Failed to register driver: %d\n", ret);
goto err;
}
return ret;
err:
kmm_free(priv);
return ret;
}
#endif /* CONFIG_I2C && CONFIG_MS58XX */
Reference in New Issue View Git Blame Copy Permalink