MacIIROMDiskDriver/rdisk.c

343 lines
11 KiB
C
Raw Normal View History

2020-06-22 04:10:31 +00:00
#include <Memory.h>
#include <Devices.h>
#include <Files.h>
#include <Disks.h>
#include <Errors.h>
#include <Events.h>
#include <OSUtils.h>
2020-06-26 07:12:08 +00:00
#include "rdisk.h"
2020-07-16 06:27:38 +00:00
// Decode keyboard/PRAM settings
2021-04-02 02:05:21 +00:00
static void RDDecodeSettings(Ptr unmountEN, Ptr mountEN, Ptr ramEN, Ptr dbgEN, Ptr cdrEN) {
2021-03-04 17:44:11 +00:00
// Read PRAM
char legacy_startup, legacy_ram;
RDiskReadXPRAM(1, 4, &legacy_startup);
RDiskReadXPRAM(1, 5, &legacy_ram);
// Decode settings: unmount (don't boot), mount (after boot), RAM disk
2020-07-16 06:27:38 +00:00
if (RDiskIsRPressed()) { // R boots from ROM disk
2021-03-04 17:44:11 +00:00
*unmountEN = 0; // Don't unmount so we boot from this drive
*mountEN = 0; // No need to mount later since we are boot disk
*ramEN = RDiskIsAPressed(); // A enables RAM disk
2020-07-02 07:06:35 +00:00
} else {
2021-03-04 17:44:11 +00:00
if (legacy_startup & 0x01) { // Boot from ROM disk
*unmountEN = 0; // Don't unmount so we boot from this drive
*mountEN = 0; // No need to mount later since we are boot disk
*ramEN = legacy_ram & 0x01;
} else if (legacy_startup & 0x02) { // Mount ROM disk
*unmountEN = 1; // Unmount to not boot from our disk
*mountEN = 1; // Mount in accRun
*ramEN = legacy_ram & 0x01;
2020-07-12 02:41:51 +00:00
} else {
2021-03-04 17:44:11 +00:00
*unmountEN = 1; // Unmount
*mountEN = 0; // Don't mount again
*ramEN = 0; // Don't allocate RAM disk
2020-07-12 02:41:51 +00:00
}
2020-07-02 07:06:35 +00:00
}
2021-03-04 17:44:11 +00:00
2021-04-02 02:05:21 +00:00
// MacsBug enabled if bit 2 == 1 or not boot
*dbgEN = *unmountEN || (legacy_startup & 0x04);
2021-03-04 17:44:11 +00:00
2021-04-02 02:05:21 +00:00
// CD-ROM enabled if bit 3 == 0 or not boot
*cdrEN = *unmountEN || !(legacy_startup & 0x08);
2020-06-30 01:08:50 +00:00
}
2020-07-15 06:26:28 +00:00
// Switch to 32-bit mode and copy
#pragma parameter C24(__A0, __A1, __D0)
2021-04-02 09:38:28 +00:00
void __attribute__ ((noinline)) C24(Ptr sourcePtr, Ptr destPtr, unsigned long byteCount) {
2021-03-04 20:22:34 +00:00
signed char mode = true32b;
2020-06-22 04:10:31 +00:00
SwapMMUMode(&mode);
BlockMove(sourcePtr, destPtr, byteCount);
2020-06-22 04:10:31 +00:00
SwapMMUMode(&mode);
}
2021-04-02 08:21:40 +00:00
// Switch to 32-bit mode and get
2021-04-02 09:38:28 +00:00
#pragma parameter __D0 G24(__A2)
2021-04-02 08:21:40 +00:00
char __attribute__ ((noinline)) G24(Ptr pos) {
2021-04-02 09:38:28 +00:00
long ret;
signed char mode = true32b;
SwapMMUMode(&mode);
2021-04-02 09:38:28 +00:00
ret = *pos; // Peek
2021-04-02 08:21:40 +00:00
SwapMMUMode(&mode);
2021-04-02 09:38:28 +00:00
return ret;
2021-04-02 08:21:40 +00:00
}
// Switch to 32-bit mode and set
#pragma parameter S24(__A2, __D3)
void __attribute__ ((noinline)) S24(Ptr pos, char patch) {
signed char mode = true32b;
SwapMMUMode(&mode);
*pos = patch; // Poke
SwapMMUMode(&mode);
}
2020-07-12 02:41:51 +00:00
// Figure out the first available drive number >= 5
static int RDFindDrvNum() {
2020-07-12 02:41:51 +00:00
DrvQElPtr dq;
int drvNum = 5;
for (dq = (DrvQElPtr)(GetDrvQHdr())->qHead; dq; dq = (DrvQElPtr)dq->qLink) {
if (dq->dQDrive >= drvNum) { drvNum = dq->dQDrive + 1; }
}
return drvNum;
}
#pragma parameter __D0 RDOpen(__A0, __A1)
OSErr RDOpen(IOParamPtr p, DCtlPtr d) {
2020-06-24 17:18:47 +00:00
int drvNum;
2020-06-22 04:10:31 +00:00
RDiskStorage_t *c;
2021-03-04 16:59:10 +00:00
char legacy_startup;
2020-06-22 04:10:31 +00:00
// Do nothing if already opened
if (d->dCtlStorage) { return noErr; }
2020-06-24 17:11:59 +00:00
2020-07-15 06:13:25 +00:00
// Do nothing if inhibited
RDiskReadXPRAM(1, 4, &legacy_startup);
if (legacy_startup & 0x80) { return noErr; }
2020-07-15 06:13:25 +00:00
2020-06-22 04:10:31 +00:00
// Allocate storage struct
d->dCtlStorage = NewHandleSysClear(sizeof(RDiskStorage_t));
if (!d->dCtlStorage) { return openErr; }
// Lock our storage struct and get master pointer
HLock(d->dCtlStorage);
c = *(RDiskStorage_t**)d->dCtlStorage;
2020-07-12 02:41:51 +00:00
// Find first available drive number
drvNum = RDFindDrvNum();
2020-06-24 17:18:47 +00:00
2020-06-22 04:10:31 +00:00
// Set drive status
2020-07-16 06:27:38 +00:00
//c->status.track = 0;
2020-07-12 02:41:51 +00:00
c->status.writeProt = -1; // nonzero is write protected
c->status.diskInPlace = 8; // 8 is nonejectable disk
c->status.installed = 1; // drive installed
2020-07-16 06:27:38 +00:00
//c->status.sides = 0;
//c->status.qType = 1;
c->status.dQDrive = drvNum;
2020-07-16 06:27:38 +00:00
//c->status.dQFSID = 0;
c->status.dQRefNum = d->dCtlRefNum;
c->status.driveSize = RDiskSize / 512;
2020-07-16 06:27:38 +00:00
//c->status.driveS1 = (RDiskSize / 512) >> 16;
2020-06-24 17:18:47 +00:00
2020-07-12 02:41:51 +00:00
// Decompress icon
2020-07-16 06:27:38 +00:00
#ifdef RDISK_COMPRESS_ICON_ENABLE
2020-07-12 02:41:51 +00:00
char *src = &RDiskIconCompressed[0];
char *dst = &c->icon[0];
2020-07-16 06:27:38 +00:00
UnpackBits(&src, &dst, RDISK_ICON_SIZE);
2020-07-12 02:41:51 +00:00
#endif
2020-06-22 04:10:31 +00:00
// Add drive to drive queue and return
RDiskAddDrive(c->status.dQRefNum, drvNum, (DrvQElPtr)&c->status.qLink);
2020-06-22 04:10:31 +00:00
return noErr;
}
2020-07-16 06:27:38 +00:00
// Init is called at beginning of first prime (read/write) call
static void RDInit(IOParamPtr p, DCtlPtr d, RDiskStorage_t *c) {
2021-04-02 02:05:21 +00:00
char unmountEN, mountEN, ramEN, dbgEN, cdrEN;
2020-06-24 17:18:47 +00:00
// Mark init done
2020-06-30 01:08:50 +00:00
c->initialized = 1;
2020-07-02 07:06:35 +00:00
// Decode settings
2021-04-02 02:05:21 +00:00
RDDecodeSettings(&unmountEN, &mountEN, &ramEN, &dbgEN, &cdrEN);
2021-04-02 07:51:40 +00:00
2020-07-12 02:41:51 +00:00
// If RAM disk enabled, try to allocate RAM disk buffer if not already
if (ramEN & !c->ramdisk) {
2020-07-02 07:06:35 +00:00
if (*MMU32bit) { // 32-bit mode
unsigned long minBufPtr, newBufPtr;
// Compute if there is enough high memory
minBufPtr = ((unsigned long)*MemTop / 2) + 1024;
newBufPtr = (unsigned long)*BufPtr - RDiskSize;
if (newBufPtr > minBufPtr && (unsigned long)*BufPtr > newBufPtr) {
// Allocate RAM disk buffer by lowering BufPtr
*BufPtr = (Ptr)newBufPtr;
// Set RAM disk buffer pointer.
c->ramdisk = *BufPtr;
// Copy ROM disk image to RAM disk
BlockMove(RDiskBuf, c->ramdisk, RDiskSize);
// Clearing write protect marks RAM disk enabled
c->status.writeProt = 0;
2020-07-02 07:58:25 +00:00
}
2020-07-02 07:06:35 +00:00
} else { // 24-bit mode
// Put RAM disk just past 8MB
2020-07-12 02:41:51 +00:00
c->ramdisk = (Ptr)(8 * 1024 * 1024);
2020-07-02 07:06:35 +00:00
// Copy ROM disk image to RAM disk
//FIXME: what if we don't have enough RAM?
// Will this wrap around and overwrite low memory?
// That's not the worst, since the system would just crash,
// but it would be better to switch to read-only status
copy24(RDiskBuf, c->ramdisk, RDiskSize);
// Clearing write protect marks RAM disk enabled
c->status.writeProt = 0;
2020-07-02 07:06:35 +00:00
}
2020-07-02 07:58:25 +00:00
}
2020-07-02 07:06:35 +00:00
2021-04-02 10:29:33 +00:00
// Get debug and CD-ROM disable settings from ROM table
2021-04-03 13:21:59 +00:00
c->dbgDisPos = *(long*)0x40851D98;
c->cdrDisPos = *(long*)0x40851D9C;
c->dbgDisByte = *(char*)0x40851DA8;
c->cdrDisByte = *(char*)0x40851DA9;
2021-04-02 10:29:33 +00:00
// Patch
if (c->dbgDisPos < RDiskSize) {
2021-04-03 13:21:59 +00:00
if (c->ramdisk && !dbgEN) {
poke24(c->ramdisk + c->dbgDisPos, c->dbgDisByte);
} else if (dbgEN) {
peek24(RDiskBuf + c->dbgDisPos, c->dbgDisByte);
2021-04-02 10:29:33 +00:00
}
}
2021-04-03 13:21:59 +00:00
if (c->cdrDisPos < RDiskSize) {
if (c->ramdisk && !cdrEN) {
poke24(c->ramdisk + c->cdrDisPos, c->cdrDisByte);
} else if (cdrEN) {
peek24(RDiskBuf + c->cdrDisPos, c->cdrDisByte);
2021-04-02 10:29:33 +00:00
}
2021-04-02 04:43:39 +00:00
}
2020-07-12 02:41:51 +00:00
// Unmount if not booting from ROM disk
2020-07-16 06:27:38 +00:00
if (unmountEN) { c->status.diskInPlace = 0; }
2020-07-02 07:06:35 +00:00
2020-07-12 02:41:51 +00:00
// If mount enabled, enable accRun to post disk inserted event later
if (mountEN) {
d->dCtlDelay = 150; // Set accRun delay (150 ticks is 2.5 sec.)
2020-07-16 06:27:38 +00:00
d->dCtlFlags |= dNeedTimeMask; // Enable accRun
2020-07-12 02:41:51 +00:00
}
2020-06-22 04:10:31 +00:00
}
#pragma parameter __D0 RDPrime(__A0, __A1)
OSErr RDPrime(IOParamPtr p, DCtlPtr d) {
2020-06-22 04:10:31 +00:00
RDiskStorage_t *c;
char cmd;
2020-07-12 02:41:51 +00:00
Ptr disk;
2020-06-22 04:10:31 +00:00
// Return disk offline error if dCtlStorage null
2020-07-12 02:41:51 +00:00
if (!d->dCtlStorage) { return notOpenErr; }
2020-06-22 04:10:31 +00:00
// Dereference dCtlStorage to get pointer to our context
c = *(RDiskStorage_t**)d->dCtlStorage;
// Initialize if this is the first prime call
if (!c->initialized) { RDInit(p, d, c); }
2020-07-12 02:41:51 +00:00
// Return disk offline error if virtual disk not inserted
if (!c->status.diskInPlace) { return offLinErr; }
2020-06-22 04:10:31 +00:00
// Get pointer to RAM or ROM disk buffer
2020-07-12 02:41:51 +00:00
disk = (c->ramdisk ? c->ramdisk : RDiskBuf) + d->dCtlPosition;
// Bounds checking
if (d->dCtlPosition >= RDiskSize || p->ioReqCount >= RDiskSize ||
d->dCtlPosition + p->ioReqCount >= RDiskSize) { return paramErr; }
2020-06-22 04:10:31 +00:00
// Service read or write request
cmd = p->ioTrap & 0x00FF;
if (cmd == aRdCmd) { // Read
// Read from disk into buffer.
2020-06-26 07:12:08 +00:00
if (*MMU32bit) { BlockMove(disk, p->ioBuffer, p->ioReqCount); }
2020-07-15 06:24:27 +00:00
else { copy24(disk, StripAddress(p->ioBuffer), p->ioReqCount); }
2021-04-02 08:21:40 +00:00
if (!c->ramdisk && c->dbgDisPos >= d->dCtlPosition &&
2021-04-02 07:51:40 +00:00
c->dbgDisPos < d->dCtlPosition + p->ioReqCount) {
p->ioBuffer[c->dbgDisPos - d->dCtlPosition] = c->dbgDisByte;
}
2021-04-02 08:21:40 +00:00
if (!c->ramdisk && c->cdrDisPos >= d->dCtlPosition &&
2021-04-02 07:51:40 +00:00
c->cdrDisPos < d->dCtlPosition + p->ioReqCount) {
p->ioBuffer[c->cdrDisPos - d->dCtlPosition] = c->cdrDisByte;
}
2020-06-22 04:10:31 +00:00
} else if (cmd == aWrCmd) { // Write
2020-06-26 07:12:08 +00:00
// Fail if write protected or RAM disk buffer not set up
if (c->status.writeProt || !c->ramdisk) { return wPrErr; }
2020-06-22 04:10:31 +00:00
// Write from buffer into disk.
if (*MMU32bit) { BlockMove(p->ioBuffer, disk, p->ioReqCount); }
2020-07-15 06:24:27 +00:00
else { copy24(StripAddress(p->ioBuffer), disk, p->ioReqCount); }
2020-07-12 02:41:51 +00:00
} else { return noErr; } //FIXME: Fail if cmd isn't read or write?
// Update count and position/offset, then return
d->dCtlPosition += p->ioReqCount;
p->ioActCount = p->ioReqCount;
return noErr;
2020-06-22 04:10:31 +00:00
}
#pragma parameter __D0 RDCtl(__A0, __A1)
OSErr RDCtl(CntrlParamPtr p, DCtlPtr d) {
2020-06-22 04:10:31 +00:00
RDiskStorage_t *c;
2020-06-26 07:12:08 +00:00
// Fail if dCtlStorage null
2020-07-12 02:41:51 +00:00
if (!d->dCtlStorage) { return notOpenErr; }
2020-06-22 04:10:31 +00:00
// Dereference dCtlStorage to get pointer to our context
c = *(RDiskStorage_t**)d->dCtlStorage;
// Handle control request based on csCode
2020-06-26 07:12:08 +00:00
switch (p->csCode) {
2020-07-16 06:27:38 +00:00
case killCode:
return noErr;
2021-04-02 05:16:47 +00:00
case kFormat:
2020-07-16 06:27:38 +00:00
if (!c->status.diskInPlace || c->status.writeProt ||
!c->ramdisk) { return controlErr; }
long long z = 0;
Ptr pz;
2021-04-03 13:21:59 +00:00
if (*MMU32bit) { pz = (Ptr)&z; }
else { pz = StripAddress((Ptr)&z); }
for (int i = 0; i < 4095; i++) {
copy24(c->ramdisk + i * sizeof(z), pz, sizeof(z));
}
2021-04-02 05:16:47 +00:00
return noErr;
2020-07-12 02:41:51 +00:00
case kVerify:
if (!c->status.diskInPlace) { return controlErr; }
return noErr;
case kEject:
// "Reinsert" disk if ejected illegally
2020-07-16 06:27:38 +00:00
if (c->status.diskInPlace) {
PostEvent(diskEvt, c->status.dQDrive);
}
2020-07-12 02:41:51 +00:00
return controlErr; // Eject not allowed so return error
2020-07-02 07:06:35 +00:00
case accRun:
2020-07-12 02:41:51 +00:00
d->dCtlFlags &= ~dNeedTimeMask; // Disable accRun
c->status.diskInPlace = 8; // 8 is nonejectable disk
PostEvent(diskEvt, c->status.dQDrive); // Post disk inserted event
2020-07-02 07:06:35 +00:00
return noErr;
2020-07-12 02:41:51 +00:00
case kDriveIcon: case kMediaIcon: // Get icon
2020-07-15 06:26:28 +00:00
#ifdef RDISK_COMPRESS_ICON_ENABLE
2020-07-12 02:41:51 +00:00
*(Ptr*)p->csParam = (Ptr)c->icon;
#else
*(Ptr*)p->csParam = (Ptr)RDiskIcon;
#endif
2020-06-27 02:13:22 +00:00
return noErr;
2020-07-12 02:41:51 +00:00
case kDriveInfo:
// high word (bytes 2 & 3) clear
// byte 1 = primary + fixed media + internal
// byte 0 = drive type (0x10 is RAM disk) / (0x11 is ROM disk)
if (c->status.writeProt) { *(long*)p->csParam = 0x00000411; }
else { *(long*)p->csParam = 0x00000410; }
2020-07-12 02:41:51 +00:00
return noErr;
case 24: // Return SCSI partition size
*(long*)p->csParam = RDiskSize / 512;
return noErr;
2020-07-15 06:13:06 +00:00
case 2351: // Post-boot
2020-07-16 06:27:38 +00:00
c->initialized = 1; // Skip initialization
d->dCtlDelay = 30; // Set accRun delay (30 ticks is 0.5 sec.)
2020-07-15 06:13:06 +00:00
d->dCtlFlags |= dNeedTimeMask; // Enable accRun
2020-07-02 07:06:35 +00:00
return noErr;
2020-06-22 04:10:31 +00:00
default: return controlErr;
}
}
#pragma parameter __D0 RDStat(__A0, __A1)
OSErr RDStat(CntrlParamPtr p, DCtlPtr d) {
2021-03-04 20:22:34 +00:00
//RDiskStorage_t *c;
2020-06-26 07:12:08 +00:00
// Fail if dCtlStorage null
2020-07-12 02:41:51 +00:00
if (!d->dCtlStorage) { return notOpenErr; }
2020-06-27 02:13:22 +00:00
// Dereference dCtlStorage to get pointer to our context
2021-03-04 20:22:34 +00:00
//c = *(RDiskStorage_t**)d->dCtlStorage;
2020-06-22 04:10:31 +00:00
// Handle status request based on csCode
2020-06-26 07:12:08 +00:00
switch (p->csCode) {
2020-07-12 02:41:51 +00:00
case kDriveStatus:
2020-06-26 07:12:08 +00:00
BlockMove(*d->dCtlStorage, &p->csParam, sizeof(DrvSts2));
2020-06-22 04:10:31 +00:00
return noErr;
default: return statusErr;
}
}
#pragma parameter __D0 RDClose(__A0, __A1)
OSErr RDClose(IOParamPtr p, DCtlPtr d) {
2020-07-16 06:27:38 +00:00
// If dCtlStorage not null, dispose of it
2020-06-26 07:12:08 +00:00
if (!d->dCtlStorage) { return noErr; }
2021-03-04 20:22:34 +00:00
//RDiskStorage_t *c = *(RDiskStorage_t**)d->dCtlStorage;
2020-06-26 07:12:08 +00:00
HUnlock(d->dCtlStorage);
DisposeHandle(d->dCtlStorage);
2020-06-22 04:10:31 +00:00
d->dCtlStorage = NULL;
return noErr;
}