First Commit of my working state

[simh.git] / NOVA / nova_dsk.c

/* nova_dsk.c: 4019 fixed head disk simulator\r
\r
   Copyright (c) 1993-2008, Robert M. Supnik\r
\r
   Permission is hereby granted, free of charge, to any person obtaining a\r
   copy of this software and associated documentation files (the "Software"),\r
   to deal in the Software without restriction, including without limitation\r
   the rights to use, copy, modify, merge, publish, distribute, sublicense,\r
   and/or sell copies of the Software, and to permit persons to whom the\r
   Software is furnished to do so, subject to the following conditions:\r
\r
   The above copyright notice and this permission notice shall be included in\r
   all copies or substantial portions of the Software.\r
\r
   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r
   IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,\r
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL\r
   ROBERT M SUPNIK BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r
   IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r
   CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r
\r
   Except as contained in this notice, the name of Robert M Supnik shall not be\r
   used in advertising or otherwise to promote the sale, use or other dealings\r
   in this Software without prior written authorization from Robert M Supnik.\r
\r
   dsk          fixed head disk\r
\r
   04-Jul-07    BKR     device name changed to DG's DSK from DEC's DK,\r
                        DEV_xxx macros now used for consistency,\r
                        added secret DG DIC function,\r
                        fixed boot info table size calculation\r
   15-May-06    RMS     Fixed bug in autosize attach (reported by David Gesswein)\r
   04-Jan-04    RMS     Changed sim_fsize calling sequence\r
   26-Jul-03    RMS     Fixed bug in set size routine\r
   14-Mar-03    RMS     Fixed variable capacity interaction with save/restore\r
   03-Mar-03    RMS     Fixed variable capacity and autosizing\r
   03-Oct-02    RMS     Added DIB\r
   06-Jan-02    RMS     Revised enable/disable support\r
   23-Aug-01    RMS     Fixed bug in write watermarking\r
   26-Apr-01    RMS     Added device enable/disable support\r
   10-Dec-00    RMS     Added Eclipse support\r
   15-Oct-00    RMS     Editorial changes\r
   14-Apr-99    RMS     Changed t_addr to unsigned\r
\r
   The 4019 is a head-per-track disk.  To minimize overhead, the entire disk\r
   is buffered in memory.\r
*/\r
\r
#include "nova_defs.h"\r
#include <math.h>\r
\r
#define UNIT_V_AUTO     (UNIT_V_UF + 0)                 /* autosize */\r
#define UNIT_V_PLAT     (UNIT_V_UF + 1)                 /* #platters - 1 */\r
#define UNIT_M_PLAT     07\r
#define UNIT_PLAT       (UNIT_M_PLAT << UNIT_V_PLAT)\r
#define UNIT_GETP(x)    ((((x) >> UNIT_V_PLAT) & UNIT_M_PLAT) + 1)\r
#define UNIT_AUTO       (1 << UNIT_V_AUTO)\r
#define UNIT_PLAT       (UNIT_M_PLAT << UNIT_V_PLAT)\r
\r
/* Constants */\r
\r
#define DSK_NUMWD       256                             /* words/sector */\r
#define DSK_NUMSC       8                               /* sectors/track */\r
#define DSK_NUMTR       128                             /* tracks/disk */\r
#define DSK_DKSIZE      (DSK_NUMTR*DSK_NUMSC*DSK_NUMWD) /* words/disk */\r
#define DSK_AMASK       ((DSK_NUMDK*DSK_NUMTR*DSK_NUMSC) - 1)\r
                                                        /* address mask */\r
