0.3.1/devices/dev_cons.c

/*
 *  Copyright (C) 2003-2005  Anders Gavare.  All rights reserved.
 *
 *  Redistribution and use in source and binary forms, with or without
 *  modification, are permitted provided that the following conditions are met:
 *
 *  1. Redistributions of source code must retain the above copyright
 *     notice, this list of conditions and the following disclaimer.
 *  2. Redistributions in binary form must reproduce the above copyright  
 *     notice, this list of conditions and the following disclaimer in the 
 *     documentation and/or other materials provided with the distribution.
 *  3. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
 *  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 *  ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE   
 *  FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 *  DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 *  OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 *  HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 *  LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 *  OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 *  SUCH DAMAGE.
 *   
 *
 *  $Id: dev_cons.c,v 1.24 2005/02/19 11:51:33 debug Exp $
 *  
 *  A console device.  (Fake, only useful for simple tests.)
 *
 *  This device provides memory mapped I/O for a simple console supporting
 *  putchar (writing to memory) and getchar (reading from memory), and
 *  support for halting the emulator.  (This is useful for regression tests,
 *  Hello World-style test programs, and other simple experiments.)
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#include "console.h"
#include "cpu.h"
#include "devices.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


#define CONS_TICK_SHIFT         14

struct cons_data {
        int             console_handle;
        int             irq_nr;
};


/*
 *  dev_cons_tick():
 */
void dev_cons_tick(struct cpu *cpu, void *extra)
{
        struct cons_data *d = extra;

        cpu_interrupt_ack(cpu, d->irq_nr);

        if (console_charavail(d->console_handle))
                cpu_interrupt(cpu, d->irq_nr);
}


/*
 *  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)
{
        struct cons_data *d = extra;
        int i;

        /*  Exit the emulator:  */
        if (relative_addr == DEV_CONS_HALT) {
                cpu->running = 0;
                cpu->machine->exit_without_entering_debugger = 1;
                return 1;
        }

        if (writeflag == MEM_WRITE) {
                for (i=0; i<len; i++) {
                        if (data[i] != 0) {
                                if (cpu->machine->register_dump ||
                                    cpu->machine->instruction_trace)
                                        debug("putchar '");

                                console_putchar(d->console_handle, data[i]);

                                if (cpu->machine->register_dump ||
                                    cpu->machine->instruction_trace)
                                        debug("'\n");
                                fflush(stdout);
                        }
                }
        } else {
                int ch = console_readchar(d->console_handle);
                if (ch < 0)
                        ch = 0;
                for (i=0; i<len; i++)
                        data[i] = ch;
        }

        dev_cons_tick(cpu, extra);

        return 1;
}


/*
 *  dev_cons_init():
 */
int dev_cons_init(struct machine *machine, struct memory *mem,
        uint64_t baseaddr, char *name, int irq_nr)
{
        struct cons_data *d;
        char *name2;

        d = malloc(sizeof(struct cons_data));
        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct cons_data));
        d->irq_nr = irq_nr;
        d->console_handle = console_start_slave(machine, name);

        name2 = malloc(strlen(name) + 20);
        if (name2 == NULL) {
                fprintf(stderr, "out of memory in dev_cons_init()\n");
                exit(1);
        }
        if (name != NULL && name[0])
                sprintf(name2, "cons [%s]", name);
        else
                sprintf(name2, "cons");

        memory_device_register(mem, name2, baseaddr, DEV_CONS_LENGTH,
            dev_cons_access, d, MEM_DEFAULT, NULL);
        machine_add_tickfunction(machine, dev_cons_tick, d, CONS_TICK_SHIFT);

        return d->console_handle;
}

