folkert/simh-testsetgenerator
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions
simh-testsetgenerator/AltairZ80/s100_disk3.c
Mark Pizzolato fffad7c20e Merge changes from v3.9-0 rc1
2012-03-19 16:05:24 -07:00

662 lines
26 KiB
C
Raw Blame History

/*************************************************************************
* *
* $Id: s100_disk3.c 1997 2008-07-18 05:29:52Z hharte $ *
* *
* Copyright (c) 2007-2008 Howard M. Harte. *
* http://www.hartetec.com *
* *
* 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 HOWARD M. HARTE 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 Howard M. Harte shall *
* not be used in advertising or otherwise to promote the sale, use or *
* other dealings in this Software without prior written authorization *
* Howard M. Harte. *
* *
* SIMH Interface based on altairz80_hdsk.c, by Peter Schorn. *
* *
* Module Description: *
* CompuPro DISK3 Hard Disk Controller module for SIMH. *
* *
* Environment: *
* User mode only *
* *
*************************************************************************/
#include "altairz80_defs.h"
#if defined (_WIN32)
#include <windows.h>
#endif
#include "sim_imd.h"
/* Debug flags */
#define ERROR_MSG (1 << 0)
#define SEEK_MSG (1 << 1)
#define CMD_MSG (1 << 2)
#define RD_DATA_MSG (1 << 3)
#define WR_DATA_MSG (1 << 4)
#define STATUS_MSG (1 << 5)
#define IRQ_MSG (1 << 6)
#define VERBOSE_MSG (1 << 7)
#define SPECIFY_MSG (1 << 8)
#define DISK3_MAX_DRIVES 4
#define DISK3_CSR 0 /* R=DISK3 Status / W=DISK3 Control Register */
#define DISK3_DATA 1 /* R=Step Pulse / W=Write Data Register */
#define DISK3_OP_DRIVE 0x00
#define DISK3_OP_CYL 0x01
#define DISK3_OP_HEAD 0x02
#define DISK3_OP_SECTOR 0x03
#define DISK3_CMD_NULL 0x00
#define DISK3_CMD_READ_DATA 0x01
#define DISK3_CMD_WRITE_DATA 0x02
#define DISK3_CMD_WRITE_HEADER 0x03
#define DISK3_CMD_READ_HEADER 0x04
#define DISK3_STATUS_BUSY 0
#define DISK3_STATUS_RANGE 1
#define DISK3_STATUS_NOT_READY 2
#define DISK3_STATUS_TIMEOUT 3
#define DISK3_STATUS_DAT_CRC 4
#define DISK3_STATUS_WR_FAULT 5
#define DISK3_STATUS_OVERRUN 6
#define DISK3_STATUS_HDR_CRC 7
#define DISK3_STATUS_MAP_FULL 8
#define DISK3_STATUS_COMPLETE 0xFF /* Complete with No Error */
#define DISK3_CODE_NOOP 0x00
#define DISK3_CODE_VERSION 0x01
#define DISK3_CODE_GLOBAL 0x02
#define DISK3_CODE_SPECIFY 0x03
#define DISK3_CODE_SET_MAP 0x04
#define DISK3_CODE_HOME 0x05
#define DISK3_CODE_SEEK 0x06
#define DISK3_CODE_READ_HDR 0x07
#define DISK3_CODE_READWRITE 0x08
#define DISK3_CODE_RELOCATE 0x09
#define DISK3_CODE_FORMAT 0x0A
#define DISK3_CODE_FORMAT_BAD 0x0B
#define DISK3_CODE_STATUS 0x0C
#define DISK3_CODE_SELECT 0x0D
#define DISK3_CODE_EXAMINE 0x0E
#define DISK3_CODE_MODIFY 0x0F
#define DISK3_CMD_MASK 0x3F
#define DISK3_REQUEST_IRQ 0x80
#define DISK3_IOPB_LEN 16
#define DISK3_IOPB_CMD 0
#define DISK3_IOPB_STATUS 1
#define DISK3_IOPB_DRIVE 2
#define DISK3_IOPB_ARG1 3
#define DISK3_IOPB_ARG2 4
#define DISK3_IOPB_ARG3 5
#define DISK3_IOPB_ARG4 6
#define DISK3_IOPB_ARG5 7
#define DISK3_IOPB_ARG6 8
#define DISK3_IOPB_ARG7 9
#define DISK3_IOPB_DATA 10
#define DISK3_IOPB_LINK 13
#define DISK3_MODE_ABS 0xFF
#define DISK3_MODE_LOGICAL 0x00
typedef struct {
UNIT *uptr;
DISK_INFO *imd;
uint16 sectsize; /* sector size, not including pre/postamble */
uint16 nsectors; /* number of sectors/track */
uint16 nheads; /* number of heads */
uint16 ntracks; /* number of tracks */
uint16 res_tracks; /* Number of reserved tracks on drive. */
uint16 track; /* Current Track */
uint16 cur_sect; /* current starting sector of transfer */
uint16 cur_track; /* Current Track */
uint16 xfr_nsects; /* Number of sectors to transfer */
uint8 ready; /* Is drive ready? */
} DISK3_DRIVE_INFO;
typedef struct {
PNP_INFO pnp; /* Plug and Play */
uint8 sel_drive; /* Currently selected drive */
uint8 mode; /* mode (0xFF=absolute, 0x00=logical) */
uint8 retries; /* Number of retries to attempt */
uint8 ndrives; /* Number of drives attached to the controller */
uint32 link_addr; /* Link Address for next IOPB */
uint32 dma_addr; /* DMA Address for the current IOPB */
DISK3_DRIVE_INFO drive[DISK3_MAX_DRIVES];
uint8 iopb[16];
} DISK3_INFO;
static DISK3_INFO disk3_info_data = { { 0x0, 0, 0x90, 2 } };
static DISK3_INFO *disk3_info = &disk3_info_data;
/* Disk geometries:
* ST506 ST412 CMI5619 Q520 Q540 Q2080
* Sectsize: 1024 1024 1024 1024 1024 1024
* Sectors: 9 9 9 9 9 11
* Heads: 4 4 6 4 8 7
* Tracks: 153 306 306 512 512 1172
*/
/* Default geometry for a 20MB hard disk. */
#define C20MB_SECTSIZE 1024
#define C20MB_NSECTORS 9
#define C20MB_NHEADS 4
#define C20MB_NTRACKS 512
static int32 ntracks = C20MB_NTRACKS;
static int32 nheads = C20MB_NHEADS;
static int32 nsectors = C20MB_NSECTORS;
static int32 sectsize = C20MB_SECTSIZE;
extern uint32 PCX;
extern REG *sim_PC;
extern t_stat set_iobase(UNIT *uptr, int32 val, char *cptr, void *desc);
extern t_stat show_iobase(FILE *st, UNIT *uptr, int32 val, void *desc);
extern uint32 sim_map_resource(uint32 baseaddr, uint32 size, uint32 resource_type,
int32 (*routine)(const int32, const int32, const int32), uint8 unmap);
extern int32 find_unit_index(UNIT *uptr);
extern void raise_ss1_interrupt(uint8 intnum);
/* These are needed for DMA. */
extern void PutByteDMA(const uint32 Addr, const uint32 Value);
extern uint8 GetByteDMA(const uint32 Addr);
#define UNIT_V_DISK3_WLK (UNIT_V_UF + 0) /* write locked */
#define UNIT_DISK3_WLK (1 << UNIT_V_DISK3_WLK)
#define UNIT_V_DISK3_VERBOSE (UNIT_V_UF + 1) /* verbose mode, i.e. show error messages */
#define UNIT_DISK3_VERBOSE (1 << UNIT_V_DISK3_VERBOSE)
#define DISK3_CAPACITY (C20MB_NTRACKS*C20MB_NHEADS*C20MB_NSECTORS*C20MB_SECTSIZE) /* Default Disk Capacity */
static t_stat disk3_reset(DEVICE *disk3_dev);
static t_stat disk3_attach(UNIT *uptr, char *cptr);
static t_stat disk3_detach(UNIT *uptr);
static void raise_disk3_interrupt(void);
static int32 disk3dev(const int32 port, const int32 io, const int32 data);
/* static uint8 DISK3_Read(const uint32 Addr); */
static uint8 DISK3_Write(const uint32 Addr, uint8 cData);
static UNIT disk3_unit[] = {
{ UDATA (NULL, UNIT_FIX + UNIT_ATTABLE + UNIT_DISABLE + UNIT_ROABLE, DISK3_CAPACITY) },
{ UDATA (NULL, UNIT_FIX + UNIT_ATTABLE + UNIT_DISABLE + UNIT_ROABLE, DISK3_CAPACITY) },
{ UDATA (NULL, UNIT_FIX + UNIT_ATTABLE + UNIT_DISABLE + UNIT_ROABLE, DISK3_CAPACITY) },
{ UDATA (NULL, UNIT_FIX + UNIT_ATTABLE + UNIT_DISABLE + UNIT_ROABLE, DISK3_CAPACITY) }
};
static REG disk3_reg[] = {
{ DRDATA (NTRACKS, ntracks, 10), },
{ DRDATA (NHEADS, nheads, 8), },
{ DRDATA (NSECTORS, nsectors, 8), },
{ DRDATA (SECTSIZE, sectsize, 11), },
{ HRDATA (SEL_DRIVE, disk3_info_data.sel_drive, 3), },
{ HRDATA (MODE, disk3_info_data.mode, 8), },
{ HRDATA (RETRIES, disk3_info_data.retries, 8), },
{ HRDATA (NDRIVES, disk3_info_data.ndrives, 8), },
{ HRDATA (LINK_ADDR, disk3_info_data.link_addr, 32), },
{ HRDATA (DMA_ADDR, disk3_info_data.dma_addr, 32), },
{ BRDATA (IOPB, &disk3_info_data.iopb[DISK3_IOPB_CMD], 16, 8, 16), },
{ NULL }
};
static MTAB disk3_mod[] = {
{ MTAB_XTD|MTAB_VDV, 0, "IOBASE", "IOBASE", &set_iobase, &show_iobase, NULL },
{ UNIT_DISK3_WLK, 0, "WRTENB", "WRTENB", NULL },
{ UNIT_DISK3_WLK, UNIT_DISK3_WLK, "WRTLCK", "WRTLCK", NULL },
/* quiet, no warning messages */
{ UNIT_DISK3_VERBOSE, 0, "QUIET", "QUIET", NULL },
/* verbose, show warning messages */
{ UNIT_DISK3_VERBOSE, UNIT_DISK3_VERBOSE, "VERBOSE", "VERBOSE", NULL },
{ 0 }
};
/* Debug Flags */
static DEBTAB disk3_dt[] = {
{ "ERROR", ERROR_MSG },
{ "SEEK", SEEK_MSG },
{ "CMD", CMD_MSG },
{ "RDDATA", RD_DATA_MSG },
{ "WRDATA", WR_DATA_MSG },
{ "STATUS", STATUS_MSG },
{ "IRQ", IRQ_MSG },
{ "VERBOSE",VERBOSE_MSG },
{ "SPECIFY",SPECIFY_MSG },
{ NULL, 0 }
};
DEVICE disk3_dev = {
"DISK3", disk3_unit, disk3_reg, disk3_mod,
DISK3_MAX_DRIVES, 10, 31, 1, DISK3_MAX_DRIVES, DISK3_MAX_DRIVES,
NULL, NULL, &disk3_reset,
NULL, &disk3_attach, &disk3_detach,
&disk3_info_data, (DEV_DISABLE | DEV_DIS | DEV_DEBUG), ERROR_MSG,
disk3_dt, NULL, "Compupro ST-506 Disk Controller DISK3"
};
/* Reset routine */
static t_stat disk3_reset(DEVICE *dptr)
{
PNP_INFO *pnp = (PNP_INFO *)dptr->ctxt;
if(dptr->flags & DEV_DIS) { /* Disconnect I/O Ports */
sim_map_resource(pnp->io_base, pnp->io_size, RESOURCE_TYPE_IO, &disk3dev, TRUE);
} else {
/* Connect DISK3 at base address */
if(sim_map_resource(pnp->io_base, pnp->io_size, RESOURCE_TYPE_IO, &disk3dev, FALSE) != 0) {
printf("%s: error mapping I/O resource at 0x%04x\n", __FUNCTION__, pnp->io_base);
return SCPE_ARG;
}
}
disk3_info->link_addr = 0x50; /* After RESET, the link pointer is at 0x50. */
return SCPE_OK;
}
/* Attach routine */
static t_stat disk3_attach(UNIT *uptr, char *cptr)
{
t_stat r = SCPE_OK;
DISK3_DRIVE_INFO *pDrive;
int i = 0;
i = find_unit_index(uptr);
if (i == -1) {
return (SCPE_IERR);
}
pDrive = &disk3_info->drive[i];
pDrive->ready = 1;
pDrive->track = 5;
pDrive->ntracks = C20MB_NTRACKS;
pDrive->nheads = C20MB_NHEADS;
pDrive->nsectors = C20MB_NSECTORS;
pDrive->sectsize = C20MB_SECTSIZE;
r = attach_unit(uptr, cptr); /* attach unit */
if ( r != SCPE_OK) /* error? */
return r;
/* Determine length of this disk */
if(sim_fsize(uptr->fileref) != 0) {
uptr->capac = sim_fsize(uptr->fileref);
} else {
uptr->capac = (pDrive->ntracks * pDrive->nsectors * pDrive->nheads * pDrive->sectsize);
}
pDrive->uptr = uptr;
/* Default for new file is DSK */
uptr->u3 = IMAGE_TYPE_DSK;
if(uptr->capac > 0) {
r = assignDiskType(uptr);
if (r != SCPE_OK) {
disk3_detach(uptr);
return r;
}
}
if (uptr->flags & UNIT_DISK3_VERBOSE)
printf("DISK3%d, attached to '%s', type=%s, len=%d\n", i, cptr,
uptr->u3 == IMAGE_TYPE_IMD ? "IMD" : uptr->u3 == IMAGE_TYPE_CPT ? "CPT" : "DSK",
uptr->capac);
if(uptr->u3 == IMAGE_TYPE_IMD) {
if(uptr->capac < 318000) {
printf("Cannot create IMD files with SIMH.\nCopy an existing file and format it with CP/M.\n");
disk3_detach(uptr);
return SCPE_OPENERR;
}
if (uptr->flags & UNIT_DISK3_VERBOSE)
printf("--------------------------------------------------------\n");
disk3_info->drive[i].imd = diskOpen((uptr->fileref), (uptr->flags & UNIT_DISK3_VERBOSE));
if (uptr->flags & UNIT_DISK3_VERBOSE)
printf("\n");
} else {
disk3_info->drive[i].imd = NULL;
}
return SCPE_OK;
}
/* Detach routine */
t_stat disk3_detach(UNIT *uptr)
{
DISK3_DRIVE_INFO *pDrive;
t_stat r;
int8 i;
i = find_unit_index(uptr);
if (i == -1) {
return (SCPE_IERR);
}
pDrive = &disk3_info->drive[i];
pDrive->ready = 0;
if (uptr->flags & UNIT_DISK3_VERBOSE)
printf("Detach DISK3%d\n", i);
r = detach_unit(uptr); /* detach unit */
if ( r != SCPE_OK)
return r;
return SCPE_OK;
}
static int32 disk3dev(const int32 port, const int32 io, const int32 data)
{
sim_debug(VERBOSE_MSG, &disk3_dev, "DISK3: " ADDRESS_FORMAT
" IO %s, Port %02x\n", PCX, io ? "WR" : "RD", port);
if(io) {
DISK3_Write(port, data);
return 0;
} else {
return(0xFF);
}
}
static uint8 DISK3_Write(const uint32 Addr, uint8 cData)
{
uint32 next_link;
uint8 result = DISK3_STATUS_COMPLETE;
uint8 i;
uint8 cmd;
DISK3_DRIVE_INFO *pDrive;
for(i = 0; i < DISK3_IOPB_LEN; i++) {
disk3_info->iopb[i] = GetByteDMA(disk3_info->link_addr + i);
}
cmd = disk3_info->iopb[DISK3_IOPB_CMD];
disk3_info->sel_drive = disk3_info->iopb[DISK3_IOPB_DRIVE] & 0x03;
disk3_info->dma_addr = disk3_info->iopb[0x0A];
disk3_info->dma_addr |= disk3_info->iopb[0x0B] << 8;
disk3_info->dma_addr |= disk3_info->iopb[0x0C] << 16;
next_link = disk3_info->iopb[DISK3_IOPB_LINK+0];
next_link |= disk3_info->iopb[DISK3_IOPB_LINK+1] << 8;
next_link |= disk3_info->iopb[DISK3_IOPB_LINK+2] << 16;
sim_debug(VERBOSE_MSG, &disk3_dev, "DISK3[%d]: LINK=0x%05x, NEXT=0x%05x, CMD=%x, %s DMA@0x%05x\n",
disk3_info->sel_drive,
disk3_info->link_addr,
next_link,
disk3_info->iopb[DISK3_IOPB_CMD] & DISK3_CMD_MASK,
(disk3_info->iopb[DISK3_IOPB_CMD] & DISK3_REQUEST_IRQ) ? "IRQ" : "POLL",
disk3_info->dma_addr);
pDrive = &disk3_info->drive[disk3_info->sel_drive];
if(pDrive->ready) {
/* Perform command */
switch(cmd & DISK3_CMD_MASK) {
case DISK3_CODE_NOOP:
sim_debug(VERBOSE_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" NOOP\n", disk3_info->sel_drive, PCX);
break;
case DISK3_CODE_VERSION:
break;
case DISK3_CODE_GLOBAL:
sim_debug(CMD_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" GLOBAL\n", disk3_info->sel_drive, PCX);
disk3_info->mode = disk3_info->iopb[DISK3_IOPB_ARG1];
disk3_info->retries = disk3_info->iopb[DISK3_IOPB_ARG2];
disk3_info->ndrives = disk3_info->iopb[DISK3_IOPB_ARG3];
sim_debug(SPECIFY_MSG, &disk3_dev, " Mode: 0x%02x\n", disk3_info->mode);
sim_debug(SPECIFY_MSG, &disk3_dev, " # Retries: 0x%02x\n", disk3_info->retries);
sim_debug(SPECIFY_MSG, &disk3_dev, " # Drives: 0x%02x\n", disk3_info->ndrives);
if(disk3_info->mode == DISK3_MODE_ABS) {
sim_debug(ERROR_MSG, &disk3_dev, "DISK3: Absolute addressing not supported.\n");
}
break;
case DISK3_CODE_SPECIFY:
{
uint8 specify_data[22];
sim_debug(CMD_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" SPECIFY\n", disk3_info->sel_drive, PCX);
for(i = 0; i < 22; i++) {
specify_data[i] = GetByteDMA(disk3_info->dma_addr + i);
}
pDrive->sectsize = specify_data[4] | (specify_data[5] << 8);
pDrive->nsectors = specify_data[6] | (specify_data[7] << 8);
pDrive->nheads = specify_data[8] | (specify_data[9] << 8);
pDrive->ntracks = specify_data[10] | (specify_data[11] << 8);
pDrive->res_tracks = specify_data[18] | (specify_data[19] << 8);
sim_debug(SPECIFY_MSG, &disk3_dev, " Sectsize: %d\n", pDrive->sectsize);
sim_debug(SPECIFY_MSG, &disk3_dev, " Sectors: %d\n", pDrive->nsectors);
sim_debug(SPECIFY_MSG, &disk3_dev, " Heads: %d\n", pDrive->nheads);
sim_debug(SPECIFY_MSG, &disk3_dev, " Tracks: %d\n", pDrive->ntracks);
sim_debug(SPECIFY_MSG, &disk3_dev, " Reserved: %d\n", pDrive->res_tracks);
break;
}
case DISK3_CODE_HOME:
pDrive->track = 0;
sim_debug(SEEK_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" HOME\n", disk3_info->sel_drive, PCX);
break;
case DISK3_CODE_SEEK:
pDrive->track = disk3_info->iopb[DISK3_IOPB_ARG1];
pDrive->track |= (disk3_info->iopb[DISK3_IOPB_ARG2] << 8);
if(pDrive->track > pDrive->ntracks) {
sim_debug(ERROR_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" SEEK ERROR %d not found\n", disk3_info->sel_drive, PCX, pDrive->track);
pDrive->track = pDrive->ntracks - 1;
result = DISK3_STATUS_TIMEOUT;
} else {
sim_debug(SEEK_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" SEEK %d\n", disk3_info->sel_drive, PCX, pDrive->track);
}
break;
case DISK3_CODE_READ_HDR:
{
sim_debug(CMD_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" READ HEADER: %d\n", pDrive->track, PCX, pDrive->track >> 8);
PutByteDMA(disk3_info->dma_addr + 0, pDrive->track & 0xFF);
PutByteDMA(disk3_info->dma_addr + 1, (pDrive->track >> 8) & 0xFF);
PutByteDMA(disk3_info->dma_addr + 2, 0);
PutByteDMA(disk3_info->dma_addr + 3, 1);
break;
}
case DISK3_CODE_READWRITE:
{
uint32 track_len;
uint32 xfr_len;
uint32 file_offset;
uint32 xfr_count = 0;
uint8 *dataBuffer;
size_t rtn;
if(disk3_info->mode == DISK3_MODE_ABS) {
sim_debug(ERROR_MSG, &disk3_dev, "DISK3: Absolute addressing not supported.\n");
break;
}
pDrive->cur_sect = disk3_info->iopb[DISK3_IOPB_ARG2] | (disk3_info->iopb[DISK3_IOPB_ARG3] << 8);
pDrive->cur_track = disk3_info->iopb[DISK3_IOPB_ARG4] | (disk3_info->iopb[DISK3_IOPB_ARG5] << 8);
pDrive->xfr_nsects = disk3_info->iopb[DISK3_IOPB_ARG6] | (disk3_info->iopb[DISK3_IOPB_ARG7] << 8);
track_len = pDrive->nsectors * pDrive->sectsize;
file_offset = (pDrive->cur_track * track_len); /* Calculate offset based on current track */
file_offset += pDrive->cur_sect * pDrive->sectsize;
xfr_len = pDrive->xfr_nsects * pDrive->sectsize;
dataBuffer = malloc(xfr_len);
sim_fseek((pDrive->uptr)->fileref, file_offset, SEEK_SET);
if(disk3_info->iopb[DISK3_IOPB_ARG1] == 1) { /* Read */
rtn = sim_fread(dataBuffer, 1, xfr_len, (pDrive->uptr)->fileref);
sim_debug(RD_DATA_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" READ @0x%05x T:%04d/S:%04d/#:%d %s\n",
disk3_info->sel_drive,
PCX,
disk3_info->dma_addr,
pDrive->cur_track,
pDrive->cur_sect,
pDrive->xfr_nsects,
rtn == (size_t)xfr_len ? "OK" : "NOK" );
/* Perform DMA Transfer */
for(xfr_count = 0;xfr_count < xfr_len; xfr_count++) {
PutByteDMA(disk3_info->dma_addr + xfr_count, dataBuffer[xfr_count]);
}
} else { /* Write */
sim_debug(WR_DATA_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" WRITE @0x%05x T:%04d/S:%04d/#:%d\n", disk3_info->sel_drive, PCX, disk3_info->dma_addr, pDrive->cur_track, pDrive->cur_sect, pDrive->xfr_nsects );
/* Perform DMA Transfer */
for(xfr_count = 0;xfr_count < xfr_len; xfr_count++) {
dataBuffer[xfr_count] = GetByteDMA(disk3_info->dma_addr + xfr_count);
}
sim_fwrite(dataBuffer, 1, xfr_len, (pDrive->uptr)->fileref);
}
free(dataBuffer);
/* Update Track/Sector in IOPB */
pDrive->cur_sect += pDrive->xfr_nsects;
if(pDrive->cur_sect >= pDrive->nsectors) {
pDrive->cur_sect = pDrive->cur_sect % pDrive->nsectors;
pDrive->cur_track++;
}
disk3_info->iopb[DISK3_IOPB_ARG2] = pDrive->cur_sect & 0xFF;
disk3_info->iopb[DISK3_IOPB_ARG3] = (pDrive->cur_sect >> 8) & 0xFF;
disk3_info->iopb[DISK3_IOPB_ARG4] = pDrive->cur_track & 0xFF;
disk3_info->iopb[DISK3_IOPB_ARG5] = (pDrive->cur_track >> 8) & 0xFF;
disk3_info->iopb[DISK3_IOPB_ARG6] = 0;
disk3_info->iopb[DISK3_IOPB_ARG7] = 0;
/* Update the DATA field in the IOPB */
disk3_info->dma_addr += xfr_len;
disk3_info->iopb[DISK3_IOPB_DATA+0] = disk3_info->dma_addr & 0xFF;
disk3_info->iopb[DISK3_IOPB_DATA+1] = (disk3_info->dma_addr >> 8) & 0xFF;
disk3_info->iopb[DISK3_IOPB_DATA+2] = (disk3_info->dma_addr >> 16) & 0xFF;
break;
}
case DISK3_CODE_FORMAT:
{
uint32 data_len;
uint32 file_offset;
uint8 *fmtBuffer;
data_len = pDrive->nsectors * pDrive->sectsize;
sim_debug(WR_DATA_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" FORMAT T:%d/H:%d/Fill=0x%02x/Len=%d\n",
disk3_info->sel_drive,
PCX,
pDrive->track,
disk3_info->iopb[DISK3_IOPB_ARG3],
disk3_info->iopb[DISK3_IOPB_ARG2],
data_len);
file_offset = (pDrive->track * (pDrive->nheads) * data_len); /* Calculate offset based on current track */
file_offset += (disk3_info->iopb[DISK3_IOPB_ARG3] * data_len);
fmtBuffer = malloc(data_len);
memset(fmtBuffer, disk3_info->iopb[DISK3_IOPB_ARG2], data_len);
sim_fseek((pDrive->uptr)->fileref, file_offset, SEEK_SET);
sim_fwrite(fmtBuffer, 1, data_len, (pDrive->uptr)->fileref);
free(fmtBuffer);
break;
}
case DISK3_CODE_SET_MAP:
break;
case DISK3_CODE_RELOCATE:
case DISK3_CODE_FORMAT_BAD:
case DISK3_CODE_STATUS:
case DISK3_CODE_SELECT:
case DISK3_CODE_EXAMINE:
case DISK3_CODE_MODIFY:
default:
sim_debug(ERROR_MSG, &disk3_dev, "DISK3[%d]: " ADDRESS_FORMAT
" CMD=%x Unsupported\n",
disk3_info->sel_drive,
PCX,
cmd & DISK3_CMD_MASK);
break;
}
} else { /* Drive not ready */
result = DISK3_STATUS_NOT_READY;
}
/* Return status */
disk3_info->iopb[DISK3_IOPB_STATUS] = result;
/* Update IOPB in host memory */
for(i = 0; i < DISK3_IOPB_LEN; i++) {
PutByteDMA(disk3_info->link_addr + i, disk3_info->iopb[i]);
}
if(cmd & DISK3_REQUEST_IRQ) {
raise_disk3_interrupt();
}
disk3_info->link_addr = next_link;
return 0;
}
#define SS1_VI1_INT 1 /* DISK2/DISK3 interrupts tied to VI1 */
static void raise_disk3_interrupt(void)
{
sim_debug(IRQ_MSG, &disk3_dev, "DISK3: " ADDRESS_FORMAT " Interrupt\n", PCX);
raise_ss1_interrupt(SS1_VI1_INT);
}
Reference in a new issue View git blame Copy permalink