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

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

revision 67 by dpavlin, Sun Oct 14 13:46:39 2007 UTC revision 73 by dpavlin, Sun Oct 14 18:35:57 2007 UTC
# Line 82  void openpic_lo_interrupt_deassert(struc Line 82  void openpic_lo_interrupt_deassert(struc
82                  INTERRUPT_DEASSERT(d->cpu_irq);                  INTERRUPT_DEASSERT(d->cpu_irq);
83  }  }
84    
85    /*
86     * FIXME acitvity is never sat
87     */
88    
89  #define OPENPIC_MASK                            0x80000000  #define OPENPIC_MASK                            0x80000000
90  #define OPENPIC_ACTIVITY                        0x40000000      /* Read Only */  #define OPENPIC_ACTIVITY                        0x40000000      /* Read Only */
91  #define OPENPIC_PRIORITY_MASK                   0x000f0000  #define OPENPIC_PRIORITY_MASK                   0x000f0000
# Line 100  void openpic_lo_interrupt_deassert(struc Line 104  void openpic_lo_interrupt_deassert(struc
104  DEVICE_ACCESS(openpic)  DEVICE_ACCESS(openpic)
105  {  {
106  //      struct openpic_data *d = extra;  //      struct openpic_data *d = extra;
107          uint64_t idata = 0, odata = 0, decoded = 0;          uint64_t idata = 0, odata = 0;
108    
109          if (writeflag == MEM_WRITE) {          if (writeflag == MEM_WRITE) {
110                  idata = memory_readmax64(cpu, data, len);                  idata = memory_readmax64(cpu, data, len);
111                  decoded =                  // shuffle byte order
112                    idata =
113                          ( idata & 0x000000ff ) << 24 |                          ( idata & 0x000000ff ) << 24 |
114                          ( idata & 0x0000ff00 ) << 8  |                          ( idata & 0x0000ff00 ) << 8  |
115                          ( idata & 0x00ff0000 ) >> 8  |                          ( idata & 0x00ff0000 ) >> 8  |
116                          ( idata & 0xff000000 ) >> 24 ;                          ( idata & 0xff000000 ) >> 24 ;
117    
118                  uint64_t priority,vector, active;                  uint64_t priority,vector, active;
119                  priority = ( decoded & OPENPIC_PRIORITY_MASK ) >> OPENPIC_PRIORITY_SHIFT;                  priority = ( idata & OPENPIC_PRIORITY_MASK ) >> OPENPIC_PRIORITY_SHIFT;
120                  vector   = ( decoded & OPENPIC_VECTOR_MASK );                  vector   = ( idata & OPENPIC_VECTOR_MASK );
121                  active   = ( decoded & OPENPIC_ACTIVITY );                  active   = ( idata & OPENPIC_ACTIVITY );
122    
123                  debug("[ openpic: WRITE %05x | %08x => %08x | priority: %x vector: 0x%02x %d active: %x ]\n",                  debug("[ openpic: WRITE %05x | %08x | priority: %x vector: 0x%02x %d active: %x ]\n",
124                          (int)relative_addr, (int)idata, (int)decoded, (int)priority, (int)vector, (int)vector, (int)active );                          (int)relative_addr, (int)idata, (int)priority, (int)vector, (int)vector, (int)active );
125          }          }
126    
127          switch (relative_addr) {          switch (relative_addr) {
128    
129            // version
130          case 0x00:          case 0x00:
131                  if (writeflag == MEM_READ) {                  if (writeflag == MEM_READ) {
132                          // version 1.2                          // version 1.x, so 2 -> 1.2
133                          odata = 0x02000000;                          odata = 2;
134                          fatal("[ openpic: read from "                          debug("[ openpic: read version "
135                              "offset 0x%x (OpenPIC version) = %x]\n", (int)                                  "offset 0x%x = 1.%d]\n", (int)
136                              relative_addr, (int)odata);                                  relative_addr, (int)odata);
137                            odata |= 0x00190000; // FIXME ?
138    
139                  }                  }
140                  fatal("[ openpic: unimplemented write to "                  fatal("[ openpic: unimplemented write to "
141                      "offset 0x%x: data=0x%x (OpenPIC version) ]\n", (int)                      "offset 0x%x: data=0x%x (OpenPIC version) ]\n", (int)
142                      relative_addr, (int)idata);                      relative_addr, (int)idata);
143                  break;                  break;
144    
145            // global timer frequency
146            case 0xf0:
147                    if (writeflag == MEM_READ) {
148                            // this would be correct, but real DSM-G600 isn't
149                            // returning it!
150                            //odata = 170 * 1000000;        // MHz
151                            odata = 0;
152                            debug("[ openpic: read global timer frequency "
153                                "offset 0x%x = %x]\n", (int)
154                                relative_addr, (int)odata);
155                    }
156                    fatal("[ openpic: unimplemented write to "
157                        "offset 0x%x: data=0x%x ]\n", (int)
158                        relative_addr, (int)idata);
159                    break;
160    
161  #if 0  #if 0
162  #define INT_STATE_REG_H  (interrupt_reg + 0x00)  #define INT_STATE_REG_H  (interrupt_reg + 0x00)
163  #define INT_ENABLE_REG_H (interrupt_reg + 0x04)  #define INT_ENABLE_REG_H (interrupt_reg + 0x04)
# Line 231  DEVICE_ACCESS(openpic) Line 255  DEVICE_ACCESS(openpic)
255                  /*  Avoid a debug message.  */                  /*  Avoid a debug message.  */
256                  break;                  break;
257  #endif  #endif
258          default:if (writeflag == MEM_WRITE) {          default:
259                    if (writeflag == MEM_WRITE) {
260                          fatal("[ openpic: unimplemented write to "                          fatal("[ openpic: unimplemented write to "
261                              "offset 0x%x: data=0x%x ]\n", (int)                                  "offset 0x%x idata = %x ]\n",
262                              relative_addr, (int)idata);                                  (int)relative_addr, (int)idata
263                            );
264                  } else {                  } else {
265                          fatal("[ openpic: unimplemented read from "                          // decoded from real device
266                              "offset 0x%x ]\n", (int)relative_addr);                          odata |= OPENPIC_MASK;
267                            
268                            int vec =
269                            (
270                                    (
271                                            (
272                                                    (
273                                                            ( relative_addr - 0x120 ) & 0xfff
274                                                    ) / 0x40
275                                            )
276                                    ) & 0xff
277                            ) + 0x40;
278    
279                            odata |= vec;
280    
281                            debug("[ openpic: unimplemented read from "
282                                    "offset 0x%x decoded vec = 0x%02x %d odata = %x ]\n",
283                                    (int)relative_addr, vec, vec, (int)odata
284                            );
285                  }                  }
286          }          }
287    
288          if (writeflag == MEM_READ)          if (writeflag == MEM_READ) {
289    
290                    debug("[ openpic: READ %05x | %08x ]\n",
291                            (int)relative_addr, (int)odata
292                    );
293    
294                    // shuffle byte order
295                    odata =
296                            ( odata & 0x000000ff ) << 24 |
297                            ( odata & 0x0000ff00 ) << 8  |
298                            ( odata & 0x00ff0000 ) >> 8  |
299                            ( odata & 0xff000000 ) >> 24 ;
300                  memory_writemax64(cpu, data, len, odata);                  memory_writemax64(cpu, data, len, odata);
301            }
302    
303          return 1;          return 1;
304  }  }
# Line 274  DEVINIT(openpic) Line 330  DEVINIT(openpic)
330                  template.interrupt_assert = openpic_lo_interrupt_assert;                  template.interrupt_assert = openpic_lo_interrupt_assert;
331                  template.interrupt_deassert = openpic_lo_interrupt_deassert;                  template.interrupt_deassert = openpic_lo_interrupt_deassert;
332                  interrupt_handler_register(&template);                  interrupt_handler_register(&template);
333    //              debug("[ openpic: added interrupt %s ]\n", n);
334          }          }
335    
336          memory_device_register(devinit->machine->memory, "openpic",          memory_device_register(devinit->machine->memory, "openpic",
Legend:
Removed from v.67  
changed lines
  Added in v.73
  ViewVC Help
Powered by ViewVC 1.1.26