github.com/rcornwell.sims
1
0
Fork 0
mirror of https://github.com/rcornwell/sims.git synced 2026-02-01 14:22:58 +00:00
Code Releases Activity
Files
665b2beda2b75253cd82105be4e147a54bf64af8
rcornwell.sims/SEL32/sel32_disk.c
James C. Bevier d9283178d9 SEL32: Reformat files to use DOS format and no tabbing
2019-07-17 21:39:18 -04:00

1166 lines
55 KiB
C
Raw Blame History

/* sel32_disk.c: SEL 32 2311/2314 Disk controller
Copyright (c) 2018, James C. Bevier
Portions provided by Richard Cornwell and other SIMH contributers
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
JAMES C. BEVIER 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.
*/
#include "sel32_defs.h"
extern t_stat set_dev_addr(UNIT * uptr, int32 val, CONST char *cptr, void *desc);
extern t_stat show_dev_addr(FILE * st, UNIT * uptr, int32 v, CONST void *desc);
extern void chan_end(uint16 chan, uint8 flags);
extern int chan_read_byte(uint16 chsa, uint8 *data);
extern int chan_write_byte(uint16 chsa, uint8 *data);
extern void set_devattn(uint16 addr, uint8 flags);
extern t_stat chan_boot(uint16 addr, DEVICE *dptr);
extern int test_write_byte_end(uint16 chsa);
extern uint32 M[]; /* our memory */
extern uint32 SPAD[]; /* cpu SPAD memory */
#ifdef NUM_DEVS_DISK
#define UNIT_V_TYPE (UNIT_V_UF + 0)
#define UNIT_TYPE (0xf << UNIT_V_TYPE)
#define GET_TYPE(x) ((UNIT_TYPE & (x)) >> UNIT_V_TYPE)
#define SET_TYPE(x) (UNIT_TYPE & ((x) << UNIT_V_TYPE))
#define UNIT_DISK UNIT_ATTABLE | UNIT_DISABLE | UNIT_ROABLE | UNIT_FIX
/* INCH command information */
/*
WD 0 - Data address
WD 1 - Flags - 0 -36 byte count
Data - 224 word INCH buffer address
WD 1 Drive 0 Attribute register
WD 2 Drive 1 Attribute register
WD 3 Drive 2 Attribute register
WD 4 Drive 3 Attribute register
WD 5 Drive 4 Attribute register
WD 6 Drive 5 Attribute register
WD 7 Drive 6 Attribute register
WD 8 Drive 7 Attribute register
Memory attribute register layout
bits 0-7 - Flags
bits 0&1 - 00=Reserved, 01=MHD, 10=FHD, 11=MHD with FHD option
bit 2 - 1=Cartridge module drive
bit 3 - 0=Reserved
bit 4 - 1=Drive not present
bit 5 - 1=Dual Port
bit 6 - 0=Reserved
bit 7 - 0=Reserved
bits 8-15 - sector count (sectors per track)(F16=16, F20=20)
bits 16-23 - MHD Head count (number of heads on MHD)
bits 24-31 - FHD head count (number of heads on FHD or number head on FHD option of mini-module)
*/
/* 224 word INCH Buffer layout */
/* 128 word subchannel status storage (SST) */
/* 66 words of program status queue (PSQ) */
/* 26 words of scratchpad */
/* 4 words of label buffer registers */
/* u3 */
/* in u3 is device command code and status */
#define DSK_CMDMSK 0x00ff /* Command being run */
#define DSK_STAR 0x0100 /* STAR value in u4 */
#define DSK_NU2 0x0200 /* */
#define DSK_READDONE 0x0400 /* Read finished, end channel */
#define DSK_ENDDSK 0x0800 /* Sensed end of disk */
#define DSK_SEEKING 0x1000 /* Disk is currently seeking */
#define DSK_READING 0x2000 /* Disk is reading data */
#define DSK_WRITING 0x4000 /* Disk is writing data */
#define DSK_BUSY 0x8000 /* Flag to send a CUE */
/* commands */
#define DSK_INCH 0x00 /* Initialize channel */
#define DSK_WD 0x01 /* Write data */
#define DSK_RD 0x02 /* Read data */
#define DSK_NOP 0x03 /* No operation */
#define DSK_SNS 0x04 /* Sense */
#define DSK_SCK 0x07 /* Seek cylinder, track, sector */
#define DSK_TIC 0x08 /* Transfer in channel */
#define DSK_FNSK 0x0B /* Format for no skip */
#define DSK_LPL 0x13 /* Lock protected label */
#define DSK_LMR 0x1F /* Load mode register */
#define DSK_RES 0x23 /* Reserve */
#define DSK_WSL 0x31 /* Write sector label */
#define DSK_RSL 0x32 /* Read sector label */
#define DSK_REL 0x33 /* Release */
#define DSK_XEZ 0x37 /* Rezero */
#define DSK_POR 0x43 /* Priority Override */
#define DSK_IHA 0x47 /* Increment head address */
#define DSK_SRM 0x4F /* Set reserve track mode */
#define DSK_WTL 0x51 /* Write track label */
#define DSK_RTL 0x52 /* Read track label */
#define DSK_XRM 0x5F /* Reset reserve track mode */
#define DSK_RAP 0xA2 /* Read angular positions */
#define DSK_TESS 0xAB /* Test STAR (subchannel target address register) */
#define DSK_ICH 0xFF /* Initialize Controller */
/* u4 - sector target address register (STAR) */
/* Holds the current cylinder, head(track), sector */
#define DISK_CYL 0xFFFF0000 /* cylinder mask */
#define DISK_TRACK 0x0000FF00 /* track mask */
#define DISK_SECTOR 0x000000ff /* sector mask */
/* u5 */
/* Sense byte 0 - mode register */
#define SNS_DROFF 0x80000000 /* Drive Carriage will be offset */
#define SNS_TRKOFF 0x40000000 /* Track offset: 0=positive, 1=negative */
#define SNS_RDTMOFF 0x20000000 /* Read timing offset = 1 */
#define SNS_RDSTRBT 0x10000000 /* Read strobe timing: 1=positive, 0=negative */
#define SNS_DIAGMOD 0x08000000 /* Diagnostic Mode ECC Code generation and checking */
#define SNS_RSVTRK 0x04000000 /* Reserve Track mode: 1=OK to write, 0=read only */
#define SNS_FHDOPT 0x02000000 /* FHD or FHD option = 1 */
#define SNS_RESERV 0x01000000 /* Reserved */
/* Sense byte 1 */
#define SNS_CMDREJ 0x800000 /* Command reject */
#define SNS_INTVENT 0x400000 /* Unit intervention required */
#define SNS_SPARE1 0x200000 /* Spare */
#define SNS_EQUCHK 0x100000 /* Equipment check */
#define SNS_DATCHK 0x080000 /* Data Check */
#define SNS_OVRRUN 0x040000 /* Data overrun/underrun */
#define SNS_DSKFERR 0x020000 /* Disk format error */
#define SNS_DEFTRK 0x010000 /* Defective track encountered */
/* Sense byte 2 */
#define SNS_LAST 0x8000 /* Last track flag encountered */
#define SNS_AATT 0x4000 /* At Alternate track */
#define SNS_WPER 0x2000 /* Write protection error */
#define SNS_WRL 0x1000 /* Write lock error */
#define SNS_MOCK 0x0800 /* Mode check */
#define SNS_INAD 0x0400 /* Invalid memory address */
#define SNS_RELF 0x0200 /* Release fault */
#define SNS_CHER 0x0100 /* Chaining error */
/* Sense byte 3 */
#define SNS_REVL 0x80 /* Revolution lost */
#define SNS_DADE 0x40 /* Disc addressing or seek error */
#define SNS_BUCK 0x20 /* Buffer check */
#define SNS_ECCS 0x10 /* ECC error in sector label */
#define SNS_ECCD 0x08 /* ECC error iin data */
#define SNS_ECCT 0x04 /* ECC error in track label */
#define SNS_RTAE 0x02 /* Reserve track access error */
#define SNS_UESS 0x01 /* Uncorrectable ECC error */
/* u6 */
/* u6 holds drive attribute entry */
/* provided by inch command for controller */
/*
bits 0-7 - Flags
bits 0&1 - 00=Reserved, 01=MHD, 10=FHD, 11=MHD with FHD option
bit 2 - 1=Cartridge module drive
bit 3 - 0=Reserved
bit 4 - 1=Drive not present
bit 5 - 1=Dual Port
bit 6 - 0=Reserved
bit 7 - 0=Reserved
bits 8-15 - sector count (sectors per track)(F16=16, F20=20)
bits 16-23 - MHD Head count (number of heads on MHD)
bits 24-31 - FHD head count (number of heads on FHD or number head on FHD option of mini-module)
*/
/* Pointer held in up7 */
/* sects/cylinder = sects/track * numhds */
/* allocated during attach command for each unit defined */
struct ddata_t
{
uint8 rbuf[1024]; /* read buffer, Sector buffer 768 or 1024 */
uint8 wbuf[1024]; /* write buffer, Sector buffer 768 or 1024 */
uint32 cpos; /* Position of head of cylinder in file */
uint32 tstart; /* Location of start of cyl/track/sect in data */
uint32 spare; /* drive register spare */
uint16 tsize; /* Size of one track in byte */
uint16 ssize; /* Size of one sector in bytes */
uint16 ccyl; /* Current Cylinder number */
uint16 cyl; /* Cylinder head at */
uint16 tpos; /* Track position */
uint16 spos; /* Sector position */
uint16 dlen; /* remaining in data */
uint16 rec; /* Current record number */
uint16 count; /* Remaining in current operation */
};
/* disk definition structure */
struct disk_t
{
char *name; /* Device ID Name */
uint32 taus; /* total allocation units */
uint16 bms; /* bit map size */
uint16 nhds; /* Number of heads */
uint16 ssiz; /* sector size in words */
uint16 spt; /* # sectors per track(cylinder) */
uint8 spau; /* # sectors per allocation unit */
uint8 spb; /* # sectors per block (192 WDS)*/
uint32 cyl; /* Number of cylinders */
uint8 type; /* Device type code */
}
disk_type[] =
{
/* Class E Disc Devices */
{"FE004", 5888, 184, 256, 192, 23, 1, 1, 1, 0x80}, /* 4 M */
{"CE010", 12800, 200, 2, 96, 16, 1, 2, 400, 0x60}, /* 10 M */
{"ME040", 23000, 719, 5, 192, 23, 2, 1, 400, 0x40}, /* 40 M */
{"ME080", 46000, 1438, 5, 192, 23, 2, 1, 800, 0x40}, /* 80 M */
{"ME300", 87400, 2732, 19, 192, 23, 4, 1, 800, 0x40}, /* 300 M */
{"FE005", 5888, 184, 4, 192, 23, 1, 1, 64, 0x80}, /* 5 M */
/* Class F Disc Devices */
{"FL001", 1334, 0, 2, 64, 26, 3, 3, 26, 0x40}, /* 1 M */
{"MH040", 20000, 625, 5, 192, 20, 2, 1, 40, 0x40}, /* 40 M */
{"MH080", 40000, 1250, 5, 192, 20, 2, 1, 80, 0x40}, /* 80 M */
{"MH300", 76000, 2375, 19, 192, 20, 4, 1, 800, 0x40}, /* 300 M */
{"FH005", 5120, 184, 4, 192, 20, 1, 1, 64, 0x80}, /* 5 M */
{"CD032", 8000, 250, 1, 192, 20, 2, 1, 800, 0x60}, /* 32 M */
{"CD032", 8000, 250, 1, 192, 20, 2, 1, 800, 0x60}, /* 32 M */
{"CD064", 8000, 250, 1, 192, 20, 2, 1, 800, 0x60}, /* 64 M */
{"CD064", 24000, 750, 3, 192, 20, 2, 1, 800, 0x60}, /* 64 M */
{"CD096", 8000, 250, 1, 192, 20, 2, 1, 800, 0x60}, /* 96 M */
{"CD096", 40000, 1250, 5, 192, 20, 2, 1, 800, 0x60}, /* 96 M */
{"MH600", 80000, 2500, 40, 192, 20, 8, 1, 80, 0x40}, /* 600 M */
{"FM600", 80000, 2500, 40, 192, 20, 8, 1, 80, 0x40}, /* 600 M */
{"FM600", 1600, 50, 40, 192, 20, 1, 1, 2, 0x80}, /* 600 M */
{NULL, 0}
};
#if 0
*****************************************************************
* DEVICE ID TABLE
*****************************************************************
SPACE
BOUND 1W
DID.TBL EQU $
*
*DEVICE ID NAME..................................................
*TOTAL ALLOC. UNITS..................................... :
*BIT MAP SIZE .............................. : :
*NO. OF HEADS ........................ : : :
*SECTOR SIZE ................... : : : :
*SECTORS/TRACK .............. : : : : :
*SECTORS/ALOC. UNIT.......... : : : : : :
*SECTORS/BLOCK ....... : : : : : : :
*OLD DEVICE ID NAME.... : : : : : : : :
* : : : : : : : : :
* ......:..:..:...:....:....:.....:......:........:
DID FORM 32, 8, 8, 8, 8, 16, 16, 32, 64
SPACE
* CLASS 'E' DISC DEVICES
DID C'DE01', 1, 1, 23, 192, 256, 184, 5888, C'FE004'
DID C'DE02', 2, 1, 16, 96, 2, 200, 12800, C'CE010'
DID C'DE04', 1, 2, 23, 192, 5, 719, 23000, C'ME040'
DID C'DE05', 1, 2, 23, 192, 5, 1438, 46000, C'ME080'
DID C'DE06', 1, 4, 23, 192, 19, 2732, 87400, C'ME300'
DID C'DE07', 1, 1, 23, 192, 4, 184, 5888, C'FE005'
* CLASS 'F' EXTENDED I/O DISC DEVICES
DID C'DF01', 3, 3, 26, 64, 2, , 1334, C'FL001'
DID C'DF02', 1, 2, 20, 192, 5, 625, 20000, C'MH040'
DID C'DF03', 1, 2, 20, 192, 5, 1250, 40000, C'MH080'
DID C'DF04', 1, 4, 20, 192, 19, 2375, 76000, C'MH300'
DID C'DF05', 1, 1, 20, 192, 4, 184, 5120, C'FH005'
DID C'DF06', 1, 2, 20, 192, 1, 250, 8000, C'CD032'
DID C'DF06', 1, 2, 20, 192, 1, 250, 8000, C'CD032'
DID C'DF07', 1, 2, 20, 192, 1, 250, 8000, C'CD064'
DID C'DF07', 1, 2, 20, 192, 3, 750, 24000, C'CD064'
DID C'DF08', 1, 2, 20, 192, 1, 250, 8000, C'CD096'
DID C'DF08', 1, 2, 20, 192, 5, 1250, 40000, C'CD096'
DID C'DF09', 1, 8, 20, 192, 40, 2500, 80000, C'MH600'
DID C'DF0A', 1, 8, 20, 192, 40, 2500, 80000, C'FM600'
DID C'DF0A', 1, 1, 20, 192, 40, 50, 1600, C'FM600'
*
#endif
uint8 disk_preio(UNIT *uptr, uint16 chan) ;
uint8 disk_startcmd(UNIT *uptr, uint16 chan, uint8 cmd) ;
uint8 disk_haltio(uint16 addr);
t_stat disk_srv(UNIT *);
t_stat disk_boot(int32, DEVICE *);
void disk_ini(UNIT *, t_bool);
t_stat disk_reset(DEVICE *);
t_stat disk_attach(UNIT *, CONST char *);
t_stat disk_detach(UNIT *);
t_stat disk_set_type(UNIT * uptr, int32 val, CONST char *cptr, void *desc);
t_stat disk_get_type(FILE * st, UNIT * uptr, int32 v, CONST void *desc);
t_stat disk_help (FILE *st, DEVICE *dptr, UNIT *uptr, int32 flag, const char *cptr);
const char *disk_description (DEVICE *dptr);
/* channel program information */
CHANP dda_chp[NUM_UNITS_DISK] = {0};
MTAB disk_mod[] = {
{MTAB_XTD | MTAB_VUN | MTAB_VALR, 0, "TYPE", "TYPE",
&disk_set_type, &disk_get_type, NULL, "Type of disk"},
{MTAB_XTD | MTAB_VUN | MTAB_VALR, 0, "DEV", "DEV", &set_dev_addr,
&show_dev_addr, NULL},
{0}
};
UNIT dda_unit[] = {
/* SET_TYPE(9) DM300 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x800)}, /* 0 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x801)}, /* 1 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x802)}, /* 2 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x803)}, /* 3 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x804)}, /* 4 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x805)}, /* 5 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x806)}, /* 6 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0x807)}, /* 7 */
};
//DIB dda_dib = {NULL, disk_startcmd, NULL, NULL, disk_ini, dda_unit, dda_chp, NUM_UNITS_DISK, 0x0f, 0x0800, 0, 0, 0};
DIB dda_dib = {
disk_preio, /* uint8 (*pre_io)(UNIT *uptr, uint16 chan)*/ /* Pre start I/O */
disk_startcmd, /* uint8 (*start_cmd)(UNIT *uptr, uint16 chan, uint8 cmd)*/ /* Start a command */
NULL, /* uint8 (*halt_io)(UNIT *uptr) */ /* Stop I/O */
NULL, /* uint8 (*test_io)(UNIT *uptr) */ /* Test I/O */
NULL, /* uint8 (*post_io)(UNIT *uptr) */ /* Post I/O */
disk_ini, /* void (*dev_ini)(UNIT *, t_bool) */ /* init function */
dda_unit, /* UNIT* units */ /* Pointer to units structure */
dda_chp, /* CHANP* chan_prg */ /* Pointer to chan_prg structure */
NUM_UNITS_DISK, /* uint8 numunits */ /* number of units defined */
0x0f, /* uint8 mask */ /* 16 devices - device mask */
0x0800, /* uint16 chan_addr */ /* parent channel address */
0, /* uint32 chan_fifo_in */ /* fifo input index */
0, /* uint32 chan_fifo_out */ /* fifo output index */
0, /* uint32 chan_fifo[FIFO_SIZE] */ /* interrupt status fifo for channel */
};
DEVICE dda_dev = {
"DMA", dda_unit, NULL, disk_mod,
NUM_UNITS_DISK, 16, 24, 4, 16, 32,
NULL, NULL, &disk_reset, &disk_boot, &disk_attach, &disk_detach,
// &dda_dib, DEV_BUF_NUM(0)|DEV_DISABLE|DEV_DEBUG, 0, dev_debug,
&dda_dib, DEV_DISABLE|DEV_DEBUG, 0, dev_debug,
NULL, NULL, &disk_help, NULL, NULL, &disk_description
};
#if NUM_DEVS_DISK > 1
/* channel program information */
CHANP ddb_chp[NUM_UNITS_DISK] = {0};
UNIT ddb_unit[] = {
/* SET_TYPE(9) DM300 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC00)}, /* 0 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC01)}, /* 1 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC02)}, /* 2 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC03)}, /* 3 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC04)}, /* 4 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC05)}, /* 5 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC06)}, /* 6 */
{UDATA(&disk_srv, UNIT_DISK|SET_TYPE(9), 0), 0, UNIT_ADDR(0xC07)}, /* 7 */
};
//DIB ddb_dib = {disk_startcmd, NULL, NULL, NULL, disk_ini, ddb_unit, ddb_chp, NUM_UNITS_DISK, 0x0f, 0x0C00, 0, 0, 0};
DIB ddb_dib = {
disk_preio, /* uint8 (*start_io)(UNIT *uptr, uint16 chan)*/ /* Pre Start I/O */
disk_startcmd, /* uint8 (*start_cmd)(UNIT *uptr, uint16 chan, uint8 cmd)*/ /* Start a command SIO */
NULL, /* uint8 (*halt_io)(UNIT *uptr) */ /* Stop I/O HIO */
NULL, /* uint8 (*test_io)(UNIT *uptr) */ /* Test I/O TIO */
NULL, /* uint8 (*post_io)(UNIT *uptr) */ /* Post I/O */
disk_ini, /* void (*dev_ini)(UNIT *, t_bool) */ /* init function */
ddb_unit, /* UNIT* units */ /* Pointer to units structure */
ddb_chp, /* CHANP* chan_prg */ /* Pointer to chan_prg structure */
NUM_UNITS_DISK, /* uint8 numunits */ /* number of units defined */
0x0f, /* uint8 mask */ /* 16 devices - device mask */
0x0C00, /* uint16 chan_addr */ /* parent channel address */
0, /* uint32 chan_fifo_in */ /* fifo input index */
0, /* uint32 chan_fifo_out */ /* fifo output index */
0, /* uint32 chan_fifo[FIFO_SIZE] */ /* interrupt status fifo for channel */
};
DEVICE ddb_dev = {
"DMB", ddb_unit, NULL, disk_mod,
NUM_UNITS_DISK, 16, 24, 4, 16, 32,
NULL, NULL, &disk_reset, &disk_boot, &disk_attach, &disk_detach,
// &ddb_dib, DEV_BUF_NUM(1)|DEV_DISABLE|DEV_DEBUG, 0, dev_debug,
&ddb_dib, DEV_DISABLE|DEV_DEBUG, 0, dev_debug,
NULL, NULL, &disk_help, NULL, NULL, &disk_description
};
#endif
/* start a disk operation */
uint8 disk_preio(UNIT *uptr, uint16 chan)
{
DEVICE *dptr = find_dev_from_unit(uptr);
int unit = (uptr - dptr->units);
if ((uptr->u3 & 0xff00) != 0) { /* just return if busy */
return SNS_BSY;
}
sim_debug(DEBUG_CMD, dptr, "dsk_preio unit=%d\n", unit);
return 0; /* good to go */
}
uint8 disk_startcmd(UNIT *uptr, uint16 chan, uint8 cmd)
{
uint16 addr = GET_UADDR(uptr->u3);
DEVICE *dptr = find_dev_from_unit(uptr);
int unit = (uptr - dptr->units);
uint8 ch;
sim_debug(DEBUG_CMD, dptr, "disk_startcmd unit %d cmd %x u3 %x\n", unit, cmd, uptr->u3);
if ((uptr->flags & UNIT_ATT) == 0) { /* unit attached status */
uptr->u5 |= SNS_INTVENT; /* unit intervention required */
if (cmd != DSK_SNS) /* we are completed with unit check status */
return SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK;
}
if ((uptr->u3 & DSK_CMDMSK) != 0) {
uptr->u3 |= DSK_BUSY; /* Flag we we are busy */
return SNS_BSY;
}
if ((uptr->u3 & 0xff00) != 0) { /* if any status info, we are busy */
return SNS_BSY;
}
sim_debug(DEBUG_CMD, dptr, "disk_startcmd CMD 2 unit=%d %02x\n", unit, cmd);
if ((uptr->flags & UNIT_ATT) == 0) { /* see if unit is attached */
if (cmd == DSK_SNS) { /* not attached, is cmd Sense 0x04 */
dosns:
sim_debug(DEBUG_CMD, dptr, "disk_startcmd CMD sense\n");
/* bytes 0,1 - Cyl entry from STAR reg in u4 */
ch = (uptr->u4 >> 24) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense STAR b0 unit=%d 1 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
ch = (uptr->u4 >> 16) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense STAR b1 unit=%d 1 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
/* byte 2 - Track entry from STAR reg in u4 */
ch = (uptr->u4 >> 8) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense STAR b2 unit=%d 1 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
/* byte 3 - Sector entry from STAR reg in u4 */
ch = (uptr->u4) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense STAR b3 unit=%d 1 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
/* bytes 4 - mode reg, byte 0 of u5 */
ch = (uptr->u5 >> 24) & 0xff; /* return the sense data for device */
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense unit=%d 1 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
/* bytes 5-7 - status bytes, bytes 1-3 of u5 */
ch = (uptr->u5 >> 16) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense unit=%d 2 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
ch = (uptr->u5 >> 8) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense unit=%d 3 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
ch = (uptr->u5) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "disk_startcmd sense unit=%d 4 %x\n", unit, ch);
chan_write_byte(addr, &ch) ;
/* bytes 8-11 - drive attribute register (DATR) entries from uptr->u6 via INCH cmd */
ch = (uptr->u6 >> 24) & 0xff;
chan_write_byte(addr, &ch) ;
ch = (uptr->u6 >> 16) & 0xff;
chan_write_byte(addr, &ch) ;
ch = (uptr->u6 >> 8 ) & 0xff;
chan_write_byte(addr, &ch) ;
ch = (uptr->u6 >> 0) & 0xff;
chan_write_byte(addr, &ch) ;
/* bytes 12 & 13 contain drive related status */
ch = 0; /* zero for now */
chan_write_byte(addr, &ch) ;
chan_write_byte(addr, &ch) ;
uptr->u5 &= 0xff000000; /* clear status bytes, but leave mode data */
return SNS_CHNEND|SNS_DEVEND;
}
if (cmd == 0x0) /* INCH cmd gives unit check */
return SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK;
uptr->u5 |= (SNS_INTVENT|SNS_CMDREJ); /* set new error status */
return SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK; /* we done */
}
/* Unit is online, so process a command */
switch (cmd) {
case DSK_INCH: /* INCH 0x00 */
{
uint32 mema; /* memory address */
int i;
UNIT *up = dptr->units; /* first unit for this device */
sim_debug(DEBUG_CMD, dptr, "disk_startcmd starting inch cmd addr %x u4 %x\n", addr, uptr->u4);
/* u4 has IOCD word 1 contents. For the disk processor it contains */
/* a pointer to the INCH buffer followed by 8 drive attribute words that */
/* contains the flags, sector count, MHD head count, and FHD count */
/* us9 has the byte count from IOCD wd2 and should be 0x24 (36) */
/* the INCH buffer address must be returned in u4 and us9 left non-zero */
/* just return OK and channel software will use up8 as status buffer */
mema = (uint32)uptr->u4; /* get memory address of buffer */
uptr->u4 = M[mema>>2]; /* get status buffer address for XIO return status */
sim_debug(DEBUG_CMD, dptr, "disk_startcmd starting inch cmd addr %x u4 %x mema %x units %d\n",
addr, uptr->u4, mema, dptr->numunits);
/* the next 8 words have drive data for each unit */
/* WARNING 8 drives must be defined for this controller */
/* so we will not have a map fault */
for (i=0; i<dptr->numunits && i<8; i++) { /* process all drives */
up->u6 = M[(mema>>2)+i+1]; /* save each unit's drive data */
up++; /* next unit for this device */
}
sim_debug(DEBUG_CMD, dptr, "disk_startcmd done inch cmd addr %x\n", addr);
return SNS_CHNEND|SNS_DEVEND;
break;
}
case DSK_SCK: /* Seek command 0x07 */
case DSK_XEZ: /* Rezero & Read IPL record 0x1f */
uptr->u3 &= ~(DSK_STAR); /* show we do not have seek STAR in u4 */
case DSK_WD: /* Write command 0x01 */
case DSK_RD: /* Read command 0x02 */
case DSK_LMR: /* read mode register */
uptr->u3 |= cmd; /* save cmd */
sim_debug(DEBUG_CMD, dptr, "disk_startcmd done with disk seek r/w cmd %x addr %x\n", cmd, addr);
sim_activate(uptr, 20); /* start things off */
return 0;
case DSK_NOP: /* NOP 0x03 */
return SNS_CHNEND|SNS_DEVEND; /* return OK */
case DSK_SNS: /* Sense 0x04 */
goto dosns; /* use code above */
break;
}
sim_debug(DEBUG_CMD, dptr, "disk_startcmd done with disk_startcmd %x addr %x u5 %x\n", cmd, addr, uptr->u5);
if (uptr->u5 & 0xff)
return SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK;
sim_activate(uptr, 20); /* start things off */
return SNS_CHNEND|SNS_DEVEND;
}
/* Handle processing of disk requests. */
t_stat disk_srv(UNIT * uptr)
{
uint16 chsa = GET_UADDR(uptr->u3);
DEVICE *dptr = find_dev_from_unit(uptr);
DIB *dibp = (DIB *)dptr->ctxt; /* get pointer to Dev Info Blk for this device */
CHANP *chp = (CHANP *)dibp->chan_prg; /* get pointer to channel program */
struct ddata_t *data = (struct ddata_t *)(uptr->up7);
int cmd = uptr->u3 & DSK_CMDMSK;
int type = GET_TYPE(uptr->flags);
int count = data->count;
int trk, cyl;
int unit = (uptr - dptr->units);
int i;
uint8 ch;
uint8 buf2[768];
uint8 buf[768];
sim_debug(DEBUG_DETAIL, &dda_dev, "disk_srv entry unit %d cmd %x chsa %x chan %x count %x\n",
unit, cmd, chsa, chsa>>8, chp->ccw_count);
if ((uptr->flags & UNIT_ATT) == 0) { /* unit attached status */
return SCPE_OK;
}
if ((uptr->flags & UNIT_ATT) == 0) { /* unit attached status */
uptr->u5 |= SNS_INTVENT; /* unit intervention required */
if (cmd != DSK_SNS) /* we are completed with unit check status */
return SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK;
}
sim_debug(DEBUG_CMD, dptr, "disk_srv cmd=%x chsa %04x count %x\n", cmd, chsa, chp->ccw_count);
switch (cmd) {
case 0: /* No command, stop disk */
break;
case DSK_SNS: /* 0x4 */
ch = uptr->u5 & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv sense unit=%d 1 %x\n", unit, ch);
chan_write_byte(chsa, &ch) ;
ch = (uptr->u5 >> 8) & 0xff;
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv sense unit=%d 2 %x\n", unit, ch);
chan_write_byte(chsa, &ch) ;
ch = 0;
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv sense unit=%d 3 %x\n", unit, ch);
chan_write_byte(chsa, &ch) ;
ch = unit;
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv sense unit=%d 4 %x\n", unit, ch);
chan_write_byte(chsa, &ch) ;
ch = 4;
uptr->u3 &= ~(0xff00);
chan_end(chsa, SNS_CHNEND|SNS_DEVEND);
break;
case DSK_SCK: /* Seek cylinder, track, sector 0x07 */
/* If we are waiting on seek to finish, check if there yet. */
if (uptr->u3 & DSK_SEEKING) {
/* see if on cylinder yet */
if ((uptr->u4 >> 16) == data->cyl) {
/* we are on cylinder, seek is done */
sim_debug(DEBUG_CMD, dptr, "dsk_srv seek on cylinder unit=%d %d %d\n",
unit, uptr->u4 >> 16, data->cyl);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
set_devattn(chsa, SNS_DEVEND); /* start the operation */
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv seek end unit=%d %x %x\n",
unit, uptr->u4 >> 16, data->cyl);
sim_activate(uptr, 20);
break;
} else {
/* Compute delay based of difference. */
/* Set next state = index */
i = (uptr->u4 >> 16) - data->cyl;
sim_debug(DEBUG_CMD, dptr, "dsk_srv seek unit=%d %x %x\n", unit, uptr->u4 >> 16, i);
if (i > 0 ) {
if (i > 50) {
data->cyl += 50; /* seek 50 cyl */
sim_activate(uptr, 800);
} else
if (i > 20) {
data->cyl += 20; /* seek 20 cyl */
sim_activate(uptr, 400);
} else {
data->cyl++; /* Seek 1 cyl */
sim_activate(uptr, 200);
}
if (data->cyl >= disk_type[type].cyl) /* test for over max */
data->cyl = disk_type[type].cyl-1; /* make max */
} else {
if (i < -50) {
data->cyl -= 50; /* seek 50 cyl */
sim_activate(uptr, 800);
} else
if (i < -20) {
data->cyl -= 20; /* seek 20 cyl */
sim_activate(uptr, 400);
} else {
data->cyl--; /* seek 1 cyl */
sim_activate(uptr, 200);
}
if (data->cyl < 0) /* test for less than zero */
data->cyl = 0; /* make zero */
}
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv seek next unit=%d %d %d\n", unit, uptr->u4 >> 16,
data->cyl);
sim_activate(uptr, 2);
break;
}
}
/* not seeking, so start a new seek */
/* Read in 4 character seek code */
for (i = 0; i < 4; i++) {
if (chan_read_byte(chsa, &buf[i])) {
/* we have error, bail out */
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
uptr->u5 |= SNS_CMDREJ|SNS_EQUCHK;
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
}
rezero:
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv seek unit=%d star %02d%02d %02d %02d\n",
unit, buf[0], buf[1], buf[2], buf[3]);
/* save STAR (target sector) data in u4 */
uptr->u4 = (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | (buf[3]);
cyl = uptr->u4 >> 16; /* get the cylinder */
trk = buf[2]; /* get the track */
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv SEEK cyl %d trk %d sec %d unit=%d\n", cyl&0xffff, trk, buf[3], unit);
/* FIXME do something with FHD here */
/* Check if seek valid */
if (cyl > disk_type[type].cyl || trk >= disk_type[type].nhds || buf[3] > disk_type[type].spt) {
sim_debug(DEBUG_CMD, dptr, "dsk_srv seek ERROR cyl %x trk %x sec %x unit=%d\n", cyl, trk, buf[3], unit);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
uptr->u5 |= SNS_CMDREJ|SNS_EQUCHK; /* set error status */
/* we have an error, tell user */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK); /* end command */
break;
}
uptr->u3 |= DSK_STAR; /* show we have seek STAR in u4 */
/* calc the sector address of data */
/* calculate file position in bytes of requested sector */
data->tstart = (cyl * disk_type[type].nhds * data->tsize) +
(trk * data->tsize) + (buf[3] * 0x300);
data->tpos = trk; /* save the track/head number */
data->spos = buf[3]; /* save the sector number */
data->count = 0; /* no data seen yet */
data->rec = 0; /* number of bytes in this sector */
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv seek start %x trk %x sec %x\n", data->tstart, trk, buf[3]);
if ((sim_fseek(uptr->fileref, data->tstart, SEEK_SET)) != 0) { /* seek home */
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv Error on seek to %x\n", data->tstart);
}
/* Check if already on correct cylinder */
if (trk != data->cyl) {
/* Do seek */
uptr->u3 |= DSK_SEEKING; /* show we are seeking */
sim_debug(DEBUG_DETAIL, dptr, "dsk_srv seek unit=%d trk %x cyl %x\n", unit, trk, data->cyl);
sim_activate(uptr, 20);
chan_end(chsa, SNS_CHNEND);
} else {
sim_debug(DEBUG_DETAIL, dptr,
"dsk_srv calc sect addr seek start %x trk %x sec %x\n", data->tstart, trk, buf[3]);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
sim_activate(uptr, 20);
chan_end(chsa, SNS_DEVEND|SNS_CHNEND);
}
return SCPE_OK;
case DSK_XEZ: /* Rezero & Read IPL record */
sim_debug(DEBUG_CMD, dptr, "RD REZERO IPL unit=%d seek 0\n", unit);
/* Do a seek to 0 */
uptr->u4 = 0; /* set STAR to 0, 0, 0 */
uptr->u3 &= ~(0xffff); /* remove old cmd */
uptr->u3 |= DSK_SCK; /* show as seek command */
data->tstart = 0; /* byte offset is 0 */
data->dlen = 0; /* no data written yet */
/* Read in 1 dummy character for length to inhibit SLI posting */
if (chan_read_byte(chsa, &buf[0])) {
/* we have error, bail out */
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
uptr->u5 |= SNS_CMDREJ|SNS_EQUCHK;
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
/* zero stuff */
buf[0] = buf[1] = buf[2] = buf[3] = 0;
goto rezero; /* murge with seek code */
break;
case DSK_LMR:
sim_debug(DEBUG_CMD, dptr, "Load Mode Reg unit=%d\n", unit);
/* Read in 1 character of mode data */
if (chan_read_byte(chsa, &buf[0])) {
/* we have error, bail out */
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
uptr->u5 |= SNS_CMDREJ|SNS_EQUCHK;
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
uptr->u3 &= ~(0xffff); /* remove old cmd */
uptr->u5 &= 0x00ffffff; /* clear old mode data */
uptr->u5 |= (buf[0] << 24); /* save mode value */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND);
break;
case DSK_RD: /* Read Data */
/* data->tstart has start of sector address in bytes */
if ((uptr->u3 & DSK_READING) == 0) { /* see if we are reading data */
uptr->u3 |= DSK_READING; /* read from disk starting */
data->dlen = 0; /* no data read yet */
sim_debug(DEBUG_CMD, dptr,
"DISK READ starting unit=%d u3 %x count %d rec %d\n", unit, uptr->u3, count, data->rec);
}
if (uptr->u3 & DSK_READING) { /* see if we are reading data */
/* read in a sector of data from disk */
if ((count=sim_fread(buf, 1, data->ssize, uptr->fileref)) != data->ssize) {
sim_debug(DEBUG_CMD, dptr, "Error %d on read %d of diskfile cyl %d hds %d sec %d\n",
count, data->ssize, data->cyl, data->tpos, data->spos);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
// sim_activate(uptr, 20);
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
sim_debug(DEBUG_CMD, dptr, "disk_srv after READ chsa %04x count %x\n", chsa, chp->ccw_count);
/* process the next sector of data */
data->rec = count; /* no bytes in sector yet */
count = 0; /* used here as a flag for short write */
for (i=0; i<(data->rec); i++) {
ch = buf[i]; /* get a char from buffer */
if (chan_write_byte(chsa, &ch)) { /* put a byte to memory */
sim_debug(DEBUG_DATAIO, dptr,
"DISK Read %d bytes from dskfile cyl %d hds %d sec %d tstart %x\r\n",
data->dlen+i, data->cyl, data->tpos, data->spos, data->tstart);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND);
goto rddone; }
}
data->dlen += data->rec; /* add byte read to total count */
sim_debug(DEBUG_CMD, dptr,
"DISK READ from sec end %d bytes end %d from diskfile cyl %d hds %d sec %d tstart %x\n",
data->dlen, data->ssize, data->cyl, data->tpos, data->spos, data->tstart);
data->spos++;
/* set sector to read next one */
if (data->spos >= (disk_type[type].spt)) {
data->spos = 0; /* number of sectors per track */
data->tpos++; /* track position */
if (data->tpos >= (disk_type[type].nhds)) {
data->tpos = 0; /* number of tracks per cylinder */
data->cyl++; /* cylinder position */
if (data->cyl >= (disk_type[type].cyl)) {
/* EOM reached, abort */
// sim_debug(DEBUG_CMD, dptr, "Error %d on read %d from diskfile cyl %d hds %d sec %d\n",
// i, data->ssize, data->cyl, data->tpos, data->spos);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
// sim_activate(uptr, 20);
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
}
}
/* see if we are done reading data */
if (test_write_byte_end(chsa)) {
sim_debug(DEBUG_DATAIO, dptr,
"DISK Read complete Read %d bytes from diskfile cyl %d hds %d sec %d tstart %x\n",
data->dlen, data->cyl, data->tpos, data->spos, data->tstart);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND);
}
rddone:
// sim_activate(uptr, 20);
sim_activate(uptr, 10); /* wait to read next sector */
break;
}
break;
case DSK_WD: /* Write Data */
/* data->tstart has start of sector address in bytes */
if ((uptr->u3 & DSK_WRITING) == 0) { /* see if we are writing data */
uptr->u3 |= DSK_WRITING; /* write to disk starting */
data->dlen = 0; /* no data written yet */
sim_debug(DEBUG_CMD, dptr, "DISK WRITE starting unit=%d u3 %x bytes %d rec %d\n",
unit, uptr->u3, data->dlen, data->rec);
}
if (uptr->u3 & DSK_WRITING) { /* see if we are writing data */
/* process the next sector of data */
data->rec = 0; /* no bytes in sector yet */
count = 0; /* used here as a flag for short read */
for (i=0; i<(data->ssize); i++) {
if (chan_read_byte(chsa, &ch)) { /* get a byte from memory */
/* if error on reading 1st byte, we are done writing */
if (i == 0) {
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
sim_debug(DEBUG_CMD, dptr,
"DISK Wrote %d bytes to diskfile cyl %d hds %d sec %d tstart %x\n",
data->dlen, data->cyl, data->tpos, data->spos, data->tstart);
chan_end(chsa, SNS_CHNEND|SNS_DEVEND);
goto wrdone;
}
ch = 0; /* finish out the sector with zero */
count++; /* show we have no more data to write */
}
buf2[i] = ch; /* save the char */
}
data->dlen += data->ssize; /* add 1 sector of bytes */
/* write the sector to disk */
if ((i=sim_fwrite(buf2, 1, data->ssize, uptr->fileref)) != data->ssize) {
sim_debug(DEBUG_CMD, dptr, "Error %d on write %d to diskfile cyl %d hds %d sec %d\n",
i, data->ssize, data->cyl, data->tpos, data->spos);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
if (count != 0) { /* see if done with write command */
sim_debug(DEBUG_DATAIO, dptr,
"DISK WroteB %d bytes to diskfile cyl %d hds %d sec %d tstart %x\n",
data->dlen, data->cyl, data->tpos, data->spos, data->tstart);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND); /* we done */
break;
}
sim_debug(DEBUG_CMD, dptr,
"DISK WR to sec end %d bytes end %d to diskfile cyl %d hds %d sec %d tstart %x\n",
data->dlen, data->ssize, data->cyl, data->tpos, data->spos, data->tstart);
data->spos++;
if (data->spos >= (disk_type[type].spt)) {
data->spos = 0; /* number of sectors per track */
data->tpos++; /* track position */
if (data->tpos >= (disk_type[type].nhds)) {
data->tpos = 0; /* number of tracks per cylinder */
data->cyl++; /* cylinder position */
if (data->cyl >= (disk_type[type].cyl)) {
/* EOM reached, abort */
sim_debug(DEBUG_DETAIL, dptr, "Error %d on write %d to diskfile cyl %d hds %d sec %d\n",
i, data->ssize, data->cyl, data->tpos, data->spos);
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
}
}
wrdone:
// sim_activate(uptr, 20);
sim_activate(uptr, 10);
break;
}
break;
default:
sim_debug(DEBUG_DETAIL, dptr, "invalid command=%d %x\n", unit, cmd);
uptr->u5 |= SNS_CMDREJ;
uptr->u3 &= ~(0xffff); /* remove old status bits & cmd */
chan_end(chsa, SNS_CHNEND|SNS_DEVEND|SNS_UNITCHK);
break;
}
sim_debug(DEBUG_DETAIL, dptr, "disk_srv done cmd=%x chsa %04x count %x\n", cmd, chsa, chp->ccw_count);
return SCPE_OK;
}
/* initialize the disk */
void disk_ini(UNIT *uptr, t_bool f)
{
DEVICE *dptr = find_dev_from_unit(uptr);
int i = GET_TYPE(uptr->flags);
uptr->u3 &= ~0xffff; /* clear out the flags but leave ch/sa */
/* capacity is tracks per allocation unit time sectors per allocation unit */
uptr->capac = disk_type[i].taus * disk_type[i].spau;
sim_debug(DEBUG_EXP, &dda_dev, "DMA init device %s on unit DMA%.1x cap %x\n",
dptr->name, GET_UADDR(uptr->u3), uptr->capac);
}
t_stat disk_reset(DEVICE * dptr)
{
return SCPE_OK;
}
/* create the disk file for the specified device */
int disk_format(UNIT *uptr) {
struct ddata_t *data = (struct ddata_t *)uptr->up7;
uint16 addr = GET_UADDR(uptr->u3);
int type = GET_TYPE(uptr->flags);
DEVICE *dptr = find_dev_from_unit(uptr);
uint16 tsize = data->tsize; /* get track size in bytes */
uint16 cyl;
uint16 hds;
uint16 spc = disk_type[type].nhds * disk_type[type].spt; /* sectors/cyl */
uint8 *buff;
/* see if user wants to initialize the disk */
if (!get_yn("Initialize disk? [Y] ", TRUE)) {
return 1;
}
/* seek to sector 0 */
if ((sim_fseek(uptr->fileref, 0, SEEK_SET)) != 0) { /* seek home */
fprintf(stderr, "Error on seek to 0\r\n");
}
/* get buffer for track data */
if ((buff = (uint8 *)calloc(tsize, sizeof(uint8))) == 0) {
detach_unit(uptr);
return SCPE_ARG;
}
sim_debug(DEBUG_CMD, dptr, "Creating disk file of capacity %d\n",
data->tsize * disk_type[type].cyl * disk_type[type].nhds);
/* write zeros to each track of the disk */
for (cyl = 0; cyl < disk_type[type].cyl; cyl++) {
for (hds=0; hds < disk_type[type].nhds; hds++) {
if ((sim_fwrite(buff, 1, data->tsize, uptr->fileref)) != data->tsize) {
sim_debug(DEBUG_CMD, dptr, "Error on write to diskfile cyl %d hds %d\n", cyl, hds);
}
}
if ((cyl % 20) == 0)
fputc('.', stderr);
}
/* seek home again */
sim_fseek(uptr->fileref, 0, SEEK_SET); /* seek home */
free(buff); /* free cylinder buffer */
data->cpos = 0;
data->ccyl = 0;
set_devattn(addr, SNS_DEVEND); /* start us up */
// sim_activate(uptr, 100);
return 0;
}
/* attach the selected file to the disk */
t_stat disk_attach(UNIT *uptr, CONST char *file)
{
uint16 addr = GET_UADDR(uptr->u3);
int type = GET_TYPE(uptr->flags);
DEVICE *dptr = find_dev_from_unit(uptr);
t_stat r;
uint16 tsize; /* track size in bytes */
uint16 ssize; /* sector size in bytes */
struct ddata_t *data;
uint8 buff[1024];
// int i;
/* have simulator attach the file to the unit */
if ((r = attach_unit(uptr, file)) != SCPE_OK)
return r;
if (disk_type[type].name == 0) { /* does the assigned disk have a name */
detach_unit(uptr); /* no, reject */
return SCPE_FMT; /* error */
}
/* get a buffer to hold disk_t structure */
/* extended data structure per unit */
if ((data = (struct ddata_t *)calloc(1, sizeof(struct ddata_t))) == 0) {
detach_unit(uptr);
return SCPE_FMT;
}
uptr->up7 = (void *)data; /* save pointer to structure in up7 */
/* track size in bytes is sectors/track times words/sector time 4 bytse/word */
tsize = disk_type[type].spt * disk_type[type].ssiz * 4; /* get track size in bytes */
data->tsize = tsize; /* save size of track in bytes */
uptr->capac = disk_type[type].taus * disk_type[type].spau; /* disk capacity in sectors */
ssize = disk_type[type].ssiz * 4; /* disk sector size in bytes */
uptr->capac *= ssize; /* disk capacity in bytes */
data->ssize = ssize; /* save sector size bytes */
sim_debug(DEBUG_CMD, dptr, "Disk taus %d spau %d ssiz %d cap %d\n",
disk_type[type].taus, disk_type[type].spau, disk_type[type].ssiz * 4, uptr->capac); /* disk capacity */
if ((sim_fseek(uptr->fileref, 0, SEEK_SET)) != 0) { /* seek home */
detach_unit(uptr); /* if no space, error */
return SCPE_FMT; /* error */
}
/* read in the 1st sector of the 'disk' */
if ((r = sim_fread(&buff[0], sizeof(uint8), ssize, uptr->fileref) != ssize)) {
sim_debug(DEBUG_CMD, &dda_dev, "Disk format fread ret = %x\n", r);
goto fmt;
}
if ((buff[0] | buff[1] | buff[2] | buff[3]) == 0) {
sim_debug(DEBUG_CMD, &dda_dev, "Disk format buf0 %x buf1 %x buf2 %x buf3 %x\n",
buff[0], buff[1], buff[2], buff[3]);
fmt:
/* format the drive */
if (disk_format(uptr)) {
detach_unit(uptr); /* if no space, error */
return SCPE_FMT; /* error */
}
}
if ((sim_fseek(uptr->fileref, 0, SEEK_SET)) != 0) { /* seek home */
detach_unit(uptr); /* if no space, error */
return SCPE_FMT; /* error */
}
data->ssize = ssize; /* save sector size in bytes */
data->tsize = tsize; /* save track size in bytes */
data->cpos = 0; /* current read/write position in cylinder*/
data->ccyl = 0; /* current cylinder number */
data->tpos = 0; /* current track position */
data->spos = 0; /* current sector position */
data->rec = 0; /* record length */
data->count = 0; /* clear count value */
// sim_debug(DEBUG_CMD, &dda_dev, "Attach %8s hds %d spt %d spc %d cyl %d capacity %d\n",
// disk_type[type].name, disk_type[type].nhds, disk_type[type].spt,
// disk_type[type].nhds * disk_type[type].spt,
// disk_type[type].cyl, uptr->capac);
// sim_debug(DEBUG_CMD, &dda_dev, "File %s attached to %s\r\n", file, disk_type[type].name);
set_devattn(addr, SNS_DEVEND);
// sim_activate(uptr, 100);
return SCPE_OK;
}
/* detach a disk device */
t_stat disk_detach(UNIT * uptr) {
struct ddata_t *data = (struct ddata_t *)uptr->up7;
if (data != 0) {
#ifdef CALLOC_BUFF
free(data->cbuf); /* free cylinder buffer */
#endif
free(data); /* free disk data structure */
}
uptr->up7 = 0; /* no pointer to disk data */
uptr->u3 &= ~0xffff; /* no cmd and flags */
return detach_unit(uptr); /* tell simh we are done with disk */
}
/* boot from the specified disk unit */
t_stat disk_boot(int32 unit_num, DEVICE * dptr) {
UNIT *uptr = &dptr->units[unit_num]; /* find disk unit number */
sim_debug(DEBUG_CMD, &dda_dev, "Disk Boot dev/unit %x\n", GET_UADDR(uptr->u3));
SPAD[0xf4] = GET_UADDR(uptr->u3); /* put boot device chan/sa into spad */
SPAD[0xf8] = 0xF000; /* show as F class device */
if ((uptr->flags & UNIT_ATT) == 0)
return SCPE_UNATT; /* attached? */
return chan_boot(GET_UADDR(uptr->u3), dptr); /* boot the ch/sa */
}
/* Disk option setting commands */
t_stat disk_set_type(UNIT * uptr, int32 val, CONST char *cptr, void *desc)
{
int i;
if (cptr == NULL)
return SCPE_ARG;
if (uptr == NULL)
return SCPE_IERR;
if (uptr->flags & UNIT_ATT)
return SCPE_ALATT;
for (i = 0; disk_type[i].name != 0; i++) {
if (strcmp(disk_type[i].name, cptr) == 0) {
uptr->flags &= ~UNIT_TYPE;
uptr->flags |= SET_TYPE(i);
// uptr->capac = disk_type[i].bpt * disk_type[i].heads * disk_type[i].cyl;
uptr->capac = disk_type[i].taus * disk_type[i].spau;
return SCPE_OK;
}
}
return SCPE_ARG;
}
t_stat
disk_get_type(FILE * st, UNIT * uptr, int32 v, CONST void *desc)
{
if (uptr == NULL)
return SCPE_IERR;
fputs("TYPE=", st);
fputs(disk_type[GET_TYPE(uptr->flags)].name, st);
return SCPE_OK;
}
/* help information for disk */
t_stat disk_help (FILE *st, DEVICE *dptr, UNIT *uptr, int32 flag,
const char *cptr)
{
int i;
fprintf (st, "SEL 2314 Disk Processor\r\n");
fprintf (st, "Use:\r\n");
fprintf (st, " sim> SET %sn TYPE=type\r\n", dptr->name);
fprintf (st, "Type can be: ");
for (i = 0; disk_type[i].name != 0; i++) {
fprintf(st, "%s", disk_type[i].name);
if (disk_type[i+1].name != 0)
fprintf(st, ", ");
}
fprintf (st, ".\nEach drive has the following storage capacity:\r\n");
for (i = 0; disk_type[i].name != 0; i++) {
int32 size = disk_type[i].taus * disk_type[i].spau;
size /= 1024;
size = (10 * size) / 1024;
fprintf(st, " %-8s %4d.%1dMB\r\n", disk_type[i].name, size/10, size%10);
}
fprint_set_help (st, dptr);
fprint_show_help (st, dptr);
return SCPE_OK;
}
const char *disk_description (DEVICE *dptr)
{
return "SEL 2314 Disk Processor";
}
#endif
View Git Blame Copy Permalink