mirror of
https://github.com/RIOT-OS/RIOT.git
synced 2024-12-29 04:50:03 +01:00
48 lines
1.1 KiB
C
48 lines
1.1 KiB
C
|
/*
|
||
|
|
* Copyright (C) 2018 Eistec AB
|
||
|
|
*
|
||
|
|
* This file is subject to the terms and conditions of the GNU Lesser
|
||
|
|
* General Public License v2.1. See the file LICENSE in the top level
|
||
|
|
* directory for more details.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @ingroup sys_phydat
|
||
|
|
* @{
|
||
|
|
*
|
||
|
|
* @file
|
||
|
|
* @brief Generic sensor/actuator data handling
|
||
|
|
*
|
||
|
|
* @author Joakim Nohlgård <joakim.nohlgard@eistec.se>
|
||
|
|
*
|
||
|
|
* @}
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <stdint.h>
|
||
|
|
#include "phydat.h"
|
||
|
|
|
||
|
|
#define ENABLE_DEBUG 0
|
||
|
|
#include "debug.h"
|
||
|
|
|
||
|
|
uint8_t phydat_fit(phydat_t *dat, long value, unsigned int index, uint8_t prescale)
|
||
|
|
{
|
||
|
|
assert(index < (sizeof(dat->val) / sizeof(dat->val[0])));
|
||
|
|
uint8_t ret = prescale;
|
||
|
|
while (prescale > 0) {
|
||
|
|
value /= 10;
|
||
|
|
--prescale;
|
||
|
|
}
|
||
|
|
int8_t scale_offset = 0;
|
||
|
|
while ((value > PHYDAT_MAX) || (value < PHYDAT_MIN)) {
|
||
|
|
value /= 10;
|
||
|
|
for (unsigned int k = 0; k < (sizeof(dat->val) / sizeof(dat->val[0])); ++k) {
|
||
|
|
dat->val[k] /= 10;
|
||
|
|
}
|
||
|
|
++scale_offset;
|
||
|
|
}
|
||
|
|
dat->val[index] = value;
|
||
|
|
dat->scale += scale_offset;
|
||
|
|
ret += scale_offset;
|
||
|
|
return ret;
|
||
|
|
}
|