src/devices/dev_8250.c

/*
 *  Copyright (C) 2004-2006  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_8250.c,v 1.24 2006/07/21 16:55:41 debug Exp $
 *  
 *  8250 serial controller.
 *
 *  TODO:  Actually implement this device.  So far it's just a fake device
 *         to allow Linux to print stuff to the console.
 */

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

#include "console.h"
#include "device.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"


struct dev_8250_data {
        int             console_handle;
        char            *name;

        int             irq_enable;
        int             irqnr;
        int             in_use;
        int             addrmult;

        int             reg[8];

        int             dlab;           /*  Divisor Latch Access bit  */
        int             divisor;
        int             databits;
        char            parity;
        const char      *stopbits;
};

#define DEV_8250_LENGTH         8
#define DEV_8250_TICKSHIFT      15


DEVICE_TICK(8250)
{
#if 0
        /*  This stuff works for 16550.  TODO for 8250  */

        struct dev_8250_data *d = extra;

        d->reg[REG_IID] |= IIR_NOPEND;
        cpu_interrupt_ack(cpu, d->irqnr);

        if (console_charavail(d->console_handle))
                d->reg[REG_IID] |= IIR_RXRDY;
        else
                d->reg[REG_IID] &= ~IIR_RXRDY;

        if (d->reg[REG_MCR] & MCR_IENABLE) {
                if (d->irq_enable & IER_ETXRDY && d->reg[REG_IID] & IIR_TXRDY) {
                        cpu_interrupt(cpu, d->irqnr);
                        d->reg[REG_IID] &= ~IIR_NOPEND;
                }

                if (d->irq_enable & IER_ERXRDY && d->reg[REG_IID] & IIR_RXRDY) {
                        cpu_interrupt(cpu, d->irqnr);
                        d->reg[REG_IID] &= ~IIR_NOPEND;
                }
        }
#endif
}


DEVICE_ACCESS(8250)
{
        uint64_t idata = 0, odata = 0;
        struct dev_8250_data *d = extra;

        if (writeflag == MEM_WRITE)
                idata = memory_readmax64(cpu, data, len);

        relative_addr /= d->addrmult;

        if (writeflag == MEM_WRITE && relative_addr == 0) {
                console_putchar(d->console_handle, idata);
        } else if (writeflag == MEM_READ && relative_addr == 5) {
                odata = 64 + 32;
        } else {
#if 0
                if (writeflag == MEM_WRITE)
                        fatal("[ 8250: write addr=0x%02x idata = 0x%02x ]\n",
                            (int)relative_addr, (int)idata);
                else
                        fatal("[ 8250: read addr=0x%02x ]\n", relative_addr);
#endif
        }

        if (writeflag == MEM_READ)
                memory_writemax64(cpu, data, len, odata);

        return 1;
}