#define DSK_NUMDK       8                               /* disks/controller */\r
#define GET_DISK(x)     (((x) / (DSK_NUMSC * DSK_NUMTR)) & (DSK_NUMDK - 1))\r
\r
/* Parameters in the unit descriptor */\r
\r
#define FUNC            u4                              /* function */\r
\r
/* Status register */\r
\r
#define DSKS_WLS        020                             /* write lock status */\r
#define DSKS_DLT        010                             /* data late error */\r
#define DSKS_NSD        004                             /* non-existent disk */\r
#define DSKS_CRC        002                             /* parity error */\r
#define DSKS_ERR        001                             /* error summary */\r
#define DSKS_ALLERR     (DSKS_WLS | DSKS_DLT | DSKS_NSD | DSKS_CRC | DSKS_ERR)\r
\r
/* Map logical sector numbers to physical sector numbers\r
   (indexed by track<2:0>'sector)\r
*/\r
\r
static const int32 sector_map[] = {\r
    0, 2, 4, 6, 1, 3, 5, 7, 1, 3, 5, 7, 2, 4, 6, 0,\r
    2, 4, 6, 0, 3, 5, 7, 1, 3, 5, 7, 1, 4, 6, 0, 2,\r
    4, 6, 0, 2, 5, 7, 1, 3, 5, 7, 1, 3, 6, 0, 2, 4,\r
    6, 0, 2, 4, 7, 1, 3, 5, 7, 1, 3, 5, 0, 2, 4, 6\r
    };\r
\r
#define DSK_MMASK       077\r
#define GET_SECTOR(x)   ((int) fmod (sim_gtime() / ((double) (x)), \\r
                        ((double) DSK_NUMSC)))\r
\r
extern uint16 M[];\r
extern UNIT cpu_unit;\r
extern int32 int_req, dev_busy, dev_done, dev_disable;\r
extern int32 saved_PC, SR, AMASK;\r
\r
int32 dsk_stat = 0;                                     /* status register */\r
int32 dsk_da = 0;                                       /* disk address */\r
int32 dsk_ma = 0;                                       /* memory address */\r
int32 dsk_wlk = 0;                                      /* wrt lock switches */\r
int32 dsk_stopioe = 0;                                  /* stop on error */\r
int32 dsk_time = 100;                                   /* time per sector */\r
\r
DEVICE dsk_dev;\r
int32 dsk (int32 pulse, int32 code, int32 AC);\r
t_stat dsk_svc (UNIT *uptr);\r
t_stat dsk_reset (DEVICE *dptr);\r
t_stat dsk_boot (int32 unitno, DEVICE *dptr);\r
t_stat dsk_attach (UNIT *uptr, char *cptr);\r
t_stat dsk_set_size (UNIT *uptr, int32 val, char *cptr, void *desc);\r
\r
/* DSK data structures\r
\r
   dsk_dev      device descriptor\r
   dsk_unit     unit descriptor\r
   dsk_reg      register list\r
*/\r
\r
DIB dsk_dib = { DEV_DSK, INT_DSK, PI_DSK, &dsk };\r
\r
UNIT dsk_unit = {\r
    UDATA (&dsk_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_BUFABLE+UNIT_MUSTBUF,\r
           DSK_DKSIZE)\r
    };\r
\r
REG dsk_reg[] = {\r
    { ORDATA (STAT, dsk_stat, 16) },\r
    { ORDATA (DA, dsk_da, 16) },\r
    { ORDATA (MA, dsk_ma, 16) },\r
    { FLDATA (BUSY, dev_busy, INT_V_DSK) },\r
    { FLDATA (DONE, dev_done, INT_V_DSK) },\r
    { FLDATA (DISABLE, dev_disable, INT_V_DSK) },\r
    { FLDATA (INT, int_req, INT_V_DSK) },\r
    { ORDATA (WLK, dsk_wlk, 8) },\r
    { DRDATA (TIME, dsk_time, 24), REG_NZ + PV_LEFT },\r
    { FLDATA (STOP_IOE, dsk_stopioe, 0) },\r
    { NULL }\r
    };\r
