/[gxemul]/trunk/src/devices/dev_wdc.c
This is repository of my old source code which isn't updated any more. Go to git.rot13.org for current projects!
ViewVC logotype

Contents of /trunk/src/devices/dev_wdc.c

Parent Directory Parent Directory | Revision Log Revision Log


Revision 6 - (show annotations)
Mon Oct 8 16:18:11 2007 UTC (16 years, 5 months ago) by dpavlin
File MIME type: text/plain
File size: 16712 byte(s)
++ trunk/HISTORY	(local)
$Id: HISTORY,v 1.772 2005/06/04 12:02:16 debug Exp $
20050428	Disabling the "-fmove-all-movables" option in the configure
		script, because it causes the compile to fail on OpenBSD/sgi.
20050502	Minor updates.
20050503	Removing the WRT54G mode (it was bogus anyway), and adding a
		comment about Windows NT for MIPS in doc/experiments.html.
		Minor updates to the x86 instruction decoding.
20050504	Adding some more x86 instructions.
		Adding support for reading files from ISO9660 CDROMs (including
		gzipped files). It's an ugly hack, but it seems to work.
		Various other minor updates (dev_vga.c, pc_bios.c etc).
20050505	Some more x86-related updates.
		Beginning (what I hope will be) a major code cleanup phase.
		"bootris" (an x86 bootsector) runs :-)
20050506	Adding some more x86 instructions.
20050507	tmpnam => mkstemp.
		Working on a hack to allow VGA charcells to be shown even when
		not running with X11.
		Adding more x86 instructions.
20050508	x86 32-bit SIB addressing fix, and more instructions.
20050509	Adding more x86 instructions.
20050510	Minor documentation updates, and other updates (x86 stuff etc.)
20050511	More x86-related updates.
20050513	Various updates, mostly x86-related. (Trying to fix flag 
		calculation, factoring out the ugly shift/rotate code, and
		some other things.)
20050514	Adding support for loading some old i386 a.out executables.
		Finally beginning the cleanup of machine/PROM/bios dependant
		info.
		Some minor documentation updates.
		Trying to clean up ARCBIOS stuff a little.
20050515	Trying to make it possible to actually use more than one disk
		type per machine (floppy, ide, scsi).
		Trying to clean up the kbd vs PROM console stuff. (For PC and
		ARC emulation modes, mostly.)
		Beginning to add an 8259 interrupt controller, and connecting
		it to the x86 emulation.
20050516	The first x86 interrupts seem to work (keyboard stuff).
		Adding a 8253/8254 programmable interval timer skeleton.
		FreeDOS now reaches a command prompt and can be interacted
		with.
20050517	After some bugfixes, MS-DOS also (sometimes) reaches a
		command prompt now.
		Trying to fix the pckbc to work with MS-DOS' keyb.com, but no
		success yet.
20050518	Adding a simple 32-bit x86 MMU skeleton.
20050519	Some more work on the x86 stuff. (Beginning the work on paging,
		and various other fixes).
20050520	More updates. Working on dev_vga (4-bit graphics modes), adding
		40 columns support to the PC bios emulation.
		Trying to add support for resizing windows when switching
		between graphics modes.
20050521	Many more x86-related updates.
20050522	Correcting the initial stack pointer's sign-extension for
		ARCBIOS emulation (thanks to Alec Voropay for noticing the
		error).
		Continuing on the cleanup (ARCBIOS etc).
		dev_vga updates.
20050523	More x86 updates: trying to add some support for protected mode
		interrupts (via gate descriptors) and many other fixes.
		More ARCBIOS cleanup.
		Adding a device flag which indicates that reads cause no
		side-effects. (Useful for the "dump" command in the debugger,
		and other things.)
		Adding support for directly starting up x86 ELFs, skipping the
		bootloader stage. (Most ELFs, however, are not suitable for
		this.)
