simh-testsetgenerator/PDP11/pdp11_ry.c

/* pdp11_ry.c: RX211/RXV21/RX02 floppy disk simulator

   Copyright (c) 1993-2004, Robert M Supnik

   Permission is hereby granted, free of charge, to any person obtaining a
   copy of this software and associated documentation files (the "Software"),
   to deal in the Software without restriction, including without limitation
   the rights to use, copy, modify, merge, publish, distribute, sublicense,
   and/or sell copies of the Software, and to permit persons to whom the
   Software is furnished to do so, subject to the following conditions:

   The above copyright notice and this permission notice shall be included in
   all copies or substantial portions of the Software.

   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
   IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
   ROBERT M SUPNIK BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
   IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
   CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.

   Except as contained in this notice, the name of Robert M Supnik shall not
   be used in advertising or otherwise to promote the sale, use or other dealings
   in this Software without prior written authorization from Robert M Supnik.

   ry		RX211/RXV21/RX02 floppy disk

   30-Sep-04	RMS	Revised Unibus interface
   21-Mar-04	RMS	Added VAX support
   29-Dec-03	RMS	Added RXV21 support
   19-May-03	RMS	Revised for new conditional compilation scheme
   25-Apr-03	RMS	Revised for extended file support
   14-Mar-03	RMS	Fixed variable size interaction with save/restore
   03-Mar-03	RMS	Fixed autosizing
   12-Oct-02	RMS	Added autoconfigure support

   An RX02 diskette consists of 77 tracks, each with 26 sectors of 256B.
   Tracks are numbered 0-76, sectors 1-26.
*/

#if defined (VM_PDP10)					/* PDP10 version */
#include "pdp10_defs.h"
extern int32 int_req;
extern int32 int_vec[32];
#define DEV_DISI	DEV_DIS

#elif defined (VM_VAX)					/* VAX version */
#include "vax_defs.h"
extern int32 int_req[IPL_HLVL];
extern int32 int_vec[IPL_HLVL][32];
#define DEV_DISI	0

#else							/* PDP-11 version */
#include "pdp11_defs.h"
extern int32 int_req[IPL_HLVL];
extern int32 int_vec[IPL_HLVL][32];
#define DEV_DISI	DEV_DIS
#endif

#define RX_NUMTR	77				/* tracks/disk */
#define RX_M_TRACK	0377
#define RX_NUMSC	26				/* sectors/track */
#define RX_M_SECTOR	0177
#define RX_NUMBY	128
#define RX_SIZE		(RX_NUMTR * RX_NUMSC * RX_NUMBY)
#define RY_NUMBY	256				/* bytes/sector */
#define RY_SIZE		(RX_NUMTR * RX_NUMSC * RY_NUMBY)
#define RX_NUMDR	2				/* drives/controller */
#define RX_M_NUMDR	01
#define UNIT_V_WLK	(UNIT_V_UF)			/* write locked */
#define UNIT_V_DEN	(UNIT_V_UF + 1)			/* double density */
#define UNIT_V_AUTO	(UNIT_V_UF + 2)			/* autosize */
#define UNIT_WLK	(1u << UNIT_V_WLK)
#define UNIT_DEN	(1u << UNIT_V_DEN)
#define UNIT_AUTO	(1u << UNIT_V_AUTO)
#define UNIT_WPRT	(UNIT_WLK | UNIT_RO)		/* write protect */

#define IDLE		0				/* idle state */
#define RWDS		1				/* rw, sect next */
#define RWDT		2				/* rw, track next */
#define RWXFR		3				/* rw, transfer */
#define FEWC		4				/* fill empty, wc next */
#define FEBA		5				/* fill empty, ba next */
#define FEXFR		6				/* fill empty, transfer */
#define SDCNF		7				/* set dens, conf next */
#define SDXFR		8				/* set dens, transfer */
#define ESBA		9				/* ext sta, ba next */
#define ESXFR		10				/* ext sta, transfer */
#define CMD_COMPLETE	11				/* set done next */
#define INIT_COMPLETE	12				/* init compl next */

