44 lines
808 B
C
44 lines
808 B
C
|
|
#include <stdio.h>
|
|
|
|
#include "serial.h"
|
|
|
|
extern int verbosity;
|
|
|
|
/* ---------------------------------------------------------------- */
|
|
int parseXvalue(char *line, char cflag)
|
|
{
|
|
int value, foo;
|
|
int vrd[4];
|
|
|
|
value=0;
|
|
|
|
if ( cflag != *line ) {
|
|
if (verbosity) {
|
|
fprintf(stderr, "%s line[0] 0x%x bad\n",
|
|
__func__, *line);
|
|
}
|
|
return -777;
|
|
}
|
|
|
|
foo = sscanf(line+1, "%d %d %d %d", vrd, vrd+1, vrd+2, vrd+3);
|
|
#if DEBUG_LEVEL
|
|
fprintf(stderr, "%s : sscanf -> %d\n", __func__, foo);
|
|
#endif
|
|
if (4 != foo) {
|
|
return -666;
|
|
}
|
|
for (foo=0; foo<4; foo++) {
|
|
value += vrd[foo];
|
|
}
|
|
return value;
|
|
}
|
|
/* ---------------------------------------------------------------- */
|
|
int parse4values(char *line, char cflag, float array[4])
|
|
{
|
|
|
|
|
|
return -777;
|
|
}
|
|
/* ---------------------------------------------------------------- */
|