baylibre-acme: properly set encoding digits

This commit is contained in:
Aurelien Jacobs 2016-08-24 02:38:58 +02:00
parent d043b29d5c
commit ad4c0275c2
1 changed files with 10 additions and 5 deletions

View File

@ -18,6 +18,7 @@
*/ */
#include <config.h> #include <config.h>
#include <math.h>
#include <string.h> #include <string.h>
#include <stdlib.h> #include <stdlib.h>
#include <errno.h> #include <errno.h>
@ -50,6 +51,7 @@ struct channel_group_priv {
struct channel_priv { struct channel_priv {
int ch_type; int ch_type;
int fd; int fd;
int digits;
float val; float val;
struct channel_group_priv *probe; struct channel_group_priv *probe;
}; };
@ -613,18 +615,18 @@ static int channel_to_unit(struct sr_channel *ch)
} }
/* We need to scale measurements down from the units used by the drivers. */ /* We need to scale measurements down from the units used by the drivers. */
static float adjust_data(int val, int type) static int type_digits(int type)
{ {
switch (type) { switch (type) {
case ENRG_PWR: case ENRG_PWR:
return ((float)val) / 1000000.0; return 6;
case ENRG_CURR: /* Fallthrough */ case ENRG_CURR: /* Fallthrough */
case ENRG_VOL: /* Fallthrough */ case ENRG_VOL: /* Fallthrough */
case TEMP_IN: /* Fallthrough */ case TEMP_IN: /* Fallthrough */
case TEMP_OUT: case TEMP_OUT:
return ((float)val) / 1000.0; return 3;
default: default:
return 0.0; return 0;
} }
} }
@ -648,7 +650,8 @@ static float read_sample(struct sr_channel *ch)
return -1.0; return -1.0;
} }
return adjust_data(strtol(buf, NULL, 10), chp->ch_type); chp->digits = type_digits(chp->ch_type);
return strtol(buf, NULL, 10) * powf(10, -chp->digits);
} }
SR_PRIV int bl_acme_open_channel(struct sr_channel *ch) SR_PRIV int bl_acme_open_channel(struct sr_channel *ch)
@ -777,6 +780,8 @@ SR_PRIV int bl_acme_receive_data(int fd, int revents, void *cb_data)
if (i < 1) if (i < 1)
chp->val = read_sample(ch); chp->val = read_sample(ch);
analog.encoding->digits = chp->digits;
analog.spec->spec_digits = chp->digits;
analog.data = &chp->val; analog.data = &chp->val;
sr_session_send(sdi, &packet); sr_session_send(sdi, &packet);
} }