/[gxemul]/trunk/src/devices/dev_cons.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_cons.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 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_cons.c,v 1.27 2005/07/12 08:49:13 debug Exp $   *  $Id: dev_cons.c,v 1.42 2007/06/15 18:44:19 debug Exp $
29   *     *  
30   *  A simple console device, useful for simple tests.   *  COMMENT: A simple console device, for the test machines
31   *   *
32   *  This device provides memory mapped I/O for a simple console supporting   *  This device provides memory mapped I/O for a simple console supporting
33   *  putchar (writing to memory) and getchar (reading from memory), and   *  putchar (writing to memory) and getchar (reading from memory), and
# Line 42  Line 42 
42  #include "console.h"  #include "console.h"
43  #include "cpu.h"  #include "cpu.h"
44  #include "device.h"  #include "device.h"
 #include "devices.h"  
45  #include "machine.h"  #include "machine.h"
46  #include "memory.h"  #include "memory.h"
47  #include "misc.h"  #include "misc.h"
48    
49    #include "testmachine/dev_cons.h"
50    
51  #define CONS_TICK_SHIFT         14  #define CONS_TICK_SHIFT         14
52    
53    struct cons_data {
54            int                     console_handle;
55            int                     in_use;
56            struct interrupt        irq;
57    };
58    
59  /*  
60   *  dev_cons_tick():  DEVICE_TICK(cons)
  */  
 void dev_cons_tick(struct cpu *cpu, void *extra)  
61  {  {
         struct cpu *c = cpu->machine->cpus[0];  
62          struct cons_data *d = extra;          struct cons_data *d = extra;
63    
         cpu_interrupt_ack(c, d->irq_nr);  
   
64          if (console_charavail(d->console_handle))          if (console_charavail(d->console_handle))
65                  cpu_interrupt(c, d->irq_nr);                  INTERRUPT_ASSERT(d->irq);
66            else
67                    INTERRUPT_DEASSERT(d->irq);
68  }  }
69    
70    
71  /*  DEVICE_ACCESS(cons)
  *  dev_cons_access():  
  */  
 int dev_cons_access(struct cpu *cpu, struct memory *mem,  
         uint64_t relative_addr, unsigned char *data, size_t len,  
         int writeflag, void *extra)  
72  {  {
73          struct cons_data *d = extra;          struct cons_data *d = extra;
74          int i;          unsigned int i;
75    
76          /*  Exit the emulator:  */          /*  Exit the emulator:  */
77          if (relative_addr == DEV_CONS_HALT) {          if (relative_addr == DEV_CONS_HALT) {
78                  cpu->running = 0;                  /*  cpu->running = 0;
79                  cpu->machine->exit_without_entering_debugger = 1;                      cpu->machine->exit_without_entering_debugger = 1;
80                  return 1;                      return 1;  */
81                    /*  TODO: this doesn't work yet. for now, let's
82                        simply use exit()  */
83                    exit(1);
84          }          }
85    
86          if (writeflag == MEM_WRITE) {          if (writeflag == MEM_WRITE) {
# Line 112  int dev_cons_access(struct cpu *cpu, str Line 112  int dev_cons_access(struct cpu *cpu, str
112  }  }
113    
114    
115  /*  DEVINIT(cons)
  *  devinit_cons():  
  */  
 int devinit_cons(struct devinit *devinit)  
116  {  {
117          struct cons_data *d;          struct cons_data *d;
118          char *name3;          char *name3;
119          size_t nlen;          size_t nlen;
120    
121          d = malloc(sizeof(struct cons_data));          CHECK_ALLOCATION(d = malloc(sizeof(struct cons_data)));
         if (d == NULL) {  
                 fprintf(stderr, "out of memory\n");  
                 exit(1);  
         }  
122          memset(d, 0, sizeof(struct cons_data));          memset(d, 0, sizeof(struct cons_data));
123    
124          nlen = strlen(devinit->name) + 10;          nlen = strlen(devinit->name) + 10;
125          if (devinit->name2 != NULL)          if (devinit->name2 != NULL)
126                  nlen += strlen(devinit->name2) + 10;                  nlen += strlen(devinit->name2) + 10;
127          name3 = malloc(nlen);          CHECK_ALLOCATION(name3 = malloc(nlen));
         if (name3 == NULL) {  
                 fprintf(stderr, "out of memory in dev_cons_init()\n");  
                 exit(1);  
         }  
128          if (devinit->name2 != NULL && devinit->name2[0])          if (devinit->name2 != NULL && devinit->name2[0])
129                  snprintf(name3, nlen, "%s [%s]", devinit->name, devinit->name2);                  snprintf(name3, nlen, "%s [%s]", devinit->name, devinit->name2);
130          else          else
131                  snprintf(name3, nlen, "%s", devinit->name);                  snprintf(name3, nlen, "%s", devinit->name);
132    
133          d->irq_nr = devinit->irq_nr;          INTERRUPT_CONNECT(devinit->interrupt_path, d->irq);
134          d->console_handle = console_start_slave(devinit->machine, name3);  
135            d->in_use = devinit->in_use;
136            d->console_handle = console_start_slave(devinit->machine, name3,
137                d->in_use);
138    
139          memory_device_register(devinit->machine->memory, name3,          memory_device_register(devinit->machine->memory, name3,
140              devinit->addr, DEV_CONS_LENGTH, dev_cons_access, d,              devinit->addr, DEV_CONS_LENGTH, dev_cons_access, d,
141              MEM_DEFAULT, NULL);              DM_DEFAULT, NULL);
142          machine_add_tickfunction(devinit->machine, dev_cons_tick,          machine_add_tickfunction(devinit->machine, dev_cons_tick,
143              d, CONS_TICK_SHIFT);              d, CONS_TICK_SHIFT);
144    
145          devinit->return_ptr = d;          /*  NOTE: Ugly cast into pointer  */
146            devinit->return_ptr = (void *)(size_t)d->console_handle;
147          return 1;          return 1;
148  }  }
149    
Legend:
Removed from v.12  
changed lines
  Added in v.42
  ViewVC Help
Powered by ViewVC 1.1.26