src/devices/dev_fdc.c

/*
 *  Copyright (C) 2003-2006  Anders Gavare.  All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions are met:
 *
 *  1. Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *  2. Redistributions in binary form must reproduce the above copyright  
 *     notice, this list of conditions and the following disclaimer in the 
 *     documentation and/or other materials provided with the distribution.
 *  3. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 *  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 *  ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE   
 *  FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 *  DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 *  OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 *  HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 *  OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 *  SUCH DAMAGE.
 *   
 *
 *  $Id: dev_fdc.c,v 1.18 2006/02/09 20:02:59 debug Exp $
 *  
 *  PC-style floppy controller.
 *
 *  TODO!  (This is just a dummy skeleton right now.)
 *
 *  TODO 2: Make it work nicely with both ARC and PC emulation.
 *
 *  See http://members.tripod.com/~oldboard/assembly/765.html for a
 *  quick overview.
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "device.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#define DEV_FDC_LENGTH          6       /*  TODO 8, but collision with wdc  */


struct fdc_data {
        unsigned char   reg[DEV_FDC_LENGTH];
        int             irqnr;
};


/*
 *  dev_fdc_access():
 */
DEVICE_ACCESS(fdc)
{
        uint64_t idata = 0, odata = 0;
        size_t i;
        struct fdc_data *d = extra;

        if (writeflag == MEM_WRITE)
                idata = memory_readmax64(cpu, data, len);

        switch (relative_addr) {
        case 0x04:
                break;
        default:if (writeflag==MEM_READ) {
                        fatal("[ fdc: read from reg %i ]\n",
                            (int)relative_addr);
                        odata = d->reg[relative_addr];
                } else {
                        fatal("[ fdc: write to reg %i:", (int)relative_addr);
                        for (i=0; i<len; i++)
                                fatal(" %02x", data[i]);
                        fatal(" ]\n");
                        d->reg[relative_addr] = idata;
                }
        }

        if (writeflag == MEM_READ)
                memory_writemax64(cpu, data, len, odata);

        return 1;
}


DEVINIT(fdc)
{
        struct fdc_data *d;

        d = malloc(sizeof(struct fdc_data));
        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct fdc_data));
        d->irqnr = devinit->irq_nr;

        memory_device_register(devinit->machine->memory, devinit->name,
            devinit->addr, DEV_FDC_LENGTH, dev_fdc_access, d,
            DM_DEFAULT, NULL);

        return 1;
}

1	dpavlin	4	/*
2	dpavlin	22	* Copyright (C) 2003-2006 Anders Gavare. All rights reserved.
3	dpavlin	4	*
4			* Redistribution and use in source and binary forms, with or without
5			* modification, are permitted provided that the following conditions are met:
6			*
7			* 1. Redistributions of source code must retain the above copyright
8			* notice, this list of conditions and the following disclaimer.
9			* 2. Redistributions in binary form must reproduce the above copyright
10			* notice, this list of conditions and the following disclaimer in the
11			* documentation and/or other materials provided with the distribution.
12			* 3. The name of the author may not be used to endorse or promote products
13			* derived from this software without specific prior written permission.
14			*
15			* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16			* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17			* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18			* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19			* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20			* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21			* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22			* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23			* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24			* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25			* SUCH DAMAGE.
26			*
27			*
28	dpavlin	22	* $Id: dev_fdc.c,v 1.18 2006/02/09 20:02:59 debug Exp $
29	dpavlin	4	*
30	dpavlin	6	* PC-style floppy controller.
31	dpavlin	4	*
32			* TODO! (This is just a dummy skeleton right now.)
33	dpavlin	6	*
34			* TODO 2: Make it work nicely with both ARC and PC emulation.
35			*
36			* See http://members.tripod.com/~oldboard/assembly/765.html for a
37			* quick overview.
38	dpavlin	4	*/
39
40			#include <stdio.h>
41			#include <stdlib.h>
42			#include <string.h>
43
44			#include "device.h"
45			#include "machine.h"
46			#include "memory.h"
47			#include "misc.h"
48
49
50	dpavlin	22	#define DEV_FDC_LENGTH 6 /* TODO 8, but collision with wdc */
51	dpavlin	4
52
53			struct fdc_data {
54			unsigned char reg[DEV_FDC_LENGTH];
55			int irqnr;
56			};
57
58
59			/*
60			* dev_fdc_access():
61			*/
62	dpavlin	22	DEVICE_ACCESS(fdc)
63	dpavlin	4	{
64			uint64_t idata = 0, odata = 0;
65	dpavlin	22	size_t i;
66	dpavlin	4	struct fdc_data *d = extra;
67
68	dpavlin	18	if (writeflag == MEM_WRITE)
69			idata = memory_readmax64(cpu, data, len);
70	dpavlin	4
71			switch (relative_addr) {
72			case 0x04:
73			break;
74	dpavlin	6	default:if (writeflag==MEM_READ) {
75			fatal("[ fdc: read from reg %i ]\n",
76	dpavlin	4	(int)relative_addr);
77			odata = d->reg[relative_addr];
78			} else {
79	dpavlin	6	fatal("[ fdc: write to reg %i:", (int)relative_addr);
80	dpavlin	4	for (i=0; i<len; i++)
81	dpavlin	6	fatal(" %02x", data[i]);
82			fatal(" ]\n");
83	dpavlin	4	d->reg[relative_addr] = idata;
84			}
85			}
86
87			if (writeflag == MEM_READ)
88			memory_writemax64(cpu, data, len, odata);
89
90			return 1;
91			}
92
93
94	dpavlin	22	DEVINIT(fdc)
95	dpavlin	4	{
96			struct fdc_data *d;
97
98			d = malloc(sizeof(struct fdc_data));
99			if (d == NULL) {
100			fprintf(stderr, "out of memory\n");
101			exit(1);
102			}
103			memset(d, 0, sizeof(struct fdc_data));
104			d->irqnr = devinit->irq_nr;
105
106			memory_device_register(devinit->machine->memory, devinit->name,
107			devinit->addr, DEV_FDC_LENGTH, dev_fdc_access, d,
108	dpavlin	20	DM_DEFAULT, NULL);
109	dpavlin	4
110			return 1;
111			}
112