BasiliskII/src/sony.cpp

/*
 *  sony.cpp - Replacement .Sony driver (floppy drives)
 *
 *  Basilisk II (C) 1997-2002 Christian Bauer
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

/*
 *  SEE ALSO
 *    Inside Macintosh: Devices, chapter 1 "Device Manager"
 *    Technote DV 05: "Drive Queue Elements"
 *    Technote DV 07: "Forcing Floppy Disk Size to be Either 400K or 800K"
 *    Technote DV 17: "Sony Driver: What Your Sony Drives For You"
 *    Technote DV 23: "Driver Education"
 *    Technote FL 24: "Don't Look at ioPosOffset for Devices"
 */

#include "sysdeps.h"

#include <string.h>
#include <vector>

#ifndef NO_STD_NAMESPACE
using std::vector;
#endif

#include "cpu_emulation.h"
#include "main.h"
#include "macos_util.h"
#include "rom_patches.h"
#include "sys.h"
#include "prefs.h"
#include "sony.h"

#define DEBUG 0
#include "debug.h"


// Check for inserted disks by polling?
#ifdef AMIGA
#define DISK_INSERT_CHECK 1
#else
#define DISK_INSERT_CHECK 0
#endif


// Floppy disk icon
const uint8 SonyDiskIcon[258] = {
        0x7f, 0xff, 0xff, 0xf8, 0x81, 0x00, 0x01, 0x04, 0x81, 0x00, 0x71, 0x02, 0x81, 0x00, 0x89, 0x01,
        0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01,
        0x81, 0x00, 0x71, 0x01, 0x81, 0x00, 0x01, 0x01, 0x80, 0xff, 0xfe, 0x01, 0x80, 0x00, 0x00, 0x01,
        0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01,
        0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x87, 0xff, 0xff, 0xe1, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x7f, 0xff, 0xff, 0xfe,

        0x7f, 0xff, 0xff, 0xf8, 0xff, 0xff, 0xff, 0xfc, 0xff, 0xff, 0xff, 0xfe, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7f, 0xff, 0xff, 0xfe,

        0, 0
};

// Floppy drive icon
const uint8 SonyDriveIcon[258] = {
        0x7f, 0xff, 0xff, 0xf8, 0x81, 0x00, 0x01, 0x04, 0x81, 0x00, 0x71, 0x02, 0x81, 0x00, 0x89, 0x01,
        0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01,
        0x81, 0x00, 0x71, 0x01, 0x81, 0x00, 0x01, 0x01, 0x80, 0xff, 0xfe, 0x01, 0x80, 0x00, 0x00, 0x01,
        0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01,
        0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x87, 0xff, 0xff, 0xe1, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
        0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x7f, 0xff, 0xff, 0xfe,

        0x7f, 0xff, 0xff, 0xf8, 0xff, 0xff, 0xff, 0xfc, 0xff, 0xff, 0xff, 0xfe, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
        0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7f, 0xff, 0xff, 0xfe,

        0, 0
};


// Struct for each drive
struct sony_drive_info {
        sony_drive_info() : num(0), fh(NULL), read_only(false), status(0) {}
        sony_drive_info(void *fh_, bool ro) : num(0), fh(fh_), read_only(ro), status(0) {}

        void close_fh(void) { Sys_close(fh); }

        int num;                        // Drive number
        void *fh;                       // Floppy driver file handle
        bool to_be_mounted;     // Flag: drive must be mounted in accRun
        bool read_only;         // Flag: force write protection
        uint32 tag_buffer;      // Mac address of tag buffer
        uint32 status;          // Mac address of drive status record
};

// List of drives handled by this driver
typedef vector<sony_drive_info> drive_vec;
static drive_vec drives;

// Icon addresses (Mac address space, set by PatchROM())
uint32 SonyDiskIconAddr;
uint32 SonyDriveIconAddr;

// Flag: Control(accRun) has been called, interrupt routine is now active
static bool acc_run_called = false;


/*
 *  Get reference to drive info or drives.end() if not found
 */

static drive_vec::iterator get_drive_info(int num)
{
        drive_vec::iterator info, end = drives.end();
        for (info = drives.begin(); info != end; ++info) {
                if (info->num == num)
                        return info;
        }
        return info;
}


/*
 *  Initialization
 */

void SonyInit(void)
{
        // No drives specified in prefs? Then add defaults
        if (PrefsFindString("floppy", 0) == NULL)
                SysAddFloppyPrefs();

        // Add drives specified in preferences
        int index = 0;
        const char *str;
        while ((str = PrefsFindString("floppy", index++)) != NULL) {
                bool read_only = false;
                if (str[0] == '*') {
                        read_only = true;
                        str++;
                }
                void *fh = Sys_open(str, read_only);
                if (fh)
                        drives.push_back(sony_drive_info(fh, SysIsReadOnly(fh)));
        }
}


