WebSVN – HelenOS – Diff – /trunk/kernel/arch/ppc32/src/drivers/cuda.c


/*
 * Copyright (c) 2006 Martin Decky
 * 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.
 */
 
/** @addtogroup ppc32  
 * @{
 */
/** @file
 */
 
#include <arch/drivers/cuda.h>
#include <ipc/irq.h>
#include <arch/asm.h>
#include <console/console.h>
#include <console/chardev.h>
#include <arch/drivers/pic.h>
#include <sysinfo/sysinfo.h>
#include <interrupt.h>
#include <stdarg.h>
 
#define CUDA_IRQ 10
#define SPECIAL     '?'
 
#define PACKET_ADB  0x00
#define PACKET_CUDA 0x01
 
#define CUDA_POWERDOWN  0x0a
#define CUDA_RESET      0x11
 
#define RS 0x200
#define B (0 * RS)
#define A (1 * RS)
#define SR (10 * RS)
#define ACR (11 * RS)
 
#define SR_OUT 0x10
#define TACK 0x10
#define TIP 0x20
 
 
static volatile uint8_t *cuda = NULL;
static irq_t cuda_irq;      /**< Cuda's IRQ. */
 
static char lchars[0x80] = {
    'a',
    's',
    'd',
    'f',
    'h',
    'g',
    'z',
    'x',
    'c',
    'v',
    SPECIAL,
    'b',
    'q',
    'w',
    'e',
    'r',
    'y',
    't',
    '1',
    '2',
    '3',
    '4',
    '6',
    '5',
    '=',
    '9',
    '7',
    '-',
    '8',
    '0',
    ']',
    'o',
    'u',
    '[',
    'i',
    'p',
    '\n',    /* Enter */
    'l',
    'j',
    '\'',
    'k',
    ';',
    '\\',
    ',',
    '/',
    'n',
    'm',
    '.',
    '\t',    /* Tab */
    ' ',
    '`',
    '\b',    /* Backspace */
    SPECIAL,
    SPECIAL, /* Escape */
    SPECIAL, /* Ctrl */
    SPECIAL, /* Alt */
    SPECIAL, /* Shift */
    SPECIAL, /* Caps-Lock */
    SPECIAL, /* RAlt */
    SPECIAL, /* Left */
    SPECIAL, /* Right */
    SPECIAL, /* Down */
    SPECIAL, /* Up */
    SPECIAL,
    SPECIAL,
    '.',     /* Keypad . */
    SPECIAL,
    '*',     /* Keypad * */
    SPECIAL,
    '+',     /* Keypad + */
    SPECIAL,
    SPECIAL, /* NumLock */
    SPECIAL,
    SPECIAL,
    SPECIAL,
    '/',     /* Keypad / */
    '\n',    /* Keypad Enter */
    SPECIAL,
    '-',     /* Keypad - */
    SPECIAL,
    SPECIAL,
    SPECIAL,
    '0',     /* Keypad 0 */
    '1',     /* Keypad 1 */
    '2',     /* Keypad 2 */
    '3',     /* Keypad 3 */
    '4',     /* Keypad 4 */
    '5',     /* Keypad 5 */
    '6',     /* Keypad 6 */
    '7',     /* Keypad 7 */
    SPECIAL,
    '8',     /* Keypad 8 */
    '9',     /* Keypad 9 */
    SPECIAL,
    SPECIAL,
    SPECIAL,
    SPECIAL, /* F5 */
    SPECIAL, /* F6 */
    SPECIAL, /* F7 */
    SPECIAL, /* F3 */
    SPECIAL, /* F8 */
    SPECIAL, /* F9 */
    SPECIAL,
    SPECIAL, /* F11 */
    SPECIAL,
    SPECIAL, /* F13 */
    SPECIAL,
    SPECIAL, /* ScrollLock */
    SPECIAL,
    SPECIAL, /* F10 */
    SPECIAL,
    SPECIAL, /* F12 */
    SPECIAL,
    SPECIAL, /* Pause */
    SPECIAL, /* Insert */
    SPECIAL, /* Home */
    SPECIAL, /* PageUp */
    SPECIAL, /* Delete */
    SPECIAL, /* F4 */
    SPECIAL, /* End */
    SPECIAL, /* F2 */
    SPECIAL, /* PageDown */
    SPECIAL  /* F1 */
};
 
 
static void receive_packet(uint8_t *kind, index_t count, uint8_t data[])
{
    cuda[B] = cuda[B] & ~TIP;
    *kind = cuda[SR];
   
    index_t i;
    for (i = 0; i < count; i++)
        data[i] = cuda[SR];
   
    cuda[B] = cuda[B] | TIP;
}
 
 
/* Called from getc(). */
static void cuda_resume(chardev_t *d)
{
}
 
 
/* Called from getc(). */
static void cuda_suspend(chardev_t *d)
{
}
 
 
static char key_read(chardev_t *d)
{
    char ch;
   
    ch = 0;
    return ch;
}
 
 
static chardev_t kbrd;
static chardev_operations_t ops = {
    .suspend = cuda_suspend,
    .resume = cuda_resume,
    .read = key_read
};
 
 
int cuda_get_scancode(void)
{
    if (cuda) {
        uint8_t kind;
        uint8_t data[4];
       
        receive_packet(&kind, 4, data);
       
        if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c))
            return data[2];
    }
   
    return -1;
}
 
