src/devices/dev_disk.c

/*
 *  Copyright (C) 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_disk.c,v 1.8 2005/10/26 14:37:03 debug Exp $
 *
 *  Basic "Disk" device. This is a simple test device which can be used to
 *  read and write data from disk devices.
 */

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

#include "cpu.h"
#include "device.h"
#include "devices.h"
#include "diskimage.h"
#include "emul.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#define BUF_SIZE        8192

struct disk_data {
        int64_t         offset;
        int             disk_id;
        int             command;
        int             status;
        unsigned char   *buf;
};


/*
 *  dev_disk_buf_access():
 */
int dev_disk_buf_access(struct cpu *cpu, struct memory *mem,
        uint64_t relative_addr, unsigned char *data, size_t len,
        int writeflag, void *extra)
{
        struct disk_data *d = (struct disk_data *) extra;

        if (writeflag == MEM_WRITE)
                memcpy(d->buf + relative_addr, data, len);
        else
                memcpy(data, d->buf + relative_addr, len);
        return 1;
}


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

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

        switch (relative_addr) {
        case 0x00:
                if (writeflag == MEM_READ) {
                        odata = d->offset;
                } else {
                        d->offset = idata;
                }
                break;
        case 0x10:
                if (writeflag == MEM_READ) {
                        odata = d->disk_id;
                } else {
                        d->disk_id = idata;
                }
                break;
        case 0x20:
                if (writeflag == MEM_READ) {
                        odata = d->command;
                } else {
                        d->command = idata;
                        switch (d->command) {
                        case 0: d->status = diskimage_access(cpu->machine,
                                     d->disk_id, DISKIMAGE_SCSI, 0,
                                     d->offset, d->buf, 512);
                                break;
                        case 1: d->status = diskimage_access(cpu->machine,
                                     d->disk_id, DISKIMAGE_SCSI, 1,
                                     d->offset, d->buf, 512);
                                break;
                        }
                }
                break;
        case 0x30:
                if (writeflag == MEM_READ) {
                        odata = d->status;
                } else {
                        d->status = idata;
                }
                break;
        default:if (writeflag == MEM_WRITE) {
                        fatal("[ disk: unimplemented write to "
                            "offset 0x%x: data=0x%x ]\n", (int)
                            relative_addr, (int)idata);
                } else {
                        fatal("[ disk: unimplemented read from "
                            "offset 0x%x ]\n", (int)relative_addr);
                }
        }

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

        return 1;
}


/*
 *  devinit_disk():
 */
int devinit_disk(struct devinit *devinit)
{
        struct disk_data *d = malloc(sizeof(struct disk_data));
        size_t nlen;
        char *n1, *n2;
                 
        nlen = strlen(devinit->name) + 30;
        n1 = malloc(nlen);
        n2 = malloc(nlen);

        if (d == NULL || n1 == NULL || n2 == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct disk_data));

        d->buf = malloc(devinit->machine->arch_pagesize);
        if (d->buf == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d->buf, 0, devinit->machine->arch_pagesize);

        snprintf(n1, nlen, "%s [control]", devinit->name);
        snprintf(n2, nlen, "%s [data buffer]", devinit->name);

        memory_device_register(devinit->machine->memory, n1,
            devinit->addr, 0x4000, dev_disk_access, (void *)d,
            MEM_DEFAULT, NULL);

        memory_device_register(devinit->machine->memory, n2,
            devinit->addr + 0x4000, devinit->machine->arch_pagesize,
            dev_disk_buf_access, (void *)d, MEM_DYNTRANS_OK |
            MEM_DYNTRANS_WRITE_OK | MEM_READING_HAS_NO_SIDE_EFFECTS, d->buf);

        return 1;
}