\r
MTAB dsk_mod[] = {\r
    { UNIT_PLAT, (0 << UNIT_V_PLAT), NULL, "1P", &dsk_set_size },\r
    { UNIT_PLAT, (1 << UNIT_V_PLAT), NULL, "2P", &dsk_set_size },\r
    { UNIT_PLAT, (2 << UNIT_V_PLAT), NULL, "3P", &dsk_set_size },\r
    { UNIT_PLAT, (3 << UNIT_V_PLAT), NULL, "4P", &dsk_set_size },\r
    { UNIT_PLAT, (4 << UNIT_V_PLAT), NULL, "5P", &dsk_set_size },\r
    { UNIT_PLAT, (5 << UNIT_V_PLAT), NULL, "6P", &dsk_set_size },\r
    { UNIT_PLAT, (6 << UNIT_V_PLAT), NULL, "7P", &dsk_set_size },\r
    { UNIT_PLAT, (7 << UNIT_V_PLAT), NULL, "8P", &dsk_set_size },\r
    { UNIT_AUTO, UNIT_AUTO, "autosize", "AUTOSIZE", NULL },\r
    { 0 }\r
    };\r
\r
DEVICE dsk_dev = {\r
    "DSK", &dsk_unit, dsk_reg, dsk_mod,\r
    1, 8, 21, 1, 8, 16,\r
    NULL, NULL, &dsk_reset,\r
    &dsk_boot, &dsk_attach, NULL,\r
    &dsk_dib, DEV_DISABLE\r
    };\r
\r
\r
/* IOT routine */\r
\r
int32 dsk (int32 pulse, int32 code, int32 AC)\r
{\r
int32 t, rval;\r
\r
rval = 0;\r
switch (code) {                                         /* decode IR<5:7> */\r
\r
    case ioDIA:                                         /* DIA */\r
        rval = dsk_stat & DSKS_ALLERR;                  /* read status */\r
        break;\r
\r
    case ioDOA:                                         /* DOA */\r
        dsk_da = AC & DSK_AMASK;                        /* save disk addr */\r
        break;\r
\r
    case ioDIB:                                         /* DIB */\r
        rval = dsk_ma & AMASK;                          /* read mem addr */\r
        break;\r
\r
    case ioDOB:                                         /* DOB */\r
        dsk_ma = AC & AMASK;                            /* save mem addr */\r
        break;\r
\r
    case ioDIC:                                         /* DIC - undocumented DG feature(!) */\r
        rval = 256 ;                                    /* return fixed sector size for DG for now */\r
        break ;\r
        }                                               /* end switch code */\r
\r
if (pulse) {                                            /* any pulse? */\r
    DEV_CLR_BUSY( INT_DSK ) ;\r
    DEV_CLR_DONE( INT_DSK ) ;\r
    DEV_UPDATE_INTR ;\r
    dsk_stat = 0;                                       /* clear status */\r
    sim_cancel (&dsk_unit);                             /* stop I/O */\r
    }\r
\r
if ((pulse == iopP) && ((dsk_wlk >> GET_DISK (dsk_da)) & 1)) {  /* wrt lock? */\r
    DEV_SET_DONE( INT_DSK ) ;\r
    DEV_UPDATE_INTR ;\r
    dsk_stat = DSKS_ERR + DSKS_WLS;                     /* set status */\r
    return rval;\r
    }\r
\r
if (pulse & 1) {                                        /* read or write? */\r
    if (((uint32) (dsk_da * DSK_NUMWD)) >= dsk_unit.capac) { /* inv sev? */\r
        DEV_SET_DONE( INT_DSK ) ;\r
        DEV_UPDATE_INTR ;\r
        dsk_stat = DSKS_ERR + DSKS_NSD;                 /* set status */\r
        return rval;                                    /* done */\r
        }\r
    dsk_unit.FUNC = pulse;                              /* save command */\r
    DEV_SET_BUSY( INT_DSK ) ;\r
    DEV_UPDATE_INTR ;\r
    t = sector_map[dsk_da & DSK_MMASK] - GET_SECTOR (dsk_time);\r
    if (t < 0) t = t + DSK_NUMSC;\r
    sim_activate (&dsk_unit, t * dsk_time);             /* activate */\r
    }\r
return rval;\r
}\r
\r
\r
/* Unit service */\r
\r
t_stat dsk_svc (UNIT *uptr)\r
{\r
int32 i, da, pa;\r
int16 *fbuf = uptr->filebuf;\r
\r
DEV_CLR_BUSY( INT_DSK ) ;\r
DEV_SET_DONE( INT_DSK ) ;\r
DEV_UPDATE_INTR ;\r
\r
if ((uptr->flags & UNIT_BUF) == 0) {                    /* not buf? abort */\r
    dsk_stat = DSKS_ERR + DSKS_NSD;                     /* set status */\r
    return IORETURN (dsk_stopioe, SCPE_UNATT);\r
    }\r
\r
da = dsk_da * DSK_NUMWD;                                /* calc disk addr */\r
if (uptr->FUNC == iopS) {                               /* read? */\r
    for (i = 0; i < DSK_NUMWD; i++) {                   /* copy sector */\r
        pa = MapAddr (0, (dsk_ma + i) & AMASK);         /* map address */\r
        if (MEM_ADDR_OK (pa)) M[pa] = fbuf[da + i];\r
        }\r
    dsk_ma = (dsk_ma + DSK_NUMWD) & AMASK;\r
    }\r
else if (uptr->FUNC == iopP) {                          /* write? */\r
    for (i = 0; i < DSK_NUMWD; i++) {                   /* copy sector */\r
        pa = MapAddr (0, (dsk_ma + i) & AMASK);         /* map address */\r
        fbuf[da + i] = M[pa];\r
        }\r
    if (((uint32) (da + i)) >= uptr->hwmark)            /* past end? */\r
        uptr->hwmark = da + i + 1;                      /* upd hwmark */\r
    dsk_ma = (dsk_ma + DSK_NUMWD + 3) & AMASK;\r
    }\r
\r
dsk_stat = 0;                                           /* set status */\r
return SCPE_OK;\r
}\r
\r
\r
/* Reset routine */\r
\r
t_stat dsk_reset (DEVICE *dptr)\r
{\r
dsk_stat = dsk_da = dsk_ma = 0;\r
DEV_CLR_BUSY( INT_DSK ) ;\r
DEV_CLR_DONE( INT_DSK ) ;\r
DEV_UPDATE_INTR ;\r
sim_cancel (&dsk_unit);\r
return SCPE_OK;\r
}\r
\r
\r
/* Bootstrap routine */\r
\r
#define BOOT_START  0375\r
#define BOOT_LEN    (sizeof (boot_rom) / sizeof (int32))\r
\r
static const int32 boot_rom[] = {\r
      0062677                     /* IORST                ; reset the I/O system  */\r
    , 0060120                     /* NIOS DSK             ; start the disk        */\r
    , 0000377                     /* JMP 377              ; wait for the world    */\r
    } ;\r
