pentair-protocol/iComII.c

/*
 * iComII - IntelliComII emulator on 'aprs485' hub tab
 *
 * Extras: pump status report
 */
#define	APRS485_API	1
#include "aprs485.h"
#include "pa_iflo.h"

char version[] = "@(#) iComII 0.03";

struct {
	u08_t	 cadr;	/* this controllers address */
	u08_t	 padr;	/* pump address */
	int	 ctrl;
	int	 poll;
	iflsr_t *pstat;
	u08_t	 sbuf[PA5SIZ];
}	gl;

pa5_t *pa5_hdr(void *buf, u08_t cfi)
{
	pa5_t	*ph;

	bzero(ph=buf,sizeof(*ph));
	ph->lpb = 0xa5;
	ph->dst = gl.padr;
	ph->src = gl.cadr;
	ph->cfi = cfi;
	return ph;
}

int pa5_snd(int bd, pa5_t *ps)
{
	int	n;
	u16_t	sum;
	u08_t	*b, *s, pa5[PA5SIZ];

	for (b = pa5, n = 3; --n >= 0; *b++ = 0xff); b[-2] = 0;
	n = sizeof(*ps) + ps->len;
	for (sum = 0, s = &ps->lpb; --n >= 0; b++) sum += *b = *s++;
	*b++ = sum>>8;
	*b++ = sum;
	return write(bd,pa5,b-pa5);
}

pa5_t *pa5_rcv(int bd, void *buf, int tmo)
{
	pa5_t	*pr;
	u08_t	*b, *c, *e;
	fd_set	rfd;
	tmv_t	tv;
	u16_t	sum;
	int	n, k;

	FD_ZERO(&rfd); FD_SET(bd,&rfd);
	tv.tv_usec = tmo * 1000;
	tv.tv_sec  = tv.tv_usec/1000000;
	tv.tv_usec -= tv.tv_sec*1000000;
	if ((k = select(bd+1,&rfd,0,0,&tv)) <= 0) return 0;
	if ((n = read(bd,buf,PA5SIZ)) < sizeof(pa5_t)) return 0;
	for (e = (b = buf) + n; b < e && *b != 0xa5; b++);
	if ((e - b) < sizeof(pa5_t)) return 0;
	pr = (pa5_t *)b;
	if (((c = &pr->dat[pr->len]) + 2) < e || pr->dst != gl.cadr) return 0;
	for (sum = 0; b < c; sum += *b++);
	if (sum != ((c[0]<<8)+c[1])) return 0;
	return pr;
}

int pump_cmd(int bd, int cmd, int val)
{
	pa5_t	*ps, *pr;
	char	snd[sizeof(pa5_t)+4], pa5[PA5SIZ];

	ps = pa5_hdr(snd,cmd);
	ps->dat[ps->len++] = val;
	if (pa5_snd(bd,ps) <= 0) return -1;
	if ((pr = pa5_rcv(bd,pa5,500)) == 0) return -2;
	if (pr->src != gl.padr) return -3;
	if (pr->cfi != ps->cfi || pr->len != ps->len) return -4;
	return pr->dat[0] == ps->dat[0] ? pr->dat[0] : -5;
}

int pump_reg(int bd, int adr, int val)
{
	pa5_t	*ps, *pr;
	char	snd[sizeof(pa5_t)+4], pa5[PA5SIZ];

	ps = pa5_hdr(snd,0x01);
	ps->dat[ps->len++] = adr>>8;
	ps->dat[ps->len++] = adr>>0;
	ps->dat[ps->len++] = val>>8;
	ps->dat[ps->len++] = val>>0;
	if (pa5_snd(bd,ps) <= 0) return -1;
	if ((pr = pa5_rcv(bd,pa5,500)) == 0) return -2;
	if (pr->src != gl.padr) return -3;
	if (pr->cfi != ps->cfi || pr->len != 2) return -4;
	adr = (pr->dat[0]<<8)+pr->dat[1];
	return adr == val ? val : -5;
}

/*
 * Extra, IntelliComII does not do this !
 */
iflsr_t *pump_stat(int bd, void *buf)
{
	pa5_t	*ps, *pr;
	int	ctrl;
	char	snd[sizeof(pa5_t)+4];

	if ((ctrl = gl.ctrl) != IFLO_DSP_REM) {
		gl.ctrl = pump_cmd(bd,IFLO_DSP,IFLO_DSP_REM);
		if (gl.ctrl != IFLO_DSP_REM) return 0;
	}
	ps = pa5_hdr(snd,IFLO_SRG);
	pr = pa5_snd(bd,ps) <= 0 ? 0 : pa5_rcv(bd,buf,500);
	if (ctrl != IFLO_DSP_REM)
		gl.ctrl = pump_cmd(bd,IFLO_DSP,IFLO_DSP_LOC);
	if (pr == 0) return 0;
	if (pr->src != gl.padr || pr->dst != gl.cadr) return 0;
	if (pr->cfi != ps->cfi || pr->len != sizeof(iflsr_t)) return 0;
	return (iflsr_t *)&pr->dat;
}