static void cuda_irq_handler(irq_t *irq, void *arg, ...)
{
    if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox))
        ipc_irq_send_notif(irq);
    else {
        int scan_code = cuda_get_scancode();
       
        if (scan_code != -1) {
            uint8_t scancode = (uint8_t) scan_code;
            if ((scancode & 0x80) != 0x80)
                chardev_push_character(&kbrd, lchars[scancode & 0x7f]);
        }
    }
}
 
static irq_ownership_t cuda_claim(void)
{
    return IRQ_ACCEPT;
}
 
 
/** Initialize keyboard and service interrupts using kernel routine */
void cuda_grab(void)
{
    if (cuda) {
        ipl_t ipl = interrupts_disable();
        spinlock_lock(&cuda_irq.lock);
        cuda_irq.notif_cfg.notify = false;
        spinlock_unlock(&cuda_irq.lock);
        interrupts_restore(ipl);
    }
}
 
 
/** Resume the former interrupt vector */
void cuda_release(void)
{
    if (cuda) {
        ipl_t ipl = interrupts_disable();
        spinlock_lock(&cuda_irq.lock);
        if (cuda_irq.notif_cfg.answerbox)
            cuda_irq.notif_cfg.notify = true;
        spinlock_unlock(&cuda_irq.unlock);
        interrupts_restore(ipl);
    }
}
 
 
void cuda_init(devno_t devno, uintptr_t base, size_t size)
{
    cuda = (uint8_t *) hw_map(base, size);
   
    chardev_initialize("cuda_kbd", &kbrd, &ops);
    stdin = &kbrd;
   
    irq_initialize(&cuda_irq);
    cuda_irq.devno = devno;
    cuda_irq.inr = CUDA_IRQ;
    cuda_irq.claim = cuda_claim;
    cuda_irq.handler = cuda_irq_handler;
    irq_register(&cuda_irq);
   
    pic_enable_interrupt(CUDA_IRQ);
   
    sysinfo_set_item_val("kbd", NULL, true);
    sysinfo_set_item_val("kbd.devno", NULL, devno);
    sysinfo_set_item_val("kbd.inr", NULL, CUDA_IRQ);
    sysinfo_set_item_val("kbd.address.virtual", NULL, base);
}
 
 
static void send_packet(const uint8_t kind, count_t count, ...)
{
    index_t i;
    va_list va;
   
    cuda[B] = cuda[B] | TIP;
    cuda[ACR] = cuda[ACR] | SR_OUT;
    cuda[SR] = kind;
    cuda[B] = cuda[B] & ~TIP;
   
    va_start(va, count);
   
    for (i = 0; i < count; i++) {
        cuda[ACR] = cuda[ACR] | SR_OUT;
        cuda[SR] = va_arg(va, int);
        cuda[B] = cuda[B] | TACK;
    }
   
    va_end(va);
   
    cuda[B] = cuda[B] | TIP;
}
 
 
void cpu_halt(void) {
    asm volatile (
        "b 0\n"
    );
}
 
