WebSVN – HelenOS – Diff – /branches/tracing/kernel/generic/src/console/console.c


/*
 * Copyright (c) 2003 Josef Cejka
 * 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/console.h>
#include <console/chardev.h>
#include <sysinfo/sysinfo.h>
#include <synch/waitq.h>
#include <synch/spinlock.h>
#include <arch/types.h>
#include <ddi/irq.h>
#include <ddi/ddi.h>
#include <ipc/event.h>
#include <ipc/irq.h>
#include <arch.h>
#include <print.h>
#include <putchar.h>
#include <atomic.h>
#include <syscall/copy.h>
#include <errno.h>
#include <string.h>
 
#define KLOG_PAGES    4
#define KLOG_LENGTH   (KLOG_PAGES * PAGE_SIZE / sizeof(wchar_t))
#define KLOG_LATENCY  8
 
/** Kernel log cyclic buffer */
static wchar_t klog[KLOG_LENGTH] __attribute__ ((aligned (PAGE_SIZE)));
 
/** Kernel log initialized */
static bool klog_inited = false;
/** First kernel log characters */
static size_t klog_start = 0;
/** Number of valid kernel log characters */
static size_t klog_len = 0;
/** Number of stored (not printed) kernel log characters */
static size_t klog_stored = 0;
/** Number of stored kernel log characters for uspace */
static size_t klog_uspace = 0;
 
/** Kernel log spinlock */
SPINLOCK_INITIALIZE(klog_lock);
 
/** Physical memory area used for klog buffer */
static parea_t klog_parea;
 
static indev_operations_t stdin_ops = {
    .poll = NULL
};
 
/** Silence output */
bool silent = false;
 
/** Standard input and output character devices */
indev_t *stdin = NULL;
outdev_t *stdout = NULL;
 
indev_t *stdin_wire(void)
{
    if (stdin == NULL) {
        stdin = malloc(sizeof(indev_t), FRAME_ATOMIC);
        if (stdin != NULL)
            indev_initialize("stdin", stdin, &stdin_ops);
    }
   
    return stdin;
}
 
/** Initialize kernel logging facility
 *
 * The shared area contains kernel cyclic buffer. Userspace application may
 * be notified on new data with indication of position and size
 * of the data within the circular buffer.
 *
 */
void klog_init(void)
{
    void *faddr = (void *) KA2PA(klog);
   
    ASSERT((uintptr_t) faddr % FRAME_SIZE == 0);
   
    klog_parea.pbase = (uintptr_t) faddr;
    klog_parea.frames = SIZE2FRAMES(sizeof(klog));
    ddi_parea_register(&klog_parea);
   
    sysinfo_set_item_val("klog.faddr", NULL, (unative_t) faddr);
    sysinfo_set_item_val("klog.pages", NULL, KLOG_PAGES);
   
    spinlock_lock(&klog_lock);
    klog_inited = true;
    spinlock_unlock(&klog_lock);
}
 
void grab_console(void)
{
    bool prev = silent;
   
    silent = false;
    arch_grab_console();
   
    /* Force the console to print the prompt */
    if ((stdin) && (prev))
        indev_push_character(stdin, '\n');
}
 
void release_console(void)
{
    silent = true;
    arch_release_console();
}
 
/** Tell kernel to get keyboard/console access again */
unative_t sys_debug_enable_console(void)
{
#ifdef CONFIG_KCONSOLE
    grab_console();
    return true;
#else
    return false;
#endif
}
 
/** Tell kernel to relinquish keyboard/console access */
unative_t sys_debug_disable_console(void)
{
    release_console();
    return true;
}
 
/** Get string from input character device.
 *
 * Read characters from input character device until first occurrence
 * of newline character.
 *
 * @param indev  Input character device.
 * @param buf    Buffer where to store string terminated by NULL.
 * @param buflen Size of the buffer.
 *
 * @return Number of characters read.
 *
 */