/*
 *  Deinitialization
 */

void SonyExit(void)
{
        drive_vec::iterator info, end = drives.end();
        for (info = drives.begin(); info != end; ++info)
                info->close_fh();
        drives.clear();
}


/*
 *  Disk was inserted, flag for mounting
 */

bool SonyMountVolume(void *fh)
{
        drive_vec::iterator info = drives.begin(), end = drives.end();
        while (info != end && info->fh != fh)
                ++info;
        if (info != end) {
                D(bug("Looking for disk in drive %d\n", info->num));
                if (SysIsDiskInserted(info->fh)) {
                        info->read_only = SysIsReadOnly(info->fh);
                        WriteMacInt8(info->status + dsDiskInPlace, 1);  // Inserted removable disk
                        WriteMacInt8(info->status + dsWriteProt, info->read_only ? 0xff : 0);
                        D(bug(" disk inserted, mounting\n"));
                        info->to_be_mounted = true;
                }
                return true;
        } else
                return false;
}


/*
 *  Mount volumes for which the to_be_mounted flag is set
 *  (called during interrupt time)
 */

static void mount_mountable_volumes(void)
{
        drive_vec::iterator info, end = drives.end();
        for (info = drives.begin(); info != end; ++info) {

#if DISK_INSERT_CHECK
                // Disk in drive?
                if (ReadMacInt8(info->status + dsDiskInPlace) == 0) {

                        // No, check if disk was inserted
                        if (SysIsDiskInserted(info->fh))
                                SonyMountVolume(info->fh);
                }
#endif

                // Mount disk if flagged
                if (info->to_be_mounted) {
                        D(bug(" mounting drive %d\n", info->num));
                        M68kRegisters r;
                        r.d[0] = info->num;
                        r.a[0] = 7;     // diskEvent
                        Execute68kTrap(0xa02f, &r);             // PostEvent()
                        info->to_be_mounted = false;
                }
        }
}


/*
 *  Set error code in DskErr
 */

static int16 set_dsk_err(int16 err)
{
        D(bug("set_dsk_err(%d)\n", err));
        WriteMacInt16(0x142, err);
        return err;
}


/*
 *  Driver Open() routine
 */

int16 SonyOpen(uint32 pb, uint32 dce)
{
        D(bug("SonyOpen\n"));

        // Set up DCE
        WriteMacInt32(dce + dCtlPosition, 0);
        WriteMacInt16(dce + dCtlQHdr + qFlags, ReadMacInt16(dce + dCtlQHdr + qFlags) & 0xff00 | 3);     // Version number, must be >=3 or System 8 will replace us
        acc_run_called = false;

        // Install driver again with refnum -2 (HD20)
        uint32 utab = ReadMacInt32(0x11c);
        WriteMacInt32(utab + 4, ReadMacInt32(utab + 16));

        // Set up fake SonyVars
        WriteMacInt32(0x134, 0xdeadbeef);

        // Clear DskErr
        set_dsk_err(0);

        // Install drives
        drive_vec::iterator info, end = drives.end();
        for (info = drives.begin(); info != end; ++info) {

                info->num = FindFreeDriveNumber(1);
                info->to_be_mounted = false;
                info->tag_buffer = 0;

                if (info->fh) {

                        // Allocate drive status record
                        M68kRegisters r;
                        r.d[0] = SIZEOF_DrvSts;
                        Execute68kTrap(0xa71e, &r);             // NewPtrSysClear()
                        if (r.a[0] == 0)
                                continue;
                        info->status = r.a[0];
                        D(bug(" DrvSts at %08lx\n", info->status));

                        // Set up drive status
                        WriteMacInt16(info->status + dsQType, sony);
                        WriteMacInt8(info->status + dsInstalled, 1);
                        WriteMacInt8(info->status + dsSides, 0xff);
                        WriteMacInt8(info->status + dsTwoSideFmt, 0xff);
                        WriteMacInt8(info->status + dsNewIntf, 0xff);
                        WriteMacInt8(info->status + dsMFMDrive, 0xff);
                        WriteMacInt8(info->status + dsMFMDisk, 0xff);
                        WriteMacInt8(info->status + dsTwoMegFmt, 0xff);

                        // Disk in drive?
                        if (SysIsDiskInserted(info->fh)) {
                                WriteMacInt8(info->status + dsDiskInPlace, 1);  // Inserted removable disk
                                WriteMacInt8(info->status + dsWriteProt, info->read_only ? 0xff : 0);
                                D(bug(" disk inserted, flagging for mount\n"));
                                info->to_be_mounted = true;
                        }

                        // Add drive to drive queue
                        D(bug(" adding drive %d\n", info->num));
                        r.d[0] = (info->num << 16) | (SonyRefNum & 0xffff);
                        r.a[0] = info->status + dsQLink;
                        Execute68kTrap(0xa04e, &r);     // AddDrive()
                }
        }
        return noErr;
}


