simh-testsetgenerator/NOVA/nova_dkp.c

/* nova_dkp.c: NOVA moving head disk simulator

   Copyright (c) 1993-2002, 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.

   dkp		moving head disk

   08-Oct-02	RMS	Added DIB
   06-Jan-02	RMS	Revised enable/disable support
   30-Nov-01	RMS	Added read only unit, extended SET/SHOW support
   24-Nov-01	RMS	Changed FLG, CAPAC to arrays
   26-Apr-01	RMS	Added device enable/disable support
   12-Dec-00	RMS	Added Eclipse support from Charles Owen
   15-Oct-00	RMS	Editorial changes
   14-Apr-99	RMS	Changed t_addr to unsigned
   15-Sep-97	RMS	Fixed bug in DIB/DOB for new disks
   15-Sep-97	RMS	Fixed bug in cylinder extraction (found by Charles Owen)
   10-Sep-97	RMS	Fixed bug in error reporting (found by Charles Owen)
   25-Nov-96	RMS	Defaulted to autosize
   29-Jun-96	RMS	Added unit disable support
*/

#include "nova_defs.h"

#define DKP_NUMDR	4				/* #drives */
#define DKP_NUMWD	256				/* words/sector */
#define UNIT_V_WLK	(UNIT_V_UF + 0)			/* write locked */
#define UNIT_V_DTYPE	(UNIT_V_UF + 1)			/* disk type */
#define UNIT_M_DTYPE	017
#define UNIT_V_AUTO	(UNIT_V_UF + 5)			/* autosize */
#define UNIT_WLK	(1 << UNIT_V_WLK)
#define UNIT_DTYPE	(UNIT_M_DTYPE << UNIT_V_DTYPE)
#define UNIT_AUTO	(1 << UNIT_V_AUTO)
#define GET_DTYPE(x)	(((x) >> UNIT_V_DTYPE) & UNIT_M_DTYPE)
#define FUNC		u3				/* function */
#define CYL		u4				/* on cylinder */
#define UNIT_WPRT	(UNIT_WLK | UNIT_RO)		/* write protect */

/* Unit, surface, sector, count register

   Original format: 2b, 6b, 4b, 4b
   Revised format:  2b, 5b, 5b, 4b
*/

#define	USSC_V_COUNT	0				/* count */
#define USSC_M_COUNT	017
#define USSC_V_OSECTOR	4				/* old: sector */
#define USSC_M_OSECTOR	017
#define USSC_V_OSURFACE	8				/* old: surface */
#define USSC_M_OSURFACE	077
#define USSC_V_NSECTOR	4				/* new: sector */
#define USSC_M_NSECTOR	037
#define USSC_V_NSURFACE	9				/* new: surface */
#define USSC_M_NSURFACE	037
#define USSC_V_UNIT	14				/* unit */
#define USSC_M_UNIT	03
#define USSC_UNIT	(USSC_M_UNIT << USSC_V_UNIT)
#define GET_COUNT(x)	(((x) >> USSC_V_COUNT) & USSC_M_COUNT)
#define GET_SECT(x,dt)	((drv_tab[dt].new)? \
			(((x) >> USSC_V_NSECTOR) & USSC_M_NSECTOR): \
			(((x) >> USSC_V_OSECTOR) & USSC_M_OSECTOR) )
#define GET_SURF(x,dt)	((drv_tab[dt].new)? \
			(((x) >> USSC_V_NSURFACE) & USSC_M_NSURFACE): \
			(((x) >> USSC_V_OSURFACE) & USSC_M_OSURFACE) )
#define GET_UNIT(x)	(((x) >> USSC_V_UNIT) & USSC_M_UNIT)

/* Flags, command, cylinder register

   Original format: 5b, 2b, 1b + 8b (surrounding command)
   Revised format:  5b, 2b, 9b
*/

#define FCCY_V_OCYL	0				/* old: cylinder */
#define FCCY_M_OCYL	0377
#define FCCY_V_OCMD	8				/* old: command */
#define FCCY_M_OCMD	3
#define FCCY_V_OCEX	10				/* old: cyl extend */
#define FCCY_OCEX	(1 << FCCY_V_OCEX)
#define FCCY_V_NCYL	0				/* new: cylinder */
#define FCCY_M_NCYL	0777
#define FCCY_V_NCMD	9				/* new: command */
#define FCCY_M_NCMD	3
#define  FCCY_READ	0
#define  FCCY_WRITE	1
#define  FCCY_SEEK	2
#define  FCCY_RECAL	3
#define FCCY_FLAGS	0174000				/* flags */
#define GET_CMD(x,dt)	((drv_tab[dt].new)? \
			(((x) >> FCCY_V_NCMD) & FCCY_M_NCMD): \
			(((x) >> FCCY_V_OCMD) & FCCY_M_OCMD) )