20050524	Adding simple 32-bit x86 TSS task switching, but no privilege
		level support yet.
		More work on dev_vga. A small "Copper bars" demo works. :-)
		Adding support for Trap Flag (single-step exceptions), at least
		in real mode, and various other x86-related fixes.
20050525	Adding a new disk image prefix (gH;S;) which can be used to
		override the default nr of heads and sectors per track.
20050527	Various bug fixes, more work on the x86 mode (stack change on
		interrupts between different priv.levels), and some minor
		documentation updates.
20050528	Various fixes (x86 stuff).
20050529	More x86 fixes. An OpenBSD/i386 bootfloppy reaches userland
		and can be interacted with (although there are problems with
		key repetition). NetBSD/i386 triggers a serious CISC-related
		problem: instruction fetches across page boundaries, where
		the later part isn't actually part of the instruction.
20050530	Various minor updates. (Documentation updates, etc.)
20050531	Adding some experimental code (experiments/new_test_*) which
		could be useful for dynamic (but not binary) translation in
		the future.
20050602	Adding a dummy ARM skeleton.
		Fixing the pckbc key repetition problem (by adding release
		scancodes for all keypresses).
20050603	Minor updates for the next release.
20050604	Release testing. Minor updates.

==============  RELEASE 0.3.3  ==============

20050604	There'll probably be a 0.3.3.1 release soon, with some very
		very tiny updates.