/*
 *  Driver Prime() routine
 */

int16 SonyPrime(uint32 pb, uint32 dce)
{
        WriteMacInt32(pb + ioActCount, 0);

        // Drive valid and disk inserted?
        drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
        if (info == drives.end())
                return set_dsk_err(nsDrvErr);
        if (!ReadMacInt8(info->status + dsDiskInPlace))
                return set_dsk_err(offLinErr);
        WriteMacInt8(info->status + dsDiskInPlace, 2);  // Disk accessed

        // Get parameters
        void *buffer = Mac2HostAddr(ReadMacInt32(pb + ioBuffer));
        size_t length = ReadMacInt32(pb + ioReqCount);
        loff_t position = ReadMacInt32(dce + dCtlPosition);
        if ((length & 0x1ff) || (position & 0x1ff))
                return set_dsk_err(paramErr);

        size_t actual = 0;
        if ((ReadMacInt16(pb + ioTrap) & 0xff) == aRdCmd) {

                // Read
                actual = Sys_read(info->fh, buffer, position, length);
                if (actual != length)
                        return set_dsk_err(readErr);

                // Clear TagBuf
                WriteMacInt32(0x2fc, 0);
                WriteMacInt32(0x300, 0);
                WriteMacInt32(0x304, 0);

        } else {

                // Write
                if (info->read_only)
                        return set_dsk_err(wPrErr);
                actual = Sys_write(info->fh, buffer, position, length);
                if (actual != length)
                        return set_dsk_err(writErr);
        }

        // Update ParamBlock and DCE
        WriteMacInt32(pb + ioActCount, actual);
        WriteMacInt32(dce + dCtlPosition, ReadMacInt32(dce + dCtlPosition) + actual);
        return set_dsk_err(noErr);
}


/*
 *  Driver Control() routine
 */

int16 SonyControl(uint32 pb, uint32 dce)
{
        uint16 code = ReadMacInt16(pb + csCode);
        D(bug("SonyControl %d\n", code));

        // General codes
        switch (code) {
                case 1:         // KillIO
                        return set_dsk_err(-1);

                case 9:         // Track cache
                        return set_dsk_err(noErr);

                case 65:        // Periodic action (accRun, "insert" disks on startup)
                        mount_mountable_volumes();
                        PatchAfterStartup();            // Install patches after system startup
                        WriteMacInt16(dce + dCtlFlags, ReadMacInt16(dce + dCtlFlags) & ~0x2000);        // Disable periodic action
                        acc_run_called = true;
                        return noErr;
        }

        // Drive valid?
        drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
        if (info == drives.end())
                return set_dsk_err(nsDrvErr);

        // Drive-specific codes
        int16 err = noErr;
        switch (code) {
                case 5:         // Verify disk
                        if (ReadMacInt8(info->status + dsDiskInPlace) <= 0)
                                err = verErr;
                        break;

                case 6:         // Format disk
                        if (info->read_only)
                                err = wPrErr;
                        else if (ReadMacInt8(info->status + dsDiskInPlace) > 0) {
                                if (!SysFormat(info->fh))
                                        err = writErr;
                        } else
                                err = offLinErr;
                        break;

                case 7:         // Eject
                        if (ReadMacInt8(info->status + dsDiskInPlace) > 0) {
                                SysEject(info->fh);
                                WriteMacInt8(info->status + dsDiskInPlace, 0);
                        }
                        break;

                case 8:         // Set tag buffer
                        info->tag_buffer = ReadMacInt32(pb + csParam);
                        break;

                case 21:                // Get drive icon
                        WriteMacInt32(pb + csParam, SonyDriveIconAddr);
                        break;

                case 22:                // Get disk icon
                        WriteMacInt32(pb + csParam, SonyDiskIconAddr);
                        break;

                case 23:                // Get drive info
                        if (info->num == 1)
                                WriteMacInt32(pb + csParam, 0x0004);    // Internal drive
                        else
                                WriteMacInt32(pb + csParam, 0x0104);    // External drive
                        break;

                case 0x5343:    // Format and write to disk ('SC'), used by DiskCopy
                        if (!ReadMacInt8(info->status + dsDiskInPlace))
                                err = offLinErr;
                        else if (info->read_only)
                                err = wPrErr;
                        else {
                                void *data = Mac2HostAddr(ReadMacInt32(pb + csParam + 2));
                                size_t actual = Sys_write(info->fh, data, 0, 2880*512);
                                if (actual != 2880*512)
                                        err = writErr;
                        }
                        break;

                default:
                        printf("WARNING: Unknown SonyControl(%d)\n", code);
                        err = controlErr;
                        break;
        }

        return set_dsk_err(err);
}