#define GET_CYL(x,dt)	((drv_tab[dt].new)? \
			(((x) >> FCCY_V_NCYL) & FCCY_M_NCYL): \
			((((x) >> FCCY_V_OCYL) & FCCY_M_OCYL) | \
			((dt != TYPE_D44)? 0: \
			(((x) & FCCY_OCEX) >> (FCCY_V_OCEX - FCCY_V_OCMD)))) )

/* Status */

#define STA_ERR		0000001				/* error */
#define STA_DLT		0000002				/* data late */
#define STA_CRC		0000004				/* crc error */
#define STA_UNS		0000010				/* unsafe */
#define STA_XCY		0000020				/* cross cylinder */
#define STA_CYL		0000040				/* nx cylinder */
#define STA_DRDY	0000100				/* drive ready */
#define STA_SEEK3	0000200				/* seeking unit 3 */
#define STA_SEEK2	0000400				/* seeking unit 2 */
#define STA_SEEK1	0001000				/* seeking unit 1 */
#define STA_SEEK0	0002000				/* seeking unit 0 */
#define STA_SKDN3	0004000				/* seek done unit 3 */
#define STA_SKDN2	0010000				/* seek done unit 2 */
#define STA_SKDN1	0020000				/* seek done unit 1 */
#define STA_SKDN0	0040000				/* seek done unit 0 */
#define STA_DONE	0100000				/* operation done */

#define STA_DYN		(STA_DRDY | STA_CYL)		/* set from unit */
#define STA_EFLGS	(STA_ERR | STA_DLT | STA_CRC | STA_UNS | \
			 STA_XCY | STA_CYL)		/* error flags */
#define STA_DFLGS	(STA_DONE | STA_SKDN0 | STA_SKDN1 | \
			 STA_SKDN2 | STA_SKDN3)		/* done flags */

#define GET_SA(cy,sf,sc,t) (((((cy)*drv_tab[t].surf)+(sf))* \
	drv_tab[t].sect)+(sc))

/* This controller supports many different disk drive types:

   type		#sectors/	#surfaces/	#cylinders/	new format?
		 surface	 cylinder	 drive

   floppy	8		1		77		no
   DS/DD floppy	16		2		77		yes
   Diablo 31	12		2		203		no
   6225		20		2		245		yes
   Century 111	6		10		203		no
   Diablo 44	12		4		408		no
   6099		32		4		192		yes
   6227		20		6		245		yes
   6070		24		4		408		yes	
   Century 114	12		20		203		no
   6103		32		8		192		yes
   4231		23		19		411		yes

   In theory, each drive can be a different type.  The size field in
   each unit selects the drive capacity for each drive and thus the
   drive type.  DISKS MUST BE DECLARED IN ASCENDING SIZE.
*/

#define TYPE_FLP	0
#define SECT_FLP	8
#define SURF_FLP	1
#define CYL_FLP		77
#define SIZE_FLP	(SECT_FLP * SURF_FLP * CYL_FLP * DKP_NUMWD)
#define NFMT_FLP	FALSE

#define TYPE_DSDD	1
#define SECT_DSDD	16
#define SURF_DSDD	2
#define CYL_DSDD	77
#define SIZE_DSDD	(SECT_DSDD * SURF_DSDD * CYL_DSDD * DKP_NUMWD)
#define NFMT_DSDD	TRUE

#define TYPE_D31	2
#define SECT_D31	12
#define SURF_D31	2
#define CYL_D31		203
#define SIZE_D31	(SECT_D31 * SURF_D31 * CYL_D31 * DKP_NUMWD)
#define NFMT_D31	FALSE

#define TYPE_6225	3
#define SECT_6225	20
#define SURF_6225	2
#define CYL_6225	245
#define SIZE_6225	(SECT_6225 * SURF_6225 * CYL_6225 * DKP_NUMWD)
#define NFMT_6225	TRUE