#define RYCS_V_FUNC	1				/* function */
#define RYCS_M_FUNC	7
#define  RYCS_FILL	0				/* fill buffer */
#define  RYCS_EMPTY	1				/* empty buffer */
#define  RYCS_WRITE	2				/* write sector */
#define  RYCS_READ	3				/* read sector */
#define  RYCS_SDEN	4				/* set density */
#define  RYCS_RYES	5				/* read status */
#define  RYCS_WRDEL	6				/* write del data */
#define  RYCS_ESTAT	7				/* read ext status */
#define RYCS_V_DRV	4				/* drive select */
#define RYCS_V_DONE	5				/* done */
#define RYCS_V_IE	6				/* int enable */
#define RYCS_V_TR	7				/* xfer request */
#define RYCS_V_DEN	8				/* density select */
#define RYCS_V_RY	11				/* RX02 flag */
#define RYCS_V_UAE	12				/* addr ext */
#define RYCS_M_UAE	03
#define RYCS_V_INIT	14				/* init */
#define RYCS_V_ERR	15				/* error */
#define RYCS_FUNC	(RYCS_M_FUNC << RYCS_V_FUNC)
#define RYCS_DRV	(1u << RYCS_V_DRV)
#define RYCS_DONE	(1u << RYCS_V_DONE)
#define RYCS_IE		(1u << RYCS_V_IE)
#define RYCS_TR		(1u << RYCS_V_TR)
#define RYCS_DEN	(1u << RYCS_V_DEN)
#define RYCS_RY		(1u << RYCS_V_RY)
#define RYCS_UAE	(RYCS_M_UAE << RYCS_V_UAE)
#define RYCS_INIT	(1u << RYCS_V_INIT)
#define RYCS_ERR	(1u << RYCS_V_ERR)
#define RYCS_IMP	(RYCS_ERR+RYCS_UAE+RYCS_DEN+RYCS_TR+RYCS_IE+\
			 RYCS_DONE+RYCS_DRV+RYCS_FUNC)
#define RYCS_RW		(RYCS_UAE+RYCS_DEN+RYCS_IE+RYCS_DRV+RYCS_FUNC)
#define RYCS_GETFNC(x)	(((x) >> RYCS_V_FUNC) & RYCS_M_FUNC)
#define RYCS_GETUAE(x)	(((x) >> RYCS_V_UAE) & RYCS_M_UAE)

#define RYES_CRC	00001				/* CRC error NI */
#define RYES_ID		00004				/* init done */
#define RYES_ACLO	00010				/* ACLO NI */
#define RYES_DERR	00020				/* density err */
#define RYES_DDEN	00040				/* drive density */
#define RYES_DD		00100				/* deleted data */
#define RYES_DRDY	00200				/* drive ready */
#define RYES_USEL	00400				/* unit selected */
#define RYES_WCO	02000				/* wc overflow */
#define RYES_NXM	04000				/* nxm */
#define RYES_ERR	(RYES_NXM|RYES_WCO|RYES_DERR|RYES_ACLO|RYES_CRC)

#define TRACK u3					/* current track */
#define CALC_DA(t,s,b)	(((t) * RX_NUMSC) + ((s) - 1)) * b

int32 ry_csr = 0;					/* control/status */
int32 ry_dbr = 0;					/* data buffer */
int32 ry_esr = 0;					/* error status */
int32 ry_ecode = 0;					/* error code */
int32 ry_track = 0;					/* desired track */
int32 ry_sector = 0;					/* desired sector */
int32 ry_ba = 0;					/* bus addr */
int32 ry_wc = 0;					/* word count */
int32 ry_state = IDLE;					/* controller state */
int32 ry_stopioe = 1;					/* stop on error */
int32 ry_cwait = 100;					/* command time */
int32 ry_swait = 10;					/* seek, per track */
int32 ry_xwait = 1;					/* tr set time */
uint8 rx2xb[RY_NUMBY] = { 0 };				/* sector buffer */

