#include "/sys/i386/i386/geode.c"
#include <sys/endian.h>
#include <stdio.h>
#include <fcntl.h>
#include <err.h>

static uint8_t crc8_table[] = {
        0, 94,188,226, 97, 63,221,131,194,156,126, 32,163,253, 31, 65,
      157,195, 33,127,252,162, 64, 30, 95,  1,227,189, 62, 96,130,220,
       35,125,159,193, 66, 28,254,160,225,191, 93,  3,128,222, 60, 98,
      190,224,  2, 92,223,129, 99, 61,124, 34,192,158, 29, 67,161,255,
       70, 24,250,164, 39,121,155,197,132,218, 56,102,229,187, 89,  7,
      219,133,103, 57,186,228,  6, 88, 25, 71,165,251,120, 38,196,154,
      101, 59,217,135,  4, 90,184,230,167,249, 27, 69,198,152,122, 36,
      248,166, 68, 26,153,199, 37,123, 58,100,134,216, 91,  5,231,185,
      140,210, 48,110,237,179, 81, 15, 78, 16,242,172, 47,113,147,205,
       17, 79,173,243,112, 46,204,146,211,141,111, 49,178,236, 14, 80,
      175,241, 19, 77,206,144,114, 44,109, 51,209,143, 12, 82,176,238,
       50,108,142,208, 83, 13,239,177,240,174, 76, 18,145,207, 45,115,
      202,148,118, 40,171,245, 23, 73,  8, 86,180,234,105, 55,213,139,
       87,  9,235,181, 54,104,138,212,149,203, 41,119,244,170, 72, 22,
      233,183, 85, 11,136,214, 52,106, 43,117,151,201, 74, 20,246,168,
      116, 42,200,150, 21, 75,169,247,182,232, 10, 84,215,137,107, 53
};

static uint8_t
crc8(void *p, int len)
{
	uint8_t *s, c;

	c = 0;
	s = p;
	while (len--)
		c = crc8_table[c ^ *s++];
	return (c);
}

int
main(int argc __unused, char *argv __unused)
{
	int fd, i;
	struct onew o;
	int16_t t;
	double a;

	fd = open("/dev/onew", O_RDWR);
	if (fd < 0)
		err(1, "/dev/onew");

	o.rst = 1;
	o.xmt = 1;
	o.rcv = 8;
	o.d[0] = 0x33;
	i = ioctl(fd, ONEW, &o);
	if (i)
		err(1, "ioctl");
	printf("\n=>");
	for (i = 0; i < o.xmt + o.rcv; i++)
		printf(" %02x", o.d[i]);
	printf(" C: %d\n", crc8(o.d + 1, 8));

	o.rst = 1;
	o.xmt = 2;
	o.rcv = 1;
	o.d[0] = 0xcc;
	o.d[1] = 0xb4;
	i = ioctl(fd, ONEW, &o);
	if (i)
		err(1, "ioctl");
	printf("\n=>");
	for (i = 0; i < o.xmt + o.rcv; i++)
		printf(" %02x", o.d[i]);
	printf(" C: %d\n", crc8(o.d + 1, 1));

	while (1) {
		o.rst = 1;
		o.xmt = 2;
		o.rcv = 0;
		o.d[0] = 0xcc;
		o.d[1] = 0x44;
		i = ioctl(fd, ONEW, &o);
		if (i)
			err(1, "ioctl");
		sleep(1);
		o.rst = 1;
		o.xmt = 2;
		o.rcv = 11;
		o.d[0] = 0xcc;
		o.d[1] = 0xbe;
		i = ioctl(fd, ONEW, &o);
		if (i)
			err(1, "ioctl");
		if (crc8(o.d + 2, 9))
			continue;
		t = le16dec(o.d + 2);
		a = t / 16.0;
		printf("%7.3f t %d\n", a, t);
	}

	return(0);
}