#define TYPE_C111	4
#define SECT_C111	6
#define SURF_C111	10
#define CYL_C111	203
#define SIZE_C111	(SECT_C111 * SURF_C111 * CYL_C111 * DKP_NUMWD)
#define NFMT_C111	FALSE

#define TYPE_D44	5
#define SECT_D44	12
#define SURF_D44	4
#define CYL_D44		408
#define SIZE_D44	(SECT_D44 * SURF_D44 * CYL_D44 * DKP_NUMWD)
#define NFMT_D44	FALSE

#define TYPE_6099	6
#define SECT_6099	32
#define SURF_6099	4
#define CYL_6099	192
#define SIZE_6099	(SECT_6099 * SURF_6099 * CYL_6099 * DKP_NUMWD)
#define NFMT_6099	TRUE	

#define TYPE_6227	7
#define SECT_6227	20
#define SURF_6227	6
#define CYL_6227	245
#define SIZE_6227	(SECT_6227 * SURF_6227 * CYL_6227 * DKP_NUMWD)
#define NFMT_6227	TRUE

#define TYPE_6070	8
#define SECT_6070	24
#define SURF_6070	4
#define CYL_6070		408
#define SIZE_6070	(SECT_6070 * SURF_6070 * CYL_6070 * DKP_NUMWD)
#define NFMT_6070	TRUE

#define TYPE_C114	9
#define SECT_C114	12
#define SURF_C114	20
#define CYL_C114	203
#define SIZE_C114	(SECT_C114 * SURF_C114 * CYL_C114 * DKP_NUMWD)
#define NFMT_C114	FALSE

#define TYPE_6103	10
#define SECT_6103	32
#define SURF_6103	8
#define CYL_6103	192
#define SIZE_6103	(SECT_6103 * SURF_6103 * CYL_6103 * DKP_NUMWD)
#define NFMT_6103	TRUE

#define TYPE_4231	11
#define SECT_4231	23
#define SURF_4231	19
#define CYL_4231	411
#define SIZE_4231	(SECT_4231 * SURF_4231 * CYL_4231 * DKP_NUMWD)
#define NFMT_4231	TRUE

struct drvtyp {
	int32	sect;					/* sectors */
	int32	surf;					/* surfaces */
	int32	cyl;					/* cylinders */
	int32	size;					/* #blocks */
	int32 new;					/* new format flag */
};

struct drvtyp drv_tab[] = {
	{ SECT_FLP,  SURF_FLP,  CYL_FLP,  SIZE_FLP,  NFMT_FLP },
	{ SECT_DSDD, SURF_DSDD, CYL_DSDD, SIZE_DSDD, NFMT_DSDD },
	{ SECT_D31,  SURF_D31,  CYL_D31,  SIZE_D31,  NFMT_D31 },
	{ SECT_6225, SURF_6225, CYL_6225, SIZE_6225, NFMT_6225 },
	{ SECT_C111, SURF_C111, CYL_C111, SIZE_C111, NFMT_C111 },
	{ SECT_D44,  SURF_D44,  CYL_D44,  SIZE_D44,  NFMT_D44 },
	{ SECT_6099, SURF_6099, CYL_6099, SIZE_6099, NFMT_6099 },
	{ SECT_6227, SURF_6227, CYL_6227, SIZE_6227, NFMT_6227 },
	{ SECT_6070, SURF_6070, CYL_6070, SIZE_6070, NFMT_6070 },
	{ SECT_C114, SURF_C114, CYL_C114, SIZE_C114, NFMT_C114 },
	{ SECT_6103, SURF_6103, CYL_6103, SIZE_6103, NFMT_6103 },
	{ SECT_4231, SURF_4231, CYL_4231, SIZE_4231, NFMT_4231 },
	{ 0 }  };

extern uint16 M[];
extern UNIT cpu_unit;
extern int32 int_req, dev_busy, dev_done, dev_disable;

int32 dkp_ma = 0;					/* memory address */
int32 dkp_ussc = 0;					/* unit/sf/sc/cnt */
int32 dkp_fccy = 0;					/* flags/cylinder */
int32 dkp_sta = 0;					/* status register */
int32 dkp_swait = 100;					/* seek latency */
int32 dkp_rwait = 100;					/* rotate latency */