/*
 *  Driver Status() routine
 */

int16 SonyStatus(uint32 pb, uint32 dce)
{
        uint16 code = ReadMacInt16(pb + csCode);
        D(bug("SonyStatus %d\n", code));

        // Drive valid?
        drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
        if (info == drives.end())
                return set_dsk_err(nsDrvErr);

        int16 err = noErr;
        switch (code) {
                case 6:         // Return format list
                        if (ReadMacInt16(pb + csParam) > 0) {
                                uint32 adr = ReadMacInt32(pb + csParam + 2);
                                WriteMacInt16(pb + csParam, 1);         // 1 format
                                WriteMacInt32(adr, 2880);                       // 2880 sectors
                                WriteMacInt32(adr + 4, 0xd2120050);     // 2 heads, 18 secs/track, 80 tracks
                        } else
                                err = paramErr;
                        break;

                case 8:         // Get drive status
                        Mac2Mac_memcpy(pb + csParam, info->status, 22);
                        break;

                case 10:        // Get disk type
                        WriteMacInt32(pb + csParam, ReadMacInt32(info->status + dsMFMDrive) & 0xffffff00 | 0xfe);
                        break;

                case 0x4456: // Duplicator version supported ('DV')
                        WriteMacInt16(pb + csParam, 0x0410);
                        break;

                case 0x5343: // Get address header format byte ('SC')
                        WriteMacInt8(pb + csParam, 0x22);       // 512 bytes/sector
                        break;

                default:
                        printf("WARNING: Unknown SonyStatus(%d)\n", code);
                        err = statusErr;
                        break;
        }

        return set_dsk_err(err);
}


/*
 *  Driver interrupt routine (1Hz) - check for volumes to be mounted
 */

