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

Subversion Repositories HelenOS

(root)/branches/dynload/kernel/arch/ppc32/src/drivers/cuda.c – Rev 4344 → 4346