WebSVN – HelenOS – Diff – /trunk/kernel/genarch/src/fb/fb.c

 #define BGCOLOR     0x000080
 #define FGCOLOR     0xffff00
 #define LOGOCOLOR   0x2020b0
-#define RED(x, bits)    ((x >> (16 + 8 - bits)) & ((1 << bits) - 1))
+#define RED(x, bits)    ((x >> (8 + 8 + 8 - bits)) & ((1 << bits) - 1))
 #define GREEN(x, bits)  ((x >> (8 + 8 - bits)) & ((1 << bits) - 1))
 #define BLUE(x, bits)   ((x >> (8 - bits)) & ((1 << bits) - 1))
 #define POINTPOS(x, y)  ((y) * scanline + (x) * pixelbytes)
     return (*((int *) src)) & 0xffffff;
+}
 static void bgr_byte0888(void *dst, int rgb)
+{
-    *((uint32_t *) dst) = BLUE(rgb, 8) << 16 | GREEN(rgb, 8) << 8 | RED(rgb,
+    *((uint32_t *) dst) = BLUE(rgb, 8) << 16 | GREEN(rgb, 8) << 8 |
-);
+        RED(rgb, 8);
+}
 static int byte0888_bgr(void *src)
+{
     int color = *(uint32_t *)(src);
-    return ((color & 0xff) << 16) | (((color >> 8) & 0xff) << 8) | ((color
+    return ((color & 0xff) << 16) | (((color >> 8) & 0xff) << 8) |
-        >> 16) & 0xff);
+        ((color >> 16) & 0xff);
+}
 static void rgb_byte888(void *dst, int rgb)
+{
     uint8_t *scr = dst;
 /**  16-bit depth (5:5:5) */
 static void rgb_byte555(void *dst, int rgb)
+{
     /* 5-bit, 5-bits, 5-bits */
-    *((uint16_t *) dst) = RED(rgb, 5) << 10 | GREEN(rgb, 5) << 5 | BLUE(rgb,
+    *((uint16_t *) dst) = RED(rgb, 5) << 10 | GREEN(rgb, 5) << 5 |
-);
+        BLUE(rgb, 5);
+}
 /** 16-bit depth (5:5:5) */
 static int byte555_rgb(void *src)
+{
     int color = *(uint16_t *)(src);
-    return (((color >> 10) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x1f) <<
+    return (((color >> 10) & 0x1f) << (16 + 3)) |
-        (8 + 3)) | ((color & 0x1f) << 3);
+        (((color >> 5) & 0x1f) << (8 + 3)) | ((color & 0x1f) << 3);
+}
 /**  16-bit depth (5:6:5) */
 static void rgb_byte565(void *dst, int rgb)
+{
     /* 5-bit, 6-bits, 5-bits */
-    *((uint16_t *) dst) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 | BLUE(rgb,        5);
+    *((uint16_t *) dst) = RED(rgb, 5) << 11 | GREEN(rgb, 6) << 5 |
+        BLUE(rgb, 5);
+}
 /** 16-bit depth (5:6:5) */
 static int byte565_rgb(void *src)
+{
     int color = *(uint16_t *)(src);
-    return (((color >> 11) & 0x1f) << (16 + 3)) | (((color >> 5) & 0x3f) <<
+    return (((color >> 11) & 0x1f) << (16 + 3)) |
-        (8 + 2)) | ((color & 0x1f) << 3);
+        (((color >> 5) & 0x3f) << (8 + 2)) | ((color & 0x1f) << 3);
+}
 /** Put pixel - 8-bit depth (color palette/3:2:3)
+ *
  * Even though we try 3:2:3 color scheme here, an 8-bit framebuffer
  * palette. This could be fixed by supporting custom palette
  * and setting it to simulate the 8-bit truecolor.
  */
 static void rgb_byte8(void *dst, int rgb)
+{
-    *((uint8_t *) dst) = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 | BLUE(rgb,
+    *((uint8_t *) dst) = RED(rgb, 3) << 5 | GREEN(rgb, 2) << 3 |
-);
+        BLUE(rgb, 3);
+}
 /** Return pixel color - 8-bit depth (color palette/3:2:3)
+ *
  * See the comment for rgb_byte().
  */
 static int byte8_rgb(void *src)
+{
     int color = *(uint8_t *)src;
-    return (((color >> 5) & 0x7) << (16 + 5)) | (((color >> 3) & 0x3) << (8
+    return (((color >> 5) & 0x7) << (16 + 5)) |
-        + 6)) | ((color & 0x7) << 5);
+        (((color >> 3) & 0x3) << (8 + 6)) | ((color & 0x7) << 5);
+}
 static void putpixel(unsigned int x, unsigned int y, int color)
+{
     (*rgb2scr)(&fbaddress[POINTPOS(x, y)], COLOR(color));
     unsigned int y;
     for (y = 0; y < yres; y++) {
         memcpy(&fbaddress[scanline * y], blankline, xres * pixelbytes);
         if (dbbuffer)
-            memcpy(&dbbuffer[scanline * y], blankline, xres *
+            memcpy(&dbbuffer[scanline * y], blankline,
-                pixelbytes);
+                xres * pixelbytes);
+    }
+}
 /** Scroll screen one row up */
 static void scroll_screen(void)
+{
     if (dbbuffer) {
         count_t first;
+        /* Clear the last row */
         memcpy(&dbbuffer[dboffset * scanline], blankline, ROW_BYTES);
         dboffset = (dboffset + FONT_SCANLINES) % yres;
         first = yres - dboffset;
+        /* Move all rows one row up */
+        if (xres * pixelbytes == scanline) {
-        memcpy(fbaddress, &dbbuffer[scanline * dboffset], first *
+            memcpy(fbaddress, &dbbuffer[dboffset * scanline],
-            scanline);
+                first * scanline);
-        memcpy(&fbaddress[first * scanline], dbbuffer, dboffset *
+            memcpy(&fbaddress[first * scanline], dbbuffer,
+                dboffset * scanline);
+        } else {
+            /*
+             * When the scanline is bigger than number of bytes
+             * in the X-resolution, chances are that the
+             * frame buffer memory past the X-resolution is special
+             * in some way. For example, the SUNW,ffb framebuffer
+             * wraps this area around the beginning of the same
+             * line. To avoid troubles, copy only memory as
+             * specified by the resolution.
+             */
-            scanline);
+            int i;
+            for (i = 0; i < first; i++)
+                memcpy(&fbaddress[i * scanline],
+                    &dbbuffer[(dboffset + i) * scanline],
+                    xres * pixelbytes);
+            for (i = 0; i < dboffset; i++)
+                memcpy(&fbaddress[(first + i) * scanline],
+                    &dbbuffer[i * scanline], xres * pixelbytes);
+        }
     } else {
         uint8_t *lastline = &fbaddress[(rows - 1) * ROW_BYTES];
+        if (xres * pixelbytes == scanline) {
+            /* Move all rows one row up */
+            memcpy((void *) fbaddress,
-        memcpy((void *) fbaddress, (void *) &fbaddress[ROW_BYTES],
+                (void *) &fbaddress[ROW_BYTES],
-            scanline * yres - ROW_BYTES);
+                scanline * yres - ROW_BYTES);
-        /* Clear last row */
+            /* Clear the last row */
-        memcpy((void *) lastline, (void *) blankline, ROW_BYTES);
+            memcpy((void *) lastline, (void *) blankline,
+                ROW_BYTES);
+        } else {
+            /*
+             * See the comment in the dbbuffer case.
+             */
+            int i;
+            /* Move all rows one row up */
+            for (i = 0; i < yres - FONT_SCANLINES; i++)
+                memcpy(&fbaddress[i * scanline],
+                    &fbaddress[(i + FONT_SCANLINES) * scanline],
+                    xres * pixelbytes);
+            /* Clear the last row */
+            for (i = 0; i < FONT_SCANLINES; i++)
+                memcpy(&lastline[i * scanline],
+                    &blankline[i * scanline],
+                    xres * pixelbytes);
+        }
+    }
+}
 static void invert_pixel(unsigned int x, unsigned int y)
 static void draw_glyph(uint8_t glyph, unsigned int col, unsigned int row)
+{
     unsigned int y;
     for (y = 0; y < FONT_SCANLINES; y++)
-        draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y], col *
+        draw_glyph_line(fb_font[glyph * FONT_SCANLINES + y],
-            COL_WIDTH, row * FONT_SCANLINES + y);
+            col * COL_WIDTH, row * FONT_SCANLINES + y);
+}
 /** Invert character at given position */
 static void invert_char(unsigned int col, unsigned int row)
