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

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

revision 12 by dpavlin, Mon Oct 8 16:18:38 2007 UTC revision 28 by dpavlin, Mon Oct 8 16:20:26 2007 UTC
# Line 1  Line 1 
1  /*  /*
2   *  Copyright (C) 2005  Anders Gavare.  All rights reserved.   *  Copyright (C) 2005-2006  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_8259.c,v 1.14 2005/08/05 09:08:20 debug Exp $   *  $Id: dev_8259.c,v 1.25 2006/07/21 16:55:41 debug Exp $
29   *     *  
30   *  8259 Programmable Interrupt Controller.   *  8259 Programmable Interrupt Controller.
31   *   *
# Line 51  Line 51 
51  /*  #define DEV_8259_DEBUG  */  /*  #define DEV_8259_DEBUG  */
52    
53    
54  /*  DEVICE_ACCESS(8259)
  *  dev_8259_access():  
  */  
 int dev_8259_access(struct cpu *cpu, struct memory *mem,  
         uint64_t relative_addr, unsigned char *data, size_t len,  
         int writeflag, void *extra)  
55  {  {
56          struct pic8259_data *d = (struct pic8259_data *) extra;          struct pic8259_data *d = (struct pic8259_data *) extra;
57          uint64_t idata = 0, odata = 0;          uint64_t idata = 0, odata = 0;
58          int i;          int i;
59    
60          idata = memory_readmax64(cpu, data, len);          if (writeflag == MEM_WRITE)
61                    idata = memory_readmax64(cpu, data, len);
62    
63  #ifdef DEV_8259_DEBUG  #ifdef DEV_8259_DEBUG
64          if (writeflag == MEM_READ)          if (writeflag == MEM_READ)
# Line 99  int dev_8259_access(struct cpu *cpu, str Line 95  int dev_8259_access(struct cpu *cpu, str
95                                      " it was aborted? ]\n");                                      " it was aborted? ]\n");
96                          d->init_state = 0;                          d->init_state = 0;
97    
98                          switch (idata) {                          if (idata == 0x0a) {
                         case 0x0a:  
99                                  d->current_command = 0x0a;                                  d->current_command = 0x0a;
100                                  break;                          } else if (idata == 0x0b) {
                         case 0x0b:  
101                                  d->current_command = 0x0b;                                  d->current_command = 0x0b;
102                                  break;                          } else if (idata == 0x0c) {
                         case 0x0c:  
103                                  /*  Put Master in Buffered Mode  */                                  /*  Put Master in Buffered Mode  */
104                                  d->current_command = 0x0c;                                  d->current_command = 0x0c;
105                                  break;                          } else if (idata == 0x20) {
106                          case 0x20:      /*  End Of Interrupt  */                                  int old_irr = d->irr;
107                                  /*                                  /*  End Of Interrupt  */
108                                   *  TODO: in buffered mode, is this an EOI 0?                                  /*  TODO: in buffered mode, is this an EOI 0? */
                                  */  
109                                  d->irr &= ~d->isr;                                  d->irr &= ~d->isr;
110                                  d->isr = 0;                                  d->isr = 0;
111                                  /*  Recalculate interrupt assertions:  */                                  /*  Recalculate interrupt assertions,
112                                  cpu_interrupt(cpu, d->irq_nr);                                      if necessary:  */
113                                  break;                                  if ((old_irr & ~d->ier) != (d->irr & ~d->ier))
114                          case 0x21:      /*  Specific EOI  */                                          cpu_interrupt(cpu, d->irq_nr);
115                          case 0x22:                          } else if ((idata >= 0x21 && idata <= 0x27) ||
116                          case 0x23:                              (idata >= 0x60 && idata <= 0x67) ||
117                          case 0x24:                              (idata >= 0xe0 && idata <= 0xe7)) {
118                          case 0x25:                                  /*  Specific EOI  */
119                          case 0x26:                                  int old_irr = d->irr;
                         case 0x27:  
                         case 0x60:  
                         case 0x61:  
                         case 0x62:  
                         case 0x63:  
                         case 0x64:  
                         case 0x65:  
                         case 0x66:  
                         case 0x67:      /*  Specific EOI  */  
120                                  d->irr &= ~(1 << (idata & 7));                                  d->irr &= ~(1 << (idata & 7));
121                                  d->isr &= ~(1 << (idata & 7));                                  d->isr &= ~(1 << (idata & 7));
122                                  /*  Recalculate interrupt assertions:  */                                  /*  Recalc. int assertions, if necessary:  */
123                                  cpu_interrupt(cpu, d->irq_nr);                                  if ((old_irr & ~d->ier) != (d->irr & ~d->ier))
124                                  break;                                          cpu_interrupt(cpu, d->irq_nr);
125                          case 0x68:      /*  Set Special Mask Mode  */                          } else if (idata == 0x68) {
126                                    /*  Set Special Mask Mode  */
127                                  /*  TODO  */                                  /*  TODO  */
128                                  break;                          } else if (idata >= 0xc0 && idata <= 0xc7) {
129                          case 0xc0:                                  /*  Set IRQ Priority Order  */
                         case 0xc1:  
                         case 0xc2:  
                         case 0xc3:  
                         case 0xc4:  
                         case 0xc5:  
                         case 0xc6:  
                         case 0xc7:      /*  Set IRQ Priority Order  */  
130                                  /*  TODO  */                                  /*  TODO  */
131                                  break;                          } else {
                         default:  
132                                  fatal("[ 8259: unimplemented command 0x%02x"                                  fatal("[ 8259: unimplemented command 0x%02x"
133                                      " ]\n", idata);                                      " ]\n", (int)idata);
134                                  cpu->running = 0;                                  cpu->running = 0;
135                          }                          }
136                  } else {                  } else {
# Line 167  int dev_8259_access(struct cpu *cpu, str Line 143  int dev_8259_access(struct cpu *cpu, str
143                                  break;                                  break;
144                          case 0x0c:                          case 0x0c:
145                                  /*  Buffered mode.  */                                  /*  Buffered mode.  */
146                                    odata = 0x00;
147                                    for (i=0; i<8; i++)
148                                            if ((d->irr >> i) & 1) {
149                                                    odata = 0x80 | i;
150                                                    break;
151                                            }
152                                    break;
153                          default:                          default:
154                                  odata = 0x00;                                  odata = 0x00;
155                                  for (i=0; i<8; i++)                                  for (i=0; i<8; i++)
# Line 204  int dev_8259_access(struct cpu *cpu, str Line 187  int dev_8259_access(struct cpu *cpu, str
187                                  /*  Slave attachment. TODO  */                                  /*  Slave attachment. TODO  */
188                                  d->init_state = 3;                                  d->init_state = 3;
189                          } else if (d->init_state == 3) {                          } else if (d->init_state == 3) {
190                                  if (idata & 0x02)                                  if (idata & 0x02) {
191                                          fatal("[ 8259: WARNING! Bit 1 i"                                          /*  Should not be set in PCs, but
192                                                on CATS, for example, it is set.  */
193                                            debug("[ 8259: WARNING! Bit 1 i"
194                                              "n Init Cmd 4 is set! ]\n");                                              "n Init Cmd 4 is set! ]\n");
195                                    }
196                                  if (!(idata & 0x01))                                  if (!(idata & 0x01))
197                                          fatal("[ 8259: WARNING! Bit 0 "                                          fatal("[ 8259: WARNING! Bit 0 "
198                                              "in Init Cmd 4 is not"                                              "in Init Cmd 4 is not"
# Line 217  int dev_8259_access(struct cpu *cpu, str Line 203  int dev_8259_access(struct cpu *cpu, str
203                  }                  }
204    
205                  if (writeflag == MEM_WRITE) {                  if (writeflag == MEM_WRITE) {
206                            int old_ier = d->ier;
207                          d->ier = idata;                          d->ier = idata;
208                          /*  Recalculate interrupt assertions:  */  
209                          cpu_interrupt(cpu, d->irq_nr);                          /*  Recalculate interrupt assertions,
210                                if necessary:  */
211                            if ((d->irr & ~old_ier) != (d->irr & ~d->ier))
212                                    cpu_interrupt(cpu, d->irq_nr);
213                  } else {                  } else {
214                          odata = d->ier;                          odata = d->ier;
215                  }                  }
# Line 256  int dev_8259_access(struct cpu *cpu, str Line 246  int dev_8259_access(struct cpu *cpu, str
246   *          which the PIC is connected. (That is left to machine specific   *          which the PIC is connected. (That is left to machine specific
247   *          code in src/machine.c.)   *          code in src/machine.c.)
248   */   */
249  int devinit_8259(struct devinit *devinit)  DEVINIT(8259)
250  {  {
251          struct pic8259_data *d = malloc(sizeof(struct pic8259_data));          struct pic8259_data *d = malloc(sizeof(struct pic8259_data));
252          char *name2;          char *name2;
# Line 278  int devinit_8259(struct devinit *devinit Line 268  int devinit_8259(struct devinit *devinit
268    
269          memory_device_register(devinit->machine->memory, name2,          memory_device_register(devinit->machine->memory, name2,
270              devinit->addr, DEV_8259_LENGTH, dev_8259_access, d,              devinit->addr, DEV_8259_LENGTH, dev_8259_access, d,
271              MEM_DEFAULT, NULL);              DM_DEFAULT, NULL);
272    
273          devinit->return_ptr = d;          devinit->return_ptr = d;
274          return 1;          return 1;
Legend:
Removed from v.12  
changed lines
  Added in v.28
  ViewVC Help
Powered by ViewVC 1.1.26