DEVICE dkp_dev;
int32 dkp (int32 pulse, int32 code, int32 AC);
t_stat dkp_svc (UNIT *uptr);
t_stat dkp_reset (DEVICE *dptr);
t_stat dkp_boot (int32 unitno, DEVICE *dptr);
t_stat dkp_attach (UNIT *uptr, char *cptr);
t_stat dkp_go (void);
t_stat dkp_set_size (UNIT *uptr, int32 val, char *cptr, void *desc);

/* DKP data structures

   dkp_dev	DKP device descriptor
   dkp_unit	DKP unit list
   dkp_reg	DKP register list
   dkp_mod	DKP modifier list
*/

DIB dkp_dib = { DEV_DKP, INT_DKP, PI_DKP, &dkp };

UNIT dkp_unit[] = {
	{ UDATA (&dkp_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+UNIT_AUTO+
		UNIT_ROABLE+(TYPE_D31 << UNIT_V_DTYPE), SIZE_D31) },
	{ UDATA (&dkp_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+UNIT_AUTO+
		UNIT_ROABLE+(TYPE_D31 << UNIT_V_DTYPE), SIZE_D31) },
	{ UDATA (&dkp_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+UNIT_AUTO+
		UNIT_ROABLE+(TYPE_D31 << UNIT_V_DTYPE), SIZE_D31) },
	{ UDATA (&dkp_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+UNIT_AUTO+
		UNIT_ROABLE+(TYPE_D31 << UNIT_V_DTYPE), SIZE_D31) }  };

REG dkp_reg[] = {
	{ ORDATA (FCCY, dkp_fccy, 16) },
	{ ORDATA (USSC, dkp_ussc, 16) },
	{ ORDATA (STA, dkp_sta, 16) },
	{ ORDATA (MA, dkp_ma, 16) },
	{ FLDATA (INT, int_req, INT_V_DKP) },
	{ FLDATA (BUSY, dev_busy, INT_V_DKP) },
	{ FLDATA (DONE, dev_done, INT_V_DKP) },
	{ FLDATA (DISABLE, dev_disable, INT_V_DKP) },
	{ DRDATA (STIME, dkp_swait, 24), PV_LEFT },
	{ DRDATA (RTIME, dkp_rwait, 24), PV_LEFT },
	{ URDATA (CAPAC, dkp_unit[0].capac, 10, 31, 0,
		  DKP_NUMDR, PV_LEFT | REG_HRO) },
	{ NULL }  };