void arch_reboot(void) {
    if (cuda)
        send_packet(PACKET_CUDA, 1, CUDA_RESET);
   
    asm volatile (
        "b 0\n"
    );
}
 
/** @}
 */
 

Rev 2227	Rev 3829
1	/*	1	/*
2	* Copyright (c) 2006 Martin Decky	2	* Copyright (c) 2006 Martin Decky
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	/** @addtogroup ppc32	29	/** @addtogroup ppc32
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <arch/drivers/cuda.h>	35	#include <arch/drivers/cuda.h>
36	#include <ipc/irq.h>	36	#include <ipc/irq.h>
37	#include <arch/asm.h>	37	#include <arch/asm.h>
38	#include <console/console.h>	38	#include <console/console.h>
39	#include <console/chardev.h>	39	#include <console/chardev.h>
40	#include <arch/drivers/pic.h>	40	#include <arch/drivers/pic.h>
41	#include <sysinfo/sysinfo.h>	41	#include <sysinfo/sysinfo.h>
42	#include <interrupt.h>	42	#include <interrupt.h>
43	#include <stdarg.h>	43	#include <stdarg.h>
44		44
45	#define CUDA_IRQ 10	45	#define CUDA_IRQ 10
46	#define SPECIAL '?'	46	#define SPECIAL '?'
47		47
48	#define PACKET_ADB 0x00	48	#define PACKET_ADB 0x00
49	#define PACKET_CUDA 0x01	49	#define PACKET_CUDA 0x01
50		50
51	#define CUDA_POWERDOWN 0x0a	51	#define CUDA_POWERDOWN 0x0a
52	#define CUDA_RESET 0x11	52	#define CUDA_RESET 0x11
53		53
54	#define RS 0x200	54	#define RS 0x200
55	#define B (0 * RS)	55	#define B (0 * RS)
56	#define A (1 * RS)	56	#define A (1 * RS)
57	#define SR (10 * RS)	57	#define SR (10 * RS)
58	#define ACR (11 * RS)	58	#define ACR (11 * RS)
59		59
60	#define SR_OUT 0x10	60	#define SR_OUT 0x10
61	#define TACK 0x10	61	#define TACK 0x10
62	#define TIP 0x20	62	#define TIP 0x20
63		63
64		64
65	static volatile uint8_t *cuda = NULL;	65	static volatile uint8_t *cuda = NULL;
66	static irq_t cuda_irq; /*< Cuda's IRQ. /	66	static irq_t cuda_irq; /*< Cuda's IRQ. /
67		67
68	static char lchars[0x80] = {	68	static char lchars[0x80] = {
69	'a',	69	'a',
70	's',	70	's',
71	'd',	71	'd',
72	'f',	72	'f',
73	'h',	73	'h',
74	'g',	74	'g',
75	'z',	75	'z',
76	'x',	76	'x',
77	'c',	77	'c',
78	'v',	78	'v',
79	SPECIAL,	79	SPECIAL,
80	'b',	80	'b',
81	'q',	81	'q',
82	'w',	82	'w',
83	'e',	83	'e',
84	'r',	84	'r',
85	'y',	85	'y',
86	't',	86	't',
87	'1',	87	'1',
88	'2',	88	'2',
89	'3',	89	'3',
90	'4',	90	'4',
91	'6',	91	'6',
92	'5',	92	'5',
93	'=',	93	'=',
94	'9',	94	'9',
95	'7',	95	'7',
96	'-',	96	'-',
97	'8',	97	'8',
98	'0',	98	'0',
99	']',	99	']',
100	'o',	100	'o',
101	'u',	101	'u',
102	'[',	102	'[',
103	'i',	103	'i',
104	'p',	104	'p',
105	'\n', /* Enter */	105	'\n', /* Enter */
106	'l',	106	'l',
107	'j',	107	'j',
108	'\'',	108	'\'',
109	'k',	109	'k',
110	';',	110	';',
111	'\\',	111	'\\',
112	',',	112	',',
113	'/',	113	'/',
114	'n',	114	'n',
115	'm',	115	'm',
116	'.',	116	'.',
117	'\t', /* Tab */	117	'\t', /* Tab */
118	' ',	118	' ',
119	'`',	119	'`',
120	'\b', /* Backspace */	120	'\b', /* Backspace */
121	SPECIAL,	121	SPECIAL,
122	SPECIAL, /* Escape */	122	SPECIAL, /* Escape */
123	SPECIAL, /* Ctrl */	123	SPECIAL, /* Ctrl */
124	SPECIAL, /* Alt */	124	SPECIAL, /* Alt */
125	SPECIAL, /* Shift */	125	SPECIAL, /* Shift */
126	SPECIAL, /* Caps-Lock */	126	SPECIAL, /* Caps-Lock */
127	SPECIAL, /* RAlt */	127	SPECIAL, /* RAlt */
128	SPECIAL, /* Left */	128	SPECIAL, /* Left */
129	SPECIAL, /* Right */	129	SPECIAL, /* Right */
130	SPECIAL, /* Down */	130	SPECIAL, /* Down */
131	SPECIAL, /* Up */	131	SPECIAL, /* Up */
132	SPECIAL,	132	SPECIAL,
133	SPECIAL,	133	SPECIAL,
134	'.', /* Keypad . */	134	'.', /* Keypad . */
135	SPECIAL,	135	SPECIAL,
136	'', / Keypad * */	136	'', / Keypad * */
137	SPECIAL,	137	SPECIAL,
138	'+', /* Keypad + */	138	'+', /* Keypad + */
139	SPECIAL,	139	SPECIAL,
140	SPECIAL, /* NumLock */	140	SPECIAL, /* NumLock */
141	SPECIAL,	141	SPECIAL,
142	SPECIAL,	142	SPECIAL,
143	SPECIAL,	143	SPECIAL,
144	'/', /* Keypad / */	144	'/', /* Keypad / */
145	'\n', /* Keypad Enter */	145	'\n', /* Keypad Enter */
146	SPECIAL,	146	SPECIAL,
147	'-', /* Keypad - */	147	'-', /* Keypad - */
148	SPECIAL,	148	SPECIAL,
149	SPECIAL,	149	SPECIAL,
150	SPECIAL,	150	SPECIAL,
151	'0', /* Keypad 0 */	151	'0', /* Keypad 0 */
152	'1', /* Keypad 1 */	152	'1', /* Keypad 1 */
153	'2', /* Keypad 2 */	153	'2', /* Keypad 2 */
154	'3', /* Keypad 3 */	154	'3', /* Keypad 3 */
155	'4', /* Keypad 4 */	155	'4', /* Keypad 4 */
156	'5', /* Keypad 5 */	156	'5', /* Keypad 5 */
157	'6', /* Keypad 6 */	157	'6', /* Keypad 6 */
158	'7', /* Keypad 7 */	158	'7', /* Keypad 7 */
159	SPECIAL,	159	SPECIAL,
160	'8', /* Keypad 8 */	160	'8', /* Keypad 8 */
161	'9', /* Keypad 9 */	161	'9', /* Keypad 9 */
162	SPECIAL,	162	SPECIAL,
163	SPECIAL,	163	SPECIAL,
164	SPECIAL,	164	SPECIAL,
165	SPECIAL, /* F5 */	165	SPECIAL, /* F5 */
166	SPECIAL, /* F6 */	166	SPECIAL, /* F6 */
167	SPECIAL, /* F7 */	167	SPECIAL, /* F7 */
168	SPECIAL, /* F3 */	168	SPECIAL, /* F3 */
169	SPECIAL, /* F8 */	169	SPECIAL, /* F8 */
170	SPECIAL, /* F9 */	170	SPECIAL, /* F9 */
171	SPECIAL,	171	SPECIAL,
172	SPECIAL, /* F11 */	172	SPECIAL, /* F11 */
173	SPECIAL,	173	SPECIAL,
174	SPECIAL, /* F13 */	174	SPECIAL, /* F13 */
175	SPECIAL,	175	SPECIAL,
176	SPECIAL, /* ScrollLock */	176	SPECIAL, /* ScrollLock */
177	SPECIAL,	177	SPECIAL,
178	SPECIAL, /* F10 */	178	SPECIAL, /* F10 */
179	SPECIAL,	179	SPECIAL,
180	SPECIAL, /* F12 */	180	SPECIAL, /* F12 */
181	SPECIAL,	181	SPECIAL,
182	SPECIAL, /* Pause */	182	SPECIAL, /* Pause */
183	SPECIAL, /* Insert */	183	SPECIAL, /* Insert */
184	SPECIAL, /* Home */	184	SPECIAL, /* Home */
185	SPECIAL, /* PageUp */	185	SPECIAL, /* PageUp */
186	SPECIAL, /* Delete */	186	SPECIAL, /* Delete */
187	SPECIAL, /* F4 */	187	SPECIAL, /* F4 */
188	SPECIAL, /* End */	188	SPECIAL, /* End */
189	SPECIAL, /* F2 */	189	SPECIAL, /* F2 */
190	SPECIAL, /* PageDown */	190	SPECIAL, /* PageDown */
191	SPECIAL /* F1 */	191	SPECIAL /* F1 */
192	};	192	};
193		193
194		194
195	static void receive_packet(uint8_t *kind, index_t count, uint8_t data[])	195	static void receive_packet(uint8_t *kind, index_t count, uint8_t data[])
196	{	196	{
197	cuda[B] = cuda[B] & ~TIP;	197	cuda[B] = cuda[B] & ~TIP;
198	*kind = cuda[SR];	198	*kind = cuda[SR];
199		199
200	index_t i;	200	index_t i;
201	for (i = 0; i < count; i++)	201	for (i = 0; i < count; i++)
202	data[i] = cuda[SR];	202	data[i] = cuda[SR];
203		203
204	cuda[B] = cuda[B] \| TIP;	204	cuda[B] = cuda[B] \| TIP;
205	}	205	}
206		206
207		207
208	/* Called from getc(). */	208	/* Called from getc(). */
209	static void cuda_resume(chardev_t *d)	209	static void cuda_resume(chardev_t *d)
210	{	210	{
211	}	211	}
212		212
213		213
214	/* Called from getc(). */	214	/* Called from getc(). */
215	static void cuda_suspend(chardev_t *d)	215	static void cuda_suspend(chardev_t *d)
216	{	216	{
217	}	217	}
218		218
219		219
220	static char key_read(chardev_t *d)	220	static char key_read(chardev_t *d)
221	{	221	{
222	char ch;	222	char ch;
223		223
224	ch = 0;	224	ch = 0;
225	return ch;	225	return ch;
226	}	226	}
227		227
228		228
229	static chardev_t kbrd;	229	static chardev_t kbrd;
230	static chardev_operations_t ops = {	230	static chardev_operations_t ops = {
231	.suspend = cuda_suspend,	231	.suspend = cuda_suspend,
232	.resume = cuda_resume,	232	.resume = cuda_resume,
233	.read = key_read	233	.read = key_read
234	};	234	};
235		235
236		236
237	int cuda_get_scancode(void)	237	int cuda_get_scancode(void)
238	{	238	{
-		239	if (cuda) {
239	uint8_t kind;	240	uint8_t kind;
240	uint8_t data[4];	241	uint8_t data[4];
241		242
242	receive_packet(&kind, 4, data);	243	receive_packet(&kind, 4, data);
243		244
244	if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c))	245	if ((kind == PACKET_ADB) && (data[0] == 0x40) && (data[1] == 0x2c))
245	return data[2];	246	return data[2];
-		247	}
246		248
247	return -1;	249	return -1;
248	}	250	}
249		251
250	static void cuda_irq_handler(irq_t irq, void arg, ...)	252	static void cuda_irq_handler(irq_t irq, void arg, ...)
251	{	253	{
252	if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox))	254	if ((irq->notif_cfg.notify) && (irq->notif_cfg.answerbox))
253	ipc_irq_send_notif(irq);	255	ipc_irq_send_notif(irq);
254	else {	256	else {
255	int scan_code = cuda_get_scancode();	257	int scan_code = cuda_get_scancode();
256		258
257	if (scan_code != -1) {	259	if (scan_code != -1) {
258	uint8_t scancode = (uint8_t) scan_code;	260	uint8_t scancode = (uint8_t) scan_code;
259	if ((scancode & 0x80) != 0x80)	261	if ((scancode & 0x80) != 0x80)
260	chardev_push_character(&kbrd, lchars[scancode & 0x7f]);	262	chardev_push_character(&kbrd, lchars[scancode & 0x7f]);
261	}	263	}
262	}	264	}
263	}	265	}
264		266
265	static irq_ownership_t cuda_claim(void)	267	static irq_ownership_t cuda_claim(void)
266	{	268	{
267	return IRQ_ACCEPT;	269	return IRQ_ACCEPT;
268	}	270	}
269		271
270		272
271	/** Initialize keyboard and service interrupts using kernel routine */	273	/** Initialize keyboard and service interrupts using kernel routine */
272	void cuda_grab(void)	274	void cuda_grab(void)
273	{	275	{
-		276	if (cuda) {
274	ipl_t ipl = interrupts_disable();	277	ipl_t ipl = interrupts_disable();
275	spinlock_lock(&cuda_irq.lock);	278	spinlock_lock(&cuda_irq.lock);
276	cuda_irq.notif_cfg.notify = false;	279	cuda_irq.notif_cfg.notify = false;
277	spinlock_unlock(&cuda_irq.lock);	280	spinlock_unlock(&cuda_irq.lock);
278	interrupts_restore(ipl);	281	interrupts_restore(ipl);
-		282	}
279	}	283	}
280		284
281		285
282	/** Resume the former interrupt vector */	286	/** Resume the former interrupt vector */
283	void cuda_release(void)	287	void cuda_release(void)
284	{	288	{
-		289	if (cuda) {
285	ipl_t ipl = interrupts_disable();	290	ipl_t ipl = interrupts_disable();
286	spinlock_lock(&cuda_irq.lock);	291	spinlock_lock(&cuda_irq.lock);
287	if (cuda_irq.notif_cfg.answerbox)	292	if (cuda_irq.notif_cfg.answerbox)
288	cuda_irq.notif_cfg.notify = true;	293	cuda_irq.notif_cfg.notify = true;
289	spinlock_unlock(&cuda_irq.unlock);	294	spinlock_unlock(&cuda_irq.unlock);
290	interrupts_restore(ipl);	295	interrupts_restore(ipl);
-		296	}
291	}	297	}
292		298
293		299
294	void cuda_init(devno_t devno, uintptr_t base, size_t size)	300	void cuda_init(devno_t devno, uintptr_t base, size_t size)
295	{	301	{
296	cuda = (uint8_t *) hw_map(base, size);	302	cuda = (uint8_t *) hw_map(base, size);
297		303
298	chardev_initialize("cuda_kbd", &kbrd, &ops);	304	chardev_initialize("cuda_kbd", &kbrd, &ops);
299	stdin = &kbrd;	305	stdin = &kbrd;
300		306
301	irq_initialize(&cuda_irq);	307	irq_initialize(&cuda_irq);
302	cuda_irq.devno = devno;	308	cuda_irq.devno = devno;
303	cuda_irq.inr = CUDA_IRQ;	309	cuda_irq.inr = CUDA_IRQ;
304	cuda_irq.claim = cuda_claim;	310	cuda_irq.claim = cuda_claim;
305	cuda_irq.handler = cuda_irq_handler;	311	cuda_irq.handler = cuda_irq_handler;
306	irq_register(&cuda_irq);	312	irq_register(&cuda_irq);
307		313
308	pic_enable_interrupt(CUDA_IRQ);	314	pic_enable_interrupt(CUDA_IRQ);
309		315
310	sysinfo_set_item_val("kbd", NULL, true);	316	sysinfo_set_item_val("kbd", NULL, true);
311	sysinfo_set_item_val("kbd.devno", NULL, devno);	317	sysinfo_set_item_val("kbd.devno", NULL, devno);
312	sysinfo_set_item_val("kbd.inr", NULL, CUDA_IRQ);	318	sysinfo_set_item_val("kbd.inr", NULL, CUDA_IRQ);
313	sysinfo_set_item_val("kbd.address.virtual", NULL, base);	319	sysinfo_set_item_val("kbd.address.virtual", NULL, base);
314	}	320	}
315		321
316		322
317	static void send_packet(const uint8_t kind, count_t count, ...)	323	static void send_packet(const uint8_t kind, count_t count, ...)
318	{	324	{
319	index_t i;	325	index_t i;
320	va_list va;	326	va_list va;
321		327
322	cuda[B] = cuda[B] \| TIP;	328	cuda[B] = cuda[B] \| TIP;
323	cuda[ACR] = cuda[ACR] \| SR_OUT;	329	cuda[ACR] = cuda[ACR] \| SR_OUT;
324	cuda[SR] = kind;	330	cuda[SR] = kind;
325	cuda[B] = cuda[B] & ~TIP;	331	cuda[B] = cuda[B] & ~TIP;
326		332
327	va_start(va, count);	333	va_start(va, count);
328		334
329	for (i = 0; i < count; i++) {	335	for (i = 0; i < count; i++) {
330	cuda[ACR] = cuda[ACR] \| SR_OUT;	336	cuda[ACR] = cuda[ACR] \| SR_OUT;
331	cuda[SR] = va_arg(va, int);	337	cuda[SR] = va_arg(va, int);
332	cuda[B] = cuda[B] \| TACK;	338	cuda[B] = cuda[B] \| TACK;
333	}	339	}
334		340
335	va_end(va);	341	va_end(va);
336		342
337	cuda[B] = cuda[B] \| TIP;	343	cuda[B] = cuda[B] \| TIP;
338	}	344	}
339		345
340		346
341	void cpu_halt(void) {	347	void cpu_halt(void) {
342	asm volatile (	348	asm volatile (
343	"b 0\n"	349	"b 0\n"
344	);	350	);
345	}	351	}
346		352
347	void arch_reboot(void) {	353	void arch_reboot(void) {
-		354	if (cuda)
348	send_packet(PACKET_CUDA, 1, CUDA_RESET);	355	send_packet(PACKET_CUDA, 1, CUDA_RESET);
-		356
349	asm volatile (	357	asm volatile (
350	"b 0\n"	358	"b 0\n"
351	);	359	);
352	}	360	}
353		361
354	/** @}	362	/** @}
355	*/	363	*/
356		364

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc32/src/drivers/cuda.c – Rev 2227 → 3829