DEVICE ry_dev;
t_stat ry_rd (int32 *data, int32 PA, int32 access);
t_stat ry_wr (int32 data, int32 PA, int32 access);
t_stat ry_svc (UNIT *uptr);
t_stat ry_reset (DEVICE *dptr);
t_stat ry_boot (int32 unitno, DEVICE *dptr);
void ry_done (int esr_flags, int new_ecode);
t_stat ry_set_size (UNIT *uptr, int32 val, char *cptr, void *desc);
t_stat ry_attach (UNIT *uptr, char *cptr);

/* RY11 data structures

   ry_dev	RY device descriptor
   ry_unit	RY unit list
   ry_reg	RY register list
   ry_mod	RY modifier list
*/

DIB ry_dib = { IOBA_RY, IOLN_RY, &ry_rd, &ry_wr,
		1, IVCL (RY), VEC_RY, { NULL } };

UNIT ry_unit[] = {
	{ UDATA (&ry_svc, UNIT_DEN+
	  UNIT_FIX+UNIT_ATTABLE+UNIT_BUFABLE+UNIT_MUSTBUF, RY_SIZE) },
	{ UDATA (&ry_svc, UNIT_DEN+
	  UNIT_FIX+UNIT_ATTABLE+UNIT_BUFABLE+UNIT_MUSTBUF, RY_SIZE) } };

REG ry_reg[] = {
	{ GRDATA (RYCS, ry_csr, DEV_RDX, 16, 0) },
	{ GRDATA (RYBA, ry_ba, DEV_RDX, 16, 0) },
	{ GRDATA (RYWC, ry_wc, DEV_RDX, 8, 0) },
	{ GRDATA (RYDB, ry_dbr, DEV_RDX, 16, 0) },
	{ GRDATA (RYES, ry_esr, DEV_RDX, 12, 0) },
	{ GRDATA (RYERR, ry_ecode, DEV_RDX, 8, 0) },
	{ GRDATA (RYTA, ry_track, DEV_RDX, 8, 0) },
	{ GRDATA (RYSA, ry_sector, DEV_RDX, 8, 0) },
	{ DRDATA (STAPTR, ry_state, 4), REG_RO },
	{ FLDATA (INT, IREQ (RY), INT_V_RY) },
	{ FLDATA (ERR, ry_csr, RYCS_V_ERR) },
	{ FLDATA (TR, ry_csr, RYCS_V_TR) },
	{ FLDATA (IE, ry_csr, RYCS_V_IE) },
	{ FLDATA (DONE, ry_csr, RYCS_V_DONE) },
	{ DRDATA (CTIME, ry_cwait, 24), PV_LEFT },
	{ DRDATA (STIME, ry_swait, 24), PV_LEFT },
	{ DRDATA (XTIME, ry_xwait, 24), PV_LEFT },
	{ BRDATA (SBUF, rx2xb, 8, 8, RY_NUMBY) },
	{ FLDATA (STOP_IOE, ry_stopioe, 0) },
	{ URDATA (CAPAC, ry_unit[0].capac, 10, T_ADDR_W, 0,
		  RX_NUMDR, REG_HRO | PV_LEFT) },
	{ GRDATA (DEVADDR, ry_dib.ba, DEV_RDX, 32, 0), REG_HRO },
	{ GRDATA (DEVVEC, ry_dib.vec, DEV_RDX, 16, 0), REG_HRO },
	{ NULL }  };

MTAB ry_mod[] = {
	{ UNIT_WLK, 0, "write enabled", "WRITEENABLED", NULL },
	{ UNIT_WLK, UNIT_WLK, "write locked", "LOCKED", NULL },
	{ (UNIT_DEN+UNIT_ATT), UNIT_ATT, "single density", NULL, NULL },
	{ (UNIT_DEN+UNIT_ATT), (UNIT_DEN+UNIT_ATT), "double density", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DEN+UNIT_ATT), 0, "single density", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DEN+UNIT_ATT), UNIT_DEN, "double density", NULL, NULL },
	{ (UNIT_AUTO+UNIT_ATT), UNIT_AUTO, "autosize", NULL, NULL },
	{ UNIT_AUTO, UNIT_AUTO, NULL, "AUTOSIZE", NULL },
	{ (UNIT_AUTO+UNIT_DEN), 0, NULL, "SINGLE", &ry_set_size },
	{ (UNIT_AUTO+UNIT_DEN), UNIT_DEN, NULL, "DOUBLE", &ry_set_size },
	{ MTAB_XTD|MTAB_VDV, 004, "ADDRESS", "ADDRESS",
		&set_addr, &show_addr, NULL },
	{ MTAB_XTD|MTAB_VDV, 0, "VECTOR", "VECTOR",
		&set_vec, &show_vec, NULL },