size_t gets(indev_t *indev, char *buf, size_t buflen)
{
    size_t offset = 0;
    size_t count = 0;
    buf[offset] = 0;
   
    wchar_t ch;
    while ((ch = indev_pop_character(indev)) != '\n') {
        if (ch == '\b') {
            if (count > 0) {
                /* Space, backspace, space */
                putchar('\b');
                putchar(' ');
                putchar('\b');
               
                count--;
                offset = str_lsize(buf, count);
                buf[offset] = 0;
            }
        }
        if (chr_encode(ch, buf, &offset, buflen - 1) == EOK) {
            putchar(ch);
            count++;
            buf[offset] = 0;
        }
    }
   
    return count;
}
 
/** Get character from input device & echo it to screen */
wchar_t getc(indev_t *indev)
{
    wchar_t ch = indev_pop_character(indev);
    putchar(ch);
    return ch;
}
 
void klog_update(void)
{
    spinlock_lock(&klog_lock);
   
    if ((klog_inited) && (event_is_subscribed(EVENT_KLOG)) && (klog_uspace > 0)) {
        event_notify_3(EVENT_KLOG, klog_start, klog_len, klog_uspace);
        klog_uspace = 0;
    }
   
    spinlock_unlock(&klog_lock);
}
 
void putchar(const wchar_t ch)
{
    spinlock_lock(&klog_lock);
   
    if ((klog_stored > 0) && (stdout) && (stdout->op->write)) {
        /* Print charaters stored in kernel log */
        size_t i;
        for (i = klog_len - klog_stored; i < klog_len; i++)
            stdout->op->write(stdout, klog[(klog_start + i) % KLOG_LENGTH], silent);
        klog_stored = 0;
    }
   
    /* Store character in the cyclic kernel log */
    klog[(klog_start + klog_len) % KLOG_LENGTH] = ch;
    if (klog_len < KLOG_LENGTH)
        klog_len++;
    else
        klog_start = (klog_start + 1) % KLOG_LENGTH;
   
    if ((stdout) && (stdout->op->write))
        stdout->op->write(stdout, ch, silent);
    else {
        /* The character is just in the kernel log */
        if (klog_stored < klog_len)
            klog_stored++;
    }
   
    /* The character is stored for uspace */
    if (klog_uspace < klog_len)
        klog_uspace++;
   
    /* Check notify uspace to update */
    bool update;
    if ((klog_uspace > KLOG_LATENCY) || (ch == '\n'))
        update = true;
    else
        update = false;
   
    spinlock_unlock(&klog_lock);
   
    if (update)
        klog_update();
}
 
/** Print using kernel facility
 *
 * Print to kernel log.
 *
 */
unative_t sys_klog(int fd, const void *buf, size_t size)
{
    char *data;
    int rc;
   
    if (size > PAGE_SIZE)
        return ELIMIT;
   
    if (size > 0) {
        data = (char *) malloc(size + 1, 0);
        if (!data)
            return ENOMEM;
       
        rc = copy_from_uspace(data, buf, size);
        if (rc) {
            free(data);
            return rc;
        }
        data[size] = 0;
       
        printf("%s", data);
        free(data);
    } else
        klog_update();
   
    return size;
}
 
/** @}
 */
 