void pr_pstat(iflsr_t *p)
{
	if (p == 0) printf("no status!\n");
	else {
		printf("run=%02x",p->run);
		printf(" mod=%02x",p->mod);
		printf(" pmp=%02x",p->pmp);
		printf(" pwr=%d",ntohs(p->pwr));
		printf(" rpm=%d",ntohs(p->rpm));
		printf(" gpm=%d",p->gpm);
		printf(" ppc=%d",p->ppc);
		printf(" err=%02x",p->err);
		printf(" tmr=%d",p->tmr);
		printf(" %02d:%02d\n",p->clk[0],p->clk[1]);
	}
}

typedef struct {
	int	rep;
	int	run;
	int	rr;
}	ltc_t;

void ltic0(int bd, ltc_t *l)
{
	int	k;

	if ((gl.ctrl = pump_cmd(bd,IFLO_DSP,IFLO_DSP_REM)) == IFLO_DSP_REM) {
		switch (l->rr) {
		default: l->rr = 0;
		/* FALLTHROUGH */
		case 0: k = IFLO_EPRG_P0; break;
		case 1: k = IFLO_EPRG_P1; break;
		case 2: k = IFLO_EPRG_P2; break;
		case 3: k = IFLO_EPRG_P3; break;
		case 4: k = IFLO_EPRG_P4; break;
		}
		if (pump_reg(bd,IFLO_REG_EPRG,k) == k) l->run = l->rr;
		if (gl.poll) gl.pstat = pump_stat(bd,&gl.sbuf);
		gl.ctrl = pump_cmd(bd,IFLO_DSP,IFLO_DSP_LOC);
	}
	else l->run = l->rr = 0;
}

int uifc(int bd)
{
	fd_set	rfd;
	tmv_t	tv;
	ltc_t	*l, ltc;
	int	don, tic, n, k;
	char	buf[64], pa5[PA5SIZ];

	bzero(l=&ltc,sizeof(*l));
	l->rep = 30;
	for (tic = don = 0; !don; ) {
		if (--tic < 0) {
			tic = 0;
			k = gl.ctrl != IFLO_DSP_REM && gl.ctrl != IFLO_DSP_LOC;
			if (k || l->run || l->run != l->rr || gl.poll) ltic0(bd,l);
			switch (gl.ctrl) {
			case IFLO_DSP_REM:
			case IFLO_DSP_LOC:
				tic = l->rep - 1;
				break;
			}
		}
		printf("\r%s  ",version+5);
		printf(l->run==0?"-- ":"%2d ",tic+1);
		printf(gl.ctrl==IFLO_DSP_REM?"R> ":
		       gl.ctrl==IFLO_DSP_LOC?"%d> ":
		                             "?> ",l->run);
		fflush(stdout);
		tv.tv_sec = 1; tv.tv_usec = 0;
		FD_ZERO(&rfd); FD_SET(0,&rfd); FD_SET(bd,&rfd);
		if ((n = select(bd+1,&rfd,0,0,&tv)) < 0 && errno != EINTR)
			break;
		if (n <= 0) continue;
		if (FD_ISSET(bd,&rfd)) {
			if ((n = read(bd,pa5,sizeof(pa5))) == 2 && pa5[0] == EOT)
				printf("\rEOT from hub                  \n");
			else	printf("\rWe are not alone on the bus...\n");
			break;
		}
		if (!FD_ISSET(0,&rfd)) continue;
		if (read(0,buf,sizeof(buf)) <= 0) continue;
		switch (buf[0]) {
		case 'q': don = 1; break;
		case 's': pr_pstat(pump_stat(bd,pa5)); break;
		case '0': l->rr = 0, tic = 0; break;
		case '1': l->rr = 1, tic = 0; break;
		case '2': l->rr = 2, tic = 0; break;
		case '3': l->rr = 3, tic = 0; break;
		case '4': l->rr = 4, tic = 0; break;
		default:
			printf("q - quit\n");
			printf("s - pump status\n");
			printf("0 - all inputs off\n");
			printf("1 - input 1 active\n");
			printf("2 - input 2 active\n");
			printf("3 - input 3 active\n");
			printf("4 - input 4 active\n");
			break;
		}
	}
	return errno;
}

int main(int ac, char **av)
{
	int	bd;
	char	msg[128];

	bzero(&gl,sizeof(gl));
	gl.cadr = 0x10;
	gl.padr = 0x60;
	gl.ctrl = -1;
	gl.poll = 1;
	bd = hub_at(ac>1?av[1]:0,msg);
	printf("%s: %s\n",av[0],msg);
	if (bd < 0) return -1;
	uifc(bd);
	hub_dt(bd);
	return 0;
}