1 // Code for manipulating VGA framebuffers.
3 // Copyright (C) 2009 Kevin O'Connor <kevin@koconnor.net>
4 // Copyright (C) 2001-2008 the LGPL VGABios developers Team
6 // This file may be distributed under the terms of the GNU LGPLv3 license.
8 #include "biosvar.h" // GET_BDA
9 #include "util.h" // memset_far
10 #include "stdvga.h" // stdvga_planar4_plane
13 /****************************************************************
15 ****************************************************************/
18 memcpy_stride(u16 seg, void *dst, void *src, int copylen, int stride, int lines)
20 for (; lines; lines--, dst+=stride, src+=stride)
21 memcpy_far(seg, dst, seg, src, copylen);
26 memset_stride(u16 seg, void *dst, u8 val, int setlen, int stride, int lines)
28 for (; lines; lines--, dst+=stride)
29 memset_far(seg, dst, val, setlen);
33 memset16_stride(u16 seg, void *dst, u16 val, int setlen, int stride, int lines)
35 for (; lines; lines--, dst+=stride)
36 memset16_far(seg, dst, val, setlen);
40 scroll_pl4(struct vgamode_s *vmode_g, int nblines, int attr
41 , struct cursorpos ul, struct cursorpos lr)
43 int cheight = GET_GLOBAL(vmode_g->cheight);
45 int stride = GET_BDA(video_cols) * cwidth;
46 void *src_far, *dest_far;
48 dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth);
49 src_far = dest_far + nblines * cheight * stride;
53 dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth);
54 src_far = dest_far - nblines * cheight * stride;
59 int cols = lr.x - ul.x + 1;
60 int rows = lr.y - ul.y + 1;
63 stdvga_planar4_plane(i);
64 void *dest = dest_far;
66 dest = memcpy_stride(SEG_GRAPH, dest, src_far, cols * cwidth
67 , stride, (rows - nblines) * cheight);
68 u8 pixels = (attr & (1<<i)) ? 0xff : 0x00;
69 memset_stride(SEG_GRAPH, dest, pixels, cols * cwidth
70 , stride, nblines * cheight);
72 stdvga_planar4_plane(-1);
76 scroll_cga(struct vgamode_s *vmode_g, int nblines, int attr
77 , struct cursorpos ul, struct cursorpos lr)
79 int cheight = GET_GLOBAL(vmode_g->cheight) / 2;
80 int cwidth = GET_GLOBAL(vmode_g->depth);
81 int stride = GET_BDA(video_cols) * cwidth;
82 void *src_far, *dest_far;
84 dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth);
85 src_far = dest_far + nblines * cheight * stride;
89 dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth);
90 src_far = dest_far - nblines * cheight * stride;
95 int cols = lr.x - ul.x + 1;
96 int rows = lr.y - ul.y + 1;
98 memcpy_stride(SEG_CTEXT, dest_far+0x2000, src_far+0x2000, cols * cwidth
99 , stride, (rows - nblines) * cheight);
100 dest_far = memcpy_stride(SEG_CTEXT, dest_far, src_far, cols * cwidth
101 , stride, (rows - nblines) * cheight);
103 memset_stride(SEG_CTEXT, dest_far + 0x2000, attr, cols * cwidth
104 , stride, nblines * cheight);
105 memset_stride(SEG_CTEXT, dest_far, attr, cols * cwidth
106 , stride, nblines * cheight);
110 scroll_lin(struct vgamode_s *vmode_g, int nblines, int attr
111 , struct cursorpos ul, struct cursorpos lr)
115 int stride = GET_BDA(video_cols) * cwidth;
116 void *src_far, *dest_far;
118 dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth);
119 src_far = dest_far + nblines * cheight * stride;
123 dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth);
124 src_far = dest_far - nblines * cheight * stride;
129 int cols = lr.x - ul.x + 1;
130 int rows = lr.y - ul.y + 1;
132 dest_far = memcpy_stride(SEG_GRAPH, dest_far, src_far, cols * cwidth
133 , stride, (rows - nblines) * cheight);
134 memset_stride(SEG_GRAPH, dest_far, attr, cols * cwidth
135 , stride, nblines * cheight);
139 scroll_text(struct vgamode_s *vmode_g, int nblines, int attr
140 , struct cursorpos ul, struct cursorpos lr)
144 int stride = GET_BDA(video_cols) * cwidth;
145 void *src_far, *dest_far = (void*)(GET_BDA(video_pagesize) * ul.page);
147 dest_far += ul.y * cheight * stride + ul.x * cwidth;
148 src_far = dest_far + nblines * cheight * stride;
152 dest_far += lr.y * cheight * stride + ul.x * cwidth;
153 src_far = dest_far - nblines * cheight * stride;
158 attr = (attr << 8) | ' ';
159 int cols = lr.x - ul.x + 1;
160 int rows = lr.y - ul.y + 1;
161 u16 seg = GET_GLOBAL(vmode_g->sstart);
163 dest_far = memcpy_stride(seg, dest_far, src_far, cols * cwidth
164 , stride, (rows - nblines) * cheight);
165 memset16_stride(seg, dest_far, attr, cols * cwidth
166 , stride, nblines * cheight);
170 vgafb_scroll(int nblines, int attr, struct cursorpos ul, struct cursorpos lr)
173 struct vgamode_s *vmode_g = get_current_mode();
177 // FIXME gfx mode not complete
178 switch (GET_GLOBAL(vmode_g->memmodel)) {
180 scroll_text(vmode_g, nblines, attr, ul, lr);
183 scroll_pl4(vmode_g, nblines, attr, ul, lr);
186 scroll_cga(vmode_g, nblines, attr, ul, lr);
190 scroll_lin(vmode_g, nblines, attr, ul, lr);
196 /****************************************************************
197 * Read/write characters to screen
198 ****************************************************************/
201 write_gfx_char_pl4(struct vgamode_s *vmode_g
202 , struct cursorpos cp, struct carattr ca)
204 u16 nbcols = GET_BDA(video_cols);
208 u8 cheight = GET_GLOBAL(vmode_g->cheight);
220 u16 addr = cp.x + cp.y * cheight * nbcols;
221 u16 src = ca.car * cheight;
223 for (i=0; i<4; i++) {
224 stdvga_planar4_plane(i);
225 u8 colors = ((ca.attr & (1<<i)) ? 0xff : 0x00);
227 for (j = 0; j < cheight; j++) {
228 u8 *dest_far = (void*)(addr + j * nbcols);
229 u8 pixels = colors & GET_GLOBAL(fdata_g[src + j]);
231 pixels ^= GET_FARVAR(SEG_GRAPH, *dest_far);
232 SET_FARVAR(SEG_GRAPH, *dest_far, pixels);
235 stdvga_planar4_plane(-1);
239 write_gfx_char_cga(struct vgamode_s *vmode_g
240 , struct cursorpos cp, struct carattr ca)
242 u16 nbcols = GET_BDA(video_cols);
246 u8 *fdata_g = vgafont8;
247 u8 bpp = GET_GLOBAL(vmode_g->depth);
248 u16 addr = (cp.x * bpp) + cp.y * 320;
249 u16 src = ca.car * 8;
251 for (i = 0; i < 8; i++) {
252 u8 *dest_far = (void*)(addr + (i >> 1) * 80);
259 data = GET_FARVAR(SEG_CTEXT, *dest_far);
261 for (j = 0; j < 8; j++) {
262 if (GET_GLOBAL(fdata_g[src + i]) & mask) {
264 data ^= (ca.attr & 0x01) << (7 - j);
266 data |= (ca.attr & 0x01) << (7 - j);
270 SET_FARVAR(SEG_CTEXT, *dest_far, data);
275 data = GET_FARVAR(SEG_CTEXT, *dest_far);
277 for (j = 0; j < 4; j++) {
278 if (GET_GLOBAL(fdata_g[src + i]) & mask) {
280 data ^= (ca.attr & 0x03) << ((3 - j) * 2);
282 data |= (ca.attr & 0x03) << ((3 - j) * 2);
286 SET_FARVAR(SEG_CTEXT, *dest_far, data);
294 write_gfx_char_lin(struct vgamode_s *vmode_g
295 , struct cursorpos cp, struct carattr ca)
297 // Get the dimensions
298 u16 nbcols = GET_BDA(video_cols);
302 u8 *fdata_g = vgafont8;
303 u16 addr = cp.x * 8 + cp.y * nbcols * 64;
304 u16 src = ca.car * 8;
306 for (i = 0; i < 8; i++) {
307 u8 *dest_far = (void*)(addr + i * nbcols * 8);
310 for (j = 0; j < 8; j++) {
312 if (GET_GLOBAL(fdata_g[src + i]) & mask)
314 SET_FARVAR(SEG_GRAPH, dest_far[j], data);
321 write_text_char(struct vgamode_s *vmode_g
322 , struct cursorpos cp, struct carattr ca)
324 // Compute the address
325 u16 nbcols = GET_BDA(video_cols);
326 void *address_far = (void*)(GET_BDA(video_pagesize) * cp.page
327 + (cp.x + cp.y * nbcols) * 2);
330 u16 dummy = (ca.attr << 8) | ca.car;
331 SET_FARVAR(GET_GLOBAL(vmode_g->sstart), *(u16*)address_far, dummy);
333 SET_FARVAR(GET_GLOBAL(vmode_g->sstart), *(u8*)address_far, ca.car);
338 vgafb_write_char(struct cursorpos cp, struct carattr ca)
341 struct vgamode_s *vmode_g = get_current_mode();
345 // FIXME gfx mode not complete
346 switch (GET_GLOBAL(vmode_g->memmodel)) {
348 write_text_char(vmode_g, cp, ca);
351 write_gfx_char_pl4(vmode_g, cp, ca);
354 write_gfx_char_cga(vmode_g, cp, ca);
358 write_gfx_char_lin(vmode_g, cp, ca);
364 vgafb_read_char(struct cursorpos cp)
367 struct vgamode_s *vmode_g = get_current_mode();
371 if (GET_GLOBAL(vmode_g->memmodel) != MM_TEXT) {
373 dprintf(1, "Read char in graphics mode\n");
377 // Compute the address
378 u16 nbcols = GET_BDA(video_cols);
379 u16 *address_far = (void*)(GET_BDA(video_pagesize) * cp.page
380 + (cp.x + cp.y * nbcols) * 2);
381 u16 v = GET_FARVAR(GET_GLOBAL(vmode_g->sstart), *address_far);
382 struct carattr ca = {v, v>>8, 0};
386 struct carattr ca2 = {0, 0, 0};
391 /****************************************************************
393 ****************************************************************/
396 vgafb_write_pixel(u8 color, u16 x, u16 y)
399 struct vgamode_s *vmode_g = get_current_mode();
403 u8 *addr_far, mask, attr, data, i;
404 switch (GET_GLOBAL(vmode_g->memmodel)) {
406 addr_far = (void*)(x / 8 + y * GET_BDA(video_cols));
407 mask = 0x80 >> (x & 0x07);
408 for (i=0; i<4; i++) {
409 stdvga_planar4_plane(i);
410 u8 colors = (color & (1<<i)) ? 0xff : 0x00;
411 u8 orig = GET_FARVAR(SEG_GRAPH, *addr_far);
414 SET_FARVAR(SEG_GRAPH, *addr_far, (colors & mask) | (orig & ~mask));
416 stdvga_planar4_plane(-1);
419 if (GET_GLOBAL(vmode_g->depth) == 2)
420 addr_far = (void*)((x >> 2) + (y >> 1) * 80);
422 addr_far = (void*)((x >> 3) + (y >> 1) * 80);
425 data = GET_FARVAR(SEG_CTEXT, *addr_far);
426 if (GET_GLOBAL(vmode_g->depth) == 2) {
427 attr = (color & 0x03) << ((3 - (x & 0x03)) * 2);
428 mask = 0x03 << ((3 - (x & 0x03)) * 2);
430 attr = (color & 0x01) << (7 - (x & 0x07));
431 mask = 0x01 << (7 - (x & 0x07));
439 SET_FARVAR(SEG_CTEXT, *addr_far, data);
443 addr_far = (void*)(x + y * (GET_BDA(video_cols) * 8));
444 SET_FARVAR(SEG_GRAPH, *addr_far, color);
452 vgafb_read_pixel(u16 x, u16 y)
455 struct vgamode_s *vmode_g = get_current_mode();
459 u8 *addr_far, mask, attr=0, data, i;
460 switch (GET_GLOBAL(vmode_g->memmodel)) {
462 addr_far = (void*)(x / 8 + y * GET_BDA(video_cols));
463 mask = 0x80 >> (x & 0x07);
465 for (i = 0; i < 4; i++) {
466 stdvga_planar4_plane(i);
467 data = GET_FARVAR(SEG_GRAPH, *addr_far) & mask;
471 stdvga_planar4_plane(-1);
474 addr_far = (void*)((x >> 2) + (y >> 1) * 80);
477 data = GET_FARVAR(SEG_CTEXT, *addr_far);
478 if (GET_GLOBAL(vmode_g->depth) == 2)
479 attr = (data >> ((3 - (x & 0x03)) * 2)) & 0x03;
481 attr = (data >> (7 - (x & 0x07))) & 0x01;
485 addr_far = (void*)(x + y * (GET_BDA(video_cols) * 8));
486 attr = GET_FARVAR(SEG_GRAPH, *addr_far);