| 1 | /* id_fd.c: Interdata floppy disk simulator\r |
| 2 | \r |
| 3 | Copyright (c) 2001-2005, Robert M Supnik\r |
| 4 | \r |
| 5 | Permission is hereby granted, free of charge, to any person obtaining a\r |
| 6 | copy of this software and associated documentation files (the "Software"),\r |
| 7 | to deal in the Software without restriction, including without limitation\r |
| 8 | the rights to use, copy, modify, merge, publish, distribute, sublicense,\r |
| 9 | and/or sell copies of the Software, and to permit persons to whom the\r |
| 10 | Software is furnished to do so, subject to the following conditions:\r |
| 11 | \r |
| 12 | The above copyright notice and this permission notice shall be included in\r |
| 13 | all copies or substantial portions of the Software.\r |
| 14 | \r |
| 15 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR\r |
| 16 | IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,\r |
| 17 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL\r |
| 18 | ROBERT M SUPNIK BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER\r |
| 19 | IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN\r |
| 20 | CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.\r |
| 21 | \r |
| 22 | Except as contained in this notice, the name of Robert M Supnik shall not be\r |
| 23 | used in advertising or otherwise to promote the sale, use or other dealings\r |
| 24 | in this Software without prior written authorization from Robert M Supnik.\r |
| 25 | \r |
| 26 | fd M46-630 floppy disk\r |
| 27 | \r |
| 28 | A diskette consists of 77 tracks, each with 26 sectors of 128B. The\r |
| 29 | Interdata floppy uses a logical record numbering scheme from 1 to 2002.\r |
| 30 | Physical tracks are numbered 0-76, physical sectors 1-26.\r |
| 31 | \r |
| 32 | To allow for deleted data handling, a directory is appended to the end\r |
| 33 | of the image, one byte per LRN. Zero (the default) is a normal record,\r |
| 34 | non-zero a deleted record.\r |
| 35 | */\r |
| 36 | \r |
| 37 | #include "id_defs.h"\r |
| 38 | \r |
| 39 | #define FD_NUMTR 77 /* tracks/disk */\r |
| 40 | #define FD_NUMSC 26 /* sectors/track */\r |
| 41 | #define FD_NUMBY 128 /* bytes/sector */\r |
| 42 | #define FD_NUMLRN (FD_NUMTR * FD_NUMSC) /* LRNs/disk */\r |
| 43 | #define FD_SIZE (FD_NUMLRN * FD_NUMBY) /* bytes/disk */\r |
| 44 | #define FD_NUMDR 4 /* drives/controller */\r |
| 45 | #define UNIT_V_WLK (UNIT_V_UF) /* write locked */\r |
| 46 | #define UNIT_WLK (1u << UNIT_V_UF)\r |
| 47 | #define UNIT_WPRT (UNIT_WLK | UNIT_RO) /* write protect */\r |
| 48 | #define LRN u3 /* last LRN */\r |
| 49 | #define FNC u4 /* last function */\r |
| 50 | #define GET_DA(x) (((x) - 1) * FD_NUMBY)\r |
| 51 | #define GET_TRK(x) (((x) - 1) / FD_NUMSC)\r |
| 52 | #define GET_SEC(x) ((((x) - 1) % FD_NUMSC) + 1)\r |
| 53 | #define LRN_BOOT 5 /* boot block LRN */\r |
| 54 | \r |
| 55 | /* Command byte */\r |
| 56 | \r |
| 57 | #define CMD_V_UNIT 4 /* unit */\r |
| 58 | #define CMD_M_UNIT 0x3\r |
| 59 | #define GET_UNIT(x) (((x) >> CMD_V_UNIT) & CMD_M_UNIT)\r |
| 60 | #define CMD_V_FNC 0 /* function */\r |
| 61 | #define CMD_M_FNC 0xF\r |
| 62 | #define GET_FNC(x) (((x) >> CMD_V_FNC) & CMD_M_FNC)\r |
| 63 | #define FNC_RD 0x1 /* read */\r |
| 64 | #define FNC_WR 0x2 /* write */\r |
| 65 | #define FNC_RDID 0x3 /* read ID */\r |
| 66 | #define FNC_RSTA 0x4 /* read status */\r |
| 67 | #define FNC_DEL 0x5 /* write deleted */\r |
| 68 | #define FNC_BOOT 0x6 /* boot */\r |
| 69 | #define FNC_STOP 0x7 /* stop */\r |
| 70 | #define FNC_RESET 0x8 /* reset */\r |
| 71 | #define FNC_FMT 0x9 /* format NI */\r |
| 72 | #define FNC_STOPPING 0x10 /* stopping */\r |
| 73 | \r |
| 74 | /* Status byte, * = dynamic */\r |
| 75 | \r |
| 76 | #define STA_WRP 0x80 /* *write prot */\r |
| 77 | #define STA_DEF 0x40 /* def track NI */\r |
| 78 | #define STA_DEL 0x20 /* del record */\r |
| 79 | #define STA_ERR 0x10 /* error */\r |
| 80 | #define STA_IDL 0x02 /* idle */\r |
| 81 | #define STA_OFL 0x01 /* fault */\r |
| 82 | #define STA_MASK (STA_DEF|STA_DEL|STA_ERR|STA_BSY|STA_IDL)\r |
| 83 | #define SET_EX (STA_ERR) /* set EX */\r |
| 84 | \r |
| 85 | /* Extended status, 6 bytes, * = dynamic */\r |
| 86 | \r |
| 87 | #define ES_SIZE 6\r |
| 88 | #define ES0_HCRC 0x80 /* ID CRC NI */\r |
| 89 | #define ES0_DCRC 0x40 /* data CRC NI */\r |
| 90 | #define ES0_LRN 0x20 /* illegal LRN */\r |
| 91 | #define ES0_WRP 0x10 /* *write prot */\r |
| 92 | #define ES0_ERR 0x08 /* error */\r |
| 93 | #define ES0_DEF 0x04 /* def trk NI */\r |
| 94 | #define ES0_DEL 0x02 /* del rec NI */\r |
| 95 | #define ES0_FLT 0x01 /* fault */\r |
| 96 | #define ES1_TK0 0x80 /* track 0 */\r |
| 97 | #define ES1_NRDY 0x40 /* not ready */\r |
| 98 | #define ES1_NOAM 0x20 /* no addr mk NI */\r |
| 99 | #define ES1_CMD 0x10 /* illegal cmd */\r |
| 100 | #define ES1_SKE 0x08 /* seek err NI */\r |
| 101 | #define ES1_UNS 0x04 /* unsafe NI */\r |
| 102 | #define ES1_UNIT 0x03 /* unit # */\r |
| 103 | \r |
| 104 | /* Processing options for commands */\r |
| 105 | \r |
| 106 | #define C_RD 0x1 /* cmd reads disk */\r |
| 107 | #define C_WD 0x2 /* cmd writes disk */\r |
| 108 | \r |
| 109 | extern uint32 int_req[INTSZ], int_enb[INTSZ];\r |
| 110 | \r |
| 111 | uint32 fd_sta = 0; /* status */\r |
| 112 | uint32 fd_cmd = 0; /* command */\r |
| 113 | uint32 fd_db = 0; /* data buffer */\r |
| 114 | uint32 fd_bptr = 0; /* buffer pointer */\r |
| 115 | uint8 fdxb[FD_NUMBY] = { 0 }; /* sector buffer */\r |
| 116 | uint8 fd_es[FD_NUMDR][ES_SIZE] = { 0 }; /* ext status */\r |
| 117 | uint32 fd_lrn = 0; /* log rec # */\r |
| 118 | uint32 fd_wdv = 0; /* wd valid */\r |
| 119 | uint32 fd_stopioe = 1; /* stop on error */\r |
| 120 | uint32 fd_arm = 0; /* intr arm */\r |
| 121 | int32 fd_ctime = 100; /* command time */\r |
| 122 | int32 fd_stime = 10; /* seek, per LRN */\r |
| 123 | int32 fd_xtime = 1; /* tr set time */\r |
| 124 | \r |
| 125 | static uint32 ctab[16] = {\r |
| 126 | 0, C_RD, C_WD, 0, /* 0, rd, wr, 0 */\r |
| 127 | 0, C_WD, C_RD, 0, /* 0, del, boot, 0 */\r |
| 128 | 0, 0, 0, 0,\r |
| 129 | 0, 0, 0, 0\r |
| 130 | };\r |
| 131 | \r |
| 132 | DEVICE fd_dev;\r |
| 133 | uint32 fd (uint32 dev, uint32 op, uint32 dat);\r |
| 134 | t_stat fd_svc (UNIT *uptr);\r |
| 135 | t_stat fd_reset (DEVICE *dptr);\r |
| 136 | t_stat fd_clr (DEVICE *dptr);\r |
| 137 | t_stat fd_boot (int32 unitno, DEVICE *dptr);\r |
| 138 | t_bool fd_dte (UNIT *uptr, t_bool wr);\r |
| 139 | uint32 fd_crc (uint32 crc, uint32 dat, uint32 cnt);\r |
| 140 | void fd_done (uint32 u, uint32 nsta, uint32 nes0, uint32 nes1);\r |
| 141 | void sched_seek (UNIT *uptr, int32 newlrn);\r |
| 142 | \r |
| 143 | /* FD data structures\r |
| 144 | \r |
| 145 | fd_dev FD device descriptor\r |
| 146 | fd_unit FD unit list\r |
| 147 | fd_reg FD register list\r |
| 148 | fd_mod FD modifier list\r |
| 149 | */\r |
| 150 | \r |
| 151 | DIB fd_dib = { d_FD, -1, v_FD, NULL, &fd, NULL };\r |
| 152 | \r |
| 153 | UNIT fd_unit[] = {\r |
| 154 | { UDATA (&fd_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+\r |
| 155 | UNIT_BUFABLE+UNIT_MUSTBUF, FD_SIZE + FD_NUMLRN) },\r |
| 156 | { UDATA (&fd_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+\r |
| 157 | UNIT_BUFABLE+UNIT_MUSTBUF, FD_SIZE + FD_NUMLRN) },\r |
| 158 | { UDATA (&fd_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+\r |
| 159 | UNIT_BUFABLE+UNIT_MUSTBUF, FD_SIZE + FD_NUMLRN) },\r |
| 160 | { UDATA (&fd_svc, UNIT_FIX+UNIT_ATTABLE+UNIT_DISABLE+\r |
| 161 | UNIT_BUFABLE+UNIT_MUSTBUF, FD_SIZE + FD_NUMLRN) }\r |
| 162 | };\r |
| 163 | \r |
| 164 | REG fd_reg[] = {\r |
| 165 | { HRDATA (CMD, fd_cmd, 8) },\r |
| 166 | { HRDATA (STA, fd_sta, 8) },\r |
| 167 | { HRDATA (BUF, fd_db, 8) },\r |
| 168 | { HRDATA (LRN, fd_lrn, 16) },\r |
| 169 | { BRDATA (ESTA, fd_es, 16, 8, ES_SIZE * FD_NUMDR) },\r |
| 170 | { BRDATA (DBUF, fdxb, 16, 8, FD_NUMBY) },\r |
| 171 | { HRDATA (DBPTR, fd_bptr, 8) },\r |
| 172 | { FLDATA (WDV, fd_wdv, 0) },\r |
| 173 | { FLDATA (IREQ, int_req[l_FD], i_FD) },\r |
| 174 | { FLDATA (IENB, int_enb[l_FD], i_FD) },\r |
| 175 | { FLDATA (IARM, fd_arm, 0) },\r |
| 176 | { DRDATA (CTIME, fd_ctime, 24), PV_LEFT },\r |
| 177 | { DRDATA (STIME, fd_stime, 24), PV_LEFT },\r |
| 178 | { DRDATA (XTIME, fd_xtime, 24), PV_LEFT },\r |
| 179 | { FLDATA (STOP_IOE, fd_stopioe, 0) },\r |
| 180 | { URDATA (ULRN, fd_unit[0].LRN, 16, 16, 0, FD_NUMDR, REG_HRO) },\r |
| 181 | { URDATA (UFNC, fd_unit[0].FNC, 16, 8, 0, FD_NUMDR, REG_HRO) },\r |
| 182 | { HRDATA (DEVNO, fd_dib.dno, 8), REG_HRO },\r |
| 183 | { NULL }\r |
| 184 | };\r |
| 185 | \r |
| 186 | MTAB fd_mod[] = {\r |
| 187 | { UNIT_WLK, 0, "write enabled", "WRITEENABLED", NULL },\r |
| 188 | { UNIT_WLK, UNIT_WLK, "write locked", "LOCKED", NULL },\r |
| 189 | { MTAB_XTD|MTAB_VDV, 0, "DEVNO", "DEVNO",\r |
| 190 | &set_dev, &show_dev, NULL },\r |
| 191 | { 0 }\r |
| 192 | };\r |
| 193 | \r |
| 194 | DEVICE fd_dev = {\r |
| 195 | "FD", fd_unit, fd_reg, fd_mod,\r |
| 196 | FD_NUMDR, 16, 20, 1, 16, 8,\r |
| 197 | NULL, NULL, &fd_reset,\r |
| 198 | &fd_boot, NULL, NULL,\r |
| 199 | &fd_dib, DEV_DISABLE\r |
| 200 | };\r |
| 201 | \r |
| 202 | /* Floppy disk: IO routine */\r |
| 203 | \r |
| 204 | uint32 fd (uint32 dev, uint32 op, uint32 dat)\r |
| 205 | {\r |
| 206 | int32 u, t, fnc;\r |
| 207 | UNIT *uptr;\r |
| 208 | \r |
| 209 | fnc = GET_FNC (fd_cmd); /* get fnc */\r |
| 210 | u = GET_UNIT (fd_cmd); /* get unit */\r |
| 211 | uptr = fd_dev.units + u;\r |
| 212 | switch (op) { /* case IO op */\r |
| 213 | case IO_ADR: /* select */\r |
| 214 | return BY; /* byte only */\r |
| 215 | \r |
| 216 | case IO_RD: /* read */\r |
| 217 | if (fd_sta & (STA_IDL | STA_BSY)) return fd_db; /* idle, busy? */\r |
| 218 | if (fd_bptr < FD_NUMBY) fd_db = fdxb[fd_bptr++];/* get byte */\r |
| 219 | if (fd_bptr >= FD_NUMBY) { /* buf end? */\r |
| 220 | if (ctab[fnc] & C_RD) { /* disk read? */\r |
| 221 | sched_seek (uptr, uptr->LRN + 1); /* sched read */\r |
| 222 | fd_sta = fd_sta | STA_BSY; /* set busy */\r |
| 223 | }\r |
| 224 | else fd_bptr = 0; /* just wrap */\r |
| 225 | }\r |
| 226 | if ((ctab[fnc] & C_RD) && fd_arm) /* if rd & arm, */\r |
| 227 | SET_INT (v_FD); /* interrupt */\r |
| 228 | return fd_db; /* return buf */\r |
| 229 | \r |
| 230 | case IO_WD: /* write */\r |
| 231 | if (fd_sta & STA_IDL) { /* idle? */\r |
| 232 | fd_lrn = ((fd_lrn << 8) | dat) & DMASK16; /* insert byte */\r |
| 233 | fd_wdv = 1;\r |
| 234 | break;\r |
| 235 | }\r |
| 236 | if (fd_bptr < FD_NUMBY) /* if room, */\r |
| 237 | fdxb[fd_bptr++] = fd_db = dat; /* store byte */\r |
| 238 | if (fd_bptr >= FD_NUMBY) { /* buf end? */\r |
| 239 | if (ctab[fnc] & C_WD) { /* disk write? */\r |
| 240 | sched_seek (uptr, uptr->LRN + 1); /* sched write */\r |
| 241 | fd_sta = fd_sta | STA_BSY; /* set busy */\r |
| 242 | }\r |
| 243 | else fd_bptr = 0; /* just wrap */\r |
| 244 | }\r |
| 245 | if ((ctab[fnc] & C_WD) && fd_arm) /* if wr & arm, */\r |
| 246 | SET_INT (v_FD); /* interrupt */\r |
| 247 | break;\r |
| 248 | \r |
| 249 | case IO_SS: /* status */\r |
| 250 | t = fd_sta & STA_MASK; /* get status */\r |
| 251 | if ((uptr->flags & UNIT_ATT) == 0) t = t | STA_DU;\r |
| 252 | if (t & SET_EX) t = t | STA_EX; /* test for ex */\r |
| 253 | return t;\r |
| 254 | \r |
| 255 | case IO_OC: /* command */\r |
| 256 | fd_arm = int_chg (v_FD, dat, fd_arm); /* upd int ctrl */\r |
| 257 | fnc = GET_FNC (dat); /* new fnc */\r |
| 258 | fd_cmd = dat; /* save cmd */\r |
| 259 | u = GET_UNIT (dat); /* get unit */\r |
| 260 | uptr = fd_dev.units + u;\r |
| 261 | if (fnc == FNC_STOP) { /* stop? */\r |
| 262 | uptr->FNC = uptr->FNC | FNC_STOPPING; /* flag stop */\r |
| 263 | if (sim_is_active (uptr)) break; /* busy? cont */\r |
| 264 | if (ctab[GET_FNC (uptr->FNC)] & C_WD) { /* write? */\r |
| 265 | sched_seek (uptr, uptr->LRN + 1); /* sched write */\r |
| 266 | fd_sta = fd_sta | STA_BSY; /* set busy */\r |
| 267 | }\r |
| 268 | else fd_done (u, 0, 0, 0); /* nrml done */\r |
| 269 | break;\r |
| 270 | }\r |
| 271 | else if (fd_sta & STA_IDL) { /* must be idle */\r |
| 272 | if (fnc != FNC_RSTA) { /* !rd status */\r |
| 273 | fd_sta = STA_BSY; /* busy, !idle */\r |
| 274 | fd_es[u][0] = 0;\r |
| 275 | fd_es[u][1] = u; /* init ext sta */\r |
| 276 | }\r |
| 277 | else fd_sta = (fd_sta & ~STA_IDL) | STA_BSY;\r |
| 278 | if (fnc == FNC_BOOT) t = LRN_BOOT; /* boot? fixed sec */\r |
| 279 | else if (fd_wdv) t = fd_lrn; /* valid data? use */\r |
| 280 | else t = uptr->LRN; /* use prev */\r |
| 281 | fd_wdv = 0; /* data invalid */\r |
| 282 | fd_bptr = 0; /* init buffer */\r |
| 283 | uptr->FNC = fnc; /* save function */\r |
| 284 | uptr->LRN = t; /* save LRN */\r |
| 285 | if (ctab[fnc] & C_RD) sched_seek (uptr, t); /* seek now? */\r |
| 286 | else sim_activate (uptr, fd_ctime); /* start cmd */\r |
| 287 | }\r |
| 288 | break;\r |
| 289 | }\r |
| 290 | \r |
| 291 | return 0;\r |
| 292 | }\r |
| 293 | \r |
| 294 | /* Unit service; the action to be taken depends on command */\r |
| 295 | \r |
| 296 | t_stat fd_svc (UNIT *uptr)\r |
| 297 | {\r |
| 298 | uint32 i, u, tk, sc, crc, fnc, da;\r |
| 299 | uint8 *fbuf = uptr->filebuf;\r |
| 300 | \r |
| 301 | u = uptr - fd_dev.units; /* get unit number */\r |
| 302 | fnc = GET_FNC (uptr->FNC); /* get function */\r |
| 303 | switch (fnc) { /* case on function */\r |
| 304 | \r |
| 305 | case FNC_RESET: /* reset */\r |
| 306 | fd_clr (&fd_dev); /* clear device */\r |
| 307 | fd_done (u, 0, 0, 0); /* set idle */\r |
| 308 | return SCPE_OK;\r |
| 309 | \r |
| 310 | case FNC_STOP: /* stop */\r |
| 311 | fd_done (u, 0, 0, 0); /* set idle */\r |
| 312 | return SCPE_OK;\r |
| 313 | \r |
| 314 | case FNC_BOOT: /* boot, buf empty */\r |
| 315 | case FNC_RD: /* read, buf empty */\r |
| 316 | if (uptr->FNC & FNC_STOPPING) break; /* stopped? */\r |
| 317 | if (fd_dte (uptr, FALSE)) return SCPE_OK; /* xfr error? */\r |
| 318 | da = GET_DA (uptr->LRN); /* get disk addr */\r |
| 319 | for (i = 0; i < FD_NUMBY; i++) /* read sector */\r |
| 320 | fdxb[i] = fbuf[da + i];\r |
| 321 | if (fbuf[FD_SIZE + uptr->LRN - 1]) { /* deleted? set err */\r |
| 322 | fd_sta = fd_sta | STA_DEL;\r |
| 323 | fd_es[u][0] = fd_es[u][0] | ES0_DEL;\r |
| 324 | }\r |
| 325 | fd_es[u][2] = GET_SEC (uptr->LRN); /* set ext sec/trk */\r |
| 326 | fd_es[u][3] = GET_TRK (uptr->LRN);\r |
| 327 | fd_bptr = 0; /* init buf */\r |
| 328 | uptr->LRN = uptr->LRN + 1; /* next block */\r |
| 329 | break;\r |
| 330 | \r |
| 331 | case FNC_WR: case FNC_DEL: /* write block */\r |
| 332 | if (fd_dte (uptr, TRUE)) return SCPE_OK; /* xfr error? */\r |
| 333 | if (fd_bptr) { /* any transfer? */\r |
| 334 | da = GET_DA (uptr->LRN); /* get disk addr */\r |
| 335 | for (i = fd_bptr; i < FD_NUMBY; i++) /* pad sector */\r |
| 336 | fdxb[i] = fd_db;\r |
| 337 | for (i = 0; i < FD_NUMBY; i++) /* write sector */\r |
| 338 | fbuf[da + i] = fdxb[i]; /* then dir */\r |
| 339 | fbuf[FD_SIZE + uptr->LRN - 1] = ((fnc == FNC_DEL)? 1: 0);\r |
| 340 | uptr->hwmark = uptr->capac; /* rewrite all */\r |
| 341 | fd_es[u][2] = GET_SEC (uptr->LRN); /* set ext sec/trk */\r |
| 342 | fd_es[u][3] = GET_TRK (uptr->LRN);\r |
| 343 | fd_bptr = 0; /* init buf */\r |
| 344 | uptr->LRN = uptr->LRN + 1; /* next block */\r |
| 345 | }\r |
| 346 | break;\r |
| 347 | \r |
| 348 | case FNC_RSTA: /* read status */\r |
| 349 | if (uptr->flags & UNIT_WPRT) /* wr protected? */\r |
| 350 | fd_es[u][0] = fd_es[u][0] | ES0_WRP;\r |
| 351 | if (GET_TRK (uptr->LRN) == 0) /* on track 0? */\r |
| 352 | fd_es[u][1] = fd_es[u][1] | ES1_TK0;\r |
| 353 | if ((uptr->flags & UNIT_BUF) == 0) { /* not attached? */\r |
| 354 | fd_es[u][0] = fd_es[u][0] | ES0_FLT; /* set err */\r |
| 355 | fd_es[u][1] = fd_es[u][1] | ES1_NRDY;\r |
| 356 | }\r |
| 357 | for (i = 0; i < ES_SIZE; i++) fdxb[i] = fd_es[u][i]; /* copy to buf */\r |
| 358 | for (i = ES_SIZE; i < FD_NUMBY; i++) fdxb[i] = 0;\r |
| 359 | break;\r |
| 360 | \r |
| 361 | case FNC_RDID: /* read ID */\r |
| 362 | if ((uptr->flags & UNIT_BUF) == 0) { /* not attached? */\r |
| 363 | fd_done (u, STA_ERR, ES0_ERR | ES0_FLT, ES1_NRDY);\r |
| 364 | return SCPE_OK;\r |
| 365 | }\r |
| 366 | for (i = 0; i < FD_NUMBY; i++) fdxb[i] = 0; /* clr buf */\r |
| 367 | tk = GET_TRK (uptr->LRN); /* get track */\r |
| 368 | sc = GET_SEC (uptr->LRN); /* get sector */\r |
| 369 | fdxb[0] = tk & 0xFF; /* store track */\r |
| 370 | fdxb[2] = sc & 0xFF; /* store sector */\r |
| 371 | crc = fd_crc (0xFFFF, 0xFE00, 8); /* CRC addr mark */\r |
| 372 | crc = fd_crc (crc, tk << 8, 16); /* CRC track */\r |
| 373 | crc = fd_crc (crc, sc << 8, 16); /* CRC sector */\r |
| 374 | fdxb[4] = (crc >> 8) & 0xFF; /* store CRC */\r |
| 375 | fdxb[5] = crc & 0xFF;\r |
| 376 | break;\r |
| 377 | \r |
| 378 | case FNC_FMT: /* format */\r |
| 379 | default:\r |
| 380 | fd_done (u, STA_ERR, ES0_ERR, ES1_CMD); /* ill cmd */\r |
| 381 | uptr->LRN = 1; /* on track 0 */\r |
| 382 | return SCPE_OK;\r |
| 383 | }\r |
| 384 | \r |
| 385 | if (uptr->FNC & FNC_STOPPING) { /* stopping? */\r |
| 386 | uptr->FNC = FNC_STOP; /* fnc = STOP */\r |
| 387 | sim_activate (uptr, fd_ctime); /* schedule */\r |
| 388 | } \r |
| 389 | fd_sta = fd_sta & ~STA_BSY; /* clear busy */\r |
| 390 | if (fd_arm) SET_INT (v_FD); /* if armed, int */\r |
| 391 | return SCPE_OK;\r |
| 392 | }\r |
| 393 | \r |
| 394 | /* Schedule seek */\r |
| 395 | \r |
| 396 | void sched_seek (UNIT *uptr, int32 newlrn)\r |
| 397 | {\r |
| 398 | int32 diff = newlrn - uptr->LRN; /* LRN diff */\r |
| 399 | \r |
| 400 | if (diff < 0) diff = -diff; /* ABS */\r |
| 401 | if (diff < 10) diff = 10; /* MIN 10 */\r |
| 402 | sim_activate (uptr, diff * fd_stime); /* schedule */\r |
| 403 | return;\r |
| 404 | }\r |
| 405 | \r |
| 406 | /* Command complete */\r |
| 407 | \r |
| 408 | void fd_done (uint32 u, uint32 nsta, uint32 nes0, uint32 nes1)\r |
| 409 | {\r |
| 410 | fd_sta = (fd_sta | STA_IDL | nsta) & ~STA_BSY; /* set idle */\r |
| 411 | if (fd_arm) SET_INT (v_FD); /* if armed, int */\r |
| 412 | fd_es[u][0] = fd_es[u][0] | nes0; /* set ext state */\r |
| 413 | fd_es[u][1] = fd_es[u][1] | nes1;\r |
| 414 | return;\r |
| 415 | }\r |
| 416 | \r |
| 417 | /* Test for data transfer error */\r |
| 418 | \r |
| 419 | t_bool fd_dte (UNIT *uptr, t_bool wr)\r |
| 420 | {\r |
| 421 | uint32 u = uptr - fd_dev.units;\r |
| 422 | \r |
| 423 | if ((uptr->flags & UNIT_BUF) == 0) { /* not attached? */\r |
| 424 | fd_done (u, STA_ERR, ES0_ERR | ES0_FLT, ES1_NRDY);\r |
| 425 | return TRUE;\r |
| 426 | }\r |
| 427 | if (wr && (uptr->flags & UNIT_WPRT)) { /* wr protected? */\r |
| 428 | fd_done (u, STA_ERR, ES0_ERR | ES0_WRP, 0);\r |
| 429 | return TRUE;\r |
| 430 | }\r |
| 431 | if ((uptr->LRN == 0) || (uptr->LRN > FD_NUMLRN)) { /* bad LRN? */\r |
| 432 | fd_done (u, STA_ERR, ES0_ERR | ES0_LRN, 0);\r |
| 433 | return TRUE;\r |
| 434 | }\r |
| 435 | return FALSE;\r |
| 436 | }\r |
| 437 | \r |
| 438 | /* Header CRC calculation */\r |
| 439 | \r |
| 440 | uint32 fd_crc (uint32 crc, uint32 dat, uint32 cnt)\r |
| 441 | {\r |
| 442 | uint32 i, wrk;\r |
| 443 | \r |
| 444 | for (i = 0; i < cnt; i++) {\r |
| 445 | wrk = crc ^ dat;\r |
| 446 | crc = (crc << 1) & DMASK16;\r |
| 447 | if (wrk & SIGN16) crc = ((crc ^ 0x1020) + 1) & DMASK16;\r |
| 448 | dat = (dat << 1) & DMASK16;\r |
| 449 | }\r |
| 450 | return crc;\r |
| 451 | }\r |
| 452 | \r |
| 453 | /* Reset routine */\r |
| 454 | \r |
| 455 | t_stat fd_clr (DEVICE *dptr)\r |
| 456 | {\r |
| 457 | int32 i, j;\r |
| 458 | UNIT *uptr;\r |
| 459 | \r |
| 460 | fd_sta = STA_IDL; /* idle */\r |
| 461 | fd_cmd = 0; /* clear state */\r |
| 462 | fd_db = 0;\r |
| 463 | fd_bptr = 0;\r |
| 464 | fd_lrn = 1;\r |
| 465 | fd_wdv = 0;\r |
| 466 | for (i = 0; i < FD_NUMBY; i++) fdxb[i] = 0; /* clr xfr buf */\r |
| 467 | for (i = 0; i < FD_NUMDR; i++) { /* loop thru units */\r |
| 468 | for (j = 0; j < ES_SIZE; j++) fd_es[i][j] = 0; /* clr ext sta */\r |
| 469 | fd_es[i][2] = 1; /* sector 1 */\r |
| 470 | uptr = fd_dev.units + i;\r |
| 471 | sim_cancel (uptr); /* stop drive */\r |
| 472 | uptr->LRN = 1; /* clear state */\r |
| 473 | uptr->FNC = 0;\r |
| 474 | }\r |
| 475 | return SCPE_OK;\r |
| 476 | }\r |
| 477 | \r |
| 478 | t_stat fd_reset (DEVICE *dptr)\r |
| 479 | {\r |
| 480 | CLR_INT (v_FD); /* clear int */\r |
| 481 | CLR_ENB (v_FD); /* disable int */\r |
| 482 | fd_arm = 0; /* disarm int */\r |
| 483 | return fd_clr (dptr);;\r |
| 484 | }\r |
| 485 | \r |
| 486 | /* Bootstrap routine */\r |
| 487 | \r |
| 488 | #define BOOT_START 0x50\r |
| 489 | #define BOOT_LEN (sizeof (boot_rom) / sizeof (uint8))\r |
| 490 | \r |
| 491 | static uint8 boot_rom[] = {\r |
| 492 | 0xD5, 0x00, 0x00, 0xCF, /* ST: AL CF */\r |
| 493 | 0x43, 0x00, 0x00, 0x80 /* BR 80 */\r |
| 494 | };\r |
| 495 | \r |
| 496 | t_stat fd_boot (int32 unitno, DEVICE *dptr)\r |
| 497 | {\r |
| 498 | extern uint32 PC, dec_flgs;\r |
| 499 | extern uint16 decrom[];\r |
| 500 | \r |
| 501 | if (decrom[0xD5] & dec_flgs) return SCPE_NOFNC; /* AL defined? */\r |
| 502 | IOWriteBlk (BOOT_START, BOOT_LEN, boot_rom); /* copy boot */\r |
| 503 | IOWriteB (AL_DEV, fd_dib.dno); /* set dev no */\r |
| 504 | IOWriteB (AL_IOC, 0x86 + (unitno << CMD_V_UNIT)); /* set dev cmd, unit num */\r |
| 505 | IOWriteB (AL_SCH, 0); /* clr sch dev no */\r |
| 506 | PC = BOOT_START;\r |
| 507 | return SCPE_OK;\r |
| 508 | }\r |