Rev 4377	Rev 4692
1	/*	1	/*
2	* Copyright (c) 2003 Josef Cejka	2	* Copyright (c) 2003 Josef Cejka
3	* Copyright (c) 2005 Jakub Jermar	3	* Copyright (c) 2005 Jakub Jermar
4	* All rights reserved.	4	* All rights reserved.
5	*	5	*
6	* Redistribution and use in source and binary forms, with or without	6	* Redistribution and use in source and binary forms, with or without
7	* modification, are permitted provided that the following conditions	7	* modification, are permitted provided that the following conditions
8	* are met:	8	* are met:
9	*	9	*
10	* - Redistributions of source code must retain the above copyright	10	* - Redistributions of source code must retain the above copyright
11	* notice, this list of conditions and the following disclaimer.	11	* notice, this list of conditions and the following disclaimer.
12	* - Redistributions in binary form must reproduce the above copyright	12	* - Redistributions in binary form must reproduce the above copyright
13	* notice, this list of conditions and the following disclaimer in the	13	* notice, this list of conditions and the following disclaimer in the
14	* documentation and/or other materials provided with the distribution.	14	* documentation and/or other materials provided with the distribution.
15	* - The name of the author may not be used to endorse or promote products	15	* - The name of the author may not be used to endorse or promote products
16	* derived from this software without specific prior written permission.	16	* derived from this software without specific prior written permission.
17	*	17	*
18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	18	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	19	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	20	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	21	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	22	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	23	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	24	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	25	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	26	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	27	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28	*/	28	*/
29		29
30	/** @addtogroup genericconsole	30	/** @addtogroup genericconsole
31	* @{	31	* @{
32	*/	32	*/
33	/** @file	33	/** @file
34	*/	34	*/
35		35
36	#include <console/console.h>	36	#include <console/console.h>
37	#include <console/chardev.h>	37	#include <console/chardev.h>
38	#include <sysinfo/sysinfo.h>	38	#include <sysinfo/sysinfo.h>
39	#include <synch/waitq.h>	39	#include <synch/waitq.h>
40	#include <synch/spinlock.h>	40	#include <synch/spinlock.h>
41	#include <arch/types.h>	41	#include <arch/types.h>
42	#include <ddi/irq.h>	42	#include <ddi/irq.h>
43	#include <ddi/ddi.h>	43	#include <ddi/ddi.h>
44	#include <ipc/event.h>	44	#include <ipc/event.h>
45	#include <ipc/irq.h>	45	#include <ipc/irq.h>
46	#include <arch.h>	46	#include <arch.h>
47	#include <print.h>	47	#include <print.h>
48	#include <putchar.h>	48	#include <putchar.h>
49	#include <atomic.h>	49	#include <atomic.h>
50	#include <syscall/copy.h>	50	#include <syscall/copy.h>
51	#include <errno.h>	51	#include <errno.h>
52	#include <string.h>	52	#include <string.h>
53		53
54	#define KLOG_PAGES 4	54	#define KLOG_PAGES 4
55	#define KLOG_LENGTH (KLOG_PAGES * PAGE_SIZE / sizeof(wchar_t))	55	#define KLOG_LENGTH (KLOG_PAGES * PAGE_SIZE / sizeof(wchar_t))
56	#define KLOG_LATENCY 8	56	#define KLOG_LATENCY 8
57		57
58	/** Kernel log cyclic buffer */	58	/** Kernel log cyclic buffer */
59	static wchar_t klog[KLOG_LENGTH] __attribute__ ((aligned (PAGE_SIZE)));	59	static wchar_t klog[KLOG_LENGTH] __attribute__ ((aligned (PAGE_SIZE)));
60		60
61	/** Kernel log initialized */	61	/** Kernel log initialized */
62	static bool klog_inited = false;	62	static bool klog_inited = false;
63	/** First kernel log characters */	63	/** First kernel log characters */
64	static index_t klog_start = 0;	64	static size_t klog_start = 0;
65	/** Number of valid kernel log characters */	65	/** Number of valid kernel log characters */
66	static size_t klog_len = 0;	66	static size_t klog_len = 0;
67	/** Number of stored (not printed) kernel log characters */	67	/** Number of stored (not printed) kernel log characters */
68	static size_t klog_stored = 0;	68	static size_t klog_stored = 0;
69	/** Number of stored kernel log characters for uspace */	69	/** Number of stored kernel log characters for uspace */
70	static size_t klog_uspace = 0;	70	static size_t klog_uspace = 0;
71		71
72	/** Kernel log spinlock */	72	/** Kernel log spinlock */
73	SPINLOCK_INITIALIZE(klog_lock);	73	SPINLOCK_INITIALIZE(klog_lock);
74		74
75	/** Physical memory area used for klog buffer */	75	/** Physical memory area used for klog buffer */
76	static parea_t klog_parea;	76	static parea_t klog_parea;
77		77
78	static indev_operations_t stdin_ops = {	78	static indev_operations_t stdin_ops = {
79	.poll = NULL	79	.poll = NULL
80	};	80	};
81		81
82	/** Silence output */	82	/** Silence output */
83	bool silent = false;	83	bool silent = false;
84		84
85	/** Standard input and output character devices */	85	/** Standard input and output character devices */
86	indev_t *stdin = NULL;	86	indev_t *stdin = NULL;
87	outdev_t *stdout = NULL;	87	outdev_t *stdout = NULL;
88		88
89	indev_t *stdin_wire(void)	89	indev_t *stdin_wire(void)
90	{	90	{
91	if (stdin == NULL) {	91	if (stdin == NULL) {
92	stdin = malloc(sizeof(indev_t), FRAME_ATOMIC);	92	stdin = malloc(sizeof(indev_t), FRAME_ATOMIC);
93	if (stdin != NULL)	93	if (stdin != NULL)
94	indev_initialize("stdin", stdin, &stdin_ops);	94	indev_initialize("stdin", stdin, &stdin_ops);
95	}	95	}
96		96
97	return stdin;	97	return stdin;
98	}	98	}
99		99
100	/** Initialize kernel logging facility	100	/** Initialize kernel logging facility
101	*	101	*
102	* The shared area contains kernel cyclic buffer. Userspace application may	102	* The shared area contains kernel cyclic buffer. Userspace application may
103	* be notified on new data with indication of position and size	103	* be notified on new data with indication of position and size
104	* of the data within the circular buffer.	104	* of the data within the circular buffer.
105	*	105	*
106	*/	106	*/
107	void klog_init(void)	107	void klog_init(void)
108	{	108	{
109	void faddr = (void ) KA2PA(klog);	109	void faddr = (void ) KA2PA(klog);
110		110
111	ASSERT((uintptr_t) faddr % FRAME_SIZE == 0);	111	ASSERT((uintptr_t) faddr % FRAME_SIZE == 0);
112		112
113	klog_parea.pbase = (uintptr_t) faddr;	113	klog_parea.pbase = (uintptr_t) faddr;
114	klog_parea.frames = SIZE2FRAMES(sizeof(klog));	114	klog_parea.frames = SIZE2FRAMES(sizeof(klog));
115	ddi_parea_register(&klog_parea);	115	ddi_parea_register(&klog_parea);
116		116
117	sysinfo_set_item_val("klog.faddr", NULL, (unative_t) faddr);	117	sysinfo_set_item_val("klog.faddr", NULL, (unative_t) faddr);
118	sysinfo_set_item_val("klog.pages", NULL, KLOG_PAGES);	118	sysinfo_set_item_val("klog.pages", NULL, KLOG_PAGES);
119		119
120	spinlock_lock(&klog_lock);	120	spinlock_lock(&klog_lock);
121	klog_inited = true;	121	klog_inited = true;
122	spinlock_unlock(&klog_lock);	122	spinlock_unlock(&klog_lock);
123	}	123	}
124		124
125	void grab_console(void)	125	void grab_console(void)
126	{	126	{
127	bool prev = silent;	127	bool prev = silent;
128		128
129	silent = false;	129	silent = false;
130	arch_grab_console();	130	arch_grab_console();
131		131
132	/* Force the console to print the prompt */	132	/* Force the console to print the prompt */
133	if ((stdin) && (prev))	133	if ((stdin) && (prev))
134	indev_push_character(stdin, '\n');	134	indev_push_character(stdin, '\n');
135	}	135	}
136		136
137	void release_console(void)	137	void release_console(void)
138	{	138	{
139	silent = true;	139	silent = true;
140	arch_release_console();	140	arch_release_console();
141	}	141	}
142		142
143	/** Tell kernel to get keyboard/console access again */	143	/** Tell kernel to get keyboard/console access again */
144	unative_t sys_debug_enable_console(void)	144	unative_t sys_debug_enable_console(void)
145	{	145	{
146	#ifdef CONFIG_KCONSOLE	146	#ifdef CONFIG_KCONSOLE
147	grab_console();	147	grab_console();
148	return true;	148	return true;
149	#else	149	#else
150	return false;	150	return false;
151	#endif	151	#endif
152	}	152	}
153		153
154	/** Tell kernel to relinquish keyboard/console access */	154	/** Tell kernel to relinquish keyboard/console access */
155	unative_t sys_debug_disable_console(void)	155	unative_t sys_debug_disable_console(void)
156	{	156	{
157	release_console();	157	release_console();
158	return true;	158	return true;
159	}	159	}
160		160
161	/** Get string from input character device.	161	/** Get string from input character device.
162	*	162	*
163	* Read characters from input character device until first occurrence	163	* Read characters from input character device until first occurrence
164	* of newline character.	164	* of newline character.
165	*	165	*
166	* @param indev Input character device.	166	* @param indev Input character device.
167	* @param buf Buffer where to store string terminated by NULL.	167	* @param buf Buffer where to store string terminated by NULL.
168	* @param buflen Size of the buffer.	168	* @param buflen Size of the buffer.
169	*	169	*
170	* @return Number of characters read.	170	* @return Number of characters read.
171	*	171	*
172	*/	172	*/
173	count_t gets(indev_t indev, char buf, size_t buflen)	173	size_t gets(indev_t indev, char buf, size_t buflen)
174	{	174	{
175	size_t offset = 0;	175	size_t offset = 0;
176	count_t count = 0;	176	size_t count = 0;
177	buf[offset] = 0;	177	buf[offset] = 0;
178		178
179	wchar_t ch;	179	wchar_t ch;
180	while ((ch = indev_pop_character(indev)) != '\n') {	180	while ((ch = indev_pop_character(indev)) != '\n') {
181	if (ch == '\b') {	181	if (ch == '\b') {
182	if (count > 0) {	182	if (count > 0) {
183	/* Space, backspace, space */	183	/* Space, backspace, space */
184	putchar('\b');	184	putchar('\b');
185	putchar(' ');	185	putchar(' ');
186	putchar('\b');	186	putchar('\b');
187		187
188	count--;	188	count--;
189	offset = str_lsize(buf, count);	189	offset = str_lsize(buf, count);
190	buf[offset] = 0;	190	buf[offset] = 0;
191	}	191	}
192	}	192	}
193	if (chr_encode(ch, buf, &offset, buflen - 1) == EOK) {	193	if (chr_encode(ch, buf, &offset, buflen - 1) == EOK) {
194	putchar(ch);	194	putchar(ch);
195	count++;	195	count++;
196	buf[offset] = 0;	196	buf[offset] = 0;
197	}	197	}
198	}	198	}
199		199
200	return count;	200	return count;
201	}	201	}
202		202
203	/** Get character from input device & echo it to screen */	203	/** Get character from input device & echo it to screen */
204	wchar_t getc(indev_t *indev)	204	wchar_t getc(indev_t *indev)
205	{	205	{
206	wchar_t ch = indev_pop_character(indev);	206	wchar_t ch = indev_pop_character(indev);
207	putchar(ch);	207	putchar(ch);
208	return ch;	208	return ch;
209	}	209	}
210		210
211	void klog_update(void)	211	void klog_update(void)
212	{	212	{
213	spinlock_lock(&klog_lock);	213	spinlock_lock(&klog_lock);
214		214
215	if ((klog_inited) && (event_is_subscribed(EVENT_KLOG)) && (klog_uspace > 0)) {	215	if ((klog_inited) && (event_is_subscribed(EVENT_KLOG)) && (klog_uspace > 0)) {
216	event_notify_3(EVENT_KLOG, klog_start, klog_len, klog_uspace);	216	event_notify_3(EVENT_KLOG, klog_start, klog_len, klog_uspace);
217	klog_uspace = 0;	217	klog_uspace = 0;
218	}	218	}
219		219
220	spinlock_unlock(&klog_lock);	220	spinlock_unlock(&klog_lock);
221	}	221	}
222		222
223	void putchar(const wchar_t ch)	223	void putchar(const wchar_t ch)
224	{	224	{
225	spinlock_lock(&klog_lock);	225	spinlock_lock(&klog_lock);
226		226
227	if ((klog_stored > 0) && (stdout) && (stdout->op->write)) {	227	if ((klog_stored > 0) && (stdout) && (stdout->op->write)) {
228	/* Print charaters stored in kernel log */	228	/* Print charaters stored in kernel log */
229	index_t i;	229	size_t i;
230	for (i = klog_len - klog_stored; i < klog_len; i++)	230	for (i = klog_len - klog_stored; i < klog_len; i++)
231	stdout->op->write(stdout, klog[(klog_start + i) % KLOG_LENGTH], silent);	231	stdout->op->write(stdout, klog[(klog_start + i) % KLOG_LENGTH], silent);
232	klog_stored = 0;	232	klog_stored = 0;
233	}	233	}
234		234
235	/* Store character in the cyclic kernel log */	235	/* Store character in the cyclic kernel log */
236	klog[(klog_start + klog_len) % KLOG_LENGTH] = ch;	236	klog[(klog_start + klog_len) % KLOG_LENGTH] = ch;
237	if (klog_len < KLOG_LENGTH)	237	if (klog_len < KLOG_LENGTH)
238	klog_len++;	238	klog_len++;
239	else	239	else
240	klog_start = (klog_start + 1) % KLOG_LENGTH;	240	klog_start = (klog_start + 1) % KLOG_LENGTH;
241		241
242	if ((stdout) && (stdout->op->write))	242	if ((stdout) && (stdout->op->write))
243	stdout->op->write(stdout, ch, silent);	243	stdout->op->write(stdout, ch, silent);
244	else {	244	else {
245	/* The character is just in the kernel log */	245	/* The character is just in the kernel log */
246	if (klog_stored < klog_len)	246	if (klog_stored < klog_len)
247	klog_stored++;	247	klog_stored++;
248	}	248	}
249		249
250	/* The character is stored for uspace */	250	/* The character is stored for uspace */
251	if (klog_uspace < klog_len)	251	if (klog_uspace < klog_len)
252	klog_uspace++;	252	klog_uspace++;
253		253
254	/* Check notify uspace to update */	254	/* Check notify uspace to update */
255	bool update;	255	bool update;
256	if ((klog_uspace > KLOG_LATENCY) \|\| (ch == '\n'))	256	if ((klog_uspace > KLOG_LATENCY) \|\| (ch == '\n'))
257	update = true;	257	update = true;
258	else	258	else
259	update = false;	259	update = false;
260		260
261	spinlock_unlock(&klog_lock);	261	spinlock_unlock(&klog_lock);
262		262
263	if (update)	263	if (update)
264	klog_update();	264	klog_update();
265	}	265	}
266		266
267	/** Print using kernel facility	267	/** Print using kernel facility
268	*	268	*
269	* Print to kernel log.	269	* Print to kernel log.
270	*	270	*
271	*/	271	*/
272	unative_t sys_klog(int fd, const void *buf, size_t size)	272	unative_t sys_klog(int fd, const void *buf, size_t size)
273	{	273	{
274	char *data;	274	char *data;
275	int rc;	275	int rc;
276		276
277	if (size > PAGE_SIZE)	277	if (size > PAGE_SIZE)
278	return ELIMIT;	278	return ELIMIT;
279		279
280	if (size > 0) {	280	if (size > 0) {
281	data = (char *) malloc(size + 1, 0);	281	data = (char *) malloc(size + 1, 0);
282	if (!data)	282	if (!data)
283	return ENOMEM;	283	return ENOMEM;
284		284
285	rc = copy_from_uspace(data, buf, size);	285	rc = copy_from_uspace(data, buf, size);
286	if (rc) {	286	if (rc) {
287	free(data);	287	free(data);
288	return rc;	288	return rc;
289	}	289	}
290	data[size] = 0;	290	data[size] = 0;
291		291
292	printf("%s", data);	292	printf("%s", data);
293	free(data);	293	free(data);
294	} else	294	} else
295	klog_update();	295	klog_update();
296		296
297	return size;	297	return size;
298	}	298	}
299		299
300	/** @}	300	/** @}
301	*/	301	*/
302		302

Subversion Repositories HelenOS

(root)/branches/tracing/kernel/generic/src/console/console.c – Rev 4377 → 4692