Rev 4343 | Rev 4345 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 4343 | Rev 4344 | ||
---|---|---|---|
Line 24... | Line 24... | ||
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 genarch_drivers |
29 | /** @addtogroup genarch_drivers |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** |
32 | /** |
33 | * @file |
33 | * @file |
34 | * @brief EGA driver. |
34 | * @brief EGA driver. |
Line 56... | Line 56... | ||
56 | 56 | ||
57 | SPINLOCK_INITIALIZE(egalock); |
57 | SPINLOCK_INITIALIZE(egalock); |
58 | static uint32_t ega_cursor; |
58 | static uint32_t ega_cursor; |
59 | static uint8_t *videoram; |
59 | static uint8_t *videoram; |
60 | static uint8_t *backbuf; |
60 | static uint8_t *backbuf; |
61 | static ioport_t ega_base; |
61 | static ioport8_t *ega_base; |
62 | 62 | ||
63 | chardev_t ega_console; |
63 | chardev_t ega_console; |
64 | 64 | ||
65 | /* |
65 | /* |
66 | * This function takes care of scrolling. |
66 | * This function takes care of scrolling. |
67 | */ |
67 | */ |
68 | static void ega_check_cursor(void) |
68 | static void ega_check_cursor(void) |
69 | { |
69 | { |
70 | if (ega_cursor < SCREEN) |
70 | if (ega_cursor < EGA_SCREEN) |
71 | return; |
71 | return; |
72 | 72 | ||
73 | memmove((void *) videoram, (void *) (videoram + ROW * 2), |
73 | memmove((void *) videoram, (void *) (videoram + EGA_COLS * 2), |
74 | (SCREEN - ROW) * 2); |
74 | (EGA_SCREEN - EGA_COLS) * 2); |
75 | memmove((void *) backbuf, (void *) (backbuf + ROW * 2), |
75 | memmove((void *) backbuf, (void *) (backbuf + EGA_COLS * 2), |
76 | (SCREEN - ROW) * 2); |
76 | (EGA_SCREEN - EGA_COLS) * 2); |
77 | memsetw(videoram + (SCREEN - ROW) * 2, ROW, 0x0720); |
77 | memsetw(videoram + (EGA_SCREEN - EGA_COLS) * 2, EGA_COLS, 0x0720); |
78 | memsetw(backbuf + (SCREEN - ROW) * 2, ROW, 0x0720); |
78 | memsetw(backbuf + (EGA_SCREEN - EGA_COLS) * 2, EGA_COLS, 0x0720); |
79 | ega_cursor = ega_cursor - ROW; |
79 | ega_cursor = ega_cursor - EGA_COLS; |
- | 80 | } |
|
- | 81 | ||
- | 82 | static void ega_show_cursor(void) |
|
- | 83 | { |
|
- | 84 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0a); |
|
- | 85 | uint8_t stat = pio_read_8(ega_base + EGA_DATA_REG); |
|
- | 86 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0a); |
|
- | 87 | pio_write_8(ega_base + EGA_DATA_REG, stat & (~(1 << 5))); |
|
80 | } |
88 | } |
81 | 89 | ||
82 | static void ega_move_cursor(void) |
90 | static void ega_move_cursor(void) |
83 | { |
91 | { |
84 | pio_write_8(ega_base + EGA_INDEX_REG, 0xe); |
92 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0e); |
85 | pio_write_8(ega_base + EGA_DATA_REG, (uint8_t) ((ega_cursor >> 8) & 0xff)); |
93 | pio_write_8(ega_base + EGA_DATA_REG, (uint8_t) ((ega_cursor >> 8) & 0xff)); |
86 | pio_write_8(ega_base + EGA_INDEX_REG, 0xf); |
94 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0f); |
87 | pio_write_8(ega_base + EGA_DATA_REG, (uint8_t) (ega_cursor & 0xff)); |
95 | pio_write_8(ega_base + EGA_DATA_REG, (uint8_t) (ega_cursor & 0xff)); |
- | 96 | } |
|
- | 97 | ||
- | 98 | static void ega_sync_cursor(void) |
|
- | 99 | { |
|
- | 100 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0e); |
|
- | 101 | uint8_t hi = pio_read_8(ega_base + EGA_DATA_REG); |
|
- | 102 | pio_write_8(ega_base + EGA_INDEX_REG, 0x0f); |
|
- | 103 | uint8_t lo = pio_read_8(ega_base + EGA_DATA_REG); |
|
- | 104 | ||
- | 105 | ega_cursor = (hi << 8) | lo; |
|
- | 106 | if ((ega_cursor % EGA_COLS) != 0) |
|
- | 107 | ega_cursor = (ega_cursor + EGA_COLS) - ega_cursor % EGA_COLS; |
|
- | 108 | ||
- | 109 | ega_check_cursor(); |
|
- | 110 | ega_move_cursor(); |
|
- | 111 | ega_show_cursor(); |
|
88 | } |
112 | } |
89 | 113 | ||
90 | static void ega_display_char(char ch, bool silent) |
114 | static void ega_display_char(char ch, bool silent) |
91 | { |
115 | { |
92 | backbuf[ega_cursor * 2] = ch; |
116 | backbuf[ega_cursor * 2] = ch; |
Line 102... | Line 126... | ||
102 | ipl = interrupts_disable(); |
126 | ipl = interrupts_disable(); |
103 | spinlock_lock(&egalock); |
127 | spinlock_lock(&egalock); |
104 | 128 | ||
105 | switch (ch) { |
129 | switch (ch) { |
106 | case '\n': |
130 | case '\n': |
107 | ega_cursor = (ega_cursor + ROW) - ega_cursor % ROW; |
131 | ega_cursor = (ega_cursor + EGA_COLS) - ega_cursor % EGA_COLS; |
108 | break; |
132 | break; |
109 | case '\t': |
133 | case '\t': |
110 | ega_cursor = (ega_cursor + 8) - ega_cursor % 8; |
134 | ega_cursor = (ega_cursor + 8) - ega_cursor % 8; |
111 | break; |
135 | break; |
112 | case '\b': |
136 | case '\b': |
113 | if (ega_cursor % ROW) |
137 | if (ega_cursor % EGA_COLS) |
114 | ega_cursor--; |
138 | ega_cursor--; |
115 | break; |
139 | break; |
116 | default: |
140 | default: |
117 | ega_display_char(ch, silent); |
141 | ega_display_char(ch, silent); |
118 | ega_cursor++; |
142 | ega_cursor++; |
Line 129... | Line 153... | ||
129 | 153 | ||
130 | static chardev_operations_t ega_ops = { |
154 | static chardev_operations_t ega_ops = { |
131 | .write = ega_putchar |
155 | .write = ega_putchar |
132 | }; |
156 | }; |
133 | 157 | ||
134 | void ega_init(ioport_t base, uintptr_t videoram_phys) |
158 | void ega_init(ioport8_t *base, uintptr_t videoram_phys) |
135 | { |
159 | { |
136 | /* Initialize the software structure. */ |
160 | /* Initialize the software structure. */ |
137 | ega_base = base; |
161 | ega_base = base; |
138 | 162 | ||
139 | backbuf = (uint8_t *) malloc(SCREEN * 2, 0); |
163 | backbuf = (uint8_t *) malloc(EGA_VRAM_SIZE, 0); |
140 | if (!backbuf) |
164 | if (!backbuf) |
141 | panic("Unable to allocate backbuffer."); |
165 | panic("Unable to allocate backbuffer."); |
142 | 166 | ||
143 | videoram = (uint8_t *) hw_map(videoram_phys, SCREEN * 2); |
167 | videoram = (uint8_t *) hw_map(videoram_phys, EGA_VRAM_SIZE); |
144 | 168 | ||
145 | /* Clear the screen and set the cursor position. */ |
169 | /* Synchronize the back buffer and cursor position. */ |
146 | memsetw(videoram, SCREEN, 0x0720); |
- | |
147 | memsetw(backbuf, SCREEN, 0x0720); |
170 | memcpy(backbuf, videoram, EGA_VRAM_SIZE); |
148 | ega_move_cursor(); |
171 | ega_sync_cursor(); |
149 | 172 | ||
150 | chardev_initialize("ega_out", &ega_console, &ega_ops); |
173 | chardev_initialize("ega_out", &ega_console, &ega_ops); |
151 | stdout = &ega_console; |
174 | stdout = &ega_console; |
152 | 175 | ||
153 | sysinfo_set_item_val("fb", NULL, true); |
176 | sysinfo_set_item_val("fb", NULL, true); |
154 | sysinfo_set_item_val("fb.kind", NULL, 2); |
177 | sysinfo_set_item_val("fb.kind", NULL, 2); |
155 | sysinfo_set_item_val("fb.width", NULL, ROW); |
178 | sysinfo_set_item_val("fb.width", NULL, EGA_COLS); |
156 | sysinfo_set_item_val("fb.height", NULL, ROWS); |
179 | sysinfo_set_item_val("fb.height", NULL, EGA_ROWS); |
157 | sysinfo_set_item_val("fb.blinking", NULL, true); |
180 | sysinfo_set_item_val("fb.blinking", NULL, true); |
158 | sysinfo_set_item_val("fb.address.physical", NULL, videoram_phys); |
181 | sysinfo_set_item_val("fb.address.physical", NULL, videoram_phys); |
159 | } |
182 | } |
160 | 183 | ||
161 | void ega_redraw(void) |
184 | void ega_redraw(void) |
162 | { |
185 | { |
163 | memcpy(videoram, backbuf, SCREEN * 2); |
186 | memcpy(videoram, backbuf, EGA_VRAM_SIZE); |
164 | ega_move_cursor(); |
187 | ega_move_cursor(); |
- | 188 | ega_show_cursor(); |
|
165 | } |
189 | } |
166 | 190 | ||
167 | /** @} |
191 | /** @} |
168 | */ |
192 | */ |