\r
\r
t_stat dsk_boot (int32 unitno, DEVICE *dptr)\r
{\r
int32   i;\r
\r
for (i = 0; i < BOOT_LEN; i++) M[BOOT_START + i] = (uint16) boot_rom[i];\r
saved_PC = BOOT_START;\r
SR = 0100000 + DEV_DSK;\r
return SCPE_OK;\r
}\r
\r
\r
/* Attach routine */\r
\r
t_stat dsk_attach (UNIT *uptr, char *cptr)\r
{\r
uint32 sz, p;\r
uint32 ds_bytes = DSK_DKSIZE * sizeof (int16);\r
\r
if ((uptr->flags & UNIT_AUTO) && (sz = sim_fsize_name (cptr))) {\r
    p = (sz + ds_bytes - 1) / ds_bytes;\r
    if (p >= DSK_NUMDK) p = DSK_NUMDK - 1;\r
    uptr->flags = (uptr->flags & ~UNIT_PLAT) | (p << UNIT_V_PLAT);\r
    }\r
uptr->capac = UNIT_GETP (uptr->flags) * DSK_DKSIZE;     /* set capacity */\r
return attach_unit (uptr, cptr);\r
}\r
\r
\r
/* Change disk size */\r
\r
t_stat dsk_set_size (UNIT *uptr, int32 val, char *cptr, void *desc)\r
{\r
if (val < 0) return SCPE_IERR;\r
if (uptr->flags & UNIT_ATT) return SCPE_ALATT;\r
uptr->capac = UNIT_GETP (val) * DSK_DKSIZE;\r
uptr->flags = uptr->flags & ~UNIT_AUTO;\r
return SCPE_OK;\r
}\r