caf_sensor_common.h

Go to the documentation of this file.

/*
 * Copyright (c) 2023 Nordic Semiconductor ASA
 *
 * SPDX-License-Identifier: LicenseRef-Nordic-5-Clause
 */
 
#ifndef _CAF_SENSOR_COMMON_H_
#define _CAF_SENSOR_COMMON_H_
 
#ifdef __cplusplus
extern "C" {
#endif
 
#include <zephyr/drivers/sensor.h>
 
 
/* This value has to be equal to fractional part of the sensor_value. */
#define FLOAT_TO_SENSOR_VAL_CONST 1000000
 
#define FLOAT_TO_SENSOR_VALUE(float_val)                                                        \
        {                                                                                       \
                .val1 = (int32_t)(float_val),                                                   \
                .val2 = (int32_t)(((float_val) - (int32_t)(float_val)) *                        \
                                                FLOAT_TO_SENSOR_VAL_CONST),                     \
        }
 
struct caf_sampled_channel {
        enum sensor_channel chan;
        uint8_t data_cnt;
};
 
static inline bool sensor_value_greater_then(struct sensor_value sensor_val1,
                                             struct sensor_value sensor_val2)
{
        return ((sensor_val1.val1 > sensor_val2.val1) ||
                ((sensor_val1.val1 == sensor_val2.val1) && (sensor_val1.val2 > sensor_val2.val2)));
}
 
static inline struct sensor_value sensor_value_abs_difference(struct sensor_value sensor_val1,
                                                              struct sensor_value sensor_val2)
{
        struct sensor_value result;
 
        result.val1 = abs(sensor_val1.val1 - sensor_val2.val1);
        result.val2 = abs(sensor_val1.val2 - sensor_val2.val2);
        if (result.val2 > FLOAT_TO_SENSOR_VAL_CONST) {
                result.val2 = result.val2 - FLOAT_TO_SENSOR_VAL_CONST;
                result.val1++;
        }
        return result;
}
 
#ifdef __cplusplus
}
#endif
 
#endif /* _CAF_SENSOR_COMMON_H_ */