#if defined (VM_PDP11)
	{ MTAB_XTD | MTAB_VDV, 0, NULL, "AUTOCONFIGURE",
		&set_addr_flt, NULL, NULL },
#endif
	{ 0 }  };

DEVICE ry_dev = {
	"RY", ry_unit, ry_reg, ry_mod,
	RX_NUMDR, DEV_RDX, 20, 1, DEV_RDX, 8,
	NULL, NULL, &ry_reset,
	&ry_boot, &ry_attach, NULL,
	&ry_dib, DEV_FLTA | DEV_DISABLE | DEV_DISI | DEV_UBUS | DEV_Q18 };

/* I/O dispatch routine, I/O addresses 17777170 - 17777172

   17777170		floppy CSR
   17777172		floppy data register
*/

t_stat ry_rd (int32 *data, int32 PA, int32 access)
{
switch ((PA >> 1) & 1) {				/* decode PA<1> */
case 0:							/* RYCS */
	ry_csr = (ry_csr & RYCS_IMP) | RYCS_RY;		/* clear junk */
	*data = ry_csr;
	break;
case 1:							/* RYDB */
	*data = ry_dbr;					/* return data */
	break;  }					/* end switch PA */
return SCPE_OK;
}

t_stat ry_wr (int32 data, int32 PA, int32 access)
{
int32 drv;

switch ((PA >> 1) & 1) {				/* decode PA<1> */

/* Writing RYCS, three cases:
   1. Writing INIT, reset device
   2. Idle and writing new function
	- clear error, done, transfer ready, int req
	- save int enable, function, drive
	- start new function
   3. Otherwise, write IE and update interrupts
*/

case 0:							/* RYCS */
	ry_csr = (ry_csr & RYCS_IMP) | RYCS_RY;		/* clear junk */
	if (access == WRITEB) data = (PA & 1)?		/* write byte? */
		(ry_csr & 0377) | (data << 8): (ry_csr & ~0377) | data;
	if (data & RYCS_INIT) {				/* initialize? */
		ry_reset (&ry_dev);			/* reset device */
		return SCPE_OK;  }			/* end if init */
	if ((data & CSR_GO) && (ry_state == IDLE)) {	/* new function? */
		ry_csr = (data & RYCS_RW) | RYCS_RY;
		drv = ((ry_csr & RYCS_DRV)? 1: 0);	/* reselect drv */
		switch (RYCS_GETFNC (data)) {
		case RYCS_FILL: case RYCS_EMPTY:
			ry_state = FEWC;		/* state = get wc */
			ry_csr = ry_csr | RYCS_TR;	/* xfer is ready */
			break;
		case RYCS_SDEN:
			ry_state = SDCNF;		/* state = get conf */
			ry_csr = ry_csr | RYCS_TR;	/* xfer is ready */
			break;
		case RYCS_ESTAT:
			ry_state = ESBA;		/* state = get ba */
			ry_csr = ry_csr | RYCS_TR;	/* xfer is ready */
			break;
		case RYCS_READ: case RYCS_WRITE: case RYCS_WRDEL:
			ry_state = RWDS;		/* state = get sector */
			ry_csr = ry_csr | RYCS_TR;	/* xfer is ready */
			ry_esr = ry_esr & RYES_ID;	/* clear errors */
			ry_ecode = 0;
			break;
		default:
			ry_state = CMD_COMPLETE;	/* state = cmd compl */
			sim_activate (&ry_unit[drv], ry_cwait);
			break;  }			/* end switch func */
		return SCPE_OK;  }			/* end if GO */
	if ((data & RYCS_IE) == 0) CLR_INT (RY);
	else if ((ry_csr & (RYCS_DONE + RYCS_IE)) == RYCS_DONE)
		SET_INT (RY);
	ry_csr = (ry_csr & ~RYCS_RW) | (data & RYCS_RW);
	break;						/* end case RYCS */

/* Accessing RYDB, two cases:
   1. Write idle, write
   2. Write not idle and TR set, state dependent
*/

case 1:							/* RYDB */
	if ((PA & 1) || ((ry_state != IDLE) && ((ry_csr & RYCS_TR) == 0)))
		return SCPE_OK;				/* if ~IDLE, need tr */
	ry_dbr = data;					/* save data */
	if (ry_state != IDLE) {
		drv = ((ry_csr & RYCS_DRV)? 1: 0);	/* select drv */
		sim_activate (&ry_unit[drv], ry_xwait); /* sched event */
		ry_csr = ry_csr & ~RYCS_TR;  }		/* clear xfer */
	break;						/* end case RYDB */
	}						/* end switch PA */
return SCPE_OK;
}

