0.3.1/devices/dev_fdc.c

/*
 *  Copyright (C) 2003-2005  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.9 2005/02/24 15:38:34 debug Exp $
 *  
 *  Floppy controller.
 *
 *  TODO!  (This is just a dummy skeleton right now.)
 */

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

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


#define DEV_FDC_LENGTH          0x100


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


/*
 *  dev_fdc_access():
 */
int dev_fdc_access(struct cpu *cpu, struct memory *mem,
        uint64_t relative_addr, unsigned char *data, size_t len,
        int writeflag, void *extra)
{
        uint64_t idata = 0, odata = 0;
        int i;
        struct fdc_data *d = extra;

        idata = memory_readmax64(cpu, data, len);

        /*  TODO:  this is 100% dummy  */

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

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

        return 1;
}


/*
 *  devinit_fdc():
 */
int devinit_fdc(struct devinit *devinit)
{
        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,
            MEM_DEFAULT, NULL);

        return 1;
}

1	/*
2	* Copyright (C) 2003-2005 Anders Gavare. All rights reserved.
3	*
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	* $Id: dev_fdc.c,v 1.9 2005/02/24 15:38:34 debug Exp $
29	*
30	* Floppy controller.
31	*
32	* TODO! (This is just a dummy skeleton right now.)
33	*/
34
35	#include <stdio.h>
36	#include <stdlib.h>
37	#include <string.h>
38
39	#include "console.h"
40	#include "device.h"
41	#include "machine.h"
42	#include "memory.h"
43	#include "misc.h"
44
45
46	#define DEV_FDC_LENGTH 0x100
47
48
49	struct fdc_data {
50	unsigned char reg[DEV_FDC_LENGTH];
51	int irqnr;
52	};
53
54
55	/*
56	* dev_fdc_access():
57	*/
58	int dev_fdc_access(struct cpu cpu, struct memory mem,
59	uint64_t relative_addr, unsigned char *data, size_t len,
60	int writeflag, void *extra)
61	{
62	uint64_t idata = 0, odata = 0;
63	int i;
64	struct fdc_data *d = extra;
65
66	idata = memory_readmax64(cpu, data, len);
67
68	/* TODO: this is 100% dummy */
69
70	switch (relative_addr) {
71	case 0x04:
72	/* no debug warning */
73	if (writeflag==MEM_READ) {
74	odata = d->reg[relative_addr];
75	} else
76	d->reg[relative_addr] = idata;
77	break;
78	default:
79	if (writeflag==MEM_READ) {
80	debug("[ fdc: read from reg %i ]\n",
81	(int)relative_addr);
82	odata = d->reg[relative_addr];
83	} else {
84	debug("[ fdc: write to reg %i:", (int)relative_addr);
85	for (i=0; i<len; i++)
86	debug(" %02x", data[i]);
87	debug(" ]\n");
88	d->reg[relative_addr] = idata;
89	}
90	}
91
92	if (writeflag == MEM_READ)
93	memory_writemax64(cpu, data, len, odata);
94
95	return 1;
96	}
97
98
99	/*
100	* devinit_fdc():
101	*/
102	int devinit_fdc(struct devinit *devinit)
103	{
104	struct fdc_data *d;
105
106	d = malloc(sizeof(struct fdc_data));
107	if (d == NULL) {
108	fprintf(stderr, "out of memory\n");
109	exit(1);
110	}
111	memset(d, 0, sizeof(struct fdc_data));
112	d->irqnr = devinit->irq_nr;
113
114	memory_device_register(devinit->machine->memory, devinit->name,
115	devinit->addr, DEV_FDC_LENGTH, dev_fdc_access, d,
116	MEM_DEFAULT, NULL);
117
118	return 1;
119	}
120