driver: sensor: as6212: fix sampling frequency
AS6212 supports 0.25Hz, 1Hz, 4Hz, and 8Hz sampling frequencies, but the current driver supports 0.25Hz, 1Hz, 4Hz, and 16Hz sampling frequencies. Signed-off-by: Clément Laigle <c.laigle@catie.fr>
This commit is contained in:
parent
905e3032a0
commit
b921db6608
2 changed files with 26 additions and 8 deletions
|
@ -201,6 +201,7 @@ static int tmp108_attr_set(const struct device *dev,
|
||||||
const struct sensor_value *val)
|
const struct sensor_value *val)
|
||||||
{
|
{
|
||||||
struct tmp108_data *drv_data = dev->data;
|
struct tmp108_data *drv_data = dev->data;
|
||||||
|
const struct tmp108_config *config = dev->config;
|
||||||
__maybe_unused uint16_t reg_value;
|
__maybe_unused uint16_t reg_value;
|
||||||
__maybe_unused int32_t uval;
|
__maybe_unused int32_t uval;
|
||||||
uint16_t mode;
|
uint16_t mode;
|
||||||
|
@ -273,20 +274,36 @@ static int tmp108_attr_set(const struct device *dev,
|
||||||
break;
|
break;
|
||||||
#endif /* CONFIG_TMP108_ALERT_INTERRUPTS */
|
#endif /* CONFIG_TMP108_ALERT_INTERRUPTS */
|
||||||
|
|
||||||
case SENSOR_ATTR_SAMPLING_FREQUENCY:
|
case SENSOR_ATTR_SAMPLING_FREQUENCY: {
|
||||||
if (val->val1 < 1) {
|
struct tmp_108_reg_def ams_as6212_reg_def = AMS_AS6212_CONF;
|
||||||
mode = TI_TMP108_FREQ_4_SECS(dev);
|
|
||||||
} else if (val->val1 < 4) {
|
if (memcmp(&config->reg_def, &ams_as6212_reg_def, sizeof(struct tmp_108_reg_def)) ==
|
||||||
mode = TI_TMP108_FREQ_1_HZ(dev);
|
0) {
|
||||||
} else if (val->val1 < 16) {
|
if (val->val1 < 1) {
|
||||||
mode = TI_TMP108_FREQ_4_HZ(dev);
|
mode = TI_TMP108_FREQ_4_SECS(dev);
|
||||||
|
} else if (val->val1 < 4) {
|
||||||
|
mode = TI_TMP108_FREQ_1_HZ(dev);
|
||||||
|
} else if (val->val1 < 8) {
|
||||||
|
mode = TI_TMP108_FREQ_4_HZ(dev);
|
||||||
|
} else {
|
||||||
|
mode = AMS_AS6212_FREQ_8_HZ(dev);
|
||||||
|
}
|
||||||
} else {
|
} else {
|
||||||
mode = TI_TMP108_FREQ_16_HZ(dev);
|
if (val->val1 < 1) {
|
||||||
|
mode = TI_TMP108_FREQ_4_SECS(dev);
|
||||||
|
} else if (val->val1 < 4) {
|
||||||
|
mode = TI_TMP108_FREQ_1_HZ(dev);
|
||||||
|
} else if (val->val1 < 16) {
|
||||||
|
mode = TI_TMP108_FREQ_4_HZ(dev);
|
||||||
|
} else {
|
||||||
|
mode = TI_TMP108_FREQ_16_HZ(dev);
|
||||||
|
}
|
||||||
}
|
}
|
||||||
result = tmp108_write_config(dev,
|
result = tmp108_write_config(dev,
|
||||||
TI_TMP108_FREQ_MASK(dev),
|
TI_TMP108_FREQ_MASK(dev),
|
||||||
mode);
|
mode);
|
||||||
break;
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
case SENSOR_ATTR_TMP108_SHUTDOWN_MODE:
|
case SENSOR_ATTR_TMP108_SHUTDOWN_MODE:
|
||||||
result = tmp108_write_config(dev,
|
result = tmp108_write_config(dev,
|
||||||
|
|
|
@ -56,6 +56,7 @@
|
||||||
#define TI_TMP108_FREQ_4_HZ(x) TI_TMP108_GET_CONF(x, CONF_CR1)
|
#define TI_TMP108_FREQ_4_HZ(x) TI_TMP108_GET_CONF(x, CONF_CR1)
|
||||||
#define TI_TMP108_FREQ_16_HZ(x) (TI_TMP108_GET_CONF(x, CONF_CR1) | \
|
#define TI_TMP108_FREQ_16_HZ(x) (TI_TMP108_GET_CONF(x, CONF_CR1) | \
|
||||||
TI_TMP108_GET_CONF(x, CONF_CR0))
|
TI_TMP108_GET_CONF(x, CONF_CR0))
|
||||||
|
#define AMS_AS6212_FREQ_8_HZ(x) (TI_TMP108_GET_CONF(x, CONF_CR1) | TI_TMP108_GET_CONF(x, CONF_CR0))
|
||||||
#define TI_TMP108_FREQ_MASK(x) ~(TI_TMP108_GET_CONF(x, CONF_CR1) | \
|
#define TI_TMP108_FREQ_MASK(x) ~(TI_TMP108_GET_CONF(x, CONF_CR1) | \
|
||||||
TI_TMP108_GET_CONF(x, CONF_CR0))
|
TI_TMP108_GET_CONF(x, CONF_CR0))
|
||||||
|
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue