WebSVN – HelenOS – Diff – /branches/dynload/uspace/srv/kbd/port/sgcn.c


/*
 * Copyright (c) 2008 Pavel Rimsky
 * 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 kbd_port
 * @ingroup  kbd
 * @{
 */
/** @file
 * @brief   SGCN (Serengeti Console) keyboard port driver.
 */
 
#include <as.h>
#include <ddi.h>
 
#include <async.h>
#include <kbd.h>
#include <kbd_port.h>
#include <sysinfo.h>
#include <stdio.h>
#include <thread.h>
 
#define POLL_INTERVAL       10000
 
/**
 * SGCN buffer header. It is placed at the very beginning of the SGCN
 * buffer.
 */
typedef struct {
    /** hard-wired to "CON" */
    char magic[4];
   
    /** we don't need this */
    char unused[8];
   
    /** offset within the SGCN buffer of the input buffer start */
    uint32_t in_begin;
   
    /** offset within the SGCN buffer of the input buffer end */
    uint32_t in_end;
   
    /** offset within the SGCN buffer of the input buffer read pointer */
    uint32_t in_rdptr;
   
    /** offset within the SGCN buffer of the input buffer write pointer */
    uint32_t in_wrptr;
} __attribute__ ((packed)) sgcn_buffer_header_t;
 
/*
 * Returns a pointer to the object of a given type which is placed at the given
 * offset from the console buffer beginning.
 */
#define SGCN_BUFFER(type, offset) \
        ((type *) (sram_virt_addr + sram_buffer_offset + (offset)))
 
/** Returns a pointer to the console buffer header. */
#define SGCN_BUFFER_HEADER  (SGCN_BUFFER(sgcn_buffer_header_t, 0))
 
/**
 * Virtual address mapped to SRAM.
 */
static uintptr_t sram_virt_addr;
 
/**
 * SGCN buffer offset within SGCN.
 */
static uintptr_t sram_buffer_offset;
 
/* polling thread */
static void *sgcn_thread_impl(void *arg);
 
 
/**
 * Initializes the SGCN driver.
 * Maps the physical memory (SRAM) and creates the polling thread.
 */
int kbd_port_init(void)
{
 
    sram_virt_addr = (uintptr_t) as_get_mappable_page(sysinfo_value("sram.area.size"));
    if (physmem_map((void *) sysinfo_value("sram.address.physical"),
        (void *) sram_virt_addr, sysinfo_value("sram.area.size") / PAGE_SIZE,
        AS_AREA_READ | AS_AREA_WRITE) != 0) {
        printf("SGCN: uspace driver could not map physical memory.");
        return -1;
    }
   
    sram_buffer_offset = sysinfo_value("sram.buffer.offset");
 
    thread_id_t tid;
    int rc;
 
    rc = thread_create(sgcn_thread_impl, NULL, "kbd_poll", &tid);
    if (rc != 0) {
        return rc;
    }
 
    return 0;
}
 
/**
 * Handler of the "key pressed" event. Reads codes of all the pressed keys from
 * the buffer.
 */
static void sgcn_key_pressed(void)
{
    char c;
   
    uint32_t begin = SGCN_BUFFER_HEADER->in_begin;
    uint32_t end = SGCN_BUFFER_HEADER->in_end;
    uint32_t size = end - begin;
   
    volatile char *buf_ptr = (volatile char *)
        SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
    volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
    volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
   
    while (*in_rdptr_ptr != *in_wrptr_ptr) {
        c = *buf_ptr;
        *in_rdptr_ptr = (((*in_rdptr_ptr) - begin + 1) % size) + begin;
        buf_ptr = (volatile char *)
            SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
        kbd_push_scancode(c);
    }
}
 
/**
 * Thread to poll SGCN for keypresses.
 */
static void *sgcn_thread_impl(void *arg)
{
    (void) arg;
 
    while (1) {
        sgcn_key_pressed();
        usleep(POLL_INTERVAL);
    }
}
 
 
/** @}
 */
 

Rev 4343	Rev 4346
1	/*	1	/*
2	* Copyright (c) 2008 Pavel Rimsky	2	* Copyright (c) 2008 Pavel Rimsky
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 kbd_port	29	/** @addtogroup kbd_port
30	* @ingroup kbd	30	* @ingroup kbd
31	* @{	31	* @{
32	*/	32	*/
33	/** @file	33	/** @file
34	* @brief SGCN (Serengeti Console) keyboard port driver.	34	* @brief SGCN (Serengeti Console) keyboard port driver.
35	*/	35	*/
36		36
37	#include <as.h>	37	#include <as.h>
38	#include <ddi.h>	38	#include <ddi.h>
39	#include <ipc/ipc.h>	-
40	#include <async.h>	39	#include <async.h>
41	#include <kbd.h>	40	#include <kbd.h>
42	#include <kbd_port.h>	41	#include <kbd_port.h>
43	#include <sysinfo.h>	42	#include <sysinfo.h>
44	#include <stdio.h>	43	#include <stdio.h>
-		44	#include <thread.h>
-		45
-		46	#define POLL_INTERVAL 10000
45		47
46	/**	48	/**
47	* SGCN buffer header. It is placed at the very beginning of the SGCN	49	* SGCN buffer header. It is placed at the very beginning of the SGCN
48	* buffer.	50	* buffer.
49	*/	51	*/
50	typedef struct {	52	typedef struct {
51	/** hard-wired to "CON" */	53	/** hard-wired to "CON" */
52	char magic[4];	54	char magic[4];
53		55
54	/** we don't need this */	56	/** we don't need this */
55	char unused[8];	57	char unused[8];
56		58
57	/** offset within the SGCN buffer of the input buffer start */	59	/** offset within the SGCN buffer of the input buffer start */
58	uint32_t in_begin;	60	uint32_t in_begin;
59		61
60	/** offset within the SGCN buffer of the input buffer end */	62	/** offset within the SGCN buffer of the input buffer end */
61	uint32_t in_end;	63	uint32_t in_end;
62		64
63	/** offset within the SGCN buffer of the input buffer read pointer */	65	/** offset within the SGCN buffer of the input buffer read pointer */
64	uint32_t in_rdptr;	66	uint32_t in_rdptr;
65		67
66	/** offset within the SGCN buffer of the input buffer write pointer */	68	/** offset within the SGCN buffer of the input buffer write pointer */
67	uint32_t in_wrptr;	69	uint32_t in_wrptr;
68	} __attribute__ ((packed)) sgcn_buffer_header_t;	70	} __attribute__ ((packed)) sgcn_buffer_header_t;
69		71
70	/*	72	/*
71	* Returns a pointer to the object of a given type which is placed at the given	73	* Returns a pointer to the object of a given type which is placed at the given
72	* offset from the console buffer beginning.	74	* offset from the console buffer beginning.
73	*/	75	*/
74	#define SGCN_BUFFER(type, offset) \	76	#define SGCN_BUFFER(type, offset) \
75	((type *) (sram_virt_addr + sram_buffer_offset + (offset)))	77	((type *) (sram_virt_addr + sram_buffer_offset + (offset)))
76		78
77	/** Returns a pointer to the console buffer header. */	79	/** Returns a pointer to the console buffer header. */
78	#define SGCN_BUFFER_HEADER (SGCN_BUFFER(sgcn_buffer_header_t, 0))	80	#define SGCN_BUFFER_HEADER (SGCN_BUFFER(sgcn_buffer_header_t, 0))
79		81
80	/**	82	/**
81	* Virtual address mapped to SRAM.	83	* Virtual address mapped to SRAM.
82	*/	84	*/
83	static uintptr_t sram_virt_addr;	85	static uintptr_t sram_virt_addr;
84		86
85	/**	87	/**
86	* SGCN buffer offset within SGCN.	88	* SGCN buffer offset within SGCN.
87	*/	89	*/
88	static uintptr_t sram_buffer_offset;	90	static uintptr_t sram_buffer_offset;
89		91
-		92	/* polling thread */
90	static void sgcn_irq_handler(ipc_callid_t iid, ipc_call_t *call);	93	static void sgcn_thread_impl(void arg);
91		94
92		95
93	/**	96	/**
94	* Initializes the SGCN driver.	97	* Initializes the SGCN driver.
95	* Maps the physical memory (SRAM) and registers the interrupt.	98	* Maps the physical memory (SRAM) and creates the polling thread.
96	*/	99	*/
97	int kbd_port_init(void)	100	int kbd_port_init(void)
98	{	101	{
99	async_set_interrupt_received(sgcn_irq_handler);	-
100	sram_virt_addr = (uintptr_t) as_get_mappable_page(sysinfo_value("sram.area.size"));	102	sram_virt_addr = (uintptr_t) as_get_mappable_page(sysinfo_value("sram.area.size"));
101	if (physmem_map((void *) sysinfo_value("sram.address.physical"),	103	if (physmem_map((void *) sysinfo_value("sram.address.physical"),
102	(void *) sram_virt_addr, sysinfo_value("sram.area.size") / PAGE_SIZE,	104	(void *) sram_virt_addr, sysinfo_value("sram.area.size") / PAGE_SIZE,
103	AS_AREA_READ \| AS_AREA_WRITE) != 0) {	105	AS_AREA_READ \| AS_AREA_WRITE) != 0) {
104	printf("SGCN: uspace driver could not map physical memory.");	106	printf("SGCN: uspace driver could not map physical memory.");
105	return -1;	107	return -1;
106	}	108	}
107		109
108	sram_buffer_offset = sysinfo_value("sram.buffer.offset");	110	sram_buffer_offset = sysinfo_value("sram.buffer.offset");
-		111
-		112	thread_id_t tid;
-		113	int rc;
-		114
109	ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"),	115	rc = thread_create(sgcn_thread_impl, NULL, "kbd_poll", &tid);
110	0, (void *) 0);	116	if (rc != 0) {
-		117	return rc;
-		118	}
-		119
111	return 0;	120	return 0;
112	}	121	}
113		122
114	/**	123	/**
115	* Handler of the "key pressed" event. Reads codes of all the pressed keys from	124	* Handler of the "key pressed" event. Reads codes of all the pressed keys from
116	* the buffer.	125	* the buffer.
117	*/	126	*/
118	static void sgcn_irq_handler(ipc_callid_t iid, ipc_call_t *call)	127	static void sgcn_key_pressed(void)
119	{	128	{
120	char c;	129	char c;
121		130
122	uint32_t begin = SGCN_BUFFER_HEADER->in_begin;	131	uint32_t begin = SGCN_BUFFER_HEADER->in_begin;
123	uint32_t end = SGCN_BUFFER_HEADER->in_end;	132	uint32_t end = SGCN_BUFFER_HEADER->in_end;
124	uint32_t size = end - begin;	133	uint32_t size = end - begin;
125		134
126	volatile char buf_ptr = (volatile char )	135	volatile char buf_ptr = (volatile char )
127	SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);	136	SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
128	volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);	137	volatile uint32_t *in_wrptr_ptr = &(SGCN_BUFFER_HEADER->in_wrptr);
129	volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);	138	volatile uint32_t *in_rdptr_ptr = &(SGCN_BUFFER_HEADER->in_rdptr);
130		139
131	while (in_rdptr_ptr != in_wrptr_ptr) {	140	while (in_rdptr_ptr != in_wrptr_ptr) {
132	c = *buf_ptr;	141	c = *buf_ptr;
133	in_rdptr_ptr = (((in_rdptr_ptr) - begin + 1) % size) + begin;	142	in_rdptr_ptr = (((in_rdptr_ptr) - begin + 1) % size) + begin;
134	buf_ptr = (volatile char *)	143	buf_ptr = (volatile char *)
135	SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);	144	SGCN_BUFFER(char, SGCN_BUFFER_HEADER->in_rdptr);
136	kbd_push_scancode(c);	145	kbd_push_scancode(c);
137	}	146	}
138	}	147	}
139		148
-		149	/**
-		150	* Thread to poll SGCN for keypresses.
-		151	*/
-		152	static void sgcn_thread_impl(void arg)
-		153	{
-		154	(void) arg;
-		155
-		156	while (1) {
-		157	sgcn_key_pressed();
-		158	usleep(POLL_INTERVAL);
-		159	}
-		160	}
-		161
-		162
140	/** @}	163	/** @}
141	*/	164	*/
142		165

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/srv/kbd/port/sgcn.c – Rev 4343 → 4346