| /* pdp11_ry.c: RX211/RXV21/RX02 floppy disk simulator | |
| Copyright (c) 1993-2006, 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 | |
| 15-May-06 RMS Fixed bug in autosize attach (reported by David Gesswein) | |
| 07-Jul-05 RMS Removed extraneous externs | |
| 18-Feb-05 RMS Fixed bug in boot code (reported by Graham Toal) | |
| 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; | |
| #define DEV_DISI DEV_DIS | |
| #elif defined (VM_VAX) /* VAX version */ | |
| #include "vax_defs.h" | |
| extern int32 int_req[IPL_HLVL]; | |
| #define DEV_DISI 0 | |
| #else /* PDP-11 version */ | |
| #include "pdp11_defs.h" | |
| extern int32 int_req[IPL_HLVL]; | |
| #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; | |
| if ((uptr->flags & UNIT_AUTO) && (sz = sim_fsize_name (cptr))) { | |
| 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 attach_unit (uptr, cptr); | |
| } | |
| /* 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) */ | |
| 0050316, /* BIS R3, (SP) ; or unit */ | |
| 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? */ | |
| 0001345, /* 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? */ | |
| 0101715, /* 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 |