+{
     unsigned int x;
     unsigned int y;
     for (x = 0; x < COL_WIDTH; x++)
         for (y = 0; y < FONT_SCANLINES; y++)
-            invert_pixel(col * COL_WIDTH + x, row * FONT_SCANLINES +
+            invert_pixel(col * COL_WIDTH + x,
-                y);
+                row * FONT_SCANLINES + y);
+}
 /** Draw character at default position */
 static void draw_char(char chr)
+{
         for (x = 0; x < helenos_width; x++) {
             byte = helenos_bits[rowbytes * y + x / 8];
             byte >>= x % 8;
             if (byte & 1)
                 putpixel(startx + x, starty + y,
                     COLOR(LOGOCOLOR));
+        }
+}
 /***************************************************************/
 /* Stdout specific functions */
  * @param scan   Bytes per one scanline
  * @param visual Color model
+ *
  */
 void fb_init(uintptr_t addr, unsigned int x, unsigned int y, unsigned int scan,
     unsigned int visual)
+{
     switch (visual) {
     case VISUAL_INDIRECT_8:
         rgb2scr = rgb_byte8;
         scr2rgb = byte8_rgb;
     sysinfo_set_item_val("fb.width", NULL, xres);
     sysinfo_set_item_val("fb.height", NULL, yres);
     sysinfo_set_item_val("fb.scanline", NULL, scan);
     sysinfo_set_item_val("fb.visual", NULL, visual);
     sysinfo_set_item_val("fb.address.physical", NULL, addr);
-    sysinfo_set_item_val("fb.address.color", NULL, PAGE_COLOR((uintptr_t)
+    sysinfo_set_item_val("fb.address.color", NULL,
-        fbaddress));
+        PAGE_COLOR((uintptr_t) fbaddress));
     sysinfo_set_item_val("fb.invert-colors", NULL, invert_colors);
     /* Allocate double buffer */
     unsigned int order = fnzb(SIZE2FRAMES(fbsize) - 1) + 1;
     dbbuffer = (uint8_t *) frame_alloc(order, FRAME_ATOMIC | FRAME_KA);

Subversion Repositories HelenOS

(root)/trunk/kernel/genarch/src/fb/fb.c – Rev 2071 → 2086