void SonyInterrupt(void)
{
        if (!acc_run_called)
                return;

        mount_mountable_volumes();
}
Revision:	1.14
Committed:	2002-02-23T17:54:23Z (22 years, 8 months ago) by cebix
Branch:	MAIN
CVS Tags:	nigel-build-12, nigel-build-13
Changes since 1.13:	+5 -1 lines
Log Message:	fixed floppy disk change detection problems under Linux
#	User	Rev	Content
1	cebix	1.1	/*
2			* sony.cpp - Replacement .Sony driver (floppy drives)
3			*
4	cebix	1.13	* Basilisk II (C) 1997-2002 Christian Bauer
5	cebix	1.1	*
6			* This program is free software; you can redistribute it and/or modify
7			* it under the terms of the GNU General Public License as published by
8			* the Free Software Foundation; either version 2 of the License, or
9			* (at your option) any later version.
10			*
11			* This program is distributed in the hope that it will be useful,
12			* but WITHOUT ANY WARRANTY; without even the implied warranty of
13			* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14			* GNU General Public License for more details.
15			*
16			* You should have received a copy of the GNU General Public License
17			* along with this program; if not, write to the Free Software
18			* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19			*/
20
21			/*
22			* SEE ALSO
23			* Inside Macintosh: Devices, chapter 1 "Device Manager"
24			* Technote DV 05: "Drive Queue Elements"
25			* Technote DV 07: "Forcing Floppy Disk Size to be Either 400K or 800K"
26			* Technote DV 17: "Sony Driver: What Your Sony Drives For You"
27			* Technote DV 23: "Driver Education"
28			* Technote FL 24: "Don't Look at ioPosOffset for Devices"
29			*/
30
31	cebix	1.12	#include "sysdeps.h"
32
33	cebix	1.1	#include <string.h>
34	cebix	1.11	#include <vector>
35
36			#ifndef NO_STD_NAMESPACE
37			using std::vector;
38			#endif
39	cebix	1.1
40			#include "cpu_emulation.h"
41			#include "main.h"
42			#include "macos_util.h"
43			#include "rom_patches.h"
44			#include "sys.h"
45			#include "prefs.h"
46			#include "sony.h"
47
48	cebix	1.4	#define DEBUG 0
49	cebix	1.1	#include "debug.h"
50
51	cebix	1.7
52			// Check for inserted disks by polling?
53	cebix	1.1	#ifdef AMIGA
54	cebix	1.7	#define DISK_INSERT_CHECK 1
55	cebix	1.1	#else
56			#define DISK_INSERT_CHECK 0
57			#endif
58
59
60			// Floppy disk icon
61			const uint8 SonyDiskIcon[258] = {
62			0x7f, 0xff, 0xff, 0xf8, 0x81, 0x00, 0x01, 0x04, 0x81, 0x00, 0x71, 0x02, 0x81, 0x00, 0x89, 0x01,
63			0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01,
64			0x81, 0x00, 0x71, 0x01, 0x81, 0x00, 0x01, 0x01, 0x80, 0xff, 0xfe, 0x01, 0x80, 0x00, 0x00, 0x01,
65			0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01,
66			0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x87, 0xff, 0xff, 0xe1, 0x88, 0x00, 0x00, 0x11,
67			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
68			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
69			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x7f, 0xff, 0xff, 0xfe,
70
71			0x7f, 0xff, 0xff, 0xf8, 0xff, 0xff, 0xff, 0xfc, 0xff, 0xff, 0xff, 0xfe, 0xff, 0xff, 0xff, 0xff,
72			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
73			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
74			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
75			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
76			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
77			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
78			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7f, 0xff, 0xff, 0xfe,
79
80			0, 0
81			};
82
83			// Floppy drive icon
84			const uint8 SonyDriveIcon[258] = {
85			0x7f, 0xff, 0xff, 0xf8, 0x81, 0x00, 0x01, 0x04, 0x81, 0x00, 0x71, 0x02, 0x81, 0x00, 0x89, 0x01,
86			0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01, 0x81, 0x00, 0x89, 0x01,
87			0x81, 0x00, 0x71, 0x01, 0x81, 0x00, 0x01, 0x01, 0x80, 0xff, 0xfe, 0x01, 0x80, 0x00, 0x00, 0x01,
88			0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01,
89			0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x87, 0xff, 0xff, 0xe1, 0x88, 0x00, 0x00, 0x11,
90			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
91			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11,
92			0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x88, 0x00, 0x00, 0x11, 0x7f, 0xff, 0xff, 0xfe,
93
94			0x7f, 0xff, 0xff, 0xf8, 0xff, 0xff, 0xff, 0xfc, 0xff, 0xff, 0xff, 0xfe, 0xff, 0xff, 0xff, 0xff,
95			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
96			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
97			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
98			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
99			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
100			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
101			0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7f, 0xff, 0xff, 0xfe,
102
103			0, 0
104			};
105
106
107			// Struct for each drive
108	cebix	1.11	struct sony_drive_info {
109			sony_drive_info() : num(0), fh(NULL), read_only(false), status(0) {}
110			sony_drive_info(void *fh_, bool ro) : num(0), fh(fh_), read_only(ro), status(0) {}
111
112			void close_fh(void) { Sys_close(fh); }
113	cebix	1.1
114			int num; // Drive number
115			void *fh; // Floppy driver file handle
116			bool to_be_mounted; // Flag: drive must be mounted in accRun
117			bool read_only; // Flag: force write protection
118			uint32 tag_buffer; // Mac address of tag buffer
119			uint32 status; // Mac address of drive status record
120			};
121
122	cebix	1.11	// List of drives handled by this driver
123			typedef vector<sony_drive_info> drive_vec;
124			static drive_vec drives;
125	cebix	1.1
126			// Icon addresses (Mac address space, set by PatchROM())
127			uint32 SonyDiskIconAddr;
128			uint32 SonyDriveIconAddr;
129
130	cebix	1.2	// Flag: Control(accRun) has been called, interrupt routine is now active
131			static bool acc_run_called = false;
132	cebix	1.1
133
134			/*
135	cebix	1.11	* Get reference to drive info or drives.end() if not found
136	cebix	1.1	*/
137
138	cebix	1.11	static drive_vec::iterator get_drive_info(int num)
139	cebix	1.1	{
140	cebix	1.11	drive_vec::iterator info, end = drives.end();
141			for (info = drives.begin(); info != end; ++info) {
142	cebix	1.1	if (info->num == num)
143			return info;
144			}
145	cebix	1.11	return info;
146	cebix	1.1	}
147
148
149			/*
150			* Initialization
151			*/
152
153			void SonyInit(void)
154			{
155			// No drives specified in prefs? Then add defaults
156			if (PrefsFindString("floppy", 0) == NULL)
157			SysAddFloppyPrefs();
158
159			// Add drives specified in preferences
160	cebix	1.11	int index = 0;
161	cebix	1.1	const char *str;
162			while ((str = PrefsFindString("floppy", index++)) != NULL) {
163			bool read_only = false;
164			if (str[0] == '*') {
165			read_only = true;
166			str++;
167			}
168			void *fh = Sys_open(str, read_only);
169	cebix	1.11	if (fh)
170			drives.push_back(sony_drive_info(fh, SysIsReadOnly(fh)));
171	cebix	1.1	}
172			}
173
174
175			/*
176			* Deinitialization
177			*/
178
179			void SonyExit(void)
180			{
181	cebix	1.11	drive_vec::iterator info, end = drives.end();
182			for (info = drives.begin(); info != end; ++info)
183			info->close_fh();
184			drives.clear();
185	cebix	1.1	}
186
187
188			/*
189			* Disk was inserted, flag for mounting
190			*/
191
192			bool SonyMountVolume(void *fh)
193			{
194	cebix	1.11	drive_vec::iterator info = drives.begin(), end = drives.end();
195			while (info != end && info->fh != fh)
196			++info;
197			if (info != end) {
198	cebix	1.14	D(bug("Looking for disk in drive %d\n", info->num));
199	cebix	1.1	if (SysIsDiskInserted(info->fh)) {
200			info->read_only = SysIsReadOnly(info->fh);
201			WriteMacInt8(info->status + dsDiskInPlace, 1); // Inserted removable disk
202			WriteMacInt8(info->status + dsWriteProt, info->read_only ? 0xff : 0);
203	cebix	1.14	D(bug(" disk inserted, mounting\n"));
204	cebix	1.1	info->to_be_mounted = true;
205			}
206			return true;
207			} else
208			return false;
209			}
210
211
212			/*
213	cebix	1.2	* Mount volumes for which the to_be_mounted flag is set
214			* (called during interrupt time)
215			*/
216
217			static void mount_mountable_volumes(void)
218			{
219	cebix	1.11	drive_vec::iterator info, end = drives.end();
220			for (info = drives.begin(); info != end; ++info) {
221	cebix	1.2
222			#if DISK_INSERT_CHECK
223			// Disk in drive?
224	cebix	1.14	if (ReadMacInt8(info->status + dsDiskInPlace) == 0) {
225	cebix	1.2
226			// No, check if disk was inserted
227			if (SysIsDiskInserted(info->fh))
228			SonyMountVolume(info->fh);
229			}
230			#endif
231
232			// Mount disk if flagged
233			if (info->to_be_mounted) {
234			D(bug(" mounting drive %d\n", info->num));
235			M68kRegisters r;
236			r.d[0] = info->num;
237			r.a[0] = 7; // diskEvent
238			Execute68kTrap(0xa02f, &r); // PostEvent()
239			info->to_be_mounted = false;
240			}
241			}
242			}
243
244
245			/*
246	cebix	1.10	* Set error code in DskErr
247			*/
248
249			static int16 set_dsk_err(int16 err)
250			{
251	cebix	1.14	D(bug("set_dsk_err(%d)\n", err));
252	cebix	1.10	WriteMacInt16(0x142, err);
253			return err;
254			}
255
256
257			/*
258	cebix	1.1	* Driver Open() routine
259			*/
260
261			int16 SonyOpen(uint32 pb, uint32 dce)
262			{
263			D(bug("SonyOpen\n"));
264
265			// Set up DCE
266			WriteMacInt32(dce + dCtlPosition, 0);
267			WriteMacInt16(dce + dCtlQHdr + qFlags, ReadMacInt16(dce + dCtlQHdr + qFlags) & 0xff00 \| 3); // Version number, must be >=3 or System 8 will replace us
268	cebix	1.2	acc_run_called = false;
269	cebix	1.1
270			// Install driver again with refnum -2 (HD20)
271			uint32 utab = ReadMacInt32(0x11c);
272			WriteMacInt32(utab + 4, ReadMacInt32(utab + 16));
273
274			// Set up fake SonyVars
275			WriteMacInt32(0x134, 0xdeadbeef);
276
277			// Clear DskErr
278	cebix	1.10	set_dsk_err(0);
279	cebix	1.1
280			// Install drives
281	cebix	1.11	drive_vec::iterator info, end = drives.end();
282			for (info = drives.begin(); info != end; ++info) {
283	cebix	1.1
284			info->num = FindFreeDriveNumber(1);
285			info->to_be_mounted = false;
286			info->tag_buffer = 0;
287
288			if (info->fh) {
289
290			// Allocate drive status record
291			M68kRegisters r;
292			r.d[0] = SIZEOF_DrvSts;
293			Execute68kTrap(0xa71e, &r); // NewPtrSysClear()
294			if (r.a[0] == 0)
295			continue;
296			info->status = r.a[0];
297			D(bug(" DrvSts at %08lx\n", info->status));
298
299			// Set up drive status
300			WriteMacInt16(info->status + dsQType, sony);
301			WriteMacInt8(info->status + dsInstalled, 1);
302			WriteMacInt8(info->status + dsSides, 0xff);
303			WriteMacInt8(info->status + dsTwoSideFmt, 0xff);
304			WriteMacInt8(info->status + dsNewIntf, 0xff);
305			WriteMacInt8(info->status + dsMFMDrive, 0xff);
306			WriteMacInt8(info->status + dsMFMDisk, 0xff);
307			WriteMacInt8(info->status + dsTwoMegFmt, 0xff);
308
309			// Disk in drive?
310			if (SysIsDiskInserted(info->fh)) {
311			WriteMacInt8(info->status + dsDiskInPlace, 1); // Inserted removable disk
312			WriteMacInt8(info->status + dsWriteProt, info->read_only ? 0xff : 0);
313	cebix	1.14	D(bug(" disk inserted, flagging for mount\n"));
314	cebix	1.1	info->to_be_mounted = true;
315			}
316
317			// Add drive to drive queue
318			D(bug(" adding drive %d\n", info->num));
319			r.d[0] = (info->num << 16) \| (SonyRefNum & 0xffff);
320			r.a[0] = info->status + dsQLink;
321			Execute68kTrap(0xa04e, &r); // AddDrive()
322			}
323			}
324			return noErr;
325			}
326
327
328			/*
329			* Driver Prime() routine
330			*/
331
332			int16 SonyPrime(uint32 pb, uint32 dce)
333			{
334			WriteMacInt32(pb + ioActCount, 0);
335
336			// Drive valid and disk inserted?
337	cebix	1.11	drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
338			if (info == drives.end())
339	cebix	1.10	return set_dsk_err(nsDrvErr);
340	cebix	1.1	if (!ReadMacInt8(info->status + dsDiskInPlace))
341	cebix	1.10	return set_dsk_err(offLinErr);
342	cebix	1.1	WriteMacInt8(info->status + dsDiskInPlace, 2); // Disk accessed
343
344			// Get parameters
345			void *buffer = Mac2HostAddr(ReadMacInt32(pb + ioBuffer));
346			size_t length = ReadMacInt32(pb + ioReqCount);
347			loff_t position = ReadMacInt32(dce + dCtlPosition);
348			if ((length & 0x1ff) \|\| (position & 0x1ff))
349	cebix	1.10	return set_dsk_err(paramErr);
350	cebix	1.1
351			size_t actual = 0;
352			if ((ReadMacInt16(pb + ioTrap) & 0xff) == aRdCmd) {
353
354			// Read
355			actual = Sys_read(info->fh, buffer, position, length);
356			if (actual != length)
357	cebix	1.10	return set_dsk_err(readErr);
358	cebix	1.1
359			// Clear TagBuf
360			WriteMacInt32(0x2fc, 0);
361			WriteMacInt32(0x300, 0);
362			WriteMacInt32(0x304, 0);
363
364			} else {
365
366			// Write
367			if (info->read_only)
368	cebix	1.10	return set_dsk_err(wPrErr);
369	cebix	1.1	actual = Sys_write(info->fh, buffer, position, length);
370			if (actual != length)
371	cebix	1.10	return set_dsk_err(writErr);
372	cebix	1.1	}
373
374			// Update ParamBlock and DCE
375			WriteMacInt32(pb + ioActCount, actual);
376			WriteMacInt32(dce + dCtlPosition, ReadMacInt32(dce + dCtlPosition) + actual);
377	cebix	1.10	return set_dsk_err(noErr);
378	cebix	1.1	}
379
380
381			/*
382			* Driver Control() routine
383			*/
384
385			int16 SonyControl(uint32 pb, uint32 dce)
386			{
387			uint16 code = ReadMacInt16(pb + csCode);
388			D(bug("SonyControl %d\n", code));
389
390			// General codes
391			switch (code) {
392			case 1: // KillIO
393	cebix	1.10	return set_dsk_err(-1);
394	cebix	1.1
395			case 9: // Track cache
396	cebix	1.10	return set_dsk_err(noErr);
397	cebix	1.1
398	cebix	1.2	case 65: // Periodic action (accRun, "insert" disks on startup)
399			mount_mountable_volumes();
400			PatchAfterStartup(); // Install patches after system startup
401			WriteMacInt16(dce + dCtlFlags, ReadMacInt16(dce + dCtlFlags) & ~0x2000); // Disable periodic action
402			acc_run_called = true;
403	cebix	1.1	return noErr;
404			}
405
406			// Drive valid?
407	cebix	1.11	drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
408			if (info == drives.end())
409	cebix	1.10	return set_dsk_err(nsDrvErr);
410	cebix	1.1
411			// Drive-specific codes
412	cebix	1.10	int16 err = noErr;
413	cebix	1.1	switch (code) {
414			case 5: // Verify disk
415	cebix	1.10	if (ReadMacInt8(info->status + dsDiskInPlace) <= 0)
416			err = verErr;
417			break;
418	cebix	1.1
419			case 6: // Format disk
420			if (info->read_only)
421	cebix	1.10	err = wPrErr;
422	cebix	1.1	else if (ReadMacInt8(info->status + dsDiskInPlace) > 0) {
423	cebix	1.10	if (!SysFormat(info->fh))
424			err = writErr;
425	cebix	1.1	} else
426	cebix	1.10	err = offLinErr;
427			break;
428	cebix	1.1
429			case 7: // Eject
430			if (ReadMacInt8(info->status + dsDiskInPlace) > 0) {
431			SysEject(info->fh);
432			WriteMacInt8(info->status + dsDiskInPlace, 0);
433			}
434	cebix	1.10	break;
435	cebix	1.1
436			case 8: // Set tag buffer
437			info->tag_buffer = ReadMacInt32(pb + csParam);
438	cebix	1.10	break;
439	cebix	1.1
440			case 21: // Get drive icon
441			WriteMacInt32(pb + csParam, SonyDriveIconAddr);
442	cebix	1.10	break;
443	cebix	1.1
444			case 22: // Get disk icon
445			WriteMacInt32(pb + csParam, SonyDiskIconAddr);
446	cebix	1.10	break;
447	cebix	1.1
448			case 23: // Get drive info
449			if (info->num == 1)
450			WriteMacInt32(pb + csParam, 0x0004); // Internal drive
451			else
452			WriteMacInt32(pb + csParam, 0x0104); // External drive
453	cebix	1.10	break;
454	cebix	1.1
455	cebix	1.10	case 0x5343: // Format and write to disk ('SC'), used by DiskCopy
456	cebix	1.1	if (!ReadMacInt8(info->status + dsDiskInPlace))
457	cebix	1.10	err = offLinErr;
458			else if (info->read_only)
459			err = wPrErr;
460			else {
461			void *data = Mac2HostAddr(ReadMacInt32(pb + csParam + 2));
462			size_t actual = Sys_write(info->fh, data, 0, 2880*512);
463			if (actual != 2880*512)
464			err = writErr;
465			}
466			break;
467	cebix	1.1
468			default:
469			printf("WARNING: Unknown SonyControl(%d)\n", code);
470	cebix	1.10	err = controlErr;
471			break;
472	cebix	1.1	}
473	cebix	1.10
474			return set_dsk_err(err);
475	cebix	1.1	}
476
477
478			/*
479			* Driver Status() routine
480			*/
481
482			int16 SonyStatus(uint32 pb, uint32 dce)
483			{
484			uint16 code = ReadMacInt16(pb + csCode);
485			D(bug("SonyStatus %d\n", code));
486
487			// Drive valid?
488	cebix	1.11	drive_vec::iterator info = get_drive_info(ReadMacInt16(pb + ioVRefNum));
489			if (info == drives.end())
490	cebix	1.10	return set_dsk_err(nsDrvErr);
491	cebix	1.1
492	cebix	1.10	int16 err = noErr;
493	cebix	1.1	switch (code) {
494			case 6: // Return format list
495			if (ReadMacInt16(pb + csParam) > 0) {
496			uint32 adr = ReadMacInt32(pb + csParam + 2);
497			WriteMacInt16(pb + csParam, 1); // 1 format
498			WriteMacInt32(adr, 2880); // 2880 sectors
499			WriteMacInt32(adr + 4, 0xd2120050); // 2 heads, 18 secs/track, 80 tracks
500			} else
501	cebix	1.10	err = paramErr;
502			break;
503	cebix	1.1
504			case 8: // Get drive status
505	cebix	1.5	Mac2Mac_memcpy(pb + csParam, info->status, 22);
506	cebix	1.10	break;
507	cebix	1.1
508			case 10: // Get disk type
509			WriteMacInt32(pb + csParam, ReadMacInt32(info->status + dsMFMDrive) & 0xffffff00 \| 0xfe);
510	cebix	1.10	break;
511	cebix	1.1
512	cebix	1.8	case 0x4456: // Duplicator version supported ('DV')
513	cebix	1.1	WriteMacInt16(pb + csParam, 0x0410);
514	cebix	1.10	break;
515	cebix	1.1
516	cebix	1.8	case 0x5343: // Get address header format byte ('SC')
517	cebix	1.1	WriteMacInt8(pb + csParam, 0x22); // 512 bytes/sector
518	cebix	1.10	break;
519	cebix	1.1
520			default:
521			printf("WARNING: Unknown SonyStatus(%d)\n", code);
522	cebix	1.10	err = statusErr;
523			break;
524	cebix	1.2	}
525	cebix	1.10
526			return set_dsk_err(err);
527	cebix	1.2	}
528
529
530			/*
531	cebix	1.7	* Driver interrupt routine (1Hz) - check for volumes to be mounted
532	cebix	1.2	*/
533
534			void SonyInterrupt(void)
535			{
536			if (!acc_run_called)
537			return;
538
539	cebix	1.7	mount_mountable_volumes();
540	cebix	1.1	}