MTAB dkp_mod[] = {
	{ UNIT_WLK, 0, "write enabled", "WRITEENABLED", NULL },
	{ UNIT_WLK, UNIT_WLK, "write locked", "LOCKED", NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_FLP << UNIT_V_DTYPE) + UNIT_ATT,
		"6030 (floppy)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_DSDD << UNIT_V_DTYPE) + UNIT_ATT,
		"6097 (DS/DD floppy)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_D31 << UNIT_V_DTYPE) + UNIT_ATT,
		"4047 (Diablo 31)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_D44 << UNIT_V_DTYPE) + UNIT_ATT,
		"4234/6045 (Diablo 44)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_C111 << UNIT_V_DTYPE) + UNIT_ATT,
		"4048 (Century 111)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_C114 << UNIT_V_DTYPE) + UNIT_ATT,
		"2314/4057 (Century 114)", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_6225 << UNIT_V_DTYPE) + UNIT_ATT,
		"6225", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_6227 << UNIT_V_DTYPE) + UNIT_ATT,
		"6227", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_6099 << UNIT_V_DTYPE) + UNIT_ATT,
		"6099", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_6103 << UNIT_V_DTYPE) + UNIT_ATT,
		"6103", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_6070 << UNIT_V_DTYPE) + UNIT_ATT,
		"6070", NULL, NULL },
	{ (UNIT_DTYPE+UNIT_ATT), (TYPE_4231 << UNIT_V_DTYPE) + UNIT_ATT,
		"4231/3330", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_FLP << UNIT_V_DTYPE),
		"6030 (floppy)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_DSDD << UNIT_V_DTYPE),
		"6097 (DS/DD floppy)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_D31 << UNIT_V_DTYPE),
		"4047 (Diablo 31)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_D44 << UNIT_V_DTYPE),
 		"4234/6045 (Diablo 44)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_C111 << UNIT_V_DTYPE),
		"4048 (Century 111)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_C114 << UNIT_V_DTYPE),
		"2314/4057 (Century 114)", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_6225 << UNIT_V_DTYPE),
		"6225", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_6227 << UNIT_V_DTYPE),
		"6227", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_6099 << UNIT_V_DTYPE),
		"6099", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_6103 << UNIT_V_DTYPE),
		"6103", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_6070 << UNIT_V_DTYPE),
		"6070", NULL, NULL },
	{ (UNIT_AUTO+UNIT_DTYPE+UNIT_ATT), (TYPE_4231 << UNIT_V_DTYPE),
		"4231/3330", NULL, NULL },
	{ (UNIT_AUTO+UNIT_ATT), UNIT_AUTO, "autosize", NULL, NULL },
	{ UNIT_AUTO, UNIT_AUTO, NULL, "AUTOSIZE", NULL },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_FLP << UNIT_V_DTYPE),
		NULL, "FLOPPY", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_FLP << UNIT_V_DTYPE),
		NULL, "6030", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_DSDD << UNIT_V_DTYPE),
		NULL, "DSDDFLOPPY", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_DSDD << UNIT_V_DTYPE),
		NULL, "6097", &dkp_set_size },
	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_D31 << UNIT_V_DTYPE),
		NULL, "D31", &dkp_set_size }, 
	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_D31 << UNIT_V_DTYPE),
		NULL, "4047", &dkp_set_size }, 
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_D44 << UNIT_V_DTYPE),
		NULL, "D44", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_D44 << UNIT_V_DTYPE),
		NULL, "4234", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_D44 << UNIT_V_DTYPE),
		NULL, "6045", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_C111 << UNIT_V_DTYPE),
		NULL, "C111", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_C111 << UNIT_V_DTYPE),
		NULL, "4048", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_C114 << UNIT_V_DTYPE),
		NULL, "C114", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_C114 << UNIT_V_DTYPE),
		NULL, "2314", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_C114 << UNIT_V_DTYPE),
		NULL, "4057", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_6225 << UNIT_V_DTYPE),
		NULL, "6225", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_6227 << UNIT_V_DTYPE),
		NULL, "6227", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_6099 << UNIT_V_DTYPE),
		NULL, "6099", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_6103 << UNIT_V_DTYPE),
		NULL, "6103", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_6070 << UNIT_V_DTYPE),
		NULL, "6070", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_4231 << UNIT_V_DTYPE),
		NULL, "4231", &dkp_set_size },
 	{ (UNIT_AUTO+UNIT_DTYPE), (TYPE_4231 << UNIT_V_DTYPE),
		NULL, "3330", &dkp_set_size },
	{ 0 }  };

DEVICE dkp_dev = {
	"DP", dkp_unit, dkp_reg, dkp_mod,
	DKP_NUMDR, 8, 30, 1, 8, 16,
	NULL, NULL, &dkp_reset,
	&dkp_boot, &dkp_attach, NULL,
	&dkp_dib, DEV_DISABLE };

/* IOT routine */

