sensors/adxl372: add support for the new sensor framework
adxl372 can be used with the new sensor framework
This commit is contained in:
parent
d0820acbbb
commit
3d765616ea
@ -277,7 +277,11 @@ if(CONFIG_SENSORS)
|
|||||||
endif()
|
endif()
|
||||||
|
|
||||||
if(CONFIG_SENSORS_ADXL372)
|
if(CONFIG_SENSORS_ADXL372)
|
||||||
list(APPEND SRCS adxl372.c)
|
if(CONFIG_SENSORS_ADXL372_UORB)
|
||||||
|
list(APPEND SRCS adxl372_uorb.c)
|
||||||
|
else()
|
||||||
|
list(APPEND SRCS adxl372.c)
|
||||||
|
endif()
|
||||||
endif()
|
endif()
|
||||||
|
|
||||||
if(CONFIG_LIS3DSH)
|
if(CONFIG_LIS3DSH)
|
||||||
|
@ -962,6 +962,39 @@ config SENSORS_ADXL372
|
|||||||
---help---
|
---help---
|
||||||
Enable driver support for the Analog Devices ADXL372 Sensor.
|
Enable driver support for the Analog Devices ADXL372 Sensor.
|
||||||
|
|
||||||
|
if SENSORS_ADXL372
|
||||||
|
|
||||||
|
config SENSORS_ADXL372_UORB
|
||||||
|
bool "ADXL372 UORB interface"
|
||||||
|
default n
|
||||||
|
|
||||||
|
if SENSORS_ADXL372_UORB
|
||||||
|
|
||||||
|
config SENSORS_ADXL372_POLL
|
||||||
|
bool "Enables polling sensor data"
|
||||||
|
default n
|
||||||
|
---help---
|
||||||
|
Enables polling of sensor.
|
||||||
|
|
||||||
|
config SENSORS_ADXL372_POLL_INTERVAL
|
||||||
|
int "Polling interval in microseconds, default 1 sec"
|
||||||
|
depends on SENSORS_ADXL372_POLL
|
||||||
|
default 1000000
|
||||||
|
range 0 4294967295
|
||||||
|
---help---
|
||||||
|
The interval until a new sensor measurement will be triggered.
|
||||||
|
|
||||||
|
config SENSORS_ADXL372_THREAD_STACKSIZE
|
||||||
|
int "Worker thread stack size"
|
||||||
|
depends on SENSORS_ADXL372_POLL
|
||||||
|
default 1024
|
||||||
|
---help---
|
||||||
|
The stack size for the worker thread.
|
||||||
|
|
||||||
|
endif #SENSORS_ADXL372_UORB
|
||||||
|
|
||||||
|
endif # SENSORS_ADXL372
|
||||||
|
|
||||||
config SENSORS_MPU60X0
|
config SENSORS_MPU60X0
|
||||||
bool "Invensense MPU60x0 Sensor support"
|
bool "Invensense MPU60x0 Sensor support"
|
||||||
default n
|
default n
|
||||||
|
@ -298,8 +298,12 @@ ifeq ($(CONFIG_SENSORS_ADXL362),y)
|
|||||||
endif
|
endif
|
||||||
|
|
||||||
ifeq ($(CONFIG_SENSORS_ADXL372),y)
|
ifeq ($(CONFIG_SENSORS_ADXL372),y)
|
||||||
|
ifeq ($(CONFIG_SENSORS_ADXL372_UORB),y)
|
||||||
|
CSRCS += adxl372_uorb.c
|
||||||
|
else
|
||||||
CSRCS += adxl372.c
|
CSRCS += adxl372.c
|
||||||
endif
|
endif
|
||||||
|
endif
|
||||||
|
|
||||||
ifeq ($(CONFIG_LIS3DSH),y)
|
ifeq ($(CONFIG_LIS3DSH),y)
|
||||||
CSRCS += lis3dsh.c
|
CSRCS += lis3dsh.c
|
||||||
|
@ -225,7 +225,7 @@ static uint8_t adxl372_read_register(FAR struct adxl372_dev_s *dev,
|
|||||||
|
|
||||||
/* Transmit the register address from where we want to read. */
|
/* Transmit the register address from where we want to read. */
|
||||||
|
|
||||||
SPI_SEND(dev->spi, reg_addr | ADXL372_READ);
|
SPI_SEND(dev->spi, (reg_addr << 1) | ADXL372_READ);
|
||||||
|
|
||||||
/* Write an idle byte while receiving the requested data */
|
/* Write an idle byte while receiving the requested data */
|
||||||
|
|
||||||
@ -266,7 +266,7 @@ static void adxl372_read_registerblk(FAR struct adxl372_dev_s *dev,
|
|||||||
|
|
||||||
/* Transmit the register address from where we want to start reading */
|
/* Transmit the register address from where we want to start reading */
|
||||||
|
|
||||||
SPI_SEND(dev->spi, reg_addr | ADXL372_READ);
|
SPI_SEND(dev->spi, (reg_addr << 1) | ADXL372_READ);
|
||||||
|
|
||||||
/* Write idle bytes while receiving the requested data */
|
/* Write idle bytes while receiving the requested data */
|
||||||
|
|
||||||
@ -306,7 +306,7 @@ static void adxl372_write_register(FAR struct adxl372_dev_s *dev,
|
|||||||
|
|
||||||
/* Transmit the register address to where we want to write */
|
/* Transmit the register address to where we want to write */
|
||||||
|
|
||||||
SPI_SEND(dev->spi, reg_addr | ADXL372_WRITE);
|
SPI_SEND(dev->spi, (reg_addr << 1) | ADXL372_WRITE);
|
||||||
|
|
||||||
/* Transmit the content which should be written into the register */
|
/* Transmit the content which should be written into the register */
|
||||||
|
|
||||||
@ -345,7 +345,7 @@ static void adxl372_write_registerblk(FAR struct adxl372_dev_s *dev,
|
|||||||
|
|
||||||
/* Transmit the register address to where we want to start writing */
|
/* Transmit the register address to where we want to start writing */
|
||||||
|
|
||||||
SPI_SEND(dev->spi, reg_addr | ADXL372_WRITE);
|
SPI_SEND(dev->spi, (reg_addr << 1) | ADXL372_WRITE);
|
||||||
|
|
||||||
/* Transmit the content which should be written in the register block */
|
/* Transmit the content which should be written in the register block */
|
||||||
|
|
||||||
|
611
drivers/sensors/adxl372_uorb.c
Normal file
611
drivers/sensors/adxl372_uorb.c
Normal file
@ -0,0 +1,611 @@
|
|||||||
|
/****************************************************************************
|
||||||
|
* drivers/sensors/adxl372_uorb.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.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Included Files
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#include <nuttx/config.h>
|
||||||
|
|
||||||
|
#include <debug.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include <sys/param.h>
|
||||||
|
|
||||||
|
#include <nuttx/kmalloc.h>
|
||||||
|
#include <nuttx/kthread.h>
|
||||||
|
#include <nuttx/signal.h>
|
||||||
|
#include <nuttx/sensors/adxl372.h>
|
||||||
|
|
||||||
|
#include <nuttx/sensors/sensor.h>
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Pre-processor Definitions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#define CONSTANTS_ONE_G 9.8f
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Private Types
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
struct adxl372_sensor_s
|
||||||
|
{
|
||||||
|
struct sensor_lowerhalf_s lower;
|
||||||
|
FAR struct spi_dev_s *spi;
|
||||||
|
float scale;
|
||||||
|
int devno;
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
bool enabled;
|
||||||
|
unsigned long interval;
|
||||||
|
sem_t run;
|
||||||
|
#endif
|
||||||
|
};
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Private Function Prototypes
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static uint8_t adxl372_getreg8(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr);
|
||||||
|
static void adxl372_putreg8(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr, uint8_t regval);
|
||||||
|
static void adxl372_getregs(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr, FAR uint8_t *regval, int len);
|
||||||
|
static int16_t adxl372_data(FAR uint8_t *data);
|
||||||
|
static int adxl372_checkid(FAR struct adxl372_sensor_s *priv);
|
||||||
|
static void adxl372_start(FAR struct adxl372_sensor_s *priv);
|
||||||
|
static void adxl372_stop(FAR struct adxl372_sensor_s *priv);
|
||||||
|
|
||||||
|
/* Sensor ops functions */
|
||||||
|
|
||||||
|
static int adxl372_activate(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep,
|
||||||
|
bool enable);
|
||||||
|
static int adxl372_set_interval(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep,
|
||||||
|
FAR unsigned long *period_us);
|
||||||
|
#ifndef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
static int adxl372_fetch(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep,
|
||||||
|
FAR char *buffer, size_t buflen);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Private Data
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static const struct sensor_ops_s g_adxl372_accel_ops =
|
||||||
|
{
|
||||||
|
NULL, /* open */
|
||||||
|
NULL, /* close */
|
||||||
|
adxl372_activate,
|
||||||
|
adxl372_set_interval,
|
||||||
|
NULL, /* batch */
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
NULL, /* fetch */
|
||||||
|
#else
|
||||||
|
adxl372_fetch,
|
||||||
|
#endif
|
||||||
|
NULL, /* selftest */
|
||||||
|
NULL, /* set_calibvalue */
|
||||||
|
NULL, /* calibrate */
|
||||||
|
NULL /* control */
|
||||||
|
};
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Private Functions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_getreg8
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Read from an 8-bit ADXL372 register
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static uint8_t adxl372_getreg8(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr)
|
||||||
|
{
|
||||||
|
uint8_t regval = 0;
|
||||||
|
|
||||||
|
SPI_LOCK(priv->spi, true);
|
||||||
|
|
||||||
|
SPI_SETFREQUENCY(priv->spi, ADXL372_SPI_FREQUENCY);
|
||||||
|
SPI_SETMODE(priv->spi, ADXL372_SPI_MODE);
|
||||||
|
|
||||||
|
/* Select the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), true);
|
||||||
|
|
||||||
|
/* Send register to read and get the next byte */
|
||||||
|
|
||||||
|
SPI_SEND(priv->spi, (regaddr << 1) | ADXL372_READ);
|
||||||
|
SPI_RECVBLOCK(priv->spi, ®val, 1);
|
||||||
|
|
||||||
|
/* Deselect the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), false);
|
||||||
|
|
||||||
|
/* Unlock bus */
|
||||||
|
|
||||||
|
SPI_LOCK(priv->spi, false);
|
||||||
|
|
||||||
|
return regval;
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_putreg8
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Write a value to an 8-bit ADXL372 register
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void adxl372_putreg8(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr, uint8_t regval)
|
||||||
|
{
|
||||||
|
SPI_LOCK(priv->spi, true);
|
||||||
|
|
||||||
|
SPI_SETFREQUENCY(priv->spi, ADXL372_SPI_FREQUENCY);
|
||||||
|
SPI_SETMODE(priv->spi, ADXL372_SPI_MODE);
|
||||||
|
|
||||||
|
/* Select the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), true);
|
||||||
|
|
||||||
|
/* Send register address and set the value */
|
||||||
|
|
||||||
|
SPI_SEND(priv->spi, (regaddr << 1) | ADXL372_WRITE);
|
||||||
|
SPI_SEND(priv->spi, regval);
|
||||||
|
|
||||||
|
/* Deselect the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), false);
|
||||||
|
|
||||||
|
/* Unlock bus */
|
||||||
|
|
||||||
|
SPI_LOCK(priv->spi, false);
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_getregs
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Read bytes from specified regaddr
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void adxl372_getregs(FAR struct adxl372_sensor_s *priv,
|
||||||
|
uint8_t regaddr, FAR uint8_t *regval, int len)
|
||||||
|
{
|
||||||
|
/* If SPI bus is shared then lock and configure it */
|
||||||
|
|
||||||
|
SPI_LOCK(priv->spi, true);
|
||||||
|
|
||||||
|
SPI_SETFREQUENCY(priv->spi, ADXL372_SPI_FREQUENCY);
|
||||||
|
SPI_SETMODE(priv->spi, ADXL372_SPI_MODE);
|
||||||
|
|
||||||
|
/* Select the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), true);
|
||||||
|
|
||||||
|
/* Send register to read and get the next 2 bytes */
|
||||||
|
|
||||||
|
SPI_SEND(priv->spi, (regaddr << 1) | ADXL372_READ);
|
||||||
|
SPI_RECVBLOCK(priv->spi, regval, len);
|
||||||
|
|
||||||
|
/* Deselect the ADXL372 */
|
||||||
|
|
||||||
|
SPI_SELECT(priv->spi, SPIDEV_ACCELEROMETER(priv->devno), false);
|
||||||
|
|
||||||
|
/* Unlock bus */
|
||||||
|
|
||||||
|
SPI_LOCK(priv->spi, false);
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_data
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int16_t adxl372_data(FAR uint8_t *data)
|
||||||
|
{
|
||||||
|
return ((int16_t)(((data[0] << 8) | (data[1] & 0xf0)))) >> 4;
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_checkid
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Read and verify the ADXL372 chip ID
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int adxl372_checkid(FAR struct adxl372_sensor_s *priv)
|
||||||
|
{
|
||||||
|
uint8_t id = 0;
|
||||||
|
|
||||||
|
id = adxl372_getreg8(priv, ADXL372_DEVID_AD);
|
||||||
|
if (id != ADXL372_DEVID_AD_VALUE)
|
||||||
|
{
|
||||||
|
snerr("Wrong AD! %02x\n", id);
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
|
id = adxl372_getreg8(priv, ADXL372_DEVID_MST);
|
||||||
|
if (id != ADXL372_DEVID_MST_VALUE)
|
||||||
|
{
|
||||||
|
snerr("Wrong MST! %02x\n", id);
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
|
id = adxl372_getreg8(priv, ADXL372_PARTID);
|
||||||
|
if (id != ADXL372_PARTID_VALUE)
|
||||||
|
{
|
||||||
|
snerr("Wrong PARTID! %02x\n", id);
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_start
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void adxl372_start(FAR struct adxl372_sensor_s *priv)
|
||||||
|
{
|
||||||
|
adxl372_putreg8(priv, ADXL372_POWER_CTL,
|
||||||
|
ADXL372_POWER_HPF_DISABLE |
|
||||||
|
ADXL372_POWER_MODE_MEASURE);
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_stop
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void adxl372_stop(FAR struct adxl372_sensor_s *priv)
|
||||||
|
{
|
||||||
|
adxl372_putreg8(priv, ADXL372_POWER_CTL, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_reset
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void adxl372_reset(FAR struct adxl372_sensor_s *priv)
|
||||||
|
{
|
||||||
|
int wdcnt = 10;
|
||||||
|
|
||||||
|
/* Set stanby mode */
|
||||||
|
|
||||||
|
adxl372_putreg8(priv, ADXL372_POWER_CTL, 0);
|
||||||
|
|
||||||
|
/* Wait for boot to finish (15 ms error timeout) */
|
||||||
|
|
||||||
|
up_mdelay(5);
|
||||||
|
while (wdcnt > 0 && (0 != adxl372_getreg8(priv, ADXL372_RESET)))
|
||||||
|
{
|
||||||
|
up_mdelay(1);
|
||||||
|
wdcnt--;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Reset ADXL372 Accelerometer. Write only. Begin a boot. */
|
||||||
|
|
||||||
|
adxl372_putreg8(priv, ADXL372_RESET_VALUE, ADXL372_RESET);
|
||||||
|
|
||||||
|
/* Wait for boot to finish (15 ms error timeout) */
|
||||||
|
|
||||||
|
up_mdelay(5);
|
||||||
|
wdcnt = 10;
|
||||||
|
while (wdcnt > 0 && (0 != adxl372_getreg8(priv, ADXL372_RESET)))
|
||||||
|
{
|
||||||
|
up_mdelay(1);
|
||||||
|
wdcnt--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_activate
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Enable or disable sensor device. when enable sensor, sensor will
|
||||||
|
* work in current mode(if not set, use default mode). when disable
|
||||||
|
* sensor, it will disable sense path and stop convert.
|
||||||
|
*
|
||||||
|
* Input Parameters:
|
||||||
|
* lower - The instance of lower half sensor driver.
|
||||||
|
* filep - The pointer of file, represents each user using the sensor.
|
||||||
|
* enable - true(enable) and false(disable).
|
||||||
|
*
|
||||||
|
* Returned Value:
|
||||||
|
* Return 0 if the driver was success; A negated errno
|
||||||
|
* value is returned on any failure.
|
||||||
|
*
|
||||||
|
* Assumptions/Limitations:
|
||||||
|
* none.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int adxl372_activate(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep,
|
||||||
|
bool enable)
|
||||||
|
{
|
||||||
|
FAR struct adxl372_sensor_s *priv = (FAR struct adxl372_sensor_s *)lower;
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
bool start_thread = false;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
if (enable)
|
||||||
|
{
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
if (!priv->enabled)
|
||||||
|
{
|
||||||
|
start_thread = true;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
adxl372_start(priv);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
adxl372_stop(priv);
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
priv->enabled = enable;
|
||||||
|
|
||||||
|
if (start_thread)
|
||||||
|
{
|
||||||
|
/* Wake up the thread */
|
||||||
|
|
||||||
|
nxsem_post(&priv->run);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_set_interval
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Set the sensor output data period in microseconds for a given sensor.
|
||||||
|
* If *period_us > max_delay it will be truncated to max_delay and if
|
||||||
|
* *period_us < min_delay it will be replaced by min_delay.
|
||||||
|
*
|
||||||
|
* Input Parameters:
|
||||||
|
* lower - The instance of lower half sensor driver.
|
||||||
|
* filep - The pointer of file, represents each user using the sensor.
|
||||||
|
* period_us - The time between report data, in us. It may by overwrite
|
||||||
|
* by lower half driver.
|
||||||
|
*
|
||||||
|
* Returned Value:
|
||||||
|
* Return 0 if the driver was success; A negated errno
|
||||||
|
* value is returned on any failure.
|
||||||
|
*
|
||||||
|
* Assumptions/Limitations:
|
||||||
|
* none.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int adxl372_set_interval(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep,
|
||||||
|
FAR unsigned long *period_us)
|
||||||
|
{
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
FAR struct adxl372_sensor_s *priv = (FAR struct adxl372_sensor_s *)lower;
|
||||||
|
|
||||||
|
priv->interval = *period_us;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifndef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_fetch
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int adxl372_fetch(FAR struct sensor_lowerhalf_s *lower,
|
||||||
|
FAR struct file *filep, FAR char *buffer,
|
||||||
|
size_t buflen)
|
||||||
|
{
|
||||||
|
FAR struct adxl372_sensor_s *priv = (FAR struct adxl372_sensor_s *)lower;
|
||||||
|
struct sensor_accel accel;
|
||||||
|
uint8_t data[6];
|
||||||
|
|
||||||
|
/* Wait for data ready */
|
||||||
|
|
||||||
|
while (!(adxl372_getreg8(priv, ADXL372_STATUS) & 0x01));
|
||||||
|
|
||||||
|
/* Get data */
|
||||||
|
|
||||||
|
adxl372_getregs(priv, ADXL372_XDATA_H, (FAR uint8_t *)data, 6);
|
||||||
|
|
||||||
|
accel.timestamp = sensor_get_timestamp();
|
||||||
|
accel.x = (float)adxl372_data(&data[0]) * priv->scale;
|
||||||
|
accel.y = (float)adxl372_data(&data[2]) * priv->scale;
|
||||||
|
accel.z = (float)adxl372_data(&data[4]) * priv->scale;
|
||||||
|
accel.temperature = 0;
|
||||||
|
|
||||||
|
memcpy(buffer, &accel, sizeof(accel));
|
||||||
|
|
||||||
|
return sizeof(accel);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_thread
|
||||||
|
*
|
||||||
|
* Description: Thread for performing interval measurement cycle and data
|
||||||
|
* read.
|
||||||
|
*
|
||||||
|
* Parameter:
|
||||||
|
* argc - Number opf arguments
|
||||||
|
* argv - Pointer to argument list
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static int adxl372_thread(int argc, FAR char **argv)
|
||||||
|
{
|
||||||
|
FAR struct adxl372_sensor_s *priv
|
||||||
|
= (FAR struct adxl372_sensor_s *)((uintptr_t)strtoul(argv[1], NULL,
|
||||||
|
16));
|
||||||
|
struct sensor_accel accel;
|
||||||
|
uint8_t data[6];
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
while (true)
|
||||||
|
{
|
||||||
|
if ((!priv->enabled))
|
||||||
|
{
|
||||||
|
/* Waiting to be woken up */
|
||||||
|
|
||||||
|
ret = nxsem_wait(&priv->run);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Read accel */
|
||||||
|
|
||||||
|
if (priv->enabled)
|
||||||
|
{
|
||||||
|
adxl372_getregs(priv, ADXL372_XDATA_H, (FAR uint8_t *)data, 6);
|
||||||
|
|
||||||
|
accel.timestamp = sensor_get_timestamp();
|
||||||
|
accel.x = (float)adxl372_data(&data[0]) * priv->scale;
|
||||||
|
accel.y = (float)adxl372_data(&data[2]) * priv->scale;
|
||||||
|
accel.z = (float)adxl372_data(&data[4]) * priv->scale;
|
||||||
|
accel.temperature = 0;
|
||||||
|
|
||||||
|
priv->lower.push_event(priv->lower.priv, &accel, sizeof(accel));
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Sleeping thread before fetching the next sensor data */
|
||||||
|
|
||||||
|
nxsig_usleep(priv->interval);
|
||||||
|
}
|
||||||
|
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Public Functions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Name: adxl372_register
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Register the ADXL372 character device as 'devpath'
|
||||||
|
*
|
||||||
|
* Input Parameters:
|
||||||
|
* devno - Sensor device number.
|
||||||
|
* dev - An instance of the SPI or I2C interface to use to communicate
|
||||||
|
* with ADXL372
|
||||||
|
*
|
||||||
|
* Returned Value:
|
||||||
|
* Zero (OK) on success; a negated errno value on failure.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
int adxl372_register_uorb(int devno, FAR struct spi_dev_s *spi)
|
||||||
|
{
|
||||||
|
FAR struct adxl372_sensor_s *priv;
|
||||||
|
int ret;
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
FAR char *argv[2];
|
||||||
|
char arg1[32];
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* Sanity check */
|
||||||
|
|
||||||
|
DEBUGASSERT(spi != NULL);
|
||||||
|
|
||||||
|
/* Initialize the ADXL372 device structure */
|
||||||
|
|
||||||
|
priv = kmm_zalloc(sizeof(struct adxl372_sensor_s));
|
||||||
|
if (priv == NULL)
|
||||||
|
{
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
priv->spi = spi;
|
||||||
|
priv->lower.ops = &g_adxl372_accel_ops;
|
||||||
|
priv->lower.type = SENSOR_TYPE_ACCELEROMETER;
|
||||||
|
priv->lower.nbuffer = 1;
|
||||||
|
priv->scale = (CONSTANTS_ONE_G / 10.0f);
|
||||||
|
priv->devno = devno;
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
priv->enabled = false;
|
||||||
|
priv->interval = CONFIG_SENSORS_ADXL372_POLL_INTERVAL;
|
||||||
|
|
||||||
|
nxsem_init(&priv->run, 0, 0);
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* Read and verify the deviceid */
|
||||||
|
|
||||||
|
ret = adxl372_checkid(priv);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
snerr("Wrong Device ID!\n");
|
||||||
|
kmm_free(priv);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Reset device */
|
||||||
|
|
||||||
|
adxl372_reset(priv);
|
||||||
|
|
||||||
|
/* Register the character driver */
|
||||||
|
|
||||||
|
ret = sensor_register(&priv->lower, devno);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
snerr("Failed to register accel driver: %d\n", ret);
|
||||||
|
kmm_free(priv);
|
||||||
|
}
|
||||||
|
|
||||||
|
#ifdef CONFIG_SENSORS_ADXL372_POLL
|
||||||
|
/* Create thread for polling sensor data */
|
||||||
|
|
||||||
|
snprintf(arg1, 16, "%p", priv);
|
||||||
|
argv[0] = arg1;
|
||||||
|
argv[1] = NULL;
|
||||||
|
|
||||||
|
ret = kthread_create("adxl372_thread", SCHED_PRIORITY_DEFAULT,
|
||||||
|
CONFIG_SENSORS_ADXL372_THREAD_STACKSIZE,
|
||||||
|
adxl372_thread,
|
||||||
|
argv);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
kmm_free(priv);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
@ -716,6 +716,10 @@ static int bmi160_register_gyro(int devno,
|
|||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Public Functions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: bmi160_register
|
* Name: bmi160_register
|
||||||
*
|
*
|
||||||
|
@ -95,54 +95,54 @@
|
|||||||
|
|
||||||
/* ADXL372 Accelerometer Register definitions */
|
/* ADXL372 Accelerometer Register definitions */
|
||||||
|
|
||||||
#define ADXL372_DEVID_AD (0x00 << 1)
|
#define ADXL372_DEVID_AD 0x00
|
||||||
# define ADXL372_DEVID_AD_VALUE 0xad
|
# define ADXL372_DEVID_AD_VALUE 0xad
|
||||||
#define ADXL372_DEVID_MST (0x01 << 1)
|
#define ADXL372_DEVID_MST 0x01
|
||||||
# define ADXL372_DEVID_MST_VALUE 0x1D
|
# define ADXL372_DEVID_MST_VALUE 0x1d
|
||||||
#define ADXL372_PARTID (0x02 << 1)
|
#define ADXL372_PARTID 0x02
|
||||||
# define ADXL372_PARTID_VALUE 0xfa
|
# define ADXL372_PARTID_VALUE 0xfa
|
||||||
#define ADXL372_REVID (0x03 << 1)
|
#define ADXL372_REVID 0x03
|
||||||
#define ADXL372_STATUS (0x04 << 1)
|
#define ADXL372_STATUS 0x04
|
||||||
#define ADXL372_STATUS2 (0x05 << 1)
|
#define ADXL372_STATUS2 0x05
|
||||||
#define ADXL372_FIFO_ENTRIES2 (0x06 << 1)
|
#define ADXL372_FIFO_ENTRIES2 0x06
|
||||||
#define ADXL372_FIFO_ENTRIES (0x07 << 1)
|
#define ADXL372_FIFO_ENTRIES 0x07
|
||||||
#define ADXL372_XDATA_H (0x08 << 1)
|
#define ADXL372_XDATA_H 0x08
|
||||||
#define ADXL372_XDATA_L (0x09 << 1)
|
#define ADXL372_XDATA_L 0x09
|
||||||
#define ADXL372_YDATA_H (0x0a << 1)
|
#define ADXL372_YDATA_H 0x0a
|
||||||
#define ADXL372_YDATA_L (0x0b << 1)
|
#define ADXL372_YDATA_L 0x0b
|
||||||
#define ADXL372_ZDATA_H (0x0c << 1)
|
#define ADXL372_ZDATA_H 0x0c
|
||||||
#define ADXL372_ZDATA_L (0x0d << 1)
|
#define ADXL372_ZDATA_L 0x0d
|
||||||
#define ADXL372_THRESH_ACT_X_H (0x23 << 1)
|
#define ADXL372_THRESH_ACT_X_H 0x23
|
||||||
#define ADXL372_FIFO_CTL (0x3a << 1)
|
#define ADXL372_FIFO_CTL 0x3a
|
||||||
# define ADXL372_FIFO_BYPASSED 0x00
|
# define ADXL372_FIFO_BYPASSED 0x00
|
||||||
# define ADXL372_FIFO_STREAMED 0x02
|
# define ADXL372_FIFO_STREAMED 0x02
|
||||||
#define ADXL372_INT1_MAP (0x3b << 1)
|
#define ADXL372_INT1_MAP 0x3b
|
||||||
# define ADXL372_INT1_MAP_DR 0x01
|
# define ADXL372_INT1_MAP_DR 0x01
|
||||||
# define ADXL372_INT1_MAP_FRDY 0x02
|
# define ADXL372_INT1_MAP_FRDY 0x02
|
||||||
# define ADXL372_INT1_MAP_FFULL 0x04
|
# define ADXL372_INT1_MAP_FFULL 0x04
|
||||||
#define ADXL372_TIMING (0x3d << 1)
|
#define ADXL372_TIMING 0x3d
|
||||||
# define ADXL372_TIMING_ODR400 (0x0 << 5) /* 400 Hz ODR */
|
# define ADXL372_TIMING_ODR400 (0x0 << 5) /* 400 Hz ODR */
|
||||||
# define ADXL372_TIMING_ODR800 (0x1 << 5) /* 800 Hz ODR */
|
# define ADXL372_TIMING_ODR800 (0x1 << 5) /* 800 Hz ODR */
|
||||||
# define ADXL372_TIMING_ODR1600 (0x2 << 5) /* 1600 Hz ODR */
|
# define ADXL372_TIMING_ODR1600 (0x2 << 5) /* 1600 Hz ODR */
|
||||||
# define ADXL372_TIMING_ODR3200 (0x3 << 5) /* 3200 Hz ODR */
|
# define ADXL372_TIMING_ODR3200 (0x3 << 5) /* 3200 Hz ODR */
|
||||||
# define ADXL372_TIMING_ODR6400 (0x4 << 5) /* 6400 Hz ODR */
|
# define ADXL372_TIMING_ODR6400 (0x4 << 5) /* 6400 Hz ODR */
|
||||||
#define ADXL372_MEASURE (0x3e << 1)
|
#define ADXL372_MEASURE 0x3e
|
||||||
# define ADXL372_MEAS_BW200 0x0 /* 200 Hz Bandwidth */
|
# define ADXL372_MEAS_BW200 0x0 /* 200 Hz Bandwidth */
|
||||||
# define ADXL372_MEAS_BW400 0x1 /* 400 Hz Bandwidth */
|
# define ADXL372_MEAS_BW400 0x1 /* 400 Hz Bandwidth */
|
||||||
# define ADXL372_MEAS_BW800 0x2 /* 800 Hz Bandwidth */
|
# define ADXL372_MEAS_BW800 0x2 /* 800 Hz Bandwidth */
|
||||||
# define ADXL372_MEAS_BW1600 0x3 /* 1600 Hz Bandwidth */
|
# define ADXL372_MEAS_BW1600 0x3 /* 1600 Hz Bandwidth */
|
||||||
# define ADXL372_MEAS_BW3200 0x4 /* 3200 Hz Bandwidth */
|
# define ADXL372_MEAS_BW3200 0x4 /* 3200 Hz Bandwidth */
|
||||||
#define ADXL372_POWER_CTL (0x3f << 1)
|
#define ADXL372_POWER_CTL 0x3f
|
||||||
# define ADXL372_POWER_LPF_DISABLE (1 << 3)
|
# define ADXL372_POWER_LPF_DISABLE (1 << 3)
|
||||||
# define ADXL372_POWER_HPF_DISABLE (1 << 2)
|
# define ADXL372_POWER_HPF_DISABLE (1 << 2)
|
||||||
# define ADXL372_POWER_MODE_STANDBY 0x0
|
# define ADXL372_POWER_MODE_STANDBY 0x0
|
||||||
# define ADXL372_POWER_MODE_WAKEUP 0x1
|
# define ADXL372_POWER_MODE_WAKEUP 0x1
|
||||||
# define ADXL372_POWER_MODE_INSTON 0x2
|
# define ADXL372_POWER_MODE_INSTON 0x2
|
||||||
# define ADXL372_POWER_MODE_MEASURE 0x3
|
# define ADXL372_POWER_MODE_MEASURE 0x3
|
||||||
#define ADXL372_RESET (0x41 << 1)
|
#define ADXL372_RESET 0x41
|
||||||
# define ADXL372_RESET_VALUE 0x52
|
# define ADXL372_RESET_VALUE 0x52
|
||||||
#define ADXL372_FIFO_DATA (0x42 << 1)
|
#define ADXL372_FIFO_DATA 0x42
|
||||||
#define ADXL372_LAST (0x42 << 1)
|
#define ADXL372_LAST 0x42
|
||||||
#define ADXL372_SCRATCH ADXL372_THRESH_ACT_X_H
|
#define ADXL372_SCRATCH ADXL372_THRESH_ACT_X_H
|
||||||
|
|
||||||
/* SPI Bus Parameters */
|
/* SPI Bus Parameters */
|
||||||
@ -154,6 +154,8 @@
|
|||||||
* Public Types
|
* Public Types
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SENSORS_ADXL372_UORB
|
||||||
|
|
||||||
/* A reference to a structure of this type must be passed to the ADXL372
|
/* A reference to a structure of this type must be passed to the ADXL372
|
||||||
* driver. This structure provides information about the configuration
|
* driver. This structure provides information about the configuration
|
||||||
* of the sensor and provides some board-specific hooks.
|
* of the sensor and provides some board-specific hooks.
|
||||||
@ -227,6 +229,7 @@ struct adxl372_config_s
|
|||||||
|
|
||||||
FAR const struct adxl372_dvr_entry_vector_s *sc_ops;
|
FAR const struct adxl372_dvr_entry_vector_s *sc_ops;
|
||||||
};
|
};
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Public Function Prototypes
|
* Public Function Prototypes
|
||||||
@ -258,9 +261,13 @@ extern "C"
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifndef CONFIG_SENSORS_ADXL372_UORB
|
||||||
int adxl372_register(FAR const char *devpath,
|
int adxl372_register(FAR const char *devpath,
|
||||||
FAR struct spi_dev_s *spi,
|
FAR struct spi_dev_s *spi,
|
||||||
FAR struct adxl372_config_s *config);
|
FAR struct adxl372_config_s *config);
|
||||||
|
#else
|
||||||
|
int adxl372_register_uorb(int devno, FAR struct spi_dev_s *spi);
|
||||||
|
#endif
|
||||||
|
|
||||||
#undef EXTERN
|
#undef EXTERN
|
||||||
#ifdef __cplusplus
|
#ifdef __cplusplus
|
||||||
|
Loading…
x
Reference in New Issue
Block a user