riot-ci/RIOT
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

drivers: mma8x5x: add motion detection interrupt support

Browse Source
This commit is contained in:
Kaspar Schleiser 2017-06-09 17:40:44 +02:00
parent 1a4c01a912
commit c78e8cbd27
2 changed files with 106 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
drivers/include/mma8x5x.h
View File

@ -178,6 +178,32 @@ int mma8x5x_is_ready(mma8x5x_t *dev);
*/ */
void mma8x5x_read(mma8x5x_t *dev, mma8x5x_data_t *data); void mma8x5x_read(mma8x5x_t *dev, mma8x5x_data_t *data);
/**
* @brief Configure motion detection interrupt
*
* User needs to configure MCU side of the selected int pin. mma8x5x will set
* the pin to low on interrupt. Before another interrupt can occur, the
* current interrupt must be acknowledged using @p mma8x5x_ack_int().
*
* @param[in] dev device descriptor of accelerometer
* @param[in] int_pin select mma8x5x int pin (1 or 2)
* @param[in] threshold motion detection threshold (see datasheet)
*/
void mma8x5x_set_motiondetect(mma8x5x_t *dev, uint8_t int_pin, uint8_t threshold);
/**
* @brief Acknowledge motion detection interrupt
*
* Acknowledges (clears) a motion detection interrupt.
* See @ref mma8x5x_set_motiondetect().
*
* @warning: this does incur an I2C write, thus should not be done from within
* the ISR.
*
* @param[in] dev device descriptor of accelerometer
*/
void mma8x5x_ack_int(mma8x5x_t *dev);
#ifdef __cplusplus #ifdef __cplusplus
} }
#endif #endif

101
drivers/mma8x5x/mma8x5x.c
View File

@ -105,47 +105,106 @@ void mma8x5x_set_user_offset(mma8x5x_t *dev, int8_t x, int8_t y, int8_t z)
i2c_release(BUS); i2c_release(BUS);
} }
void mma8x5x_set_active(mma8x5x_t *dev) static int _get_reg(mma8x5x_t *dev, uint8_t addr)
{ {
uint8_t reg; uint8_t reg;
assert(dev); assert(dev);
DEBUG("[mma8x5x] put device to active mode\n"); DEBUG("[mma8x5x] getting reg 0x%02x\n", (unsigned)addr);
i2c_acquire(BUS); i2c_acquire(BUS);
i2c_read_reg(BUS, ADDR, MMA8X5X_CTRL_REG1, &reg); i2c_read_reg(BUS, ADDR, addr, &reg);
reg |= MMA8X5X_CTRL_REG1_ACTIVE;
i2c_write_reg(BUS, ADDR, MMA8X5X_CTRL_REG1, reg);
i2c_release(BUS); i2c_release(BUS);
DEBUG("[mma8x5x] reg 0x%02x=0x%02x\n", (unsigned)addr, (unsigned)reg);
return reg;
}
static void _reg_setbits(mma8x5x_t *dev, uint8_t reg, uint8_t val)
{
uint8_t tmp;
assert(dev);
i2c_acquire(BUS);
i2c_read_reg(BUS, ADDR, reg, &tmp);
DEBUG("[mma8x5x] 0x%02x: 0x%02x | 0x%02x = 0x%02x\n",
(unsigned)reg, (unsigned)tmp, (unsigned)val, (unsigned) tmp | val);
tmp |= val;
i2c_write_reg(BUS, ADDR, reg, tmp);
i2c_release(BUS);
}
static void _reg_clearbits(mma8x5x_t *dev, uint8_t reg, uint8_t val)
{
uint8_t tmp;
assert(dev);
i2c_acquire(BUS);
i2c_read_reg(BUS, ADDR, reg, &tmp);
DEBUG("[mma8x5x] 0x%02x: 0x%02x &= ~0x%02x = 0x%02x\n",
(unsigned)reg, (unsigned)tmp, (unsigned)val, (unsigned) tmp & ~val);
tmp &= ~val;
i2c_write_reg(BUS, ADDR, reg, tmp);
i2c_release(BUS);
}
void mma8x5x_set_active(mma8x5x_t *dev)
{
DEBUG("[mma8x5x] put device to active mode\n");
_reg_setbits(dev, MMA8X5X_CTRL_REG1, MMA8X5X_CTRL_REG1_ACTIVE);
} }
void mma8x5x_set_standby(mma8x5x_t *dev) void mma8x5x_set_standby(mma8x5x_t *dev)
{ {
uint8_t reg;
assert(dev);
DEBUG("[mma8x5x] put device to standby mode\n"); DEBUG("[mma8x5x] put device to standby mode\n");
_reg_clearbits(dev, MMA8X5X_CTRL_REG1, MMA8X5X_CTRL_REG1_ACTIVE);
}
i2c_acquire(BUS); void mma8x5x_set_motiondetect(mma8x5x_t *dev, uint8_t int_pin, uint8_t threshold)
i2c_read_reg(BUS, ADDR, MMA8X5X_CTRL_REG1, &reg); {
reg &= ~MMA8X5X_CTRL_REG1_ACTIVE; DEBUG("[mma8x5x] put device to motion detect mode (ELE=1, OAE=1)\n");
i2c_write_reg(BUS, ADDR, MMA8X5X_CTRL_REG1, reg); assert(int_pin < 3);
i2c_release(BUS);
mma8x5x_set_standby(dev);
_reg_setbits(dev, MMA8X5X_FF_MT_CFG, \
MMA8X5X_FF_MT_CFG_XEFE | \
MMA8X5X_FF_MT_CFG_YEFE | \
MMA8X5X_FF_MT_CFG_ZEFE | \
MMA8X5X_FF_MT_CFG_OAE | MMA8X5X_FF_MT_CFG_ELE);
switch(int_pin) {
case 0:
_reg_clearbits(dev, MMA8X5X_CTRL_REG4, MMA8X5X_CTRL_REG4_INT_EN_FF_MT);
goto out;
case 1:
_reg_setbits(dev, MMA8X5X_CTRL_REG5, MMA8X5X_CTRL_REG5_INT_CFG_FF_MT);
break;
case 2:
_reg_clearbits(dev, MMA8X5X_CTRL_REG5, MMA8X5X_CTRL_REG5_INT_CFG_FF_MT);
break;
}
_reg_setbits(dev, MMA8X5X_FF_MT_THS, threshold & 0x7f);
_reg_setbits(dev, MMA8X5X_CTRL_REG4, MMA8X5X_CTRL_REG4_INT_EN_FF_MT);
out:
mma8x5x_set_active(dev);
}
void mma8x5x_ack_int(mma8x5x_t *dev)
{
_get_reg(dev, MMA8X5X_FF_MT_SRC);
} }
int mma8x5x_is_ready(mma8x5x_t *dev) int mma8x5x_is_ready(mma8x5x_t *dev)
{ {
uint8_t reg;
assert(dev);
DEBUG("[mma8x5x] checking for new available data\n"); DEBUG("[mma8x5x] checking for new available data\n");
i2c_acquire(BUS); uint8_t reg = _get_reg(dev, MMA8X5X_STATUS);
i2c_read_reg(BUS, ADDR, MMA8X5X_STATUS, &reg);
i2c_release(BUS);
if (reg & MMA8X5X_STATUS_ZYXDR) { if (reg & MMA8X5X_STATUS_ZYXDR) {
return MMA8X5X_DATA_READY; return MMA8X5X_DATA_READY;