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 | */ |