1	/*
2	* Copyright (C) 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_disk.c,v 1.8 2005/10/26 14:37:03 debug Exp $
29	*
30	* Basic "Disk" device. This is a simple test device which can be used to
31	* read and write data from disk devices.
32	*/
33
34	#include <stdio.h>
35	#include <stdlib.h>
36	#include <string.h>
37
38	#include "cpu.h"
39	#include "device.h"
40	#include "devices.h"
41	#include "diskimage.h"
42	#include "emul.h"
43	#include "machine.h"
44	#include "memory.h"
45	#include "misc.h"
46
47
48	#define BUF_SIZE 8192
49
50	struct disk_data {
51	int64_t offset;
52	int disk_id;
53	int command;
54	int status;
55	unsigned char *buf;
56	};
57
58
59	/*
60	* dev_disk_buf_access():
61	*/
62	int dev_disk_buf_access(struct cpu cpu, struct memory mem,
63	uint64_t relative_addr, unsigned char *data, size_t len,
64	int writeflag, void *extra)
65	{
66	struct disk_data d = (struct disk_data ) extra;
67
68	if (writeflag == MEM_WRITE)
69	memcpy(d->buf + relative_addr, data, len);
70	else
71	memcpy(data, d->buf + relative_addr, len);
72	return 1;
73	}
74
75
76	/*
77	* dev_disk_access():
78	*/
79	int dev_disk_access(struct cpu cpu, struct memory mem,
80	uint64_t relative_addr, unsigned char *data, size_t len,
81	int writeflag, void *extra)
82	{
83	struct disk_data d = (struct disk_data ) extra;
84	uint64_t idata = 0, odata = 0;
85
86	if (writeflag == MEM_WRITE)
87	idata = memory_readmax64(cpu, data, len);
88
89	switch (relative_addr) {
90	case 0x00:
91	if (writeflag == MEM_READ) {
92	odata = d->offset;
93	} else {
94	d->offset = idata;
95	}
96	break;
97	case 0x10:
98	if (writeflag == MEM_READ) {
99	odata = d->disk_id;
100	} else {
101	d->disk_id = idata;
102	}
103	break;
104	case 0x20:
105	if (writeflag == MEM_READ) {
106	odata = d->command;
107	} else {
108	d->command = idata;
109	switch (d->command) {
110	case 0: d->status = diskimage_access(cpu->machine,
111	d->disk_id, DISKIMAGE_SCSI, 0,
112	d->offset, d->buf, 512);
113	break;
114	case 1: d->status = diskimage_access(cpu->machine,
115	d->disk_id, DISKIMAGE_SCSI, 1,
116	d->offset, d->buf, 512);
117	break;
118	}
119	}
120	break;
121	case 0x30:
122	if (writeflag == MEM_READ) {
123	odata = d->status;
124	} else {
125	d->status = idata;
126	}
127	break;
128	default:if (writeflag == MEM_WRITE) {
129	fatal("[ disk: unimplemented write to "
130	"offset 0x%x: data=0x%x ]\n", (int)
131	relative_addr, (int)idata);
132	} else {
133	fatal("[ disk: unimplemented read from "
134	"offset 0x%x ]\n", (int)relative_addr);
135	}
136	}
137
138	if (writeflag == MEM_READ)
139	memory_writemax64(cpu, data, len, odata);
140
141	return 1;
142	}
143
144
145	/*
146	* devinit_disk():
147	*/
148	int devinit_disk(struct devinit *devinit)
149	{
150	struct disk_data *d = malloc(sizeof(struct disk_data));
151	size_t nlen;
152	char n1, n2;
153
154	nlen = strlen(devinit->name) + 30;
155	n1 = malloc(nlen);
156	n2 = malloc(nlen);
157
158	if (d == NULL \|\| n1 == NULL \|\| n2 == NULL) {
159	fprintf(stderr, "out of memory\n");
160	exit(1);
161	}
162	memset(d, 0, sizeof(struct disk_data));
163
164	d->buf = malloc(devinit->machine->arch_pagesize);
165	if (d->buf == NULL) {
166	fprintf(stderr, "out of memory\n");
167	exit(1);
168	}
169	memset(d->buf, 0, devinit->machine->arch_pagesize);
170
171	snprintf(n1, nlen, "%s [control]", devinit->name);
172	snprintf(n2, nlen, "%s [data buffer]", devinit->name);
173
174	memory_device_register(devinit->machine->memory, n1,
175	devinit->addr, 0x4000, dev_disk_access, (void *)d,
176	MEM_DEFAULT, NULL);
177
178	memory_device_register(devinit->machine->memory, n2,
179	devinit->addr + 0x4000, devinit->machine->arch_pagesize,
180	dev_disk_buf_access, (void *)d, MEM_DYNTRANS_OK \|
181	MEM_DYNTRANS_WRITE_OK \| MEM_READING_HAS_NO_SIDE_EFFECTS, d->buf);
182
183	return 1;
184	}
185