patrick/zephyr
1
0
Fork 0
Code Issues Pull requests Actions 8 Packages Projects Releases Wiki Activity

drivers: sensor: fxos8700: Keep current power mode when setting ODR

Browse source 
Setting the power mode to enabled causes other initialization to not
occur. Restore the power mode set upon entry when exiting.

Signed-off-by: Ryan Holleran <rhollerar@gmail.com>
This commit is contained in:
Ryan Holleran 2021-10-02 18:01:57 -05:00 committed by Maureen Helm
parent a80b59e0c9
commit cbb0585e0b
1 changed files with 10 additions and 3 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

13
drivers/sensor/fxos8700/fxos8700.c
View file

@ -24,6 +24,7 @@ static int fxos8700_set_odr(const struct device *dev,
const struct fxos8700_config *config = dev->config;
struct fxos8700_data *data = dev->data;
uint8_t dr;
enum fxos8700_power power;
#ifdef CONFIG_FXOS8700_MODE_HYBRID
/* ODR is halved in hybrid mode */
@ -72,18 +73,24 @@ static int fxos8700_set_odr(const struct device *dev,
/*
* Modify FXOS8700_REG_CTRLREG1 can only occur when the device
* is in standby mode.
* is in standby mode. Get the current power mode to restore it later.
*/
if (fxos8700_get_power(dev, &power)) {
LOG_ERR("Could not get power mode");
return -EIO;
}
/* Set standby power mode */
if (fxos8700_set_power(dev, FXOS8700_POWER_STANDBY)) {
LOG_ERR("Could not set standby");
return -EIO;
}
/* Change the attribute and activate the device. */
/* Change the attribute and restore power mode. */
return i2c_reg_update_byte(data->i2c, config->i2c_address,
FXOS8700_REG_CTRLREG1,
FXOS8700_CTRLREG1_DR_MASK | FXOS8700_CTRLREG1_ACTIVE_MASK,
dr | FXOS8700_POWER_ACTIVE);
dr | power);
}
static int fxos8700_set_mt_ths(const struct device *dev,