/[gxemul]/trunk/src/devices/dev_fdc.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

Diff of /trunk/src/devices/dev_fdc.c

Parent Directory Parent Directory | Revision Log Revision Log | View Patch Patch

revision 4 by dpavlin, Mon Oct 8 16:18:00 2007 UTC revision 42 by dpavlin, Mon Oct 8 16:22:32 2007 UTC
# Line 1  Line 1 
1  /*  /*
2   *  Copyright (C) 2003-2005  Anders Gavare.  All rights reserved.   *  Copyright (C) 2003-2007  Anders Gavare.  All rights reserved.
3   *   *
4   *  Redistribution and use in source and binary forms, with or without   *  Redistribution and use in source and binary forms, with or without
5   *  modification, are permitted provided that the following conditions are met:   *  modification, are permitted provided that the following conditions are met:
# Line 25  Line 25 
25   *  SUCH DAMAGE.   *  SUCH DAMAGE.
26   *     *  
27   *   *
28   *  $Id: dev_fdc.c,v 1.9 2005/02/24 15:38:34 debug Exp $   *  $Id: dev_fdc.c,v 1.21 2007/06/15 19:11:15 debug Exp $
29   *     *  
30   *  Floppy controller.   *  COMMENT: PC-style floppy controller
31   *   *
32   *  TODO!  (This is just a dummy skeleton right now.)   *  TODO!  (This is just a dummy skeleton right now.)
33     *
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   */   */
39    
40  #include <stdio.h>  #include <stdio.h>
41  #include <stdlib.h>  #include <stdlib.h>
42  #include <string.h>  #include <string.h>
43    
 #include "console.h"  
44  #include "device.h"  #include "device.h"
45    #include "interrupt.h"
46  #include "machine.h"  #include "machine.h"
47  #include "memory.h"  #include "memory.h"
48  #include "misc.h"  #include "misc.h"
49    
50    
51  #define DEV_FDC_LENGTH          0x100  #define DEV_FDC_LENGTH          6       /*  TODO 8, but collision with wdc  */
52    
53    
54  struct fdc_data {  struct fdc_data {
55          unsigned char   reg[DEV_FDC_LENGTH];          uint8_t                 reg[DEV_FDC_LENGTH];
56          int             irqnr;          struct interrupt        irq;
57  };  };
58    
59    
60  /*  DEVICE_ACCESS(fdc)
  *  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)  
61  {  {
         uint64_t idata = 0, odata = 0;  
         int i;  
62          struct fdc_data *d = extra;          struct fdc_data *d = extra;
63            uint64_t idata = 0, odata = 0;
64            size_t i;
65    
66          idata = memory_readmax64(cpu, data, len);          if (writeflag == MEM_WRITE)
67                    idata = memory_readmax64(cpu, data, len);
         /*  TODO:  this is 100% dummy  */  
68    
69          switch (relative_addr) {          switch (relative_addr) {
70          case 0x04:          case 0x04:
                 /*  no debug warning  */  
                 if (writeflag==MEM_READ) {  
                         odata = d->reg[relative_addr];  
                 } else  
                         d->reg[relative_addr] = idata;  
71                  break;                  break;
72          default:          default:if (writeflag==MEM_READ) {
73                  if (writeflag==MEM_READ) {                          fatal("[ fdc: read from reg %i ]\n",
                         debug("[ fdc: read from reg %i ]\n",  
74                              (int)relative_addr);                              (int)relative_addr);
75                          odata = d->reg[relative_addr];                          odata = d->reg[relative_addr];
76                  } else {                  } else {
77                          debug("[ fdc: write to reg %i:", (int)relative_addr);                          fatal("[ fdc: write to reg %i:", (int)relative_addr);
78                          for (i=0; i<len; i++)                          for (i=0; i<len; i++)
79                                  debug(" %02x", data[i]);                                  fatal(" %02x", data[i]);
80                          debug(" ]\n");                          fatal(" ]\n");
81                          d->reg[relative_addr] = idata;                          d->reg[relative_addr] = idata;
82                  }                  }
83          }          }
# Line 96  int dev_fdc_access(struct cpu *cpu, stru Line 89  int dev_fdc_access(struct cpu *cpu, stru
89  }  }
90    
91    
92  /*  DEVINIT(fdc)
  *  devinit_fdc():  
  */  
 int devinit_fdc(struct devinit *devinit)  
93  {  {
94          struct fdc_data *d;          struct fdc_data *d;
95    
96          d = malloc(sizeof(struct fdc_data));          CHECK_ALLOCATION(d = malloc(sizeof(struct fdc_data)));
         if (d == NULL) {  
                 fprintf(stderr, "out of memory\n");  
                 exit(1);  
         }  
97          memset(d, 0, sizeof(struct fdc_data));          memset(d, 0, sizeof(struct fdc_data));
98          d->irqnr = devinit->irq_nr;  
99            INTERRUPT_CONNECT(devinit->interrupt_path, d->irq);
100    
101          memory_device_register(devinit->machine->memory, devinit->name,          memory_device_register(devinit->machine->memory, devinit->name,
102              devinit->addr, DEV_FDC_LENGTH, dev_fdc_access, d,              devinit->addr, DEV_FDC_LENGTH, dev_fdc_access, d,
103              MEM_DEFAULT, NULL);              DM_DEFAULT, NULL);
104    
105          return 1;          return 1;
106  }  }
Legend:
Removed from v.4  
changed lines
  Added in v.42
  ViewVC Help
Powered by ViewVC 1.1.26