DEVINIT(8250)
{
        size_t nlen;
        char *name;
        struct dev_8250_data *d;

        d = malloc(sizeof(struct dev_8250_data));
        if (d == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        memset(d, 0, sizeof(struct dev_8250_data));
        d->irqnr    = devinit->irq_nr;
        d->addrmult = devinit->addr_mult;
        d->in_use   = devinit->in_use;
        d->dlab     = 0;
        d->divisor  = 115200 / 9600;
        d->databits = 8;
        d->parity   = 'N';
        d->stopbits = "1";
        d->name = devinit->name2 != NULL? devinit->name2 : "";
        d->console_handle =
            console_start_slave(devinit->machine, devinit->name2 != NULL?
            devinit->name2 : devinit->name, d->in_use);

        nlen = strlen(devinit->name) + 10;
        if (devinit->name2 != NULL)
                nlen += strlen(devinit->name2);
        name = malloc(nlen);
        if (name == NULL) {
                fprintf(stderr, "out of memory\n");
                exit(1);
        }
        if (devinit->name2 != NULL && devinit->name2[0])
                snprintf(name, nlen, "%s [%s]", devinit->name, devinit->name2);
        else
                snprintf(name, nlen, "%s", devinit->name);

        memory_device_register(devinit->machine->memory, name,
            devinit->addr, DEV_8250_LENGTH * devinit->addr_mult,
            dev_8250_access, d, DM_DEFAULT, NULL);
        machine_add_tickfunction(devinit->machine, dev_8250_tick, d,
            DEV_8250_TICKSHIFT, 0.0);

        return 1;
}

1	/*
2	* Copyright (C) 2004-2006 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_8250.c,v 1.24 2006/07/21 16:55:41 debug Exp $
29	*
30	* 8250 serial controller.
31	*
32	* TODO: Actually implement this device. So far it's just a fake device
33	* to allow Linux to print stuff to the console.
34	*/
35
36	#include <stdio.h>
37	#include <stdlib.h>
38	#include <string.h>
39
40	#include "console.h"
41	#include "device.h"
42	#include "machine.h"
43	#include "memory.h"
44	#include "misc.h"
45
46
47	struct dev_8250_data {
48	int console_handle;
49	char *name;
50
51	int irq_enable;
52	int irqnr;
53	int in_use;
54	int addrmult;
55
56	int reg[8];
57
58	int dlab; /* Divisor Latch Access bit */
59	int divisor;
60	int databits;
61	char parity;
62	const char *stopbits;
63	};
64
65	#define DEV_8250_LENGTH 8
66	#define DEV_8250_TICKSHIFT 15
67
68
69	DEVICE_TICK(8250)
70	{
71	#if 0
72	/* This stuff works for 16550. TODO for 8250 */
73
74	struct dev_8250_data *d = extra;
75
76	d->reg[REG_IID] \|= IIR_NOPEND;
77	cpu_interrupt_ack(cpu, d->irqnr);
78
79	if (console_charavail(d->console_handle))
80	d->reg[REG_IID] \|= IIR_RXRDY;
81	else
82	d->reg[REG_IID] &= ~IIR_RXRDY;
83
84	if (d->reg[REG_MCR] & MCR_IENABLE) {
85	if (d->irq_enable & IER_ETXRDY && d->reg[REG_IID] & IIR_TXRDY) {
86	cpu_interrupt(cpu, d->irqnr);
87	d->reg[REG_IID] &= ~IIR_NOPEND;
88	}
89
90	if (d->irq_enable & IER_ERXRDY && d->reg[REG_IID] & IIR_RXRDY) {
91	cpu_interrupt(cpu, d->irqnr);
92	d->reg[REG_IID] &= ~IIR_NOPEND;
93	}
94	}
95	#endif
96	}
97
98
99	DEVICE_ACCESS(8250)
100	{
101	uint64_t idata = 0, odata = 0;
102	struct dev_8250_data *d = extra;
103
104	if (writeflag == MEM_WRITE)
105	idata = memory_readmax64(cpu, data, len);
106
107	relative_addr /= d->addrmult;
108
109	if (writeflag == MEM_WRITE && relative_addr == 0) {
110	console_putchar(d->console_handle, idata);
111	} else if (writeflag == MEM_READ && relative_addr == 5) {
112	odata = 64 + 32;
113	} else {
114	#if 0
115	if (writeflag == MEM_WRITE)
116	fatal("[ 8250: write addr=0x%02x idata = 0x%02x ]\n",
117	(int)relative_addr, (int)idata);
118	else
119	fatal("[ 8250: read addr=0x%02x ]\n", relative_addr);
120	#endif
121	}
122
123	if (writeflag == MEM_READ)
124	memory_writemax64(cpu, data, len, odata);
125
126	return 1;
127	}
128
129
130	DEVINIT(8250)
131	{
132	size_t nlen;
133	char *name;
134	struct dev_8250_data *d;
135
136	d = malloc(sizeof(struct dev_8250_data));
137	if (d == NULL) {
138	fprintf(stderr, "out of memory\n");
139	exit(1);
140	}
141	memset(d, 0, sizeof(struct dev_8250_data));
142	d->irqnr = devinit->irq_nr;
143	d->addrmult = devinit->addr_mult;
144	d->in_use = devinit->in_use;
145	d->dlab = 0;
146	d->divisor = 115200 / 9600;
147	d->databits = 8;
148	d->parity = 'N';
149	d->stopbits = "1";
150	d->name = devinit->name2 != NULL? devinit->name2 : "";
151	d->console_handle =
152	console_start_slave(devinit->machine, devinit->name2 != NULL?
153	devinit->name2 : devinit->name, d->in_use);
154
155	nlen = strlen(devinit->name) + 10;
156	if (devinit->name2 != NULL)
157	nlen += strlen(devinit->name2);
158	name = malloc(nlen);
159	if (name == NULL) {
160	fprintf(stderr, "out of memory\n");
161	exit(1);
162	}
163	if (devinit->name2 != NULL && devinit->name2[0])
164	snprintf(name, nlen, "%s [%s]", devinit->name, devinit->name2);
165	else
166	snprintf(name, nlen, "%s", devinit->name);
167
168	memory_device_register(devinit->machine->memory, name,
169	devinit->addr, DEV_8250_LENGTH * devinit->addr_mult,
170	dev_8250_access, d, DM_DEFAULT, NULL);
171	machine_add_tickfunction(devinit->machine, dev_8250_tick, d,
172	DEV_8250_TICKSHIFT, 0.0);
173
174	return 1;
175	}
176