1 /*
2 * Copyright (C) 2004-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_wdc.c,v 1.37 2005/05/27 07:29:25 debug Exp $
29 *
30 * Standard IDE controller.
31 */
32
33 #include <stdio.h>
34 #include <stdlib.h>
35 #include <string.h>
36
37 #include "console.h"
38 #include "cop0.h"
39 #include "cpu.h"
40 #include "devices.h"
41 #include "diskimage.h"
42 #include "machine.h"
43 #include "memory.h"
44 #include "misc.h"
45
46 #include "wdcreg.h"
47
48
49 #define WDC_TICK_SHIFT 14
50 #define WDC_INBUF_SIZE (512*257)
51
52 /* INT_DELAY=2 to be safe, 1 is faster but maybe buggy. */
53 #define INT_DELAY 1
54
55 extern int quiet_mode;
56
57 /* #define debug fatal */
58 /* #define DATA_DEBUG */
59
60 struct wdc_data {
61 int irq_nr;
62 int base_drive;
63
64 int delayed_interrupt;
65
66 unsigned char identify_struct[512];
67
68 unsigned char inbuf[WDC_INBUF_SIZE];
69 int inbuf_head;
70 int inbuf_tail;
71
72 int write_in_progress;
73 int write_count;
74 int64_t write_offset;
75
76 int error;
77 int precomp;
78 int seccnt;
79 int sector;
80 int cyl_lo;
81 int cyl_hi;
82 int sectorsize;
83 int lba;
84 int drive;
85 int head;
86 int cur_command;
87 };
88
89
90 /*
91 * dev_wdc_tick():
92 */
93 void dev_wdc_tick(struct cpu *cpu, void *extra)
94 {
95 struct wdc_data *d = extra;
96
97 if (d->delayed_interrupt) {
98 d->delayed_interrupt --;
99
100 if (d->delayed_interrupt == 0)
101 cpu_interrupt(cpu, d->irq_nr);
102 }
103 }
104
105
106 /*
107 * wdc_addtoinbuf():
108 *
109 * Write to the inbuf at its head, read at its tail.
110 */
111 static void wdc_addtoinbuf(struct wdc_data *d, int c)
112 {
113 d->inbuf[d->inbuf_head] = c;
114
115 d->inbuf_head = (d->inbuf_head + 1) % WDC_INBUF_SIZE;
116 if (d->inbuf_head == d->inbuf_tail)
117 fatal("[ wdc_addtoinbuf(): WARNING! wdc inbuf overrun ]\n");
118 }
119
120
121 /*
122 * wdc_get_inbuf():
123 *
124 * Read from the tail of inbuf.
125 */
126 static uint64_t wdc_get_inbuf(struct wdc_data *d)
127 {
128 int c = d->inbuf[d->inbuf_tail];
129
130 if (d->inbuf_head == d->inbuf_tail) {
131 fatal("[ wdc: WARNING! someone is reading too much from the "
132 "wdc inbuf! ]\n");
133 return -1;
134 }
135
136 d->inbuf_tail = (d->inbuf_tail + 1) % WDC_INBUF_SIZE;
137 return c;
138 }
139
140
141 /*
142 * wdc_initialize_identify_struct(d):
143 */
144 static void wdc_initialize_identify_struct(struct cpu *cpu, struct wdc_data *d)
145 {
146 uint64_t total_size;
147 int cyls, heads, sectors_per_track;
148
149 total_size = diskimage_getsize(cpu->machine, d->drive + d->base_drive,
150 DISKIMAGE_IDE);
151
152 diskimage_getchs(cpu->machine, d->drive + d->base_drive,
153 DISKIMAGE_IDE, &cyls, &heads, &sectors_per_track);
154
155 memset(d->identify_struct, 0, sizeof(d->identify_struct));
156
157 /* Offsets are in 16-bit WORDS! High byte, then low. */
158
159 /* 0: general flags */
160 d->identify_struct[2 * 0 + 0] = 0;
161 d->identify_struct[2 * 0 + 1] = 1 << 6;
162
163 /* 1: nr of cylinders */
164 d->identify_struct[2 * 1 + 0] = (cyls >> 8);
165 d->identify_struct[2 * 1 + 1] = cyls & 255;
166
167 /* 3: nr of heads */
168 d->identify_struct[2 * 3 + 0] = heads >> 8;
169 d->identify_struct[2 * 3 + 1] = heads;
170
171 /* 6: sectors per track */
172 d->identify_struct[2 * 6 + 0] = sectors_per_track >> 8;
173 d->identify_struct[2 * 6 + 1] = sectors_per_track;
174
175 /* 10-19: Serial number */
176 memcpy(&d->identify_struct[2 * 10], "S/N 1234-5678 ", 20);
177
178 /* 23-26: Firmware version */
179 memcpy(&d->identify_struct[2 * 23], "VER 1.0 ", 8);
180
181 /* 27-46: Model number */
182 memcpy(&d->identify_struct[2 * 27],
183 "Fake GXemul IDE disk ", 40);
184 /* TODO: Use the diskimage's filename instead? */
185
186 /* 47: max sectors per multitransfer */
187 d->identify_struct[2 * 47 + 0] = 0x80;
188 d->identify_struct[2 * 47 + 1] = 1; /* 1 or 16? */
189
190 /* 57-58: current capacity in sectors */
191 d->identify_struct[2 * 57 + 0] = ((total_size / 512) >> 24) % 255;
192 d->identify_struct[2 * 57 + 1] = ((total_size / 512) >> 16) % 255;
193 d->identify_struct[2 * 58 + 0] = ((total_size / 512) >> 8) % 255;
194 d->identify_struct[2 * 58 + 1] = (total_size / 512) & 255;
195
196 /* 60-61: total nr of addresable sectors */
197 d->identify_struct[2 * 60 + 0] = ((total_size / 512) >> 24) % 255;
198 d->identify_struct[2 * 60 + 1] = ((total_size / 512) >> 16) % 255;
199 d->identify_struct[2 * 61 + 0] = ((total_size / 512) >> 8) % 255;
200 d->identify_struct[2 * 61 + 1] = (total_size / 512) & 255;
201
202 }
203
204
205 /*
206 * status_byte():
207 */
208 static int status_byte(struct wdc_data *d, struct cpu *cpu)
209 {
210 int odata = 0;
211
212 if (diskimage_exist(cpu->machine, d->drive + d->base_drive,
213 DISKIMAGE_IDE))
214 odata |= WDCS_DRDY;
215 if (d->inbuf_head != d->inbuf_tail)
216 odata |= WDCS_DRQ;
217 if (d->write_in_progress)
218 odata |= WDCS_DRQ;
219 if (d->error)
220 odata |= WDCS_ERR;
221
222 #if 0
223 /*
224 * TODO: Is this correct behaviour?
225 *
226 * NetBSD/cobalt seems to want it, but Linux on MobilePro does not.
227 */
228 if (!diskimage_exist(cpu->machine, d->drive + d->base_drive,
229 DISKIMAGE_IDE))
230 odata = 0xff;
231 #endif
232
233 return odata;
234 }
235
236
237 /*
238 * dev_wdc_altstatus_access():
239 */
240 int dev_wdc_altstatus_access(struct cpu *cpu, struct memory *mem,
241 uint64_t relative_addr, unsigned char *data, size_t len,
242 int writeflag, void *extra)
243 {
244 struct wdc_data *d = extra;
245 uint64_t idata = 0, odata = 0;
246
247 idata = memory_readmax64(cpu, data, len);
248
249 /* Same as the normal status byte? */
250 odata = status_byte(d, cpu);
251
252 if (writeflag==MEM_READ)
253 debug("[ wdc: read from ALTSTATUS: 0x%02x ]\n",
254 (int)odata);
255 else
256 debug("[ wdc: write to ALT. CTRL: 0x%02x ]\n",
257 (int)idata);
258
259 if (writeflag == MEM_READ)
260 memory_writemax64(cpu, data, len, odata);
261
262 return 1;
263 }
264
265
266 /*
267 * dev_wdc_access():
268 */
269 int dev_wdc_access(struct cpu *cpu, struct memory *mem,
270 uint64_t relative_addr, unsigned char *data, size_t len,
271 int writeflag, void *extra)
272 {
273 struct wdc_data *d = extra;
274 uint64_t idata = 0, odata = 0;
275 int i, cyls, heads, sectors_per_track;
276
277 idata = memory_readmax64(cpu, data, len);
278
279 switch (relative_addr) {
280
281 case wd_data: /* 0: data */
282 if (writeflag==MEM_READ) {
283 odata = 0;
284
285 /* TODO: This is hardcoded for little-endian? */
286
287 odata += wdc_get_inbuf(d);
288 if (len >= 2)
289 odata += (wdc_get_inbuf(d) << 8);
290 if (len == 4) {
291 odata += (wdc_get_inbuf(d) << 16);
292 odata += (wdc_get_inbuf(d) << 24);
293 }
294
295 #ifdef DATA_DEBUG
296 debug("[ wdc: read from DATA: 0x%04x ]\n", odata);
297 #endif
298
299 if (d->inbuf_tail != d->inbuf_head)
300 d->delayed_interrupt = INT_DELAY;
301
302 } else {
303 int inbuf_len;
304 #ifdef DATA_DEBUG
305 debug("[ wdc: write to DATA (len=%i): 0x%08lx ]\n",
306 (int)len, (long)idata);
307 #endif
308 if (!d->write_in_progress) {
309 fatal("[ wdc: write to DATA, but not "
310 "expecting any? (len=%i): 0x%08lx ]\n",
311 (int)len, (long)idata);
312 }
313
314 switch (len) {
315 case 4: wdc_addtoinbuf(d, idata & 0xff);
316 wdc_addtoinbuf(d, (idata >> 8) & 0xff);
317 wdc_addtoinbuf(d, (idata >> 16) & 0xff);
318 wdc_addtoinbuf(d, (idata >> 24) & 0xff);
319 break;
320 case 2: wdc_addtoinbuf(d, idata & 0xff);
321 wdc_addtoinbuf(d, (idata >> 8) & 0xff);
322 break;
323 case 1: wdc_addtoinbuf(d, idata); break;
324 default:fatal("wdc: unimplemented write len %i\n", len);
325 exit(1);
326 }
327
328 inbuf_len = d->inbuf_head - d->inbuf_tail;
329 while (inbuf_len < 0)
330 inbuf_len += WDC_INBUF_SIZE;
331
332 #if 0
333 if ((inbuf_len % (512 * d->write_count)) == 0) {
334 #endif
335 if ((inbuf_len % 512) == 0) {
336 int count = 1; /* d->write_count; */
337 unsigned char *buf = malloc(count * 512);
338 if (buf == NULL) {
339 fprintf(stderr, "out of memory\n");
340 exit(1);
341 }
342
343 for (i=0; i<512 * count; i++)
344 buf[i] = wdc_get_inbuf(d);
345
346 diskimage_access(cpu->machine,
347 d->drive + d->base_drive, DISKIMAGE_IDE, 1,
348 d->write_offset, buf, 512 * count);
349 free(buf);
350
351 d->write_count --;
352 d->write_offset += 512;
353
354 d->delayed_interrupt = INT_DELAY;
355
356 if (d->write_count == 0)
357 d->write_in_progress = 0;
358 }
359 }
360 break;
361
362 case wd_error: /* 1: error (r), precomp (w) */
363 if (writeflag==MEM_READ) {
364 odata = d->error;
365 debug("[ wdc: read from ERROR: 0x%02x ]\n", odata);
366 /* TODO: is the error value cleared on read? */
367 d->error = 0;
368 } else {
369 d->precomp = idata;
370 debug("[ wdc: write to PRECOMP: 0x%02x ]\n", idata);
371 }
372 break;
373
374 case wd_seccnt: /* 2: sector count */
375 if (writeflag==MEM_READ) {
376 odata = d->seccnt;
377 debug("[ wdc: read from SECCNT: 0x%02x ]\n", odata);
378 } else {
379 d->seccnt = idata;
380 debug("[ wdc: write to SECCNT: 0x%02x ]\n", idata);
381 }
382 break;
383
384 case wd_sector: /* 3: first sector */
385 if (writeflag==MEM_READ) {
386 odata = d->sector;
387 debug("[ wdc: read from SECTOR: 0x%02x ]\n", odata);
388 } else {
389 d->sector = idata;
390 debug("[ wdc: write to SECTOR: 0x%02x ]\n", idata);
391 }
392 break;
393
394 case wd_cyl_lo: /* 4: cylinder low */
395 if (writeflag==MEM_READ) {
396 odata = d->cyl_lo;
397 debug("[ wdc: read from CYL_LO: 0x%02x ]\n", odata);
398 } else {
399 d->cyl_lo = idata;
400 debug("[ wdc: write to CYL_LO: 0x%02x ]\n", idata);
401 }
402 break;
403
404 case wd_cyl_hi: /* 5: cylinder low */
405 if (writeflag==MEM_READ) {
406 odata = d->cyl_hi;
407 debug("[ wdc: read from CYL_HI: 0x%02x ]\n", odata);
408 } else {
409 d->cyl_hi = idata;
410 debug("[ wdc: write to CYL_HI: 0x%02x ]\n", idata);
411 }
412 break;
413
414 case wd_sdh: /* 6: sectorsize/drive/head */
415 if (writeflag==MEM_READ) {
416 odata = (d->sectorsize << 6) + (d->lba << 5) +
417 (d->drive << 4) + (d->head);
418 debug("[ wdc: read from SDH: 0x%02x (sectorsize %i,"
419 " lba=%i, drive %i, head %i) ]\n", (int)odata,
420 d->sectorsize, d->lba, d->drive, d->head);
421 } else {
422 d->sectorsize = (idata >> 6) & 3;
423 d->lba = (idata >> 5) & 1;
424 d->drive = (idata >> 4) & 1;
425 d->head = idata & 0xf;
426 debug("[ wdc: write to SDH: 0x%02x (sectorsize %i,"
427 " lba=%i, drive %i, head %i) ]\n", (int)idata,
428 d->sectorsize, d->lba, d->drive, d->head);
429 }
430 break;
431
432 case wd_command: /* 7: command or status */
433 if (writeflag==MEM_READ) {
434 odata = status_byte(d, cpu);
435 #if 1
436 if (!quiet_mode)
437 debug("[ wdc: read from STATUS: 0x%02x ]\n",
438 odata);
439 #endif
440
441 cpu_interrupt_ack(cpu, d->irq_nr);
442 d->delayed_interrupt = 0;
443 } else {
444 debug("[ wdc: write to COMMAND: 0x%02x ]\n", idata);
445 d->cur_command = idata;
446
447 /* TODO: Is this correct behaviour? */
448 if (!diskimage_exist(cpu->machine,
449 d->drive + d->base_drive, DISKIMAGE_IDE)) {
450 d->error |= WDCE_ABRT;
451 d->delayed_interrupt = INT_DELAY;
452 break;
453 }
454
455 /* Handle the command: */
456 switch (d->cur_command) {
457 case WDCC_READ:
458 debug("[ wdc: READ from drive %i, head %i, "
459 "cylinder %i, sector %i, nsecs %i ]\n",
460 d->drive, d->head, d->cyl_hi*256+d->cyl_lo,
461 d->sector, d->seccnt);
462 /* TODO: HAHA! This should be removed
463 quickly */
464 diskimage_getchs(cpu->machine, d->drive +
465 d->base_drive, DISKIMAGE_IDE, &cyls,
466 &heads, &sectors_per_track);
467
468 {
469 unsigned char buf[512*256];
470 int cyl = d->cyl_hi * 256+ d->cyl_lo;
471 int count = d->seccnt? d->seccnt : 256;
472 uint64_t offset = 512 * (d->sector - 1
473 + d->head * sectors_per_track +
474 heads*sectors_per_track*cyl);
475
476 #if 0
477 /* LBA: */
478 if (d->lba)
479 offset = 512 * (((d->head & 0xf) << 24) + (cyl << 8) + d->sector);
480 printf("WDC read from offset %lli\n", (long long)offset);
481 #endif
482 diskimage_access(cpu->machine,
483 d->drive + d->base_drive,
484 DISKIMAGE_IDE, 0,
485 offset, buf, 512 * count);
486 /* TODO: result code */
487 for (i=0; i<512 * count; i++)
488 wdc_addtoinbuf(d, buf[i]);
489 }
490 d->delayed_interrupt = INT_DELAY;
491 break;
492 case WDCC_WRITE:
493 debug("[ wdc: WRITE to drive %i, head %i, "
494 "cylinder %i, sector %i, nsecs %i ]\n",
495 d->drive, d->head, d->cyl_hi*256+d->cyl_lo,
496 d->sector, d->seccnt);
497 /* TODO: HAHA! This should be removed
498 quickly */
499 diskimage_getchs(cpu->machine, d->drive +
500 d->base_drive, DISKIMAGE_IDE, &cyls,
501 &heads, &sectors_per_track);
502 {
503 int cyl = d->cyl_hi * 256+ d->cyl_lo;
504 int count = d->seccnt? d->seccnt : 256;
505 uint64_t offset = 512 * (d->sector - 1
506 + d->head * sectors_per_track +
507 heads*sectors_per_track*cyl);
508
509 #if 0
510 /* LBA: */
511 if (d->lba)
512 offset = 512 * (((d->head & 0xf) << 24) + (cyl << 8) + d->sector);
513 printf("WDC write to offset %lli\n", (long long)offset);
514 #endif
515
516 d->write_in_progress = 1;
517 d->write_count = count;
518 d->write_offset = offset;
519
520 /* TODO: result code */
521 }
522 /* TODO: Really interrupt here? */
523 #if 0
524 d->delayed_interrupt = INT_DELAY;
525 #endif
526 break;
527
528 case WDCC_IDP: /* Initialize drive parameters */
529 debug("[ wdc: IDP drive %i (TODO) ]\n",
530 d->drive);
531 /* TODO */
532 d->delayed_interrupt = INT_DELAY;
533 break;
534 case SET_FEATURES:
535 fatal("[ wdc: SET_FEATURES drive %i (TODO), "
536 "feature 0x%02x ]\n", d->drive, d->precomp);
537 /* TODO */
538 switch (d->precomp) {
539 case WDSF_SET_MODE:
540 fatal("[ wdc: WDSF_SET_MODE drive %i, "
541 "pio/dma flags 0x%02x ]\n",
542 d->drive, d->seccnt);
543 break;
544 default:
545 d->error |= WDCE_ABRT;
546 }
547 /* TODO: always interrupt? */
548 d->delayed_interrupt = INT_DELAY;
549 break;
550 case WDCC_RECAL:
551 debug("[ wdc: RECAL drive %i ]\n", d->drive);
552 d->delayed_interrupt = INT_DELAY;
553 break;
554 case WDCC_IDENTIFY:
555 debug("[ wdc: IDENTIFY drive %i ]\n", d->drive);
556 wdc_initialize_identify_struct(cpu, d);
557 /* The IDENTIFY data block is sent out
558 in low/high byte order: */
559 for (i=0; i<sizeof(d->identify_struct); i+=2) {
560 wdc_addtoinbuf(d, d->identify_struct
561 [i+1]);
562 wdc_addtoinbuf(d, d->identify_struct
563 [i+0]);
564 }
565 d->delayed_interrupt = INT_DELAY;
566 break;
567 case WDCC_IDLE_IMMED:
568 debug("[ wdc: IDLE_IMMED drive %i ]\n",
569 d->drive);
570 /* TODO: interrupt here? */
571 d->delayed_interrupt = INT_DELAY;
572 break;
573 default:
574 /* TODO */
575 d->error |= WDCE_ABRT;
576
577 fatal("[ wdc: unknown command 0x%02x ("
578 "drive %i, head %i, cylinder %i, sector %i,"
579 " nsecs %i) ]\n", d->cur_command, d->drive,
580 d->head, d->cyl_hi*256+d->cyl_lo,
581 d->sector, d->seccnt);
582 exit(1);
583 }
584 }
585 break;
586
587 default:
588 if (writeflag==MEM_READ)
589 debug("[ wdc: read from 0x%02x ]\n",
590 (int)relative_addr);
591 else
592 debug("[ wdc: write to 0x%02x: 0x%02x ]\n",
593 (int)relative_addr, (int)idata);
594 }
595
596 if (writeflag == MEM_READ)
597 memory_writemax64(cpu, data, len, odata);
598
599 return 1;
600 }
601
602
603 /*
604 * dev_wdc_init():
605 *
606 * base_drive should be 0 for the primary device, and 2 for the secondary.
607 */
608 void dev_wdc_init(struct machine *machine, struct memory *mem,
609 uint64_t baseaddr, int irq_nr, int base_drive)
610 {
611 struct wdc_data *d;
612 uint64_t alt_status_addr;
613
614 d = malloc(sizeof(struct wdc_data));
615 if (d == NULL) {
616 fprintf(stderr, "out of memory\n");
617 exit(1);
618 }
619 memset(d, 0, sizeof(struct wdc_data));
620 d->irq_nr = irq_nr;
621 d->base_drive = base_drive;
622
623 alt_status_addr = baseaddr + 0x206;
624
625 /* Special hack for pcic/hpcmips: TODO: Fix */
626 if (baseaddr == 0x14000180)
627 alt_status_addr = 0x14000386;
628
629 memory_device_register(mem, "wdc_altstatus", alt_status_addr, 2,
630 dev_wdc_altstatus_access, d, MEM_DEFAULT, NULL);
631 memory_device_register(mem, "wdc", baseaddr, DEV_WDC_LENGTH,
632 dev_wdc_access, d, MEM_DEFAULT, NULL);
633
634 machine_add_tickfunction(machine, dev_wdc_tick,
635 d, WDC_TICK_SHIFT);
636 }
637

  ViewVC Help
Powered by ViewVC 1.1.26