int32 dkp (int32 pulse, int32 code, int32 AC)
{
UNIT *uptr;
int32 u, rval, dtype;

rval = 0;
uptr = dkp_dev.units + GET_UNIT (dkp_ussc);		/* select unit */
dtype = GET_DTYPE (uptr->flags);			/* get drive type */
switch (code) {						/* decode IR<5:7> */
case ioDIA:						/* DIA */
	dkp_sta = dkp_sta & ~STA_DYN;			/* clear dynamic */
	if (uptr->flags & UNIT_ATT) dkp_sta = dkp_sta | STA_DRDY;
	if (uptr->CYL >= drv_tab[dtype].cyl)
		dkp_sta = dkp_sta | STA_CYL;		/* bad cylinder? */
	if (dkp_sta & STA_EFLGS) dkp_sta = dkp_sta | STA_ERR;
	rval = dkp_sta;
	break;
case ioDOA:						/* DOA */
	if ((dev_busy & INT_DKP) == 0) {
		dkp_fccy = AC;				/* save cmd, cyl */
		dkp_sta = dkp_sta & ~(AC & FCCY_FLAGS);  }
	break;
case ioDIB:						/* DIB */
	rval = dkp_ma;					/* return buf addr */
	break;
case ioDOB:						/* DOB */
	if ((dev_busy & INT_DKP) == 0) dkp_ma = 
		AC & (drv_tab[dtype].new? DMASK: AMASK);
	break;
case ioDIC:						/* DIC */
	rval = dkp_ussc;				/* return unit, sect */
	break;
case ioDOC:						/* DOC */
	if ((dev_busy & INT_DKP) == 0) dkp_ussc = AC;	/* save unit, sect */
	break;  }					/* end switch code */

/* IOT, continued */

u = GET_UNIT(dkp_ussc);					/* select unit */
switch (pulse) {					/* decode IR<8:9> */
case iopS:						/* start */
	dev_busy = dev_busy | INT_DKP;			/* set busy */
	dev_done = dev_done & ~INT_DKP;			/* clear done */
	int_req = int_req & ~INT_DKP;			/* clear int */
	if (dkp_go ()) break;				/* new cmd, error? */
	dev_busy = dev_busy & ~INT_DKP;			/* clear busy */
	dev_done = dev_done | INT_DKP;			/* set done */
	int_req = (int_req & ~INT_DEV) | (dev_done & ~dev_disable);
	dkp_sta = dkp_sta | STA_DONE;
	break;
case iopC:						/* clear */
	dev_busy = dev_busy & ~INT_DKP;			/* clear busy */
	dev_done = dev_done & ~INT_DKP;			/* clear done */
	int_req = int_req & ~INT_DKP;			/* clear int */
	dkp_sta = dkp_sta & ~(STA_DFLGS + STA_EFLGS);
	if (dkp_unit[u].FUNC != FCCY_SEEK) sim_cancel (&dkp_unit[u]);
	break;
case iopP:						/* pulse */
	dev_done = dev_done & ~INT_DKP;			/* clear done */
	if (dkp_go ()) break;				/* new seek command */
	dev_done = dev_done | INT_DKP;			/* set done */
	int_req = (int_req & ~INT_DEV) | (dev_done & ~dev_disable);
	dkp_sta = dkp_sta | (STA_SKDN0 >> u);		/* set seek done */
	break;  }					/* end case pulse */
return rval;
}

/* New command, start vs pulse handled externally
   Returns true if command ok, false if error
*/

t_stat dkp_go (void)
{
UNIT *uptr;
int32 newcyl, func, u, dtype;

dkp_sta = dkp_sta & ~STA_EFLGS;				/* clear errors */
u = GET_UNIT (dkp_ussc);				/* get unit number */
uptr = dkp_dev.units + u;				/* get unit */
if (((uptr->flags & UNIT_ATT) == 0) || sim_is_active (uptr)) {
	dkp_sta = dkp_sta | STA_ERR;			/* attached or busy? */
	return FALSE;  }
dtype = GET_DTYPE (uptr->flags);			/* get drive type */
func = GET_CMD (dkp_fccy, dtype);			/* get function */
newcyl = GET_CYL (dkp_fccy, dtype);			/* get cylinder */
switch (func) {						/* decode command */
case FCCY_READ: case FCCY_WRITE:
	sim_activate (uptr, dkp_rwait);			/* schedule */
	break;
case FCCY_RECAL:					/* recalibrate */
	newcyl = 0;
	func = FCCY_SEEK;
case FCCY_SEEK: 					/* seek */
	sim_activate (uptr, dkp_swait * abs (newcyl - uptr->CYL));
	dkp_sta = dkp_sta | (STA_SEEK0 >> u);		/* set seeking */
	uptr->CYL = newcyl;				/* on cylinder */
	break;  }					/* end case command */
uptr->FUNC = func;					/* save command */
return TRUE;						/* no error */
}

/* Unit service

   If seek done, put on cylinder;
   else, do read or write
   If controller was busy, clear busy, set done, interrupt

   Memory access: sectors are read into/written from an intermediate
   buffer to allow word-by-word mapping of memory addresses on the
   Eclipse.  This allows each word written to memory to be tested
   for out of range.
*/

