Rev 1963 | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1963 | Rev 1968 | ||
---|---|---|---|
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 | #include <console/console.h> |
30 | #include <console/console.h> |
31 | #include <console/chardev.h> |
31 | #include <console/chardev.h> |
32 | #include <synch/waitq.h> |
32 | #include <synch/waitq.h> |
33 | #include <synch/spinlock.h> |
33 | #include <synch/spinlock.h> |
34 | #include <arch/types.h> |
34 | #include <arch/types.h> |
35 | #include <typedefs.h> |
35 | #include <typedefs.h> |
36 | #include <arch.h> |
36 | #include <arch.h> |
37 | #include <func.h> |
37 | #include <func.h> |
38 | #include <print.h> |
38 | #include <print.h> |
39 | #include <atomic.h> |
39 | #include <atomic.h> |
40 | 40 | ||
41 | #define BUFLEN 2048 |
41 | #define BUFLEN 2048 |
42 | static char debug_buffer[BUFLEN]; |
42 | static char debug_buffer[BUFLEN]; |
43 | static size_t offset = 0; |
43 | static size_t offset = 0; |
44 | /** Initialize stdout to something that does not print, but does not fail |
44 | /** Initialize stdout to something that does not print, but does not fail |
45 | * |
45 | * |
46 | * Save data in some buffer so that it could be retrieved in the debugger |
46 | * Save data in some buffer so that it could be retrieved in the debugger |
47 | */ |
47 | */ |
48 | static void null_putchar(chardev_t *d, const char ch) |
48 | static void null_putchar(chardev_t *d, const char ch) |
49 | { |
49 | { |
50 | if (offset >= BUFLEN) |
50 | if (offset >= BUFLEN) |
51 | offset = 0; |
51 | offset = 0; |
52 | debug_buffer[offset++] = ch; |
52 | debug_buffer[offset++] = ch; |
53 | } |
53 | } |
54 | 54 | ||
55 | static chardev_operations_t null_stdout_ops = { |
55 | static chardev_operations_t null_stdout_ops = { |
56 | .write = null_putchar |
56 | .write = null_putchar |
57 | }; |
57 | }; |
58 | chardev_t null_stdout = { |
58 | chardev_t null_stdout = { |
59 | .name = "null", |
59 | .name = "null", |
60 | .op = &null_stdout_ops |
60 | .op = &null_stdout_ops |
61 | }; |
61 | }; |
62 | 62 | ||
63 | /** Standard input character device. */ |
63 | /** Standard input character device. */ |
64 | chardev_t *stdin = NULL; |
64 | chardev_t *stdin = NULL; |
65 | chardev_t *stdout = &null_stdout; |
65 | chardev_t *stdout = &null_stdout; |
66 | 66 | ||
67 | /** Get character from character device. Do not echo character. |
67 | /** Get character from character device. Do not echo character. |
68 | * |
68 | * |
69 | * @param chardev Character device. |
69 | * @param chardev Character device. |
70 | * |
70 | * |
71 | * @return Character read. |
71 | * @return Character read. |
72 | */ |
72 | */ |
73 | __u8 _getc(chardev_t *chardev) |
73 | __u8 _getc(chardev_t *chardev) |
74 | { |
74 | { |
75 | __u8 ch; |
75 | __u8 ch; |
76 | ipl_t ipl; |
76 | ipl_t ipl; |
77 | 77 | ||
78 | if (atomic_get(&haltstate)) { |
78 | if (atomic_get(&haltstate)) { |
79 | /* If we are here, we are hopefully on the processor, that |
79 | /* If we are here, we are hopefully on the processor, that |
80 | * issued the 'halt' command, so proceed to read the character |
80 | * issued the 'halt' command, so proceed to read the character |
81 | * directly from input |
81 | * directly from input |
82 | */ |
82 | */ |
83 | if (chardev->op->read) |
83 | if (chardev->op->read) |
84 | return chardev->op->read(chardev); |
84 | return chardev->op->read(chardev); |
85 | /* no other way of interacting with user, halt */ |
85 | /* no other way of interacting with user, halt */ |
86 | if (CPU) |
86 | if (CPU) |
87 | printf("cpu%d: ", CPU->id); |
87 | printf("cpu%d: ", CPU->id); |
88 | else |
88 | else |
89 | printf("cpu: "); |
89 | printf("cpu: "); |
90 | printf("halted - no kconsole\n"); |
90 | printf("halted - no kconsole\n"); |
91 | cpu_halt(); |
91 | cpu_halt(); |
92 | } |
92 | } |
93 | 93 | ||
94 | waitq_sleep(&chardev->wq); |
94 | waitq_sleep(&chardev->wq); |
95 | ipl = interrupts_disable(); |
95 | ipl = interrupts_disable(); |
96 | spinlock_lock(&chardev->lock); |
96 | spinlock_lock(&chardev->lock); |
97 | ch = chardev->buffer[(chardev->index - chardev->counter) % CHARDEV_BUFLEN]; |
97 | ch = chardev->buffer[(chardev->index - chardev->counter) % CHARDEV_BUFLEN]; |
98 | chardev->counter--; |
98 | chardev->counter--; |
99 | spinlock_unlock(&chardev->lock); |
99 | spinlock_unlock(&chardev->lock); |
100 | interrupts_restore(ipl); |
100 | interrupts_restore(ipl); |
101 | 101 | ||
102 | chardev->op->resume(chardev); |
102 | chardev->op->resume(chardev); |
103 | 103 | ||
104 | return ch; |
104 | return ch; |
105 | } |
105 | } |
106 | 106 | ||
107 | /** Get string from character device. |
107 | /** Get string from character device. |
108 | * |
108 | * |
109 | * Read characters from character device until first occurrence |
109 | * Read characters from character device until first occurrence |
110 | * of newline character. |
110 | * of newline character. |
111 | * |
111 | * |
112 | * @param chardev Character device. |
112 | * @param chardev Character device. |
113 | * @param buf Buffer where to store string terminated by '\0'. |
113 | * @param buf Buffer where to store string terminated by '\0'. |
114 | * @param len Size of the buffer. |
114 | * @param len Size of the buffer. |
115 | * |
115 | * |
116 | * @return Number of characters read. |
116 | * @return Number of characters read. |
117 | */ |
117 | */ |
118 | count_t gets(chardev_t *chardev, char *buf, size_t buflen) |
118 | count_t gets(chardev_t *chardev, char *buf, size_t buflen) |
119 | { |
119 | { |
120 | index_t index = 0; |
120 | index_t index = 0; |
121 | char ch; |
121 | char ch; |
122 | 122 | ||
123 | while (index < buflen) { |
123 | while (index < buflen) { |
124 | ch = _getc(chardev); |
124 | ch = _getc(chardev); |
125 | if (ch == '\b') { |
125 | if (ch == '\b') { |
126 | if (index > 0) { |
126 | if (index > 0) { |
127 | index--; |
127 | index--; |
128 | /* Space backspace, space */ |
128 | /* Space backspace, space */ |
129 | putchar('\b'); |
129 | putchar('\b'); |
130 | putchar(' '); |
130 | putchar(' '); |
131 | putchar('\b'); |
131 | putchar('\b'); |
132 | } |
132 | } |
133 | continue; |
133 | continue; |
134 | } |
134 | } |
135 | putchar(ch); |
135 | putchar(ch); |
136 | 136 | ||
137 | if (ch == '\n') { /* end of string => write 0, return */ |
137 | if (ch == '\n') { /* end of string => write 0, return */ |
138 | buf[index] = '\0'; |
138 | buf[index] = '\0'; |
139 | return (count_t) index; |
139 | return (count_t) index; |
140 | } |
140 | } |
141 | buf[index++] = ch; |
141 | buf[index++] = ch; |
142 | } |
142 | } |
143 | return (count_t) index; |
143 | return (count_t) index; |
144 | } |
144 | } |
145 | 145 | ||
146 | /** Get character from device & echo it to screen */ |
146 | /** Get character from device & echo it to screen */ |
147 | __u8 getc(chardev_t *chardev) |
147 | __u8 getc(chardev_t *chardev) |
148 | { |
148 | { |
149 | __u8 ch; |
149 | __u8 ch; |
150 | 150 | ||
151 | ch = _getc(chardev); |
151 | ch = _getc(chardev); |
152 | putchar(ch); |
152 | putchar(ch); |
153 | return ch; |
153 | return ch; |
154 | } |
154 | } |
155 | 155 | ||
156 | void putchar(char c) |
156 | void putchar(char c) |
157 | { |
157 | { |
158 | if (stdout->op->write) |
158 | if (stdout->op->write) |
159 | stdout->op->write(stdout, c); |
159 | stdout->op->write(stdout, c); |
160 | } |
160 | } |
161 | 161 |