Rev 892 | Rev 1507 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 892 | Rev 893 | ||
---|---|---|---|
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 | #include <arch/ski/ski.h> |
29 | #include <arch/ski/ski.h> |
30 | #include <console/console.h> |
30 | #include <console/console.h> |
31 | #include <console/chardev.h> |
31 | #include <console/chardev.h> |
32 | 32 | ||
33 | static chardev_t ski_console; |
33 | static chardev_t ski_console; |
34 | static bool kb_disable; |
34 | static bool kb_disable; |
35 | 35 | ||
36 | static void ski_putchar(chardev_t *d, const char ch); |
36 | static void ski_putchar(chardev_t *d, const char ch); |
37 | static __s32 ski_getchar(void); |
37 | static __s32 ski_getchar(void); |
38 | 38 | ||
39 | /** Display character on debug console |
39 | /** Display character on debug console |
40 | * |
40 | * |
41 | * Use SSC (Simulator System Call) to |
41 | * Use SSC (Simulator System Call) to |
42 | * display character on debug console. |
42 | * display character on debug console. |
43 | * |
43 | * |
44 | * @param d Character device. |
44 | * @param d Character device. |
45 | * @param ch Character to be printed. |
45 | * @param ch Character to be printed. |
46 | */ |
46 | */ |
47 | void ski_putchar(chardev_t *d, const char ch) |
47 | void ski_putchar(chardev_t *d, const char ch) |
48 | { |
48 | { |
49 | __asm__ volatile ( |
49 | __asm__ volatile ( |
50 | "mov r15=%0\n" |
50 | "mov r15=%0\n" |
51 | "mov r32=%1\n" /* r32 is in0 */ |
51 | "mov r32=%1\n" /* r32 is in0 */ |
52 | "break 0x80000\n" /* modifies r8 */ |
52 | "break 0x80000\n" /* modifies r8 */ |
53 | : |
53 | : |
54 | : "i" (SKI_PUTCHAR), "r" (ch) |
54 | : "i" (SKI_PUTCHAR), "r" (ch) |
55 | : "r15", "in0", "r8" |
55 | : "r15", "in0", "r8" |
56 | ); |
56 | ); |
57 | 57 | ||
58 | if (ch == '\n') |
58 | if (ch == '\n') |
59 | ski_putchar(d, '\r'); |
59 | ski_putchar(d, '\r'); |
60 | } |
60 | } |
61 | 61 | ||
62 | /** Ask debug console if a key was pressed. |
62 | /** Ask debug console if a key was pressed. |
63 | * |
63 | * |
64 | * Use SSC (Simulator System Call) to |
64 | * Use SSC (Simulator System Call) to |
65 | * get character from debug console. |
65 | * get character from debug console. |
66 | * |
66 | * |
67 | * This call is non-blocking. |
67 | * This call is non-blocking. |
68 | * |
68 | * |
69 | * @return ASCII code of pressed key or 0 if no key pressed. |
69 | * @return ASCII code of pressed key or 0 if no key pressed. |
70 | */ |
70 | */ |
71 | __s32 ski_getchar(void) |
71 | __s32 ski_getchar(void) |
72 | { |
72 | { |
73 | __u64 ch; |
73 | __u64 ch; |
74 | 74 | ||
75 | __asm__ volatile ( |
75 | __asm__ volatile ( |
76 | "mov r15=%1\n" |
76 | "mov r15=%1\n" |
77 | "break 0x80000;;\n" /* modifies r8 */ |
77 | "break 0x80000;;\n" /* modifies r8 */ |
78 | "mov %0=r8;;\n" |
78 | "mov %0=r8;;\n" |
79 | 79 | ||
80 | : "=r" (ch) |
80 | : "=r" (ch) |
81 | : "i" (SKI_GETCHAR) |
81 | : "i" (SKI_GETCHAR) |
82 | : "r15", "r8" |
82 | : "r15", "r8" |
83 | ); |
83 | ); |
84 | 84 | ||
85 | return (__s32) ch; |
85 | return (__s32) ch; |
86 | } |
86 | } |
87 | 87 | ||
88 | /** |
88 | /** |
89 | This is blocking wrap function of ski_getchar |
89 | * This is a blocking wrapper for ski_getchar(). |
90 | It active waits ... for using with non-stable kernel |
90 | * To be used when the kernel crashes. |
91 | */ |
91 | */ |
92 | static char ski_getchar_blocking(chardev_t *d) |
92 | static char ski_getchar_blocking(chardev_t *d) |
93 | { |
93 | { |
94 | volatile int ch; |
94 | int ch; |
- | 95 | ||
95 | while(!(ch=ski_getchar())); |
96 | while(!(ch=ski_getchar())) |
- | 97 | ; |
|
96 | if(ch == '\r') ch = '\n'; |
98 | if(ch == '\r') |
- | 99 | ch = '\n'; |
|
97 | return (char) ch; |
100 | return (char) ch; |
98 | } |
101 | } |
99 | 102 | ||
100 | - | ||
101 | /** Ask keyboard if a key was pressed. */ |
103 | /** Ask keyboard if a key was pressed. */ |
102 | void poll_keyboard(void) |
104 | void poll_keyboard(void) |
103 | { |
105 | { |
104 | char ch; |
106 | char ch; |
105 | 107 | ||
106 | if (kb_disable) |
108 | if (kb_disable) |
107 | return; |
109 | return; |
108 | 110 | ||
109 | ch = ski_getchar(); |
111 | ch = ski_getchar(); |
110 | if(ch == '\r') |
112 | if(ch == '\r') |
111 | ch = '\n'; |
113 | ch = '\n'; |
112 | if (ch) |
114 | if (ch) |
113 | chardev_push_character(&ski_console, ch); |
115 | chardev_push_character(&ski_console, ch); |
114 | } |
116 | } |
115 | 117 | ||
116 | /* Called from getc(). */ |
118 | /* Called from getc(). */ |
117 | static void ski_kb_enable(chardev_t *d) |
119 | static void ski_kb_enable(chardev_t *d) |
118 | { |
120 | { |
119 | kb_disable = false; |
121 | kb_disable = false; |
120 | } |
122 | } |
121 | 123 | ||
122 | /* Called from getc(). */ |
124 | /* Called from getc(). */ |
123 | static void ski_kb_disable(chardev_t *d) |
125 | static void ski_kb_disable(chardev_t *d) |
124 | { |
126 | { |
125 | kb_disable = true; |
127 | kb_disable = true; |
126 | } |
128 | } |
127 | 129 | ||
128 | 130 | ||
129 | static chardev_operations_t ski_ops = { |
131 | static chardev_operations_t ski_ops = { |
130 | .resume = ski_kb_enable, |
132 | .resume = ski_kb_enable, |
131 | .suspend = ski_kb_disable, |
133 | .suspend = ski_kb_disable, |
132 | .write = ski_putchar, |
134 | .write = ski_putchar, |
133 | .read = ski_getchar_blocking |
135 | .read = ski_getchar_blocking |
134 | }; |
136 | }; |
135 | 137 | ||
136 | 138 | ||
137 | /** Initialize debug console |
139 | /** Initialize debug console |
138 | * |
140 | * |
139 | * Issue SSC (Simulator System Call) to |
141 | * Issue SSC (Simulator System Call) to |
140 | * to open debug console. |
142 | * to open debug console. |
141 | */ |
143 | */ |
142 | void ski_init_console(void) |
144 | void ski_init_console(void) |
143 | { |
145 | { |
144 | __asm__ volatile ( |
146 | __asm__ volatile ( |
145 | "mov r15=%0\n" |
147 | "mov r15=%0\n" |
146 | "break 0x80000\n" |
148 | "break 0x80000\n" |
147 | : |
149 | : |
148 | : "i" (SKI_INIT_CONSOLE) |
150 | : "i" (SKI_INIT_CONSOLE) |
149 | : "r15", "r8" |
151 | : "r15", "r8" |
150 | ); |
152 | ); |
151 | 153 | ||
152 | chardev_initialize("ski_console", &ski_console, &ski_ops); |
154 | chardev_initialize("ski_console", &ski_console, &ski_ops); |
153 | stdin = &ski_console; |
155 | stdin = &ski_console; |
154 | stdout = &ski_console; |
156 | stdout = &ski_console; |
155 | } |
157 | } |
156 | 158 |