Rev 3386 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3386 | Rev 4153 | ||
---|---|---|---|
Line 33... | Line 33... | ||
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <arch/ski/ski.h> |
35 | #include <arch/ski/ski.h> |
36 | #include <console/console.h> |
36 | #include <console/console.h> |
37 | #include <console/chardev.h> |
37 | #include <console/chardev.h> |
38 | #include <arch/interrupt.h> |
- | |
39 | #include <sysinfo/sysinfo.h> |
38 | #include <sysinfo/sysinfo.h> |
40 | #include <arch/types.h> |
39 | #include <arch/types.h> |
41 | #include <ddi/device.h> |
- | |
42 | #include <ddi/irq.h> |
- | |
43 | #include <ipc/irq.h> |
- | |
44 | #include <proc/thread.h> |
40 | #include <proc/thread.h> |
45 | #include <synch/spinlock.h> |
41 | #include <synch/spinlock.h> |
46 | #include <arch/asm.h> |
42 | #include <arch/asm.h> |
- | 43 | #include <arch/drivers/kbd.h> |
|
- | 44 | #include <arch.h> |
|
47 | 45 | ||
48 | #define SKI_KBD_INR 0 |
- | |
49 | - | ||
50 | static irq_t ski_kbd_irq; |
46 | static indev_t skiin; /**< Ski input device. */ |
51 | static devno_t ski_kbd_devno; |
47 | static outdev_t skiout; /**< Ski output device. */ |
52 | - | ||
53 | chardev_t ski_console; |
- | |
54 | chardev_t ski_uconsole; |
- | |
55 | 48 | ||
56 | static bool kbd_disabled; |
49 | static bool kbd_disabled; |
57 | 50 | ||
58 | static void ski_putchar(chardev_t *d, const char ch); |
- | |
59 | static int32_t ski_getchar(void); |
- | |
60 | - | ||
61 | /** Display character on debug console |
51 | /** Display character on debug console |
62 | * |
52 | * |
63 | * Use SSC (Simulator System Call) to |
53 | * Use SSC (Simulator System Call) to |
64 | * display character on debug console. |
54 | * display character on debug console. |
65 | * |
55 | * |
66 | * @param d Character device. |
56 | * @param d Character device. |
67 | * @param ch Character to be printed. |
57 | * @param ch Character to be printed. |
68 | */ |
58 | */ |
69 | void ski_putchar(chardev_t *d, const char ch) |
59 | static void ski_putchar(outdev_t *d, const char ch, bool silent) |
70 | { |
60 | { |
- | 61 | if (!silent) { |
|
71 | asm volatile ( |
62 | asm volatile ( |
72 | "mov r15 = %0\n" |
63 | "mov r15 = %0\n" |
73 | "mov r32 = %1\n" /* r32 is in0 */ |
64 | "mov r32 = %1\n" /* r32 is in0 */ |
74 | "break 0x80000\n" /* modifies r8 */ |
65 | "break 0x80000\n" /* modifies r8 */ |
75 | : |
66 | : |
76 | : "i" (SKI_PUTCHAR), "r" (ch) |
67 | : "i" (SKI_PUTCHAR), "r" (ch) |
77 | : "r15", "in0", "r8" |
68 | : "r15", "in0", "r8" |
78 | ); |
69 | ); |
79 | 70 | ||
80 | if (ch == '\n') |
71 | if (ch == '\n') |
81 | ski_putchar(d, '\r'); |
72 | ski_putchar(d, '\r', false); |
- | 73 | } |
|
82 | } |
74 | } |
83 | 75 | ||
- | 76 | static indev_operations_t skiin_ops = { |
|
- | 77 | .poll = NULL |
|
- | 78 | }; |
|
- | 79 | ||
- | 80 | static outdev_operations_t skiout_ops = { |
|
- | 81 | .write = ski_putchar |
|
- | 82 | }; |
|
- | 83 | ||
84 | /** Ask debug console if a key was pressed. |
84 | /** Ask debug console if a key was pressed. |
85 | * |
85 | * |
86 | * Use SSC (Simulator System Call) to |
86 | * Use SSC (Simulator System Call) to |
87 | * get character from debug console. |
87 | * get character from debug console. |
88 | * |
88 | * |
89 | * This call is non-blocking. |
89 | * This call is non-blocking. |
90 | * |
90 | * |
91 | * @return ASCII code of pressed key or 0 if no key pressed. |
91 | * @return ASCII code of pressed key or 0 if no key pressed. |
92 | */ |
92 | */ |
93 | int32_t ski_getchar(void) |
93 | static int32_t ski_getchar(void) |
94 | { |
94 | { |
95 | uint64_t ch; |
95 | uint64_t ch; |
96 | 96 | ||
97 | asm volatile ( |
97 | asm volatile ( |
98 | "mov r15 = %1\n" |
98 | "mov r15 = %1\n" |
Line 105... | Line 105... | ||
105 | ); |
105 | ); |
106 | 106 | ||
107 | return (int32_t) ch; |
107 | return (int32_t) ch; |
108 | } |
108 | } |
109 | 109 | ||
110 | /** |
- | |
111 | * This is a blocking wrapper for ski_getchar(). |
- | |
112 | * To be used when the kernel crashes. |
- | |
113 | */ |
- | |
114 | static char ski_getchar_blocking(chardev_t *d) |
- | |
115 | { |
- | |
116 | int ch; |
- | |
117 | - | ||
118 | while(!(ch = ski_getchar())) |
- | |
119 | ; |
- | |
120 | if(ch == '\r') |
- | |
121 | ch = '\n'; |
- | |
122 | return (char) ch; |
- | |
123 | } |
- | |
124 | - | ||
125 | /** Ask keyboard if a key was pressed. */ |
110 | /** Ask keyboard if a key was pressed. */ |
126 | static void poll_keyboard(void) |
111 | static void poll_keyboard(void) |
127 | { |
112 | { |
128 | char ch; |
113 | char ch; |
129 | static char last; |
- | |
130 | ipl_t ipl; |
- | |
131 | - | ||
132 | ipl = interrupts_disable(); |
- | |
133 | 114 | ||
134 | if (kbd_disabled) { |
115 | if (kbd_disabled) |
135 | interrupts_restore(ipl); |
- | |
136 | return; |
116 | return; |
137 | } |
- | |
138 | - | ||
139 | spinlock_lock(&ski_kbd_irq.lock); |
- | |
140 | - | ||
141 | ch = ski_getchar(); |
117 | ch = ski_getchar(); |
142 | if(ch == '\r') |
118 | if(ch == '\r') |
143 | ch = '\n'; |
119 | ch = '\n'; |
144 | if (ch) { |
120 | if (ch) { |
145 | if (ski_kbd_irq.notif_cfg.notify && ski_kbd_irq.notif_cfg.answerbox) { |
- | |
146 | chardev_push_character(&ski_uconsole, ch); |
- | |
147 | ipc_irq_send_notif(&ski_kbd_irq); |
- | |
148 | } else { |
- | |
149 | chardev_push_character(&ski_console, ch); |
121 | indev_push_character(&skiin, ch); |
150 | } |
- | |
151 | last = ch; |
- | |
152 | spinlock_unlock(&ski_kbd_irq.lock); |
- | |
153 | interrupts_restore(ipl); |
- | |
154 | return; |
122 | return; |
155 | } |
123 | } |
156 | - | ||
157 | if (last) { |
- | |
158 | if (ski_kbd_irq.notif_cfg.notify && ski_kbd_irq.notif_cfg.answerbox) { |
- | |
159 | chardev_push_character(&ski_uconsole, 0); |
- | |
160 | ipc_irq_send_notif(&ski_kbd_irq); |
- | |
161 | } |
- | |
162 | last = 0; |
- | |
163 | } |
- | |
164 | - | ||
165 | spinlock_unlock(&ski_kbd_irq.lock); |
- | |
166 | interrupts_restore(ipl); |
- | |
167 | } |
124 | } |
168 | 125 | ||
169 | /* Called from getc(). */ |
- | |
170 | static void ski_kbd_enable(chardev_t *d) |
126 | #define POLL_INTERVAL 10000 /* 10 ms */ |
171 | { |
- | |
172 | kbd_disabled = false; |
- | |
173 | } |
- | |
174 | 127 | ||
175 | /* Called from getc(). */ |
128 | /** Kernel thread for polling keyboard. */ |
176 | static void ski_kbd_disable(chardev_t *d) |
129 | static void kkbdpoll(void *arg) |
177 | { |
- | |
178 | kbd_disabled = true; |
- | |
179 | } |
- | |
180 | - | ||
181 | /** Decline to service hardware IRQ. |
- | |
182 | * |
- | |
183 | * This is only a virtual IRQ, so always decline. |
- | |
184 | * |
- | |
185 | * @return Always IRQ_DECLINE. |
- | |
186 | */ |
- | |
187 | static irq_ownership_t ski_kbd_claim(void) |
- | |
188 | { |
130 | { |
- | 131 | while (1) { |
|
- | 132 | if (!silent) { |
|
- | 133 | poll_keyboard(); |
|
- | 134 | } |
|
189 | return IRQ_DECLINE; |
135 | thread_usleep(POLL_INTERVAL); |
- | 136 | } |
|
190 | } |
137 | } |
191 | 138 | ||
192 | static chardev_operations_t ski_ops = { |
- | |
193 | .resume = ski_kbd_enable, |
- | |
194 | .suspend = ski_kbd_disable, |
- | |
195 | .write = ski_putchar, |
- | |
196 | .read = ski_getchar_blocking |
- | |
197 | }; |
- | |
198 | - | ||
199 | /** Initialize debug console |
139 | /** Initialize debug console |
200 | * |
140 | * |
201 | * Issue SSC (Simulator System Call) to |
141 | * Issue SSC (Simulator System Call) to |
202 | * to open debug console. |
142 | * to open debug console. |
203 | */ |
143 | */ |
204 | void ski_init_console(void) |
144 | static void ski_init(void) |
205 | { |
145 | { |
- | 146 | static bool initialized; |
|
- | 147 | ||
- | 148 | if (initialized) |
|
- | 149 | return; |
|
- | 150 | ||
206 | asm volatile ( |
151 | asm volatile ( |
207 | "mov r15 = %0\n" |
152 | "mov r15 = %0\n" |
208 | "break 0x80000\n" |
153 | "break 0x80000\n" |
209 | : |
154 | : |
210 | : "i" (SKI_INIT_CONSOLE) |
155 | : "i" (SKI_INIT_CONSOLE) |
211 | : "r15", "r8" |
156 | : "r15", "r8" |
212 | ); |
157 | ); |
- | 158 | ||
- | 159 | initialized = true; |
|
- | 160 | } |
|
213 | 161 | ||
214 | chardev_initialize("ski_console", &ski_console, &ski_ops); |
- | |
215 | chardev_initialize("ski_uconsole", &ski_uconsole, &ski_ops); |
- | |
216 | stdin = &ski_console; |
162 | indev_t *skiin_init(void) |
- | 163 | { |
|
217 | stdout = &ski_console; |
164 | ski_init(); |
218 | 165 | ||
219 | ski_kbd_devno = device_assign_devno(); |
166 | indev_initialize("skiin", &skiin, &skiin_ops); |
220 | - | ||
221 | irq_initialize(&ski_kbd_irq); |
167 | thread_t *t = thread_create(kkbdpoll, NULL, TASK, 0, "kkbdpoll", true); |
222 | ski_kbd_irq.inr = SKI_KBD_INR; |
168 | if (t) |
223 | ski_kbd_irq.devno = ski_kbd_devno; |
169 | thread_ready(t); |
224 | ski_kbd_irq.claim = ski_kbd_claim; |
170 | else |
225 | irq_register(&ski_kbd_irq); |
171 | return NULL; |
226 | 172 | ||
227 | sysinfo_set_item_val("kbd", NULL, true); |
173 | sysinfo_set_item_val("kbd", NULL, true); |
228 | sysinfo_set_item_val("kbd.inr", NULL, SKI_KBD_INR); |
174 | sysinfo_set_item_val("kbd.type", NULL, KBD_SKI); |
- | 175 | ||
229 | sysinfo_set_item_val("kbd.devno", NULL, ski_kbd_devno); |
176 | return &skiin; |
230 | } |
177 | } |
231 | 178 | ||
- | 179 | ||
232 | void ski_kbd_grab(void) |
180 | void skiout_init(void) |
233 | { |
181 | { |
234 | ipl_t ipl = interrupts_disable(); |
182 | ski_init(); |
- | 183 | ||
235 | spinlock_lock(&ski_kbd_irq.lock); |
184 | outdev_initialize("skiout", &skiout, &skiout_ops); |
236 | ski_kbd_irq.notif_cfg.notify = false; |
185 | stdout = &skiout; |
- | 186 | ||
237 | spinlock_unlock(&ski_kbd_irq.lock); |
187 | sysinfo_set_item_val("fb", NULL, false); |
238 | interrupts_restore(ipl); |
- | |
239 | } |
188 | } |
240 | 189 | ||
241 | void ski_kbd_release(void) |
190 | void ski_kbd_grab(void) |
242 | { |
191 | { |
243 | ipl_t ipl = interrupts_disable(); |
- | |
244 | spinlock_lock(&ski_kbd_irq.lock); |
- | |
245 | if (ski_kbd_irq.notif_cfg.answerbox) |
- | |
246 | ski_kbd_irq.notif_cfg.notify = true; |
192 | kbd_disabled = true; |
247 | spinlock_unlock(&ski_kbd_irq.lock); |
- | |
248 | interrupts_restore(ipl); |
- | |
249 | } |
193 | } |
250 | 194 | ||
251 | - | ||
252 | #define POLL_INTERVAL 50000 /* 50 ms */ |
- | |
253 | - | ||
254 | /** Kernel thread for polling keyboard. */ |
- | |
255 | void kkbdpoll(void *arg) |
195 | void ski_kbd_release(void) |
256 | { |
196 | { |
257 | while (1) { |
- | |
258 | poll_keyboard(); |
197 | kbd_disabled = false; |
259 | thread_usleep(POLL_INTERVAL); |
- | |
260 | } |
- | |
261 | } |
198 | } |
262 | 199 | ||
263 | /** @} |
200 | /** @} |
264 | */ |
201 | */ |