freebsd-skq/sys/gnu/scsi/nic5000.c

static char     rcsid[] = "@(#)$Id: nic5000.c,v 1.1 1995/02/14 15:00:37 jkh Exp $";
/*******************************************************************************
 *  II - Version 0.1 $Revision: 1.1 $   $State: Exp $
 *
 * Copyright 1994 Dietmar Friede
 *******************************************************************************
 * Bug reports, patches, comments, suggestions should be sent to:
 *
 *	jkr@saarlink.de or jkrause@guug.de
 *
 *******************************************************************************
 * $Log: nic5000.c,v $
 * Revision 1.1  1995/02/14  15:00:37  jkh
 * An ISDN driver that supports the EDSS1 and the 1TR6 ISDN interfaces.
 * EDSS1 is the "Euro-ISDN", 1TR6 is the soon obsolete german ISDN Interface.
 * Obtained from: Dietmar Friede <dfriede@drnhh.neuhaus.de> and
 * 	Juergen Krause <jkr@saarlink.de>
 *
 * This is only one part - the rest to follow in a couple of hours.
 * This part is a benign import, since it doesn't affect anything else.
 *
 *
 ******************************************************************************/

/*
 *
 * Copyright (c) 1994 Dietmar Friede (dietmar@friede.de) All rights reserved.
 * FSF/FSAG GNU Copyright applies
 *
 * A low level driver for the NICCY-5000 ISDN/SCSI device
 *
 */

#include "snic.h"
#if NSNIC > 0

#define SPLSNIC splbio
#define ESUCCESS 0
#define SNIC_RETRIES 8
#include "sys/types.h"
#include "sys/param.h"
#include "sys/ioctl.h"
#include "sys/malloc.h"
#include "sys/kernel.h"

#include "scsi/scsi_all.h"
#include "scsi/scsiconf.h"
#include "gnu/isdn/isdn_ioctl.h"
#include "gnu/i386/isa/niccyreg.h"
#include "gnu/scsi/scsi_nic.h"
/* #define NETBSD */

#undef	SCSI_NOMASK
#define OPEN		1
#define LOAD_HEAD	2
#define LOAD_DATA	4
#define	LOAD_ENTITY	8
#define IS_DIAL(p)	(((p)&0x20)==0)
#define IS_LISTEN(p)	((p)&0x20)
#define	CHAN(pl)	(((pl)&7)-1)
#define	C_CHAN(x)	((x)&1)
#define APPL(pl)	((((pl)>>6)&0x7f)-1)
#define CARD(pl)	(((pl)>>13)&7)
#define MK_APPL(pl)	(((pl)+1)<<6)
#define min(a,b)	((a)<(b)?(a):(b))

#define	SNICOUTSTANDING	2

extern int hz;

struct	snic_data
{
	struct	scsi_switch *sc_sw;	/* address of scsi low level switch */
	int	ctrl;			/* so they know which one we want */
	int	targ;			/* our scsi target ID */
	int	lu;			/* out scsi lu */
	int	cmdscount;		/* cmds allowed outstanding by board*/
	int		xfer_block_wait;
	struct	scsi_xfer	*free_xfer;
	struct	scsi_xfer	scsi_xfer[SNICOUTSTANDING]; /* XXX */
};

struct	snic_driver
{
	int	size;
	struct	snic_data	**snic_data;
}*snic_driver;

static	int	next_snic_unit = 0;
static unsigned dnlnum = 0;

static u_char ack_msg= 0xff;
static u_char snic_nxt_b;

typedef enum
{
	DISCON, ISDISCON, DIAL, CALLED, CONNECT, IDLE, ACTIVE, WAITING, WAIT_ACK
}               io_state;

typedef struct
{
	char            ctrl;
	u_char          msg_nr;
	short           plci;
	short           ncci;
	short           state;
	Buffer          o_buf;
}               chan_t;

struct snic_softc
{
	short           sc_stat;
	u_char          sc_flags;
	u_char          sc_unit;
	u_char          sc_ctrl;
	u_char		sc_type;
	u_short		sc_istat;
	struct scsi_msg sc_icmd;
	Buffer		sc_imsg;
	Header		sc_imsg0;
	u_short		sc_ostat;
	struct scsi_msg sc_ocmd;
	Buffer		sc_omsg;
	chan_t          sc_chan[2];
	u_char		sc_state_ind[8];
	u_char		sc_gotack;
}               snic_sc[NSNIC];

extern isdn_appl_t isdn_appl[];
extern isdn_ctrl_t isdn_ctrl[];
extern u_short isdn_state;
extern int     ispy_applnr;
extern int Isdn_Appl, Isdn_Ctrl, Isdn_Typ;
extern void isdn_start_out();

static old_spy= 0;
static void snic_interupt();
static int snic_get_msg();
static void snic_start();

int             snic_connect(), snic_listen(), snic_disconnect(), snic_accept();
int             snic_output();

#ifdef NETBSD
int	snicattach(int ctrl, struct scsi_switch *scsi_switch, int physid, int *sunit)
{
	int targ, lu;
#else	/* FreeBSD */
int	snicattach(int ctrl, int targ, int lu, struct scsi_switch *scsi_switch)
{
#endif
	int		unit,i;
	struct snic_data	*snic, **snicrealloc;
	struct snic_softc *sc;
	int             cn;
	isdn_ctrl_t    *ctrl0, *ctrl1;

#ifdef NETBSD
	targ = physid >> 3;
	lu = physid & 7;
#endif

	if(next_snic_unit >= NSNIC)
		return(0);

	unit = next_snic_unit;
	if (next_snic_unit == 0)
	{
		snic_driver =
			malloc(sizeof(struct snic_driver),M_DEVBUF,M_NOWAIT);
		if(!snic_driver)
		{
			printf("snic%d: malloc failed\n",unit);
			return(0);
		}
		bzero(snic_driver,sizeof(snic_driver));
		snic_driver->size = 0;
	}
	next_snic_unit++;

	if(unit >= snic_driver->size)
	{
		snicrealloc =
			malloc(sizeof(snic_driver->snic_data) * next_snic_unit,
				M_DEVBUF,M_NOWAIT);
		if(!snicrealloc)
		{
			printf("snic%d: malloc failed\n",unit);
			return(0);
		}
		/* Make sure we have something to copy before we copy it */
		bzero(snicrealloc,sizeof(snic_driver->snic_data) * next_snic_unit);
		if(snic_driver->size)
		{
			bcopy(snic_driver->snic_data,snicrealloc,
				sizeof(snic_driver->snic_data) * snic_driver->size);
			free(snic_driver->snic_data,M_DEVBUF);
		}
		snic_driver->snic_data = snicrealloc;
		snic_driver->snic_data[unit] = NULL;
		snic_driver->size++;
	}

	if(snic_driver->snic_data[unit])
	{
		return(0);
	}

	snic = snic_driver->snic_data[unit] =
		malloc(sizeof(struct snic_data),M_DEVBUF,M_NOWAIT);
	if(!snic)
	{
		printf("snic%d: malloc failed\n",unit);
		return(0);
	}
#ifdef NETBSD
	*sunit= unit;
#endif
	bzero(snic,sizeof(struct snic_data));

	snic->sc_sw	=	scsi_switch;
	snic->ctrl	=	ctrl;
	snic->targ	=	targ;
	snic->lu		=	lu;
	snic->cmdscount =	SNICOUTSTANDING; /* XXX (ask the board) */

	i = snic->cmdscount;
	while(i-- )
	{
		snic->scsi_xfer[i].next = snic->free_xfer;
		snic->free_xfer = &snic->scsi_xfer[i];
	}

	sc = &snic_sc[unit];
	sc->sc_ctrl = -1;
	sc->sc_gotack= 1;
	if ((cn = isdn_ctrl_attach(2)) == -1)
	{
		return (0);
	}
	sc->sc_ctrl = cn;

	sc->sc_chan[0].plci = sc->sc_chan[1].plci = -1;

	ctrl0 = &isdn_ctrl[cn];
	ctrl1 = &isdn_ctrl[cn + 1];
	sc->sc_chan[0].ctrl = ctrl0->ctrl = cn;
	sc->sc_chan[1].ctrl = ctrl1->ctrl = cn + 1;
	ctrl0->o_buf = &sc->sc_chan[0].o_buf.Data[5];
	ctrl1->o_buf = &sc->sc_chan[1].o_buf.Data[5];

	ctrl0->listen = ctrl1->listen = snic_listen;
	ctrl0->disconnect = ctrl1->disconnect = snic_disconnect;
	ctrl0->accept = ctrl1->accept = snic_accept;
	ctrl0->connect = ctrl1->connect = snic_connect;
	ctrl0->output = ctrl1->output = snic_output;
	ctrl0->unit = ctrl1->unit = unit;
	ctrl0->appl = ctrl1->appl = -1;
	ctrl0->o_len = ctrl1->o_len = -1;
	sc->sc_flags= LOAD_ENTITY;
	return(1);
}

static
struct scsi_xfer *snic_get_xs(int unit)
{
	struct scsi_xfer *xs;
	struct snic_data *snic;
	int	s;

	snic = snic_driver->snic_data[unit];
	if (xs = snic->free_xfer)
	{
		snic->free_xfer = xs->next;
		xs->flags = 0;
	}
	return(xs);
}

static void
snic_free_xs(int unit, struct scsi_xfer *xs)
{
	struct snic_data *snic;
	
	snic = snic_driver->snic_data[unit];
	xs->next = snic->free_xfer;
	snic->free_xfer = xs;
}

static void
snic_timout(int unit)
{
	struct snic_softc * sc= &snic_sc[unit&0xff];

	if(sc->sc_istat&0x100)
	{
		snic_interupt(unit);
		return;
	}
	if(sc->sc_istat & 2)
		sc->sc_istat= sc->sc_ostat= 0;
	else if((sc->sc_istat & 0x200) == 0 ) return;
	if(sc->sc_ostat & 0xff)
	{
		sc->sc_istat|= 0x200;
		timeout(snic_timout,unit,2);
		return;
	}
	if(sc->sc_gotack) snic_start(unit);
	snic_get_msg(unit);
}

static int
isdn_small_interupt(int unit, struct scsi_xfer *xs)
{
	struct snic_data *snic = snic_driver->snic_data[unit];
	struct snic_softc * sc= &snic_sc[unit];
	Header *msg = &sc->sc_imsg0;
	int c;

	switch (msg->Type)
	{
	case 0:
		if(sc->sc_istat&0x200)
			break;
		sc->sc_istat|= 0x200;
		timeout(snic_timout,unit,2);
		break;
	case 0xff:
		sc->sc_gotack= 1;
		break;
	case 0xfe:
printf("f");
		sc->sc_gotack= 1;
		for(c= 0; c < 2; c++)
		{
			chan_t *chan = &sc->sc_chan[c];
			if(chan->state == WAIT_ACK)
			{
				chan->state = WAITING;
				sc->sc_ostat |= c?0x800:0x400;
			}
		}
		break;
	case 0xfd:
printf("fd");
		break;
	default:
		return(0);
	}
	sc->sc_istat&= ~0xff;
	sc->sc_imsg0.Type= 0;
	return(1);
}

static void
snic_get_done(int unit, struct scsi_xfer *xs)
{
	struct snic_data *snic = snic_driver->snic_data[unit];
	struct snic_softc * sc= &snic_sc[unit];
	Header *msg = &sc->sc_imsg0;
	int len, error;

	error= xs->error;

	switch(error)
	{
	case	XS_NOERROR:
		if(xs->datalen == 0)
			sc->sc_imsg.h.Type= 0;
		
		if(isdn_small_interupt(unit,xs)) break;

		if(xs->datalen < (len=(msg->DataLen + 10)))
		{
			struct scsi_msg *scsi_cmd= &sc->sc_icmd;
			/* resubmit it */

			sc->sc_imsg.h.Type= 0xba;
			scsi_cmd->len[1]= (len>>8)&0xff;
			scsi_cmd->len[2]= len&0xff;
			xs->retries= SNIC_RETRIES;
			xs->error = XS_NOERROR;
			xs->flags &= ~ITSDONE;
			xs->data        =       (char *) &sc->sc_imsg;
			xs->datalen	=	len;
			xs->resid	=	len;

			if ((*(snic->sc_sw->scsi_cmd))(xs) == SUCCESSFULLY_QUEUED)
			{
				return;
			}
			error= xs->error | 0x1000;
			break;
		}
		if(xs->datalen <= 10)
		{
			sc->sc_istat|= 0x400;
			sc->sc_imsg.h = sc->sc_imsg0;
		}
		sc->sc_imsg0.Type= 0;
		break;

	case	XS_TIMEOUT:
	case	XS_BUSY:
	case	XS_DRIVER_STUFFUP:
		break;
	default:
		printf("snic%d: unknown error %x\n",unit,xs->error);
	}	

	if(error)
	{
		sc->sc_imsg.h.Type= sc->sc_imsg0.Type= 0;
		sc->sc_istat&= 0x200;
		if((sc->sc_istat&0x200) == 0)
		{
			sc->sc_istat= 0x200;
			timeout(snic_timout,unit,2);
		}
	}

	snic_free_xs(unit,xs);
	if(sc->sc_istat&0x4ff == 0x400 )
		sc->sc_istat|= 1;
	if(sc->sc_istat&0xff)
	{
		snic_interupt(unit);
		return;
	}
	if(sc->sc_gotack) snic_start(unit);
	if(sc->sc_istat & 0x200)
		return;
	sc->sc_istat|= 0x200;
	timeout(snic_timout,unit,2);
}

static int
snic_get_msg(unit)
int	unit;
{
	struct snic_data *snic = snic_driver->snic_data[unit];
	struct snic_softc * sc= &snic_sc[unit];
	struct scsi_msg *scsi_cmd= &sc->sc_icmd;
	struct	scsi_xfer *xs;
	Header		*data= &sc->sc_imsg0;
	int	retval;

	if(sc->sc_istat&0xff)
		return(-1);
	sc->sc_istat |= 1;

	data->Type= 0xbb;
	sc->sc_istat &= ~0x200;

	bzero(scsi_cmd, sizeof(struct scsi_msg));
	bzero(data,10);

	scsi_cmd->op_code = GET_MSG_COMMAND;
	scsi_cmd->len[2]= 10;

	xs = snic_get_xs(unit);
	if(!xs)
	{
		sc->sc_istat&= ~0xff;
		data->Type= 0;
		return(EBUSY);
	}

	xs->flags |= (INUSE | SCSI_DATA_IN | SCSI_NOSLEEP);
	xs->adapter	=	snic->ctrl;
	xs->targ	=	snic->targ;
	xs->lu		=	snic->lu;
	xs->retries	=	SNIC_RETRIES;
	xs->timeout	=	2000;
	xs->cmd		=	(struct scsi_generic *) scsi_cmd;
	xs->cmdlen	=	sizeof(struct scsi_msg);
	xs->data	=	(char *) data;
	xs->datalen	=	10;
	xs->resid	=	10;
	xs->when_done	=	snic_get_done;
	xs->done_arg	=	unit;
	xs->done_arg2	=	(int)xs;
	xs->bp		=	NULL;
	xs->error	=	XS_NOERROR;

	if(retval = (*(snic->sc_sw->scsi_cmd))(xs))
	{
		sc->sc_istat= ~0xff;
		data->Type= 0;
		snic_free_xs(unit,xs);
	}
	return (retval);
}

static void
snic_put_done(int unit, struct scsi_xfer *xs)
{
	int	retval;
	struct snic_data *snic = snic_driver->snic_data[unit];
	struct snic_softc * sc= &snic_sc[unit];
	Header *b= (Header *) xs->data;
	int c;

	sc->sc_ostat&= ~0xff;
	if(xs->error != XS_NOERROR)
	{
		snic_free_xs(unit,xs);
		switch(b->Type)
		{
		case 0:
			return;
		case 0xff:
			sc->sc_ostat|= 0x100;
			return;
		case BD_DATA_B3_REQ | 0x40:
		case BD_DATA_B3_REQ:
			sc->sc_ostat|= 0x400;
			return;
		default:
			sc->sc_ostat|= 0x200;
			return;
		}
	}

	snic_free_xs(unit,xs);

	c= 0;
	switch(b->Type)
	{
	case 0xff: break;
	case BD_DATA_B3_REQ | 0x40:
		c= 1;
	case BD_DATA_B3_REQ:
		sc->sc_chan[c].state = WAIT_ACK;
		break;
	default:
		b->Type= 0;
	}

	if(sc->sc_istat&0x100)
	{
		snic_interupt(unit);
		return;
	}

	if(sc->sc_ostat&0x100)
	{
		sc->sc_ostat&= ~0x100;
		if(snic_put_msg(unit,&ack_msg,1,0))
			sc->sc_ostat|= 0x100;
		else return;
	}

	if(sc->sc_gotack) snic_start(unit);
	if(sc->sc_istat&0x200)
		return;
	sc->sc_istat|= 0x200;
	timeout(snic_timout,unit,2);
}

static void
snic_start(int unit)
{
	int	retval;
	struct snic_softc * sc= &snic_sc[unit];
	Header *b;
	int c;

	if(sc->sc_ostat&0x200)
	{
		b= &sc->sc_omsg.h;
		sc->sc_ostat&= ~0x200;
		if(snic_put_msg(unit,b, b->DataLen+10,2))
			sc->sc_ostat|= 0x200;
		else return;
	}


	for(c= 0; c<2; c++)
	{
		int cc= (snic_nxt_b++)&1;
		u_short m= 0x400 << cc;

		if(sc->sc_ostat&m)
		{
			chan_t         *chan= &sc->sc_chan[cc];
			b= &chan->o_buf.h;
			sc->sc_ostat&= ~m;
			if(chan->state == WAITING)
			{
				chan->state= ACTIVE;
				if(snic_put_msg(unit,b, b->DataLen+10,4))
				{
					chan->state= WAITING;
					sc->sc_ostat|= m;
				}
				else return;
			}
		}
	}
}

int
snic_put_msg(int unit, Header *data, unsigned len, int w)
{
	struct snic_softc *sc = &snic_sc[unit];
	struct scsi_msg *scsi_cmd = &sc->sc_ocmd;
	int	retval;
	struct	scsi_xfer *xs;
	struct snic_data *snic = snic_driver->snic_data[unit];

	if(data->Type==0)
		return(0);

	if(sc->sc_ostat&0xff)
		return(EBUSY);

	sc->sc_ostat |= 1;
	if((data->Type == 0xa8) || (data->Type == 0xe8))
	{
		if(sc->sc_gotack==0)
		{
			sc->sc_ostat &= ~0xff;
			return(EBUSY);
		}
	}
	if(data->Type != 0xff)
		sc->sc_gotack= 0;
	bzero(scsi_cmd, sizeof(struct scsi_msg));

	scsi_cmd->op_code = PUT_MSG_COMMAND;
	if(len > 2063)
	{
		printf("snic%d: unsupported length %d\n",unit,len);
		sc->sc_ostat &= ~0xff;
		return(ENODEV);
	}
	scsi_cmd->len[1]= (len >> 8) & 0xff;
	scsi_cmd->len[2]= len & 0xff;

	xs = snic_get_xs(unit);
	if(!xs)
	{
		printf("snic pm%d: busy %d\n", unit, w);
		sc->sc_ostat &= ~0xff;
		return(EBUSY);
	}
	xs->flags |= (INUSE | SCSI_DATA_OUT | SCSI_NOSLEEP);
	xs->adapter	=	snic->ctrl;
	xs->targ	=	snic->targ;
	xs->lu		=	snic->lu;
	xs->retries	=	SNIC_RETRIES;
	xs->timeout	=	2000;
	xs->cmd		=	(struct scsi_generic *) scsi_cmd;
	xs->cmdlen	=	sizeof(struct scsi_msg);
	xs->data	=	(char *)data;
	xs->datalen	=	len;
	xs->resid	=	len;
	xs->when_done	=	snic_put_done;
	xs->done_arg	=	unit;
	xs->done_arg2	=	(int)xs;
	xs->bp		=	NULL;
	xs->error	=	XS_NOERROR;

	if(retval = (*(snic->sc_sw->scsi_cmd))(xs))
	{
		sc->sc_ostat &= ~0xff;
		snic_free_xs(unit,xs);
		return(EBUSY);
	}

	return(0);
}

int
snicopen(dev_t dev, int flag)
{
	struct snic_softc *sc;
	u_char          unit;
	int             x;
	unsigned	error;
	u_char	b= 0xff;

	unit = minor(dev);
	/* minor number out of limits ? */
	if (unit >= next_snic_unit)
		return (ENXIO);
	sc = &snic_sc[unit];

	x= splhigh();
	/* Card busy ? */
	if (sc->sc_flags & 7)
	{
		splx(x);
		return (EBUSY);
	}
	sc->sc_flags |= OPEN;

	if(sc->sc_flags & LOAD_ENTITY)
	{
		snic_get_msg(unit);
/*
		if(snic_put_msg(unit,(Header *) &ack_msg,1,5))
			sc->sc_ostat|= 0x100;
*/
	}

	splx(x);
	return (0);
}

int
snicclose(dev_t dev, int flag)
{
	struct snic_softc *sc = &snic_sc[minor(dev)];

	sc->sc_flags &= ~7;
	return (0);
}

int
snicioctl(dev_t dev, int cmd, caddr_t data, int flag)
{
	int             error;
	u_char          unit= minor(dev);
	int             i, x;
	struct snic_softc *sc = &snic_sc[minor(dev)];
	Buffer *b= &sc->sc_omsg;

	error = 0;
	x= splhigh();
	while(sc->sc_ostat || (sc->sc_gotack==0))
	{
		error = tsleep((caddr_t) sc, PZERO | PCATCH, "ioctl", 2);
		if (error != EWOULDBLOCK)
		{
			splx(x);
			return(error);
		}
	}

	switch (cmd)
	{
	case NICCY_DEBUG:
		data[0]= 0x50;
		bcopy(sc->sc_state_ind,data+1,8);
		break;
	case NICCY_LOAD:
		{
			struct head    *head = (struct head *) data;
			int len, l, off;

			bzero(b, 22);
			b->h.Type = MD_DNL_MOD_REQ;
			sc->sc_type = head->typ;
			b->h.SubType = head->typ;
			b->h.DataLen = 12;
			bcopy(head->nam, b->Data, 8);
			bcopy(&head->len, &b->Data[8], 4);

			sc->sc_flags |= LOAD_HEAD;
			sc->sc_stat = -1;
			while((error= snic_put_msg(unit,(Header *) b,22,6)) == EBUSY)
			{
				error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic1", 1);
				if (error != EWOULDBLOCK)
					break;
			}
			if(error == 0)
			{
				while (sc->sc_flags & LOAD_HEAD)
				{
					error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic2", 1);
					if (error != EWOULDBLOCK)
						break;
					error= 0;
				}
			}
			if (sc->sc_flags & 7)
				sc->sc_flags = (sc->sc_flags & ~7 ) | OPEN;
			if(error)
			{
				head->status = sc->sc_stat;
				splx(x);
				return (error);
			}

			len= head->d_len;
			off= 0;
			while(len > 0)
			{
				while(sc->sc_ostat || (sc->sc_gotack==0))
				{
					error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic7", 2);
					if (error != EWOULDBLOCK)
					{
						splx(x);
						return(error);
					}
				}
				bzero(b,10);
				b->h.Type = MD_DNL_MOD_DATA;
				sc->sc_type = head->typ;
				b->h.SubType = head->typ;
				l= min(len,512);
				len-= l;
				b->h.DataLen = l + 8;
				b->h.Number = dnlnum++;
				b->h.MoreData= len>0;
				bcopy(head->nam, b->Data, 8);
				if(error= copyin(head->data+off, b->Data+8, l))
				{
					splx(x);
					return(error);
				}
				off+= l;
				sc->sc_flags |= LOAD_DATA;
				sc->sc_stat = -1;

				while((error= snic_put_msg(unit,(Header *) b,b->h.DataLen+10,7)) == EBUSY)
				{
					error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic3", 1);
					if (error != EWOULDBLOCK)
						break;
				}
			}

			if(error == 0)
			{
				while (sc->sc_flags & LOAD_DATA)
				{
					error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic4", 1);
					if (error != EWOULDBLOCK)
						break;
					error= 0;
				}
			}
			if (sc->sc_flags & 7)
				sc->sc_flags = (sc->sc_flags & ~7 ) | OPEN;
			head->status = sc->sc_stat;
			splx(x);
			return (error);
		}
	case NICCY_SET_CLOCK:
		bzero(b,10);
		b->h.Type = MD_SET_CLOCK_REQ;
		b->h.DataLen = 14;
		bcopy(data, b->Data,14);
		while((error= snic_put_msg(unit,(Header *) b,24,8)) == EBUSY)
		{
			error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic5", 1);
			if (error != EWOULDBLOCK)
				break;
		}
		splx(x);
		return (error);
	case NICCY_SPY:
		bzero(b,10);
		b->h.Type = MD_MANUFACT_REQ;
		b->h.SubType = 18;
		b->h.DataLen = 1;
/* There are ilegal states. So I use them to toggle */
		if((data[0] == 0) && (old_spy == 0)) data[0]= 255;
		else if(data[0] && old_spy ) data[0]= 0;
		old_spy= b->Data[0]= data[0];
		while((error= snic_put_msg(unit,(Header *) b,11,9)) == EBUSY)
		{
			error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic6", 1);
			if (error != EWOULDBLOCK)
				break;
		}
		splx(x);
		return (error);
	case NICCY_RESET:
		bzero(b,10);
		b->h.Type = MD_RESET_REQ;
		while((error= snic_put_msg(unit,(Header *) b,10,9)) == EBUSY)
		{
			error = tsleep((caddr_t) sc, PZERO | PCATCH, "nic6", 1);
			if (error != EWOULDBLOCK)
				break;
		}
		sc->sc_flags|= LOAD_ENTITY;
		splx(x);
		return (error);

	default:
		error = ENODEV;
	}
	splx(x);
	return (error);
}

#define con_b3_req(unit,mb,pl)	en_q(unit,mb|BD_CONN_B3_REQ,0,pl,0,NULL)
#define con_act_resp(unit,pl)	en_q(unit,DD_CONN_ACT_RSP,0, pl,0,NULL)
#define discon_resp(sc,pl)	en_q(unit,DD_DISC_RSP,0, pl,0,NULL)
#define inf_resp(unit,pl)	en_q(unit,DD_INFO_RSP,0, pl,0,NULL)
#define listen_b3_req(unit,mb,pl) en_q(unit,mb|BD_LIST_B3_REQ,0,pl,0,NULL)
#define con_resp(unit,pl,rea)	en_q(unit,DD_CONN_RSP,0, pl, 1,(u_char *) &rea)

static int
en_q(int unit, int t, int st, int pl, int l, u_char *val)
{
	struct snic_softc * sc= &snic_sc[unit];
	Buffer *b= &sc->sc_omsg;
	int error= 0;

	if(b->h.Type)
        {
                return(EBUSY);
        }
	bzero(b,10);
if(( t >= 0x80) && CHAN(pl) && ((t & 0x40) == 0))
printf("?%x %x",t,pl);
if(t>=0x40)
printf("S%x %x",t,pl);
	
	b->h.Type = t;
	b->h.SubType = st;
	b->h.PLCI = pl;
	if(l)
	{
		b->h.DataLen= l;
		bcopy(val,b->Data,l);
	}

	if((error= snic_put_msg(unit,(Header *) b,10+l,13)) == EBUSY)
	{
		sc->sc_ostat|= 0x200;
		return(0);
	}
	return(error);
}

static int
reset_plci(int w, chan_t * chan, short p)
{
	isdn_ctrl_t    *ctrl;

	if (p == -1)
		return (-1);

	if(chan == NULL)
		return(p);

	ctrl = &isdn_ctrl[chan->ctrl];
	if(chan->plci == p)
	{
		if (ISBUSY(ctrl->appl))
		{
			isdn_disconn_ind(ctrl->appl);
			isdn_appl[ctrl->appl].ctrl = -1;
			isdn_appl[ctrl->appl].state = 0;
		}
		ctrl->appl = -1;
		ctrl->o_len = -1;
		chan->plci = -1;
		chan->ncci = -1;
		chan->state = DISCON;
		chan->o_buf.h.Type= 0;
	}
	return (p);
}

static int
sel_b2_prot_req(int unit, int c, int pl, dlpd_t * dlpd)
{
	return(en_q(unit, (c ? 0x40 : 0)| BD_SEL_PROT_REQ, 2, pl, sizeof(dlpd_t), (u_char *) dlpd));
}

static int
sel_b3_prot_req(int unit, int mb, u_short pl, ncpd_t * ncpd)
{
	return(en_q(unit, mb | BD_SEL_PROT_REQ, 3, pl, sizeof(ncpd_t), (u_char *) ncpd));
}

static int
discon_req(int w, int unit , int pl, int rea, int err)
{
	if((pl == 0) || (pl == -1))
		return(0);
	return(en_q(unit, DD_DISC_REQ,0, pl, 1, (u_char *) &rea));
}

static int
state_ind(int unit, int api, int spv)
{
	u_char	buf[3];

	buf[0]= unit; buf[1]= api; buf[2]= spv;
	return(en_q(unit, MD_STATE_IND,0, 0, 3, buf));
}

static int
con_b3_resp(int unit, int mb, u_short ncci, u_short pl, u_char reject)
{
	u_char          buf[32];
	int             l = 4;

	bzero(buf, 32);
	*(u_short *) buf = ncci;
	buf[2] = reject;
	buf[3] = 0; /* ncpi ??? */
	l += 15;
	return(en_q(unit, mb | BD_CONN_B3_RSP,0, pl, l, buf));
}

int
snic_connect(int cn, int ap, int b_channel, int inf_mask, int out_serv
	    ,int out_serv_add, int src_subadr, unsigned ad_len
	    ,char *dest_addr, int spv)
{
	char            buf[128];

	if (ad_len > 118)
		return (-1);

	buf[0] = spv ? 0x53 : 0;
	buf[1] = b_channel;
	if (spv)
		inf_mask |= 0x40000000;
	*(u_long *) & buf[2] = inf_mask;
	buf[6] = out_serv;
	buf[7] = out_serv_add;
	buf[8] = src_subadr;
	buf[9] = ad_len;
	bcopy(dest_addr, &buf[10], ad_len);
	return (en_q(isdn_ctrl[cn].unit, DD_CONN_REQ, 0, MK_APPL(ap), ad_len + 10, buf));
}

int
snic_listen(int cn, int ap, int inf_mask, int subadr_mask, int si_mask, int spv)
{
	u_short         sbuf[4];

	if (spv)
		inf_mask |= 0x40000000;
	*(u_long *) sbuf = inf_mask;
	sbuf[2] = subadr_mask;
	sbuf[3] = si_mask;
	return (en_q(isdn_ctrl[cn].unit, DD_LISTEN_REQ, 0, MK_APPL(ap), 8, (u_char *) sbuf));
}

int
snic_disconnect(int cn, int rea)
{
	isdn_ctrl_t    *ctrl = &isdn_ctrl[cn];
	chan_t         *chan = &snic_sc[ctrl->unit].sc_chan[C_CHAN(cn)];
	int             p, err;
	u_char		buf[16];

	if(chan->ncci != -1)
	{
		bzero(buf,16);
		*(u_short *) buf = chan->ncci;
		err= en_q(ctrl->unit, (C_CHAN(cn)?0x40:0)|BD_DISC_B3_REQ, 0
				, chan->plci, 3+sizeof(ncpi_t), buf);
		if((err==0) && (ctrl->o_len == 0))
			ctrl->o_len= -1;
		return(err);
	}
	p = chan->plci;
	if ((p == 0) || (p == -1))
		return (ENODEV);

	err= en_q(ctrl->unit, DD_DISC_REQ, 0, p, 1, (u_char *) &rea);
	if((err==0) && (ctrl->o_len == 0))
		ctrl->o_len= -1;
	return(err);
}

int
snic_accept(int cn, int an, int rea)
{
	isdn_ctrl_t    *ctrl = &isdn_ctrl[cn];
	struct snic_softc *sc = &snic_sc[ctrl->unit];
	chan_t         *chan = &sc->sc_chan[C_CHAN(cn)];
	isdn_appl_t    *appl  = &isdn_appl[an];

	if(ISFREE(ctrl->appl))
		return(ENODEV);

	if (rea)
	{
		ctrl->appl= -1;
		return(discon_req(1, ctrl->unit, chan->plci, rea, 0));
	}
	ctrl->appl= an;
	ctrl->lastact = time.tv_sec;
	appl->ctrl= cn;
	appl->state= 4;

	return(sel_b2_prot_req(ctrl->unit, C_CHAN(cn), chan->plci, &appl->dlpd));
}

int
snic_output(int cn)
{
	isdn_ctrl_t    *ctrl = &isdn_ctrl[cn];
	struct snic_softc *sc = &snic_sc[ctrl->unit];
	chan_t         *chan = &sc->sc_chan[C_CHAN(cn)];
	int		len= ctrl->o_len;
	Buffer *b= &chan->o_buf;
	int error= 0;

	if (sc->sc_state_ind[1] || (chan->ncci == -1))
		return (ENODEV);

	if(chan->state != IDLE)
		return(EBUSY);
	chan->state= WAITING;

	bzero(b,10);
	
	b->h.Type = BD_DATA_B3_REQ;
	if(C_CHAN(cn)) b->h.Type |= 0x40;
	b->h.PLCI = chan->plci;
	b->h.DataLen= len+5;
	*(u_short *) b->Data = chan->ncci;
	*(u_short *) &b->Data[2] = 0;
	b->h.Number = b->Data[4] = chan->msg_nr++;

	chan->state = ACTIVE;
	ctrl->lastact = time.tv_sec;

	if((error= snic_put_msg(ctrl->unit,(Header *) b,15+len,14)) == EBUSY)
	{
		sc->sc_ostat|= C_CHAN(cn)?0x800:0x400;
		chan->state= WAITING;
		return(0);
	}
	return(error);
}

static void
badstate(Header *h, int n)
{
	int i;
	u_char *p= (u_char *)h;
	printf("Niccy: not implemented %x.%x len %d at %d", h->Type,
		h->SubType, h->DataLen,n);
	if(h->DataLen)
	{
		p+= 10;
		for(i=0; i < h->DataLen ; i++) printf(" %x",p[i]);
	}
	printf("\n");
}

unsigned  SavMsgTyp;

static void
snic_interupt(unsigned unit)
{
	struct snic_softc * sc= &snic_sc[unit&0xff];
	Buffer *msg;
	chan_t         *chan;
	u_short        n, mb, c, pl, err = 0;
	isdn_ctrl_t    *ctrl;
	isdn_appl_t    *appl;
	int error= 0;

	msg = &sc->sc_imsg;
	chan= NULL;
	ctrl= NULL;
	appl= NULL;

SavMsgTyp= msg->h.Type;

	if(sc->sc_istat & 2)
		return;

	if(sc->sc_ostat&0xff)
	{
		sc->sc_istat|= 0x101;
		if(sc->sc_istat&0x200)
			return;
		sc->sc_istat|= 0x200;
		timeout(snic_timout,unit,2);
		return;
	}

	mb= 0;
	pl = msg->h.PLCI;
	if(pl && (msg->h.Type >= 0x40) && (msg->h.Type < 0xfd) && (msg->h.Type != 0x47))
	{
		if ((c = CHAN(pl)) < 2)
		{
			chan = &sc->sc_chan[c];
			ctrl = &isdn_ctrl[chan->ctrl];
		} else
		{
			c = 0xffff;
			chan= NULL;
			ctrl= NULL;
		}

		if(ctrl && (ctrl->appl & 0xC0) == 0)
			appl= &isdn_appl[ctrl->appl];
		else if( APPL(pl) < 0x30)
			appl = &isdn_appl[APPL(pl)];
		else if( APPL(pl) < 0x40)
			appl= NULL;
		else goto fin;

		if(msg->h.Type >= 0x80)
		{
			mb= msg->h.Type & 0x40;
			msg->h.Type &= 0xbf;
		}
	}
SavMsgTyp|= 0x100;

if(msg->h.Type>=0x40)
printf("I%x %x %x",msg->h.Type,pl,mb);
	switch (msg->h.Type)
	{
	case 0x01:		/* INIT IND */
	case 0x15:		/* POLL IND */
		error= en_q(unit,msg->h.Type|0x20,0,0,0,NULL);
		break;
	case 0x04:		/* DNL MOD CONF */
		sc->sc_stat = msg->Data[0];
		if (sc->sc_flags & 7)
			sc->sc_flags = (sc->sc_flags & ~7) | OPEN;
		break;
	case 0x06:		/* DNL MOD IND */
		sc->sc_stat = msg->Data[0];
		error= en_q(unit,msg->h.Type|0x20,sc->sc_type,0,1, &msg->Data[1]);
		if(sc->sc_flags & LOAD_ENTITY)
		{
			sc->sc_istat= sc->sc_ostat= 2;
			timeout(snic_timout,unit,hz);
			msg->h.Type= 0;
			return;
		}
		if (sc->sc_flags)
			sc->sc_flags = OPEN;
		break;
	case 0x0e:		/* SET CLOCK CONF */
		error= state_ind(unit,1,0);
		break;
	case 0x16:		/* STATE IND */
		if(sc->sc_flags & LOAD_ENTITY)
		{
			if(sc->sc_flags & 7)
				sc->sc_flags = OPEN;
			else sc->sc_flags= 0;
		}
		bcopy( msg->Data, sc->sc_state_ind, 8);
		error= en_q(unit,msg->h.Type|0x20,0,0,0,NULL);
		break;
	case 0x17:		/* STATE RESP */
		bcopy( msg->Data, sc->sc_state_ind, 8);
		break;
	case 0x1e:              /* MANUFACT CONF */
		if(msg->h.SubType == 18)
			break;
		badstate(&msg->h,1);
		break;
	case 0x1f:              /* MANUFACT IND */
		if(msg->h.SubType == 19)
		{
			isdn_input(ispy_applnr, msg->h.DataLen, msg->Data,0);
			error= en_q(unit,msg->h.Type|0x20,msg->h.SubType,0,0,NULL);
			break;
		}
		badstate(&msg->h,2);
		break;
	case 0x40:		/* CONNECT CONF */
		err = *(u_short *) msg->Data;
		if (err || (appl == NULL) || (chan == NULL) || (ctrl == NULL))
		{
			if(chan) reset_plci(3, chan, pl);
			if(appl) appl->state= 0;
			break;
		}
		if (ISBUSY(ctrl->appl))
		{
			error= discon_req(2, unit, pl, 0, 0);
			break;
		}
		chan->plci = pl;
		chan->msg_nr = 0;
		chan->ncci = -1;
		ctrl->lastact = time.tv_sec;
		ctrl->appl = APPL(pl);
		appl->ctrl = chan->ctrl;
		ctrl->islisten= 0;
		chan->state = DIAL;
		appl->state= 3;
		break;

	case 0x41:		/* CONNECT IND */
		if (ISBUSY(ctrl->appl))
		{
			error= discon_req(3, unit, pl, 0, 0);
			break;
		}
		chan->plci = pl;
		chan->msg_nr = 0;
		chan->ncci = -1;
		ctrl->lastact = time.tv_sec;
		ctrl->appl = 0x7f;
		ctrl->islisten= 1;
		chan->state = CALLED;
		msg->Data[msg->Data[3] + 4] = 0;
		isdn_accept_con_ind(APPL(pl), chan->ctrl, msg->Data[0], msg->Data[1]
		       ,msg->Data[2], msg->Data[3], (char *) &msg->Data[4]);
		break;

	case 0x42:		/* CONNECT ACTIVE IND */
		error= con_act_resp(unit, pl);
		if (IS_LISTEN(pl))
		{
			isdn_conn_ind(ctrl->appl,chan->ctrl,0);
			break;
		}
		isdn_conn_ind(APPL(pl),chan->ctrl,1);
		chan->state = CONNECT;
		ctrl->appl = APPL(pl);
		appl->ctrl = chan->ctrl;
		break;

	case 0x43:		/* DISCONNECT CONF */
		reset_plci(4, chan, pl);
		break;

	case 0x44:		/* DISCONNECT IND */
		error= discon_resp(unit, reset_plci(5, chan, pl));
		break;

	case 0x47:		/* LISTEN CONF */
		isdn_state = *(u_short *) msg->Data;
		break;

	case 0x4a:		/* INFO IND */
		isdn_info(APPL(pl),*(u_short *)msg->Data, msg->Data[2], msg->Data+3);
		error= inf_resp(unit, pl);
		break;
	case 0x80:	/* SELECT PROT CONF */
		err = *(u_short *) msg->Data;
		if (err)
		{
			error= discon_req(4, unit, pl, 0, err);
			break;
		}

		switch (msg->h.SubType)
		{
		case 2:/* SELECT B2 PROTOCOL */
			if(ISFREE(ctrl->appl))
				break;
			error= sel_b3_prot_req(unit, mb, pl, &isdn_appl[ctrl->appl].ncpd);
			break;

		case 3:/* SELECT B3 PROTOCOL */
			if (IS_DIAL(pl))
				error= con_b3_req(unit, mb, pl);
			else
				error= listen_b3_req(unit, mb, pl);
			break;
		}
		break;

	case 0x81:	/* LISTEN B3 CONF */
		err = *(u_short *) msg->Data;
		if (err)
		{
			error= discon_req(5, unit, pl, 0, err);
			break;
		}
		error= con_resp(unit, pl, err);
		break;

	case 0x82:	/* CONNECT B3 CONF */
		err = *(u_short *) (msg->Data + 2);
		n = *(u_short *) msg->Data;

		if (err)
		{
			error= discon_req(6, unit, pl, 0, err);
			break;
		}
		if(ISFREE(ctrl->appl))
			break;
		chan->ncci = n;
		chan->state = CONNECT;
		break;

	case 0x83:	/* CONNECT B3 IND */
		if(ISFREE(ctrl->appl))
			break;
		n = *(u_short *) msg->Data;
		chan->ncci = n;
		chan->state = CONNECT;
		error= con_b3_resp(unit, mb, n, pl, 0);
		break;

	case 0x84:	/* CONNECT B3 ACTIVE IND */
		if(ISFREE(ctrl->appl))
			break;
		if (chan->state < IDLE)
		{
			chan->state = IDLE;
			ctrl->o_len = 0;
			timeout(isdn_start_out,chan->ctrl,hz/5);
		}
		break;

	case 0x85:	/* DISCONNECT B3 CONF */
		if(ISBUSY(ctrl->appl))
			chan->state = ISDISCON;
		err = *(u_short *) (msg->Data + 2);
		if (err)
		{
			error= discon_req(7, unit, pl, 0, err);
			break;
		}
		break;
	case 0x86:	/* DISCONNECT B3 IND */
		if(ISBUSY(ctrl->appl))
			chan->state = ISDISCON;
		err = *(u_short *) (msg->Data + 2);
		error= discon_req(8, unit, pl, 0, err);
		break;

	case 0x88:	/* DATA B3 CONF */
		if(ISFREE(ctrl->appl))
			break;
		err = *(u_short *) (msg->Data + 2);
		if (err)
		{
printf("e%x\n",err);
			ctrl->send_err++;
			isdn_appl[ctrl->appl].send_err++;
		}
		chan->state = IDLE;
		chan->o_buf.h.Type= 0;
		ctrl->o_len = 0;
		isdn_start_out(chan->ctrl);
		break;

	case 0x89:	/* DATA B3 IND */
		if(ISFREE(ctrl->appl))
			break;
		if(isdn_input(ctrl->appl, msg->h.DataLen-5, msg->Data+5,ctrl->islisten))
			ctrl->lastact = time.tv_sec;
		break;

	default:
		badstate(&msg->h,3);
		break;
	}

fin:
	if(error)
	{
printf("x%x %x %x %x %x\n",error,msg->h.Type,sc->sc_istat,sc->sc_ostat,sc->sc_omsg.h.Type);
		sc->sc_istat|= 0x101;
		if(sc->sc_istat&0x200)
			return;
		sc->sc_istat|= 0x200;
		timeout(snic_timout,unit,2);
		return;
	}

	msg->h.Type= 0;
	if(snic_put_msg(unit,(Header *) &ack_msg,1,15))
		sc->sc_ostat|= 0x100;
	sc->sc_istat= 0x200;
	snic_get_msg(unit);
}

#endif				/* NSNIC > 0 */