BBN-Vax-TCP/stand/tm.c

/*	tm.c	4.5	81/04/03	*/

/*
 * TM11/TE??
 */

#include "../h/param.h"
#include "../h/inode.h"
#include "../h/pte.h"
#include "../h/ubareg.h"
#include "saio.h"
#include "savax.h"

#include "../h/tmreg.h"

u_short	tmstd[] = { 0172520 };

tmopen(io)
	register struct iob *io;
{
	register skip;

	tmstrategy(io, TM_REW);
	skip = io->i_boff;
	while (skip--) {
		io->i_cc = 0;
		tmstrategy(io, TM_SFORW);
	}
}

tmclose(io)
	register struct iob *io;
{

	tmstrategy(io, TM_REW);
}

tmstrategy(io, func)
	register struct iob *io;
{
	register int com, unit, errcnt;
	register struct device *tmaddr =
	    (struct device *)ubamem(io->i_unit, tmstd[0]);
	int word, info;

	unit = io->i_unit;
	errcnt = 0;
retry:
	tmquiet(tmaddr);
	com = (unit<<8);
	info = ubasetup(io, 1);
	tmaddr->tmbc = -io->i_cc;
	tmaddr->tmba = info;
	if (func == READ)
		tmaddr->tmcs = com | TM_RCOM | TM_GO;
	else if (func == WRITE)
		tmaddr->tmcs = com | TM_WCOM | TM_GO;
	else if (func == TM_SREV) {
		tmaddr->tmbc = -1;
		tmaddr->tmcs = com | TM_SREV | TM_GO;
		return (0);
	} else
		tmaddr->tmcs = com | func | TM_GO;
	for (;;) {
		word = tmaddr->tmcs;
		if (word&TM_CUR)
			break;
	}
	ubafree(io, info);
	word = tmaddr->tmer;
	if (word&TMER_EOT)
		return(0);
	if (word < 0) {
		if (errcnt == 0)
			printf("te error: er=%b", tmaddr->tmer, TMER_BITS);
		if (errcnt==10) {
			printf("\n");
			return(-1);
		}
		errcnt++;
		tmstrategy(io, TM_SREV);
		goto retry;
	}
	if (errcnt)
		printf(" recovered by retry\n");
	return (io->i_cc+tmaddr->tmbc);
}

tmquiet(tmaddr)
	register struct device *tmaddr;
{
	register word;
	for (;;) {
		word = tmaddr->tmcs;
		if (word&TM_CUR)
			break;
	}
	for (;;) {
		word = tmaddr->tmer;
		if ((word&TMER_TUR) && (word&TMER_SDWN)==0)
			break;
	}
}