WebSVN – HelenOS-historic – Diff – /kernel/trunk/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 SPECIAL     '?'
 
#define PACKET_ADB  0x00
#define PACKET_CUDA 0x01
 
#define CUDA_POWERDOWN 0x0a
 
#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 iroutine vector;
 
 
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 */
};
 
 
void send_packet(const uint8_t kind, index_t count, ...);
 
 
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)
{
    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(int n, istate_t *istate)
{
    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]);
    }
}
 
 
/** Initialize keyboard and service interrupts using kernel routine */
void cuda_grab(void)
{
    vector = int_register(CUDA_IRQ, "cuda", cuda_irq);
}
 
 
/** Resume the former interrupt vector */
void cuda_release(void)
{
    if (vector)
        int_register(CUDA_IRQ, "user_interrupt", vector);
}
 
 
void cuda_init(uintptr_t base, size_t size)
{
    cuda = (uint8_t *) hw_map(base, size);
   
    int_register(CUDA_IRQ, "cuda", cuda_irq);
    pic_enable_interrupt(CUDA_IRQ);
   
    chardev_initialize("cuda_kbd", &kbrd, &ops);
    stdin = &kbrd;
   
    sysinfo_set_item_val("cuda", NULL, true);
    sysinfo_set_item_val("cuda.irq", NULL, CUDA_IRQ);
}
 
 
void send_packet(const uint8_t kind, index_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) {
#ifdef CONFIG_POWEROFF
    send_packet(PACKET_CUDA, 1, CUDA_POWERDOWN);
#endif
    asm volatile (
        "b 0\n"
    );
}
 
/** @}
 */
 

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

Subversion Repositories HelenOS-historic

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