/* Unit service; the action to be taken depends on the transfer state:

   IDLE		Should never get here
   FEWC		Save word count, set TR, set FEBA
   FEBA		Save bus address, set FEXFR
   FEXFR	Fill/empty buffer
   RWDS		Save sector, set TR, set RWDT
   RWDT		Save track, set RWXFR
   RWXFR	Read/write buffer
   SDCNF	Check confirmation, set SDXFR
   SDXFR	Erase disk
   CMD_COMPLETE	copy requested data to ir, finish command
   INIT_COMPLETE read drive 0, track 1, sector 1 to buffer, finish command
*/

t_stat ry_svc (UNIT *uptr)
{
int32 i, t, func, bps;
static uint8 estat[8];
uint32 ba, da;
int8 *fbuf = uptr->filebuf;

func = RYCS_GETFNC (ry_csr);				/* get function */
bps = (ry_csr & RYCS_DEN)? RY_NUMBY: RX_NUMBY;		/* get sector size */
ba = (RYCS_GETUAE (ry_csr) << 16) | ry_ba;		/* get mem addr */
switch (ry_state) {					/* case on state */

case IDLE:						/* idle */
	return SCPE_IERR;
case FEWC:						/* word count */
	ry_wc = ry_dbr & 0377;				/* save WC */
	ry_csr = ry_csr | RYCS_TR;			/* set TR */
	ry_state = FEBA;				/* next state */
	return SCPE_OK;
case FEBA:						/* buffer address */
	ry_ba = ry_dbr;					/* save buf addr */
	ry_state = FEXFR;				/* next state */
	sim_activate (uptr, ry_cwait);			/* schedule xfer */
	return SCPE_OK;
case FEXFR:						/* transfer */
	if ((ry_wc << 1) > bps) {			/* wc too big? */
		ry_done (RYES_WCO, 0230);		/* error */
		break;  }
	if (func == RYCS_FILL) {			/* fill? read */
		for (i = 0; i < RY_NUMBY; i++) rx2xb[i] = 0;
		t = Map_ReadB (ba, ry_wc << 1, rx2xb);  }
	else t = Map_WriteB (ba, ry_wc << 1, rx2xb);
	ry_wc = t >> 1;					/* adjust wc */
	ry_done (t? RYES_NXM: 0, 0);			/* done */
	break;

case RWDS:						/* wait for sector */
	ry_sector = ry_dbr & RX_M_SECTOR;		/* save sector */
	ry_csr = ry_csr | RYCS_TR;			/* set xfer */
	ry_state = RWDT;				/* advance state */
	return SCPE_OK;
case RWDT:						/* wait for track */
	ry_track = ry_dbr & RX_M_TRACK;			/* save track */
	ry_state = RWXFR;				/* next state */
	sim_activate (uptr,				/* sched xfer */
		ry_swait * abs (ry_track - uptr->TRACK));
	return SCPE_OK;
case RWXFR:						/* read/write */
	if ((uptr->flags & UNIT_BUF) == 0) {		/* not buffered? */
		ry_done (0, 0110);			/* done, error */
		return IORETURN (ry_stopioe, SCPE_UNATT);  }
	if (ry_track >= RX_NUMTR) {			/* bad track? */
		ry_done (0, 0040);			/* done, error */
		break;  }
	uptr->TRACK = ry_track;				/* now on track */
	if ((ry_sector == 0) || (ry_sector > RX_NUMSC)) {	/* bad sect? */
		ry_done (0, 0070);			/* done, error */
		break;  }
	if (((uptr->flags & UNIT_DEN) != 0) ^
	    ((ry_csr & RYCS_DEN) != 0)) {		/* densities agree? */
		ry_done (RYES_DERR, 0240);		/* no, error */
		break;  }
	da = CALC_DA (ry_track, ry_sector, bps);	/* get disk address */
	if (func == RYCS_WRDEL) ry_esr = ry_esr | RYES_DD;	/* del data? */
	if (func == RYCS_READ) {			/* read? */
		for (i = 0; i < bps; i++)
		    rx2xb[i] = fbuf[da + i];  }
	else {	if (uptr->flags & UNIT_WPRT) {		/* write and locked? */
		    ry_done (0, 0100);			/* done, error */
		    break;  }
		for (i = 0; i < bps; i++)		/* write */
		    fbuf[da + i] = rx2xb[i];
		da = da + bps;
		if (da > uptr->hwmark) uptr->hwmark = da;  }
	ry_done (0, 0);					/* done */
	break;

case SDCNF:						/* confirm set density */
	if ((ry_dbr & 0377) != 0111) {			/* confirmed? */
		ry_done (0, 0250);			/* no, error */
		break;  }
	ry_state = SDXFR;				/* next state */
	sim_activate (uptr, ry_cwait * 100);		/* schedule operation */
	break;
case SDXFR:						/* erase disk */
	for (i = 0; i < (int32) uptr->capac; i++) fbuf[i] = 0;
	uptr->hwmark = (uint32) uptr->capac;
	if (ry_csr & RYCS_DEN) uptr->flags = uptr->flags | UNIT_DEN;
	else uptr->flags = uptr->flags & ~UNIT_DEN;
	ry_done (0, 0);
	break;

case ESBA:
	ry_ba = ry_dbr;					/* save WC */
	ry_state = ESXFR;				/* next state */
	sim_activate (uptr, ry_cwait);			/* schedule xfer */
	return SCPE_OK;
case ESXFR:
	estat[0] = ry_ecode;				/* fill 8B status */
	estat[1] = ry_wc;
	estat[2] = ry_unit[0].TRACK;
	estat[3] = ry_unit[1].TRACK;
	estat[4] = ry_track;
	estat[5] = ry_sector;
	estat[6] = ((ry_csr & RYCS_DRV)? 0200: 0) |
		   ((ry_unit[1].flags & UNIT_DEN)? 0100: 0) |
		   ((uptr->flags & UNIT_ATT)? 0040: 0) |
		   ((ry_unit[0].flags & UNIT_DEN)? 0020: 0) |
		   ((ry_csr & RYCS_DEN)? 0001: 0);
	estat[7] = uptr->TRACK;
	t = Map_WriteB (ba, 8, estat);			/* DMA to memory */
	ry_done (t? RYES_NXM: 0, 0);			/* done */
	break;

case CMD_COMPLETE:					/* command complete */
	ry_done (0, 0);
	break;

case INIT_COMPLETE:					/* init complete */
	ry_unit[0].TRACK = 1;				/* drive 0 to trk 1 */
	ry_unit[1].TRACK = 0;				/* drive 1 to trk 0 */
	if ((uptr->flags & UNIT_BUF) == 0) {		/* not buffered? */
		ry_done (RYES_ID, 0010);		/* init done, error */
		break;	}
	da = CALC_DA (1, 1, bps);			/* track 1, sector 1 */
	for (i = 0; i < bps; i++)			/* read sector */
		rx2xb[i] = fbuf[da + i];
	ry_done (RYES_ID, 0);				/* set done */
	if ((ry_unit[1].flags & UNIT_ATT) == 0) ry_ecode = 0020;
	break;  }					/* end case state */

return SCPE_OK;
}

