25 |
* SUCH DAMAGE. |
* SUCH DAMAGE. |
26 |
* |
* |
27 |
* |
* |
28 |
* $Id: dev_cons.c,v 1.24 2005/02/19 11:51:33 debug Exp $ |
* $Id: dev_cons.c,v 1.26 2005/06/26 11:43:48 debug Exp $ |
29 |
* |
* |
30 |
* A console device. (Fake, only useful for simple tests.) |
* A console device. (Fake, only useful for simple tests.) |
31 |
|
* It is hardwared to the lowest available MIPS hardware IRQ, and only |
32 |
|
* interrupts CPU 0. |
33 |
* |
* |
34 |
* This device provides memory mapped I/O for a simple console supporting |
* This device provides memory mapped I/O for a simple console supporting |
35 |
* putchar (writing to memory) and getchar (reading from memory), and |
* putchar (writing to memory) and getchar (reading from memory), and |
62 |
*/ |
*/ |
63 |
void dev_cons_tick(struct cpu *cpu, void *extra) |
void dev_cons_tick(struct cpu *cpu, void *extra) |
64 |
{ |
{ |
65 |
|
struct cpu *c = cpu->machine->cpus[0]; |
66 |
struct cons_data *d = extra; |
struct cons_data *d = extra; |
67 |
|
|
68 |
cpu_interrupt_ack(cpu, d->irq_nr); |
cpu_interrupt_ack(c, d->irq_nr); |
69 |
|
|
70 |
if (console_charavail(d->console_handle)) |
if (console_charavail(d->console_handle)) |
71 |
cpu_interrupt(cpu, d->irq_nr); |
cpu_interrupt(c, d->irq_nr); |
72 |
} |
} |
73 |
|
|
74 |
|
|
126 |
{ |
{ |
127 |
struct cons_data *d; |
struct cons_data *d; |
128 |
char *name2; |
char *name2; |
129 |
|
size_t nlen; |
130 |
|
|
131 |
d = malloc(sizeof(struct cons_data)); |
d = malloc(sizeof(struct cons_data)); |
132 |
if (d == NULL) { |
if (d == NULL) { |
137 |
d->irq_nr = irq_nr; |
d->irq_nr = irq_nr; |
138 |
d->console_handle = console_start_slave(machine, name); |
d->console_handle = console_start_slave(machine, name); |
139 |
|
|
140 |
name2 = malloc(strlen(name) + 20); |
nlen = strlen(name) + 20; |
141 |
|
name2 = malloc(nlen); |
142 |
if (name2 == NULL) { |
if (name2 == NULL) { |
143 |
fprintf(stderr, "out of memory in dev_cons_init()\n"); |
fprintf(stderr, "out of memory in dev_cons_init()\n"); |
144 |
exit(1); |
exit(1); |
145 |
} |
} |
146 |
if (name != NULL && name[0]) |
if (name != NULL && name[0]) |
147 |
sprintf(name2, "cons [%s]", name); |
snprintf(name2, nlen, "cons [%s]", name); |
148 |
else |
else |
149 |
sprintf(name2, "cons"); |
snprintf(name2, nlen, "cons"); |
150 |
|
|
151 |
memory_device_register(mem, name2, baseaddr, DEV_CONS_LENGTH, |
memory_device_register(mem, name2, baseaddr, DEV_CONS_LENGTH, |
152 |
dev_cons_access, d, MEM_DEFAULT, NULL); |
dev_cons_access, d, MEM_DEFAULT, NULL); |