pentair-protocol/iPmon.c

/*
 * iPmon - IntelliFlow status monitor on 'pabus'
 */
#define	APRS485_API	1
#include "aprs485.h"
#include "pa_iflo.h"

char version[] = "@(#) iPmon 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;
}

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("%02d:%02d",p->clk[0],p->clk[1]);
		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(" b09=%02x",p->b09);
		printf(" err=%02x",p->err);
		printf(" b11=%02x",p->b11);
		printf(" tmr=%d\n",p->tmr);
	}
}

int uifc(int bd)
{
	fd_set	rfd;
	tmv_t	tv;
	int	don, tic, rep, n;
	char	buf[64], pa5[PA5SIZ];

	rep = 15;
	for (tic = 1, don = 0; !don; ) {
		if (--tic < 0) {
			tic = (gl.pstat = pump_stat(bd,&gl.sbuf)) ? (rep-1) : 0;
			pr_pstat(gl.pstat);
		}
		printf("\r%s ",version+5);
		printf("%2d",tic+1);
		printf(gl.ctrl==IFLO_DSP_REM?"R> ":
		       gl.ctrl==IFLO_DSP_LOC?"L> ":
		                             "?> ");
		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;
		default:
			printf("q - quit\n");
			break;
		}
	}
	return errno;
}

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

	bzero(&gl,sizeof(gl));
	gl.cadr = 0x11;
	gl.padr = 0x60;
	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;
}