WebSVN – HelenOS – Diff – /trunk/kernel/generic/src/console/chardev.c


/*
 * Copyright (c) 2005 Jakub Jermar
 * 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 genericconsole
 * @{
 */
/** @file
 */
 
#include <console/chardev.h>
#include <putchar.h>
#include <synch/waitq.h>
#include <synch/spinlock.h>
 
/** Initialize character device.
 *
 * @param chardev Character device.
 * @param op Implementation of character device operations.
 */
void chardev_initialize(char *name, chardev_t *chardev,
            chardev_operations_t *op)
{
    chardev->name = name;
 
    waitq_initialize(&chardev->wq);
    spinlock_initialize(&chardev->lock, "chardev");
    chardev->counter = 0;
    chardev->index = 0;
    chardev->op = op;
}
 
/** Push character read from input character device.
 *
 * @param chardev Character device.
 * @param ch Character being pushed.
 */
void chardev_push_character(chardev_t *chardev, uint8_t ch)
{
    spinlock_lock(&chardev->lock);
    chardev->counter++;
    if (chardev->counter == CHARDEV_BUFLEN - 1) {
        /* buffer full => disable device interrupt */
        chardev->op->suspend(chardev);
    }
   
    chardev->buffer[chardev->index++] = ch;
    chardev->index = chardev->index % CHARDEV_BUFLEN; /* index modulo size of buffer */
    waitq_wakeup(&chardev->wq, WAKEUP_FIRST);
    spinlock_unlock(&chardev->lock);
}
 
/** @}
 */
 

Subversion Repositories HelenOS

(root)/trunk/kernel/generic/src/console/chardev.c – Rev 2071 → 3065

Rev 2071		Rev 3065
1	/*	1	/*
2	* Copyright (c) 2005 Jakub Jermar	2	* Copyright (c) 2005 Jakub Jermar
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 genericconsole	29	/** @addtogroup genericconsole
30	* @{	30	* @{
31	*/	31	*/
32	/** @file	32	/** @file
33	*/	33	*/
34		34
35	#include <console/chardev.h>	35	#include <console/chardev.h>
36	#include <putchar.h>	36	#include <putchar.h>
37	#include <synch/waitq.h>	37	#include <synch/waitq.h>
38	#include <synch/spinlock.h>	38	#include <synch/spinlock.h>
39		39
40	/** Initialize character device.	40	/** Initialize character device.
41	*	41	*
42	* @param chardev Character device.	42	* @param chardev Character device.
43	* @param op Implementation of character device operations.	43	* @param op Implementation of character device operations.
44	*/	44	*/
45	void chardev_initialize(char name,chardev_t chardev,	45	void chardev_initialize(char name, chardev_t chardev,
46	chardev_operations_t *op)	46	chardev_operations_t *op)
47	{	47	{
48	chardev->name = name;	48	chardev->name = name;
49		49
50	waitq_initialize(&chardev->wq);	50	waitq_initialize(&chardev->wq);
51	spinlock_initialize(&chardev->lock, "chardev");	51	spinlock_initialize(&chardev->lock, "chardev");
52	chardev->counter = 0;	52	chardev->counter = 0;
53	chardev->index = 0;	53	chardev->index = 0;
54	chardev->op = op;	54	chardev->op = op;
55	}	55	}
56		56
57	/** Push character read from input character device.	57	/** Push character read from input character device.
58	*	58	*
59	* @param chardev Character device.	59	* @param chardev Character device.
60	* @param ch Character being pushed.	60	* @param ch Character being pushed.
61	*/	61	*/
62	void chardev_push_character(chardev_t *chardev, uint8_t ch)	62	void chardev_push_character(chardev_t *chardev, uint8_t ch)
63	{	63	{
64	spinlock_lock(&chardev->lock);	64	spinlock_lock(&chardev->lock);
65	chardev->counter++;	65	chardev->counter++;
66	if (chardev->counter == CHARDEV_BUFLEN - 1) {	66	if (chardev->counter == CHARDEV_BUFLEN - 1) {
67	/* buffer full => disable device interrupt */	67	/* buffer full => disable device interrupt */
68	chardev->op->suspend(chardev);	68	chardev->op->suspend(chardev);
69	}	69	}
70		70
71	chardev->buffer[chardev->index++] = ch;	71	chardev->buffer[chardev->index++] = ch;
72	chardev->index = chardev->index % CHARDEV_BUFLEN; /* index modulo size of buffer */	72	chardev->index = chardev->index % CHARDEV_BUFLEN; /* index modulo size of buffer */
73	waitq_wakeup(&chardev->wq, WAKEUP_FIRST);	73	waitq_wakeup(&chardev->wq, WAKEUP_FIRST);
74	spinlock_unlock(&chardev->lock);	74	spinlock_unlock(&chardev->lock);
75	}	75	}
76		76
77	/** @}	77	/** @}
78	*/	78	*/
79		79