src/devices/dev_8250.c

/*
 *  Copyright (C) 2004-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_8250.c,v 1.16 2005/02/26 11:56:42 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             reg[8];

        int             console_handle;
        int             irq_enable;
        int             irqnr;

        int             addrmult;

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

#define DEV_8250_LENGTH         8


/*
 *  dev_8250_tick():
 *
 */
void dev_8250_tick(struct cpu *cpu, void *extra)
{
#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
}


/*
 *  dev_8250_access():
 */
int dev_8250_access(struct cpu *cpu, struct memory *mem, uint64_t relative_addr,
        unsigned char *data, size_t len, int writeflag, void *extra)
{
        uint64_t idata = 0, odata = 0;
        struct dev_8250_data *d = extra;

        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():
 */
int devinit_8250(struct devinit *devinit)
{
        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->console_handle = console_start_slave(devinit->machine, "console");
        d->dlab = 0;
        d->divisor  = 115200 / 9600;
        d->databits = 8;
        d->parity   = 'N';
        d->stopbits = "1";

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

        return 1;
}

1	dpavlin	4	/*
2			* Copyright (C) 2004-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_8250.c,v 1.16 2005/02/26 11:56:42 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 reg[8];
49
50			int console_handle;
51			int irq_enable;
52			int irqnr;
53
54			int addrmult;
55
56			int dlab; /* Divisor Latch Access bit */
57			int divisor;
58			int databits;
59			char parity;
60			const char *stopbits;
61			};
62
63			#define DEV_8250_LENGTH 8
64
65
66			/*
67			* dev_8250_tick():
68			*
69			*/
70			void dev_8250_tick(struct cpu cpu, void extra)
71			{
72			#if 0
73			/* This stuff works for 16550. TODO for 8250 */
74
75			struct dev_8250_data *d = extra;
76
77			d->reg[REG_IID] \|= IIR_NOPEND;
78			cpu_interrupt_ack(cpu, d->irqnr);
79
80			if (console_charavail(d->console_handle))
81			d->reg[REG_IID] \|= IIR_RXRDY;
82			else
83			d->reg[REG_IID] &= ~IIR_RXRDY;
84
85			if (d->reg[REG_MCR] & MCR_IENABLE) {
86			if (d->irq_enable & IER_ETXRDY && d->reg[REG_IID] & IIR_TXRDY) {
87			cpu_interrupt(cpu, d->irqnr);
88			d->reg[REG_IID] &= ~IIR_NOPEND;
89			}
90
91			if (d->irq_enable & IER_ERXRDY && d->reg[REG_IID] & IIR_RXRDY) {
92			cpu_interrupt(cpu, d->irqnr);
93			d->reg[REG_IID] &= ~IIR_NOPEND;
94			}
95			}
96			#endif
97			}
98
99
100			/*
101			* dev_8250_access():
102			*/
103			int dev_8250_access(struct cpu cpu, struct memory mem, uint64_t relative_addr,
104			unsigned char data, size_t len, int writeflag, void extra)
105			{
106			uint64_t idata = 0, odata = 0;
107			struct dev_8250_data *d = extra;
108
109			idata = memory_readmax64(cpu, data, len);
110			relative_addr /= d->addrmult;
111
112			if (writeflag == MEM_WRITE && relative_addr == 0)
113			console_putchar(d->console_handle, idata);
114			else
115			if (writeflag == MEM_READ && relative_addr == 5)
116			odata = 64 + 32;
117			else {
118			#if 0
119			if (writeflag == MEM_WRITE)
120			fatal("[ 8250: write addr=0x%02x idata = 0x%02x ]\n",
121			(int)relative_addr, (int)idata);
122			else
123			fatal("[ 8250: read addr=0x%02x ]\n", relative_addr);
124			#endif
125			}
126
127			if (writeflag == MEM_READ)
128			memory_writemax64(cpu, data, len, odata);
129
130			return 1;
131			}
132
133
134			/*
135			* devinit_8250():
136			*/
137			int devinit_8250(struct devinit *devinit)
138			{
139			struct dev_8250_data *d;
140
141			d = malloc(sizeof(struct dev_8250_data));
142			if (d == NULL) {
143			fprintf(stderr, "out of memory\n");
144			exit(1);
145			}
146			memset(d, 0, sizeof(struct dev_8250_data));
147			d->irqnr = devinit->irq_nr;
148			d->addrmult = devinit->addr_mult;
149			d->console_handle = console_start_slave(devinit->machine, "console");
150			d->dlab = 0;
151			d->divisor = 115200 / 9600;
152			d->databits = 8;
153			d->parity = 'N';
154			d->stopbits = "1";
155
156			memory_device_register(devinit->machine->memory, devinit->name,
157			devinit->addr, DEV_8250_LENGTH * devinit->addr_mult,
158			dev_8250_access, d, MEM_DEFAULT, NULL);
159			machine_add_tickfunction(devinit->machine, dev_8250_tick, d, 14);
160
161			return 1;
162			}
163