t_stat dkp_svc (UNIT *uptr)
{
int32 sc, sa, xcsa, bda;
int32 sx, dx, pa, u;
int32 dtype, err, newsect, newsurf;
uint32 awc;
t_stat rval;
static uint16 tbuf[DKP_NUMWD];				/* transfer buffer */

rval = SCPE_OK;
dtype = GET_DTYPE (uptr->flags);			/* get drive type */
if (uptr->FUNC == FCCY_SEEK) {				/* seek? */
	if (uptr->CYL >= drv_tab[dtype].cyl)		/* bad cylinder? */
		dkp_sta = dkp_sta | STA_ERR | STA_CYL;
	dev_done = dev_done | INT_DKP;			/* set done */
	int_req = (int_req & ~INT_DEV) | (dev_done & ~dev_disable);
	u = uptr - dkp_dev.units;			/* get unit number */
	dkp_sta = (dkp_sta | (STA_SKDN0 >> u))		/* set seek done */
		& ~(STA_SEEK0 >> u);			/* clear seeking */
	return SCPE_OK;  }

if (((uptr->flags & UNIT_ATT) == 0) ||			/* not attached? */
    ((uptr->flags & UNIT_WPRT) && (uptr->FUNC == FCCY_WRITE)))
	dkp_sta = dkp_sta | STA_DONE | STA_ERR;		/* error */

else if ((uptr->CYL >= drv_tab[dtype].cyl) ||		/* bad cylinder */
	 (GET_SURF (dkp_ussc, dtype) >= drv_tab[dtype].surf) || /* bad surface */
         (GET_SECT (dkp_ussc, dtype) >= drv_tab[dtype].sect))	/* or bad sector? */
	dkp_sta = dkp_sta | STA_DONE | STA_ERR | STA_UNS;

else if (GET_CYL (dkp_fccy, dtype) != uptr->CYL)		/* address error? */
	dkp_sta = dkp_sta | STA_DONE | STA_ERR | STA_UNS;

else {	sc = 16 - GET_COUNT (dkp_ussc);			/* get sector count */
	sa = GET_SA (uptr->CYL, GET_SURF (dkp_ussc, dtype),
		GET_SECT (dkp_ussc, dtype), dtype);	/* get disk block */
	xcsa = GET_SA (uptr->CYL + 1, 0, 0, dtype);	/* get next cyl addr */
	if ((sa + sc) > xcsa ) {			/* across cylinder? */
		sc = xcsa - sa;				/* limit transfer */
		dkp_sta = dkp_sta | STA_XCY;  }		/* xcyl error */
	bda = sa * DKP_NUMWD * sizeof (short);		/* to words, bytes */

	err = fseek (uptr->fileref, bda, SEEK_SET);	/* position drive */

	if (uptr->FUNC == FCCY_READ) {			/* read? */
	    for (sx = 0; sx < sc; sx++) {		/* loop thru sectors */
	        awc = fxread (tbuf, sizeof(uint16), DKP_NUMWD, uptr->fileref);
		for ( ; awc < DKP_NUMWD; awc++) tbuf[awc] = 0;
		if (err = ferror (uptr->fileref)) break;
		for (dx = 0; dx < DKP_NUMWD; dx++) {	/* loop thru buffer */
		    pa = MapAddr (0, dkp_ma);
		    if (MEM_ADDR_OK (pa)) M[pa] = tbuf[dx];
	            dkp_ma = (dkp_ma + 1) & AMASK;  }  }  }

	if (uptr->FUNC == FCCY_WRITE) {			/* write? */
	    for (sx = 0; sx < sc; sx++) {		/* loop thru sectors */
		for (dx = 0; dx < DKP_NUMWD; dx++) {	/* loop into buffer */
		    pa = MapAddr (0, dkp_ma);
		    tbuf[dx] = M[pa];
	            dkp_ma = (dkp_ma + 1) & AMASK;  }
		fxwrite (tbuf, sizeof(int16), DKP_NUMWD, uptr->fileref);
		if (err = ferror (uptr->fileref)) break;  }  }

	if (err != 0) {
		perror ("DKP I/O error");
		rval = SCPE_IOERR;  }
	clearerr (uptr->fileref);

	sa = sa + sc;					/* update sector addr */
	newsect = sa % drv_tab[dtype].sect;
	newsurf = (sa / drv_tab[dtype].sect) % drv_tab[dtype].surf;
	dkp_ussc = (dkp_ussc & USSC_UNIT) | ((dkp_ussc + sc) & USSC_M_COUNT) |
		((drv_tab[dtype].new)?
		((newsurf << USSC_V_NSURFACE) | (newsect << USSC_V_NSECTOR)):
		((newsurf << USSC_V_OSURFACE) | (newsect << USSC_V_OSECTOR)) );
	dkp_sta = dkp_sta | STA_DONE;  }		/* set status */

dev_busy = dev_busy & ~INT_DKP;				/* clear busy */
dev_done = dev_done | INT_DKP;				/* set done */
int_req = (int_req & ~INT_DEV) | (dev_done & ~dev_disable);
return rval;
}

