/[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 18 by dpavlin, Mon Oct 8 16:19:11 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.13 2005/10/26 14:37:03 debug Exp $   *  $Id: dev_fdc.c,v 1.21 2007/06/15 19:11:15 debug Exp $
29   *     *  
30   *  PC-style 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   *   *
# Line 42  Line 42 
42  #include <string.h>  #include <string.h>
43    
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          8  #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          if (writeflag == MEM_WRITE)          if (writeflag == MEM_WRITE)
67                  idata = memory_readmax64(cpu, data, len);                  idata = memory_readmax64(cpu, data, len);
# Line 93  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.18  
changed lines
  Added in v.42
  ViewVC Help
Powered by ViewVC 1.1.26