WebSVN – HelenOS-historic – Diff – /kernel/trunk/arch/mips32/src/drivers/msim.c


/*
 * Copyright (C) 2005 Ondrej Palkovsky
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - 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.
 * - 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 ``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 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.
 */
 
#include <interrupt.h>
#include <console/chardev.h>
#include <arch/drivers/msim.h>
#include <arch/cp0.h>
#include <console/console.h>
 
static chardev_t console;
 
static void msim_write(chardev_t *dev, const char ch);
static void msim_enable(chardev_t *dev);
static void msim_disable(chardev_t *dev);
static char msim_do_read(chardev_t *dev);
 
static chardev_operations_t msim_ops = {
    .resume = msim_enable,
    .suspend = msim_disable,
    .write = msim_write,
    .read = msim_do_read,
};
 
/** Putchar that works with MSIM & gxemul */
void msim_write(chardev_t *dev, const char ch)
{
    *((char *) MSIM_VIDEORAM) = ch;
}
 
/* Called from getc(). */
void msim_enable(chardev_t *dev)
{
    cp0_unmask_int(MSIM_KBD_IRQ);
}
 
/* Called from getc(). */
void msim_disable(chardev_t *dev)
{
    cp0_mask_int(MSIM_KBD_IRQ);
}
 
#include <print.h>
/** Read character using polling, assume interrupts disabled */
static char msim_do_read(chardev_t *dev)
{
    char ch;
 
    while (1) {
        ch = *((volatile char *) MSIM_KBD_ADDRESS);
        if (ch) {
            if (ch == '\r')
                return '\n';
            if (ch == 0x7f)
                return '\b';
            return ch;
        }
    }
}
 
/** Process keyboard interrupt. */
static void msim_interrupt(int n, void *stack)
{
    char ch = 0;
 
    ch = *((char *) MSIM_KBD_ADDRESS);
    if (ch =='\r')
        ch = '\n';
    if (ch == 0x7f)
        ch = '\b';
    chardev_push_character(&console, ch);
}
 
 
/* Return console object representing msim console */
void msim_console(void)
{
    chardev_initialize("msim_console", &console, &msim_ops);
 
    int_register(MSIM_KBD_IRQ, "msim_kbd", msim_interrupt);
 
    cp0_unmask_int(MSIM_KBD_IRQ);
 
    stdin = &console;
    stdout = &console;
}
 

Rev 606	Rev 607
1	/*	1	/*
2	* Copyright (C) 2005 Ondrej Palkovsky	2	* Copyright (C) 2005 Ondrej Palkovsky
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#include <interrupt.h>	29	#include <interrupt.h>
30	#include <console/chardev.h>	30	#include <console/chardev.h>
31	#include <arch/drivers/msim.h>	31	#include <arch/drivers/msim.h>
32	#include <arch/cp0.h>	32	#include <arch/cp0.h>
33	#include <console/console.h>	33	#include <console/console.h>
34		34
35	static chardev_t console;	35	static chardev_t console;
36		36
37	static void msim_write(chardev_t *dev, const char ch);	37	static void msim_write(chardev_t *dev, const char ch);
38	static void msim_enable(chardev_t *dev);	38	static void msim_enable(chardev_t *dev);
39	static void msim_disable(chardev_t *dev);	39	static void msim_disable(chardev_t *dev);
-		40	static char msim_do_read(chardev_t *dev);
40		41
41	static chardev_operations_t msim_ops = {	42	static chardev_operations_t msim_ops = {
42	.resume = msim_enable,	43	.resume = msim_enable,
43	.suspend = msim_disable,	44	.suspend = msim_disable,
44	.write = msim_write	45	.write = msim_write,
-		46	.read = msim_do_read,
45	};	47	};
46		48
47	/** Putchar that works with MSIM & gxemul */	49	/** Putchar that works with MSIM & gxemul */
48	void msim_write(chardev_t *dev, const char ch)	50	void msim_write(chardev_t *dev, const char ch)
49	{	51	{
50	((char ) MSIM_VIDEORAM) = ch;	52	((char ) MSIM_VIDEORAM) = ch;
51	}	53	}
52		54
53	/* Called from getc(). */	55	/* Called from getc(). */
54	void msim_enable(chardev_t *dev)	56	void msim_enable(chardev_t *dev)
55	{	57	{
56	cp0_unmask_int(MSIM_KBD_IRQ);	58	cp0_unmask_int(MSIM_KBD_IRQ);
57	}	59	}
58		60
59	/* Called from getc(). */	61	/* Called from getc(). */
60	void msim_disable(chardev_t *dev)	62	void msim_disable(chardev_t *dev)
61	{	63	{
62	cp0_mask_int(MSIM_KBD_IRQ);	64	cp0_mask_int(MSIM_KBD_IRQ);
63	}	65	}
64		66
65	#include <print.h>	67	#include <print.h>
-		68	/** Read character using polling, assume interrupts disabled */
-		69	static char msim_do_read(chardev_t *dev)
-		70	{
-		71	char ch;
-		72
-		73	while (1) {
-		74	ch = ((volatile char ) MSIM_KBD_ADDRESS);
-		75	if (ch) {
-		76	if (ch == '\r')
-		77	return '\n';
-		78	if (ch == 0x7f)
-		79	return '\b';
-		80	return ch;
-		81	}
-		82	}
-		83	}
-		84
66	/** Process keyboard interrupt. */	85	/** Process keyboard interrupt. */
67	static void msim_interrupt(int n, void *stack)	86	static void msim_interrupt(int n, void *stack)
68	{	87	{
69	char ch;	88	char ch = 0;
70		89
71	ch = ((char ) MSIM_KBD_ADDRESS);	90	ch = ((char ) MSIM_KBD_ADDRESS);
72	if (ch =='\r')	91	if (ch =='\r')
73	ch = '\n';	92	ch = '\n';
74	if (ch == 0x7f)	93	if (ch == 0x7f)
75	ch = '\b';	94	ch = '\b';
76	chardev_push_character(&console, ch);	95	chardev_push_character(&console, ch);
77	}	96	}
78		97
79		98
80	/* Return console object representing msim console */	99	/* Return console object representing msim console */
81	void msim_console(void)	100	void msim_console(void)
82	{	101	{
83	chardev_initialize("msim_console", &console, &msim_ops);	102	chardev_initialize("msim_console", &console, &msim_ops);
84		103
85	int_register(MSIM_KBD_IRQ, "msim_kbd", msim_interrupt);	104	int_register(MSIM_KBD_IRQ, "msim_kbd", msim_interrupt);
86		105
87	cp0_unmask_int(MSIM_KBD_IRQ);	106	cp0_unmask_int(MSIM_KBD_IRQ);
88		107
89	stdin = &console;	108	stdin = &console;
90	stdout = &console;	109	stdout = &console;
91	}	110	}
92		111

Subversion Repositories HelenOS-historic

(root)/kernel/trunk/arch/mips32/src/drivers/msim.c – Rev 606 → 607