/* Reset routine */

t_stat dkp_reset (DEVICE *dptr)
{
int32 u;
UNIT *uptr;

dev_busy = dev_busy & ~INT_DKP;				/* clear busy */
dev_done = dev_done & ~INT_DKP;				/* clear done, int */
int_req = int_req & ~INT_DKP;
dkp_fccy = dkp_ussc = dkp_ma = dkp_sta = 0;		/* clear registers */
for (u = 0; u < DKP_NUMDR; u++) {			/* loop thru units */
	uptr = dkp_dev.units + u;
	sim_cancel (uptr);				/* cancel activity */
	uptr->CYL = uptr->FUNC = 0;  }
return SCPE_OK;
}

/* Attach routine (with optional autosizing) */

t_stat dkp_attach (UNIT *uptr, char *cptr)
{
int32 i, p;
t_stat r;

uptr->capac = drv_tab[GET_DTYPE (uptr->flags)].size;
r = attach_unit (uptr, cptr);
if ((r != SCPE_OK) || ((uptr->flags & UNIT_AUTO) == 0)) return r;
if (fseek (uptr->fileref, 0, SEEK_END)) return SCPE_OK;
if ((p = ftell (uptr->fileref)) == 0) return SCPE_OK;
for (i = 0; drv_tab[i].sect != 0; i++) {
	if (p <= (drv_tab[i].size * (int) sizeof (short))) {
		uptr->flags = (uptr->flags & ~UNIT_DTYPE) | (i << UNIT_V_DTYPE);
		uptr->capac = drv_tab[i].size;
		return SCPE_OK;  }  }
return SCPE_OK;
}

/* Set size command validation routine */

t_stat dkp_set_size (UNIT *uptr, int32 val, char *cptr, void *desc)
{
if (uptr->flags & UNIT_ATT) return SCPE_ALATT;
uptr->capac = drv_tab[GET_DTYPE (val)].size;
return SCPE_OK;
}

/* Bootstrap routine */

#define BOOT_START 02000
#define BOOT_UNIT 02021
#define BOOT_SEEK 02022
#define BOOT_LEN (sizeof (boot_rom) / sizeof (int))

static const int32 boot_rom[] = {
	060233,			/* NIOC 0,DKP		; clear disk */
	020420,			/* LDA 0,USSC 		; unit, sfc, sec, cnt */
	063033,			/* DOC 0,DKP		; select disk */
	020417,			/* LDA 0,SEKCMD		; command, cylinder */
	061333,			/* DOAP 0,DKP		; start seek */
	024415,			/* LDA 1,SEKDN */
	060433,			/* DIA 0,DKP		; get status */
	0123415,		/* AND# 1,0,SZR		; skip if done */
	000776,			/* JMP .-2 */
	0102400,		/* SUB 0,0 		; mem addr = 0 */
	062033,			/* DOB 0,DKP */
	020411,			/* LDA 0,REDCMD		; command, cylinder */
	061133,			/* DOAS 0,DKP		; start read */
	060433,			/* DIA 0, DKP		; get status */
	0101113,		/* MOVL# 0,0,SNC	; skip if done */
	000776,			/* JMP .-2 */
	000377,			/* JMP 377 */
	000016,			/* USSC: 0.B1+0.B7+0.B11+16 */
	0175000,		/* SEKCMD: 175000 */
	074000,			/* SEKDN: 074000 */
	0174000			/* REDCMD: 174000 */
};

t_stat dkp_boot (int32 unitno, DEVICE *dptr)
{
int32 i, dtype;
extern int32 saved_PC;

for (i = 0; i < BOOT_LEN; i++) M[BOOT_START + i] = boot_rom[i];
unitno = unitno & USSC_M_UNIT;
dtype = GET_DTYPE (dkp_unit[unitno].flags);
M[BOOT_UNIT] = M[BOOT_UNIT] | (unitno << USSC_V_UNIT);
if (drv_tab[dtype].new) M[BOOT_SEEK] = 0176000;
saved_PC = BOOT_START;
return SCPE_OK;
}