/* Command complete.  Set done and put final value in interface register,
   request interrupt if needed, return to IDLE state.
*/

void ry_done (int32 esr_flags, int32 new_ecode)
{
int32 drv = (ry_csr & RYCS_DRV)? 1: 0;

ry_state = IDLE;					/* now idle */
ry_csr = ry_csr | RYCS_DONE;				/* set done */
if (ry_csr & CSR_IE) SET_INT (RY);			/* if ie, intr */
ry_esr = (ry_esr | esr_flags) & ~(RYES_USEL|RYES_DDEN|RYES_DRDY);
if (drv) ry_esr = ry_esr | RYES_USEL;			/* updates RYES */
if (ry_unit[drv].flags & UNIT_ATT) {
	ry_esr = ry_esr | RYES_DRDY;
	if (ry_unit[drv].flags & UNIT_DEN)
		ry_esr = ry_esr | RYES_DDEN;  }
if ((new_ecode > 0) || (ry_esr & RYES_ERR))		/* test for error */
	ry_csr = ry_csr | RYCS_ERR;
ry_ecode = new_ecode;					/* update ecode */
ry_dbr = ry_esr;					/* update RYDB */
return;
}

/* Device initialization.  The RY is one of the few devices that schedules
   an I/O transfer as part of its initialization.
*/

