/[gxemul]/trunk/src/memory.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/memory.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 32 by dpavlin, Mon Oct 8 16:20:58 2007 UTC
# Line 25  Line 25 
25   *  SUCH DAMAGE.   *  SUCH DAMAGE.
26   *   *
27   *   *
28   *  $Id: memory.c,v 1.192 2006/07/14 16:33:27 debug Exp $   *  $Id: memory.c,v 1.199 2006/10/24 09:32:48 debug Exp $
29   *   *
30   *  Functions for handling the memory of an emulated machine.   *  Functions for handling the memory of an emulated machine.
31   */   */
# Line 120  void *zeroed_alloc(size_t s) Line 120  void *zeroed_alloc(size_t s)
120  {  {
121          void *p = mmap(NULL, s, PROT_READ | PROT_WRITE,          void *p = mmap(NULL, s, PROT_READ | PROT_WRITE,
122              MAP_ANON | MAP_PRIVATE, -1, 0);              MAP_ANON | MAP_PRIVATE, -1, 0);
123    
124          if (p == NULL) {          if (p == NULL) {
125    #if 1
126                    fprintf(stderr, "zeroed_alloc(): mmap() failed. This should"
127                        " not usually happen. If you can reproduce this, then"
128                        " please contact me with details about your run-time"
129                        " environment.\n");
130                    exit(1);
131    #else
132                  p = malloc(s);                  p = malloc(s);
133                  if (p == NULL) {                  if (p == NULL) {
134                          fprintf(stderr, "out of memory\n");                          fprintf(stderr, "out of memory\n");
135                          exit(1);                          exit(1);
136                  }                  }
137                  memset(p, 0, s);                  memset(p, 0, s);
138    #endif
139          }          }
140    
141          return p;          return p;
142  }  }
143    
# Line 278  void memory_device_dyntrans_access(struc Line 288  void memory_device_dyntrans_access(struc
288              called too often.  */              called too often.  */
289    
290          for (i=0; i<mem->n_mmapped_devices; i++) {          for (i=0; i<mem->n_mmapped_devices; i++) {
291                  if (mem->dev_extra[i] == extra &&                  if (mem->devices[i].extra == extra &&
292                      mem->dev_flags[i] & DM_DYNTRANS_WRITE_OK &&                      mem->devices[i].flags & DM_DYNTRANS_WRITE_OK &&
293                      mem->dev_dyntrans_data[i] != NULL) {                      mem->devices[i].dyntrans_data != NULL) {
294                          if (mem->dev_dyntrans_write_low[i] != (uint64_t) -1)                          if (mem->devices[i].dyntrans_write_low != (uint64_t) -1)
295                                  need_inval = 1;                                  need_inval = 1;
296                          if (low != NULL)                          if (low != NULL)
297                                  *low = mem->dev_dyntrans_write_low[i];                                  *low = mem->devices[i].dyntrans_write_low;
298                          mem->dev_dyntrans_write_low[i] = (uint64_t) -1;                          mem->devices[i].dyntrans_write_low = (uint64_t) -1;
299    
300                          if (high != NULL)                          if (high != NULL)
301                                  *high = mem->dev_dyntrans_write_high[i];                                  *high = mem->devices[i].dyntrans_write_high;
302                          mem->dev_dyntrans_write_high[i] = 0;                          mem->devices[i].dyntrans_write_high = 0;
303    
304                          if (!need_inval)                          if (!need_inval)
305                                  return;                                  return;
# Line 298  void memory_device_dyntrans_access(struc Line 308  void memory_device_dyntrans_access(struc
308                              be in the dyntrans load/store cache, by marking                              be in the dyntrans load/store cache, by marking
309                              the pages read-only.  */                              the pages read-only.  */
310                          if (cpu->invalidate_translation_caches != NULL) {                          if (cpu->invalidate_translation_caches != NULL) {
311                                  for (s=0; s<mem->dev_length[i];                                  for (s = *low; s <= *high;
312                                      s+=cpu->machine->arch_pagesize)                                      s += cpu->machine->arch_pagesize)
313                                          cpu->invalidate_translation_caches                                          cpu->invalidate_translation_caches
314                                              (cpu, mem->dev_baseaddr[i] + s,                                              (cpu, mem->devices[i].baseaddr + s,
315                                              JUST_MARK_AS_NON_WRITABLE                                              JUST_MARK_AS_NON_WRITABLE
316                                              | INVALIDATE_PADDR);                                              | INVALIDATE_PADDR);
317                          }                          }
# Line 327  void memory_device_update_data(struct me Line 337  void memory_device_update_data(struct me
337          int i;          int i;
338    
339          for (i=0; i<mem->n_mmapped_devices; i++) {          for (i=0; i<mem->n_mmapped_devices; i++) {
340                  if (mem->dev_extra[i] != extra)                  if (mem->devices[i].extra != extra)
341                          continue;                          continue;
342    
343                  mem->dev_dyntrans_data[i] = data;                  mem->devices[i].dyntrans_data = data;
344                  mem->dev_dyntrans_write_low[i] = (uint64_t)-1;                  mem->devices[i].dyntrans_write_low = (uint64_t)-1;
345                  mem->dev_dyntrans_write_high[i] = 0;                  mem->devices[i].dyntrans_write_high = 0;
346          }          }
347  }  }
348    
# Line 340  void memory_device_update_data(struct me Line 350  void memory_device_update_data(struct me
350  /*  /*
351   *  memory_device_register():   *  memory_device_register():
352   *   *
353   *  Register a (memory mapped) device by adding it to the dev_* fields of a   *  Register a memory mapped device.
  *  memory struct.  
354   */   */
355  void memory_device_register(struct memory *mem, const char *device_name,  void memory_device_register(struct memory *mem, const char *device_name,
356          uint64_t baseaddr, uint64_t len,          uint64_t baseaddr, uint64_t len,
# Line 351  void memory_device_register(struct memor Line 360  void memory_device_register(struct memor
360  {  {
361          int i, newi = 0;          int i, newi = 0;
362    
         if (mem->n_mmapped_devices >= MAX_DEVICES) {  
                 fprintf(stderr, "memory_device_register(): too many "  
                     "devices registered, cannot register '%s'\n", device_name);  
                 exit(1);  
         }  
   
363          /*          /*
364           *  Figure out at which index to insert this device, and simultaneously           *  Figure out at which index to insert this device, and simultaneously
365           *  check for collisions:           *  check for collisions:
366           */           */
367          newi = -1;          newi = -1;
368          for (i=0; i<mem->n_mmapped_devices; i++) {          for (i=0; i<mem->n_mmapped_devices; i++) {
369                  if (i == 0 && baseaddr + len <= mem->dev_baseaddr[i])                  if (i == 0 && baseaddr + len <= mem->devices[i].baseaddr)
370                          newi = i;                          newi = i;
371                  if (i > 0 && baseaddr + len <= mem->dev_baseaddr[i] &&                  if (i > 0 && baseaddr + len <= mem->devices[i].baseaddr &&
372                      baseaddr >= mem->dev_endaddr[i-1])                      baseaddr >= mem->devices[i-1].endaddr)
373                          newi = i;                          newi = i;
374                  if (i == mem->n_mmapped_devices - 1 &&                  if (i == mem->n_mmapped_devices - 1 &&
375                      baseaddr >= mem->dev_endaddr[i])                      baseaddr >= mem->devices[i].endaddr)
376                          newi = i + 1;                          newi = i + 1;
377    
378                  /*  If we are not colliding with device i, then continue:  */                  /*  If this is not colliding with device i, then continue:  */
379                  if (baseaddr + len <= mem->dev_baseaddr[i])                  if (baseaddr + len <= mem->devices[i].baseaddr)
380                          continue;                          continue;
381                  if (baseaddr >= mem->dev_endaddr[i])                  if (baseaddr >= mem->devices[i].endaddr)
382                          continue;                          continue;
383    
384                  fatal("\nERROR! \"%s\" collides with device %i (\"%s\")!\n",                  fatal("\nERROR! \"%s\" collides with device %i (\"%s\")!\n",
385                      device_name, i, mem->dev_name[i]);                      device_name, i, mem->devices[i].name);
386                  exit(1);                  exit(1);
387          }          }
388          if (mem->n_mmapped_devices == 0)          if (mem->n_mmapped_devices == 0)
# Line 408  void memory_device_register(struct memor Line 411  void memory_device_register(struct memor
411          }          }
412    
413          for (i=0; i<mem->n_mmapped_devices; i++) {          for (i=0; i<mem->n_mmapped_devices; i++) {
414                  if (dyntrans_data == mem->dev_dyntrans_data[i] &&                  if (dyntrans_data == mem->devices[i].dyntrans_data &&
415                      mem->dev_flags[i] & (DM_DYNTRANS_OK | DM_DYNTRANS_WRITE_OK)                      mem->devices[i].flags&(DM_DYNTRANS_OK|DM_DYNTRANS_WRITE_OK)
416                      && flags & (DM_DYNTRANS_OK | DM_DYNTRANS_WRITE_OK)) {                      && flags & (DM_DYNTRANS_OK | DM_DYNTRANS_WRITE_OK)) {
417                          fatal("ERROR: the data pointer used for dyntrans "                          fatal("ERROR: the data pointer used for dyntrans "
418                              "accesses must only be used once!\n");                              "accesses must only be used once!\n");
419                          fatal("(%p cannot be used by '%s'; already in use by '"                          fatal("(%p cannot be used by '%s'; already in use by '"
420                              "%s')\n", dyntrans_data, device_name,                              "%s')\n", dyntrans_data, device_name,
421                              mem->dev_name[i]);                              mem->devices[i].name);
422                          exit(1);                          exit(1);
423                  }                  }
424          }          }
425    
426          mem->n_mmapped_devices++;          mem->n_mmapped_devices++;
427    
428          /*          mem->devices = realloc(mem->devices, sizeof(struct memory_device)
429           *  YUCK! This is ugly. TODO: fix              * mem->n_mmapped_devices);
430           */          if (mem->devices == NULL) {
431                    fprintf(stderr, "out of memory\n");
432                    exit(1);
433            }
434    
435          /*  Make space for the new entry:  */          /*  Make space for the new entry:  */
436          memmove(&mem->dev_name[newi+1], &mem->dev_name[newi], sizeof(char *) *          if (newi + 1 != mem->n_mmapped_devices)
437              (MAX_DEVICES - newi - 1));                  memmove(&mem->devices[newi+1], &mem->devices[newi],
438          memmove(&mem->dev_baseaddr[newi+1], &mem->dev_baseaddr[newi],                      sizeof(struct memory_device)
439              sizeof(uint64_t) * (MAX_DEVICES - newi - 1));                      * (mem->n_mmapped_devices - newi - 1));
440          memmove(&mem->dev_endaddr[newi+1], &mem->dev_endaddr[newi],  
441              sizeof(uint64_t) * (MAX_DEVICES - newi - 1));          mem->devices[newi].name = strdup(device_name);
442          memmove(&mem->dev_length[newi+1], &mem->dev_length[newi],          mem->devices[newi].baseaddr = baseaddr;
443              sizeof(uint64_t) * (MAX_DEVICES - newi - 1));          mem->devices[newi].endaddr = baseaddr + len;
444          memmove(&mem->dev_flags[newi+1], &mem->dev_flags[newi], sizeof(int) *          mem->devices[newi].length = len;
445              (MAX_DEVICES - newi - 1));          mem->devices[newi].flags = flags;
446          memmove(&mem->dev_extra[newi+1], &mem->dev_extra[newi], sizeof(void *) *          mem->devices[newi].dyntrans_data = dyntrans_data;
             (MAX_DEVICES - newi - 1));  
         memmove(&mem->dev_f[newi+1], &mem->dev_f[newi], sizeof(void *) *  
             (MAX_DEVICES - newi - 1));  
         memmove(&mem->dev_dyntrans_data[newi+1], &mem->dev_dyntrans_data[newi],  
             sizeof(void *) * (MAX_DEVICES - newi - 1));  
         memmove(&mem->dev_dyntrans_write_low[newi+1],  
             &mem->dev_dyntrans_write_low[newi],  
             sizeof(uint64_t) * (MAX_DEVICES - newi - 1));  
         memmove(&mem->dev_dyntrans_write_high[newi+1],  
             &mem->dev_dyntrans_write_high[newi],  
             sizeof(uint64_t) * (MAX_DEVICES - newi - 1));  
   
   
         mem->dev_name[newi] = strdup(device_name);  
         mem->dev_baseaddr[newi] = baseaddr;  
         mem->dev_endaddr[newi] = baseaddr + len;  
         mem->dev_length[newi] = len;  
         mem->dev_flags[newi] = flags;  
         mem->dev_dyntrans_data[newi] = dyntrans_data;  
447    
448          if (mem->dev_name[newi] == NULL) {          if (mem->devices[newi].name == NULL) {
449                  fprintf(stderr, "out of memory\n");                  fprintf(stderr, "out of memory\n");
450                  exit(1);                  exit(1);
451          }          }
# Line 476  void memory_device_register(struct memor Line 464  void memory_device_register(struct memor
464                  exit(1);                  exit(1);
465          }          }
466    
467          mem->dev_dyntrans_write_low[newi] = (uint64_t)-1;          mem->devices[newi].dyntrans_write_low = (uint64_t)-1;
468          mem->dev_dyntrans_write_high[newi] = 0;          mem->devices[newi].dyntrans_write_high = 0;
469          mem->dev_f[newi] = f;          mem->devices[newi].f = f;
470          mem->dev_extra[newi] = extra;          mem->devices[newi].extra = extra;
471    
472          if (baseaddr < mem->mmap_dev_minaddr)          if (baseaddr < mem->mmap_dev_minaddr)
473                  mem->mmap_dev_minaddr = baseaddr & ~mem->dev_dyntrans_alignment;                  mem->mmap_dev_minaddr = baseaddr & ~mem->dev_dyntrans_alignment;
474          if (baseaddr + len > mem->mmap_dev_maxaddr)          if (baseaddr + len > mem->mmap_dev_maxaddr)
475                  mem->mmap_dev_maxaddr = (((baseaddr + len) - 1) |                  mem->mmap_dev_maxaddr = (((baseaddr + len) - 1) |
476                      mem->dev_dyntrans_alignment) + 1;                      mem->dev_dyntrans_alignment) + 1;
477    
478            if (newi < mem->last_accessed_device)
479                    mem->last_accessed_device ++;
480  }  }
481    
482    
483  /*  /*
484   *  memory_device_remove():   *  memory_device_remove():
485   *   *
486   *  Unregister a (memory mapped) device from a memory struct.   *  Unregister a memory mapped device from a memory object.
487   */   */
488  void memory_device_remove(struct memory *mem, int i)  void memory_device_remove(struct memory *mem, int i)
489  {  {
490          if (i < 0 || i >= mem->n_mmapped_devices) {          if (i < 0 || i >= mem->n_mmapped_devices) {
491                  fatal("memory_device_remove(): invalid device number %i\n", i);                  fatal("memory_device_remove(): invalid device number %i\n", i);
492                  return;                  exit(1);
493          }          }
494    
495          mem->n_mmapped_devices --;          mem->n_mmapped_devices --;
# Line 506  void memory_device_remove(struct memory Line 497  void memory_device_remove(struct memory
497          if (i == mem->n_mmapped_devices)          if (i == mem->n_mmapped_devices)
498                  return;                  return;
499    
500          /*          memmove(&mem->devices[i], &mem->devices[i+1],
501           *  YUCK! This is ugly. TODO: fix              sizeof(struct memory_device) * (mem->n_mmapped_devices - i));
          */  
502    
503          memmove(&mem->dev_name[i], &mem->dev_name[i+1], sizeof(char *) *          if (i <= mem->last_accessed_device)
504              (MAX_DEVICES - i - 1));                  mem->last_accessed_device --;
505          memmove(&mem->dev_baseaddr[i], &mem->dev_baseaddr[i+1],          if (mem->last_accessed_device < 0)
506              sizeof(uint64_t) * (MAX_DEVICES - i - 1));                  mem->last_accessed_device = 0;
         memmove(&mem->dev_endaddr[i], &mem->dev_endaddr[i+1],  
             sizeof(uint64_t) * (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_length[i], &mem->dev_length[i+1], sizeof(uint64_t) *  
             (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_flags[i], &mem->dev_flags[i+1], sizeof(int) *  
             (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_extra[i], &mem->dev_extra[i+1], sizeof(void *) *  
             (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_f[i], &mem->dev_f[i+1], sizeof(void *) *  
             (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_dyntrans_data[i], &mem->dev_dyntrans_data[i+1],  
             sizeof(void *) * (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_dyntrans_write_low[i], &mem->dev_dyntrans_write_low  
             [i+1], sizeof(uint64_t) * (MAX_DEVICES - i - 1));  
         memmove(&mem->dev_dyntrans_write_high[i], &mem->dev_dyntrans_write_high  
             [i+1], sizeof(uint64_t) * (MAX_DEVICES - i - 1));  
507  }  }
508    
509    
Legend:
Removed from v.28  
changed lines
  Added in v.32
  ViewVC Help
Powered by ViewVC 1.1.26