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

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

revision 28 by dpavlin, Mon Oct 8 16:20:26 2007 UTC revision 42 by dpavlin, Mon Oct 8 16:22:32 2007 UTC
# Line 1  Line 1 
1  /*  /*
2   *  Copyright (C) 2003-2006  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_mp.c,v 1.37 2006/07/01 21:15:46 debug Exp $   *  $Id: dev_mp.c,v 1.42 2007/06/15 19:57:33 debug Exp $
29     *
30     *  COMMENT: Generic Multi-processor controller for the test machines
31   *   *
32   *  This is a fake multiprocessor (MP) device. It can be useful for   *  This is a fake multiprocessor (MP) device. It can be useful for
33   *  theoretical experiments, but probably bares no resemblance to any   *  theoretical experiments, but probably bares no resemblance to any
34   *  multiprocessor controller used in any real machine.   *  multiprocessor controller used in any real machine.
35     *
36     *  NOTE: The devinit irq string should be the part _after_ "cpu[%i].".
37     *        For MIPS, it will be MIPS_IPI_INT.
38   */   */
39    
40  #include <stdio.h>  #include <stdio.h>
# Line 37  Line 42 
42  #include <string.h>  #include <string.h>
43    
44  #include "cpu.h"  #include "cpu.h"
 #include "cpu_mips.h"  
45  #include "device.h"  #include "device.h"
46  #include "machine.h"  #include "machine.h"
47    #include "interrupt.h"
48  #include "memory.h"  #include "memory.h"
49  #include "misc.h"  #include "misc.h"
50    
# Line 55  struct mp_data { Line 60  struct mp_data {
60          /*  Each CPU has an array of pending ipis.  */          /*  Each CPU has an array of pending ipis.  */
61          int             *n_pending_ipis;          int             *n_pending_ipis;
62          int             **ipi;          int             **ipi;
63    
64            /*  Connections to all CPUs' IPI pins:  */
65            struct interrupt *ipi_irq;
66  };  };
67    
68    
69  extern int single_step;  extern int single_step;
70    
71    
 /*  
  *  dev_mp_access():  
  */  
72  DEVICE_ACCESS(mp)  DEVICE_ACCESS(mp)
73  {  {
74          struct mp_data *d = extra;          struct mp_data *d = extra;
# Line 189  DEVICE_ACCESS(mp) Line 194  DEVICE_ACCESS(mp)
194                                  send_it = 1;                                  send_it = 1;
195                          if (send_it) {                          if (send_it) {
196                                  d->n_pending_ipis[i] ++;                                  d->n_pending_ipis[i] ++;
197                                  d->ipi[i] = realloc(d->ipi[i],                                  CHECK_ALLOCATION(d->ipi[i] = realloc(d->ipi[i],
198                                      d->n_pending_ipis[i] * sizeof(int));                                      d->n_pending_ipis[i] * sizeof(int)));
199                                  if (d->ipi[i] == NULL) {  
                                         fprintf(stderr, "out of memory\n");  
                                         exit(1);  
                                 }  
200                                  /*  Add the IPI last in the array:  */                                  /*  Add the IPI last in the array:  */
201                                  d->ipi[i][d->n_pending_ipis[i] - 1] =                                  d->ipi[i][d->n_pending_ipis[i] - 1] =
202                                      idata >> 16;                                      idata >> 16;
203                                  cpu_interrupt(d->cpus[i], MIPS_IPI_INT);  
204                                    INTERRUPT_ASSERT(d->ipi_irq[i]);
205                          }                          }
206                  }                  }
207                  break;                  break;
# Line 222  DEVICE_ACCESS(mp) Line 225  DEVICE_ACCESS(mp)
225                                      &d->ipi[cpu->cpu_id][1],                                      &d->ipi[cpu->cpu_id][1],
226                                      d->n_pending_ipis[cpu->cpu_id]);                                      d->n_pending_ipis[cpu->cpu_id]);
227                  }                  }
228    
229                  /*  Deassert the interrupt, if there are no pending IPIs:  */                  /*  Deassert the interrupt, if there are no pending IPIs:  */
230                  if (d->n_pending_ipis[cpu->cpu_id] == 0)                  if (d->n_pending_ipis[cpu->cpu_id] == 0)
231                          cpu_interrupt_ack(d->cpus[cpu->cpu_id], MIPS_IPI_INT);                          INTERRUPT_DEASSERT(d->ipi_irq[cpu->cpu_id]);
232                  break;                  break;
233    
234          case DEV_MP_NCYCLES:          case DEV_MP_NCYCLES:
235                  /*                  /*
236                   *  Return _approximately_ the number of cycles executed                   *  Return _approximately_ the number of cycles executed
237                   *  in this machine.                   *  on this CPU.
                  *  
                  *  Note: At the moment, this is actually the number of  
                  *  instructions executed on CPU 0.  
238                   *                   *
239                   *  (This value is not updated for each instruction.)                   *  (This value is not updated for each instruction.)
240                   */                   */
241                  odata = cpu->machine->ninstrs;                  odata = cpu->ninstrs;
242                  break;                  break;
243    
244          default:          default:
# Line 255  DEVICE_ACCESS(mp) Line 256  DEVICE_ACCESS(mp)
256  DEVINIT(mp)  DEVINIT(mp)
257  {  {
258          struct mp_data *d;          struct mp_data *d;
259          int n;          int n, i;
260    
261          d = malloc(sizeof(struct mp_data));          CHECK_ALLOCATION(d = malloc(sizeof(struct mp_data)));
         if (d == NULL) {  
                 fprintf(stderr, "out of memory\n");  
                 exit(1);  
         }  
262          memset(d, 0, sizeof(struct mp_data));          memset(d, 0, sizeof(struct mp_data));
263    
264          d->cpus = devinit->machine->cpus;          d->cpus = devinit->machine->cpus;
265          d->startup_addr = INITIAL_PC;          d->startup_addr = INITIAL_PC;
266          d->stack_addr = INITIAL_STACK_POINTER;          d->stack_addr = INITIAL_STACK_POINTER;
267    
268          n = devinit->machine->ncpus;          n = devinit->machine->ncpus;
269          d->n_pending_ipis = malloc(n * sizeof(int));  
270          d->ipi = malloc(n * sizeof(int *));          /*  Connect to all CPUs' IPI pins:  */
271          if (d->ipi == NULL || d->n_pending_ipis == NULL) {          CHECK_ALLOCATION(d->ipi_irq = malloc(n * sizeof(struct interrupt)));
272                  fprintf(stderr, "out of memory\n");  
273                  exit(1);          for (i=0; i<n; i++) {
274                    char tmpstr[200];
275                    snprintf(tmpstr, sizeof(tmpstr), "%s.cpu[%i].%s",
276                        devinit->machine->path, i, devinit->interrupt_path);
277                    INTERRUPT_CONNECT(tmpstr, d->ipi_irq[i]);
278          }          }
279    
280            CHECK_ALLOCATION(d->n_pending_ipis = malloc(n * sizeof(int)));
281          memset(d->n_pending_ipis, 0, sizeof(int) * n);          memset(d->n_pending_ipis, 0, sizeof(int) * n);
282    
283            CHECK_ALLOCATION(d->ipi = malloc(n * sizeof(int *)));
284          memset(d->ipi, 0, sizeof(int *) * n);          memset(d->ipi, 0, sizeof(int *) * n);
285    
286          memory_device_register(devinit->machine->memory, devinit->name,          memory_device_register(devinit->machine->memory, devinit->name,
Legend:
Removed from v.28  
changed lines
  Added in v.42
  ViewVC Help
Powered by ViewVC 1.1.26