t_stat ry_reset (DEVICE *dptr)
{
ry_csr = ry_dbr = 0;					/* clear registers */
ry_esr = ry_ecode = 0;					/* clear error */
ry_ba = ry_wc = 0;					/* clear wc, ba */
ry_track = ry_sector = 0;				/* clear trk, sector */
ry_state = IDLE;					/* ctrl idle */
CLR_INT (RY);						/* clear int req */
sim_cancel (&ry_unit[1]);				/* cancel drive 1 */
if (dptr->flags & UNIT_DIS) sim_cancel (&ry_unit[0]);	/* disabled? */
else if (ry_unit[0].flags & UNIT_BUF)  {		/* attached? */
	ry_state = INIT_COMPLETE;			/* yes, sched init */
	sim_activate (&ry_unit[0], ry_swait * abs (1 - ry_unit[0].TRACK));  }
else ry_done (RYES_ID, 0010);				/* no, error */
return auto_config (0, 0);				/* run autoconfig */
}

/* Attach routine */

t_stat ry_attach (UNIT *uptr, char *cptr)
{
uint32 sz;
t_stat r;

r = attach_unit (uptr, cptr);
if (r != SCPE_OK) return r;
if ((uptr->flags & UNIT_AUTO) && (sz = sim_fsize (uptr->fileref))) {
	if (sz > RX_SIZE) uptr->flags = uptr->flags | UNIT_DEN;
	else uptr->flags = uptr->flags & ~UNIT_DEN;  }
uptr->capac = (uptr->flags & UNIT_DEN)? RY_SIZE: RX_SIZE;
return SCPE_OK;
}

/* Set size routine */

t_stat ry_set_size (UNIT *uptr, int32 val, char *cptr, void *desc)
{
if (uptr->flags & UNIT_ATT) return SCPE_ALATT;
uptr->capac = val? RY_SIZE: RX_SIZE;
return SCPE_OK;
}

/* Device bootstrap */

#if defined (VM_PDP11)

#define BOOT_START	02000				/* start */
#define BOOT_ENTRY	(BOOT_START + 002)		/* entry */
#define BOOT_UNIT	(BOOT_START + 010)		/* unit number */
#define BOOT_CSR	(BOOT_START + 026)		/* CSR */
#define BOOT_LEN	(sizeof (boot_rom) / sizeof (int16))

static const uint16 boot_rom[] = {
	042131,				/* "YD" */
	0012706, BOOT_START,		/*  MOV #boot_start, SP */
	0012700, 0000000,		/*  MOV #unit, R0	; unit number */
	0010003,			/*  MOV R0, R3 */
	0006303,			/*  ASL R3 */
	0006303,			/*  ASL R3 */
	0006303,			/*  ASL R3 */
	0006303,			/*  ASL R3 */
	0012701, 0177170,		/*  MOV #RYCS, R1	; csr */
	0005002,			/*  CLR R2		; ba */
	0005004,			/*  CLR R4		; density */
	0012705, 0000001,		/*  MOV #1, R5		; sector */
	0005104,			/* DN: COM R4		; compl dens */
	0042704, 0177377,		/*  BIC #177377, R4	; clr rest */
	0032711, 0000040,		/* RD: BIT #40, (R1)	; ready? */
	0001775,			/*  BEQ .-4 */
	0012746, 0000007,		/*  MOV #READ+GO, -(SP) */
	0050416,			/*  BIS R4, (SP)	; or density */
	0012611,			/*  MOV (SP)+, (R1)	; read & go */
	0105711,			/*  TSTB (R1)		; xfr ready? */
	0100376,			/*  BPL .-2 */
	0010561, 0000002,		/*  MOV R5, 2(R1)	; sector */
	0105711,			/*  TSTB (R1)		; xfr ready? */
	0100376,			/*  BPL .-2 */
	0012761, 0000001, 0000002,	/*  MOV #1, 2(R1)	; track */
	0032711, 0000040,		/*  BIT #40, (R1)	; ready? */
	0001775,			/*  BEQ .-4 */
	0005711,			/*  TST (R1)		; error? */
	0100003,			/*  BEQ OK */
	0005704,			/*  TST R4		; single? */
	0001346,			/*  BNE DN		; no, try again */
	0000000,			/*  HALT		; dead */
	0012746, 0000003,		/* OK: MOV #EMPTY+GO, -(SP); empty & go */
	0050416,			/*  BIS R4, (SP)	; or density */
	0012611,			/*  MOV (SP)+, (R1)	; read & go */
	0105711,			/*  TSTB (R1)		; xfr, done? */
	0001776,			/*  BPL .-2 */
	0012746, 0000100,		/*  MOV #100, -(SP)	; assume sd */
	0005704,			/*  TST R4		; test dd */
	0001401,			/*  BEQ .+4 */
	0006316,			/*  ASL (SP)		; dd, double */
	0011661, 0000002,		/*  MOV (SP), 2(R1)	; wc */
	0105711,			/*  TSTB (R1)		; xfr, done? */
	0001776,			/*  BPL .-2 */
	0010261, 0000002,		/*  MOV R2, 2(R1)	; ba */
	0032711, 0000040,		/*  BIT #40, (R1)	; ready? */
	0001775,			/*  BEQ .-4 */
	0061602,			/*  ADD (SP), R2	; cvt wd to byte */
	0062602,			/*  ADD (SP)+, R2	; adv buf addr */
	0122525,			/*  CMPB (R5)+, (R5)+	; sect += 2 */
	0020527, 0000007,		/*  CMP R5, #7		; end? */
	0101716,			/*  BLOS RD		; read next */
	0005002,			/*  CLR R2 */
	0005003,			/*  CLR R3 */
	0012704, BOOT_START+020,	/*  MOV #START+20, R4 */
	0005005,			/*  CLR R5 */
	0005007				/*  CLR R7 */
};

t_stat ry_boot (int32 unitno, DEVICE *dptr)
{
int32 i;
extern int32 saved_PC;
extern uint16 *M;

if ((ry_unit[unitno & RX_M_NUMDR].flags & UNIT_DEN) == 0)
	return SCPE_NOFNC;
for (i = 0; i < BOOT_LEN; i++) M[(BOOT_START >> 1) + i] = boot_rom[i];
M[BOOT_UNIT >> 1] = unitno & RX_M_NUMDR;
M[BOOT_CSR >> 1] = ry_dib.ba & DMASK;
saved_PC = BOOT_ENTRY;
return SCPE_OK;
}

#else

t_stat ry_boot (int32 unitno, DEVICE *dptr)
{
return SCPE_NOFNC;
}

#endif