1	/*
2	* Copyright (C) 2003-2005 Anders Gavare. All rights reserved.
3	*
4	* Redistribution and use in source and binary forms, with or without
5	* modification, are permitted provided that the following conditions are met:
6	*
7	* 1. Redistributions of source code must retain the above copyright
8	* notice, this list of conditions and the following disclaimer.
9	* 2. Redistributions in binary form must reproduce the above copyright
10	* notice, this list of conditions and the following disclaimer in the
11	* documentation and/or other materials provided with the distribution.
12	* 3. The name of the author may not be used to endorse or promote products
13	* derived from this software without specific prior written permission.
14	*
15	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16	* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17	* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18	* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19	* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20	* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21	* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22	* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23	* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24	* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25	* SUCH DAMAGE.
26	*
27	*
28	* $Id: dev_cons.c,v 1.24 2005/02/19 11:51:33 debug Exp $
29	*
30	* A console device. (Fake, only useful for simple tests.)
31	*
32	* This device provides memory mapped I/O for a simple console supporting
33	* putchar (writing to memory) and getchar (reading from memory), and
34	* support for halting the emulator. (This is useful for regression tests,
35	* Hello World-style test programs, and other simple experiments.)
36	*/
37
38	#include <stdio.h>
39	#include <stdlib.h>
40	#include <string.h>
41
42	#include "console.h"
43	#include "cpu.h"
44	#include "devices.h"
45	#include "machine.h"
46	#include "memory.h"
47	#include "misc.h"
48
49
50	#define CONS_TICK_SHIFT 14
51
52	struct cons_data {
53	int console_handle;
54	int irq_nr;
55	};
56
57
58	/*
59	* dev_cons_tick():
60	*/
61	void dev_cons_tick(struct cpu cpu, void extra)
62	{
63	struct cons_data *d = extra;
64
65	cpu_interrupt_ack(cpu, d->irq_nr);
66
67	if (console_charavail(d->console_handle))
68	cpu_interrupt(cpu, d->irq_nr);
69	}
70
71
72	/*
73	* dev_cons_access():
74	*/
75	int dev_cons_access(struct cpu cpu, struct memory mem,
76	uint64_t relative_addr, unsigned char *data, size_t len,
77	int writeflag, void *extra)
78	{
79	struct cons_data *d = extra;
80	int i;
81
82	/* Exit the emulator: */
83	if (relative_addr == DEV_CONS_HALT) {
84	cpu->running = 0;
85	cpu->machine->exit_without_entering_debugger = 1;
86	return 1;
87	}
88
89	if (writeflag == MEM_WRITE) {
90	for (i=0; i<len; i++) {
91	if (data[i] != 0) {
92	if (cpu->machine->register_dump \|\|
93	cpu->machine->instruction_trace)
94	debug("putchar '");
95
96	console_putchar(d->console_handle, data[i]);
97
98	if (cpu->machine->register_dump \|\|
99	cpu->machine->instruction_trace)
100	debug("'\n");
101	fflush(stdout);
102	}
103	}
104	} else {
105	int ch = console_readchar(d->console_handle);
106	if (ch < 0)
107	ch = 0;
108	for (i=0; i<len; i++)
109	data[i] = ch;
110	}
111
112	dev_cons_tick(cpu, extra);
113
114	return 1;
115	}
116
117
118	/*
119	* dev_cons_init():
120	*/
121	int dev_cons_init(struct machine machine, struct memory mem,
122	uint64_t baseaddr, char *name, int irq_nr)
123	{
124	struct cons_data *d;
125	char *name2;
126
127	d = malloc(sizeof(struct cons_data));
128	if (d == NULL) {
129	fprintf(stderr, "out of memory\n");
130	exit(1);
131	}
132	memset(d, 0, sizeof(struct cons_data));
133	d->irq_nr = irq_nr;
134	d->console_handle = console_start_slave(machine, name);
135
136	name2 = malloc(strlen(name) + 20);
137	if (name2 == NULL) {
138	fprintf(stderr, "out of memory in dev_cons_init()\n");
139	exit(1);
140	}
141	if (name != NULL && name[0])
142	sprintf(name2, "cons [%s]", name);
143	else
144	sprintf(name2, "cons");
145
146	memory_device_register(mem, name2, baseaddr, DEV_CONS_LENGTH,
147	dev_cons_access, d, MEM_DEFAULT, NULL);
148	machine_add_tickfunction(machine, dev_cons_tick, d, CONS_TICK_SHIFT);
149
150	return d->console_handle;
151	}
152