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 <ipc/ipc.h>
#include <async.h>
#include <kbd.h>
#include <kbd_port.h>
#include <sysinfo.h>
#include <stdio.h>
 
/**
 * 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;
 
static void sgcn_irq_handler(ipc_callid_t iid, ipc_call_t *call);
 
 
/**
 * Initializes the SGCN driver.
 * Maps the physical memory (SRAM) and registers the interrupt.
 */
int kbd_port_init(void)
{
    async_set_interrupt_received(sgcn_irq_handler);
    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");
    ipc_register_irq(sysinfo_value("kbd.inr"), sysinfo_value("kbd.devno"),
        0, (void *) 0);
    return 0;
}
 
/**
 * Handler of the "key pressed" event. Reads codes of all the pressed keys from
 * the buffer.
 */
static void sgcn_irq_handler(ipc_callid_t iid, ipc_call_t *call)
{
    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);
    }
}
 
/** @}
 */
 

Subversion Repositories HelenOS

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

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