/* * This file is part of the libpayload project. * * Copyright (C) 2008 Advanced Micro Devices, Inc. * Copyright (C) 2010 coresystems GmbH * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. */ #include <libpayload.h> #include <coreboot_tables.h> #include <pci.h> #include <video_console.h> #include "font8x16.h" struct video_console coreboot_video_console; static unsigned int cursor_x = 0, cursor_y = 0, cursor_en = 0; /* color definitions for the 16 standard colors */ #define VGA_COLOR_DEFAULT 7 static const u32 vga_colors[] = { // BLUE | GREEN | RED (0x00 << 16) | (0x00 << 8) | 0x00, (0xAA << 16) | (0x00 << 8) | 0x00, (0x00 << 16) | (0xAA << 8) | 0x00, (0xAA << 16) | (0x55 << 8) | 0x00, (0x00 << 16) | (0x00 << 8) | 0xAA, (0xAA << 16) | (0x00 << 8) | 0xAA, (0x00 << 16) | (0xAA << 8) | 0xAA, (0xAA << 16) | (0xAA << 8) | 0xAA, (0x55 << 16) | (0x55 << 8) | 0x55, (0xFF << 16) | (0x55 << 8) | 0x55, (0x55 << 16) | (0xFF << 8) | 0x55, (0xFF << 16) | (0xFF << 8) | 0x55, (0x55 << 16) | (0x55 << 8) | 0xFF, (0xFF << 16) | (0x55 << 8) | 0xFF, (0x55 << 16) | (0xFF << 8) | 0xFF, (0xFF << 16) | (0xFF << 8) | 0xFF, }; /* Addresses for the various components */ static unsigned long fbinfo; static unsigned long fbaddr; static unsigned long chars; #define FI ((struct cb_framebuffer *) phys_to_virt(fbinfo)) #define FB ((unsigned char *) phys_to_virt(fbaddr)) #define CHARS ((unsigned short *) phys_to_virt(chars)) static void corebootfb_scroll_up(void) { unsigned char *dst = FB; unsigned char *src = FB + (FI->bytes_per_line * FONT_HEIGHT); int y; /* Scroll all lines up */ for(y = 0; y < FI->y_resolution - FONT_HEIGHT; y++) { memcpy(dst, src, FI->x_resolution * (FI->bits_per_pixel >> 3)); dst += FI->bytes_per_line; src += FI->bytes_per_line; } /* Erase last line */ dst = FB + (FI->y_resolution - FONT_HEIGHT) * FI->bytes_per_line; for(; y < FI->y_resolution; y++) { memset(dst, 0, FI->x_resolution * (FI->bits_per_pixel >> 3)); dst += FI->bytes_per_line; } /* And update the char buffer */ dst = (unsigned char *) CHARS; src = (unsigned char *) (CHARS + coreboot_video_console.columns); memcpy(dst, src, coreboot_video_console.columns * (coreboot_video_console.rows - 1) * 2); int column; for (column = 0; column < coreboot_video_console.columns; column++) CHARS[(coreboot_video_console.rows - 1) * coreboot_video_console.columns + column] = (VGA_COLOR_DEFAULT << 8); cursor_y--; } static void corebootfb_clear(void) { int row, column; unsigned char *ptr = FB; /* Clear the screen */ for(row = 0; row < FI->y_resolution; row++) { memset(ptr, 0, FI->x_resolution * (FI->bits_per_pixel >> 3)); ptr += FI->bytes_per_line; } /* And update the char buffer */ for(row = 0; row < coreboot_video_console.rows; row++) for (column = 0; column < coreboot_video_console.columns; column++) CHARS[row * coreboot_video_console.columns + column] = (VGA_COLOR_DEFAULT << 8); } static void corebootfb_putchar(u8 row, u8 col, unsigned int ch) { unsigned char *dst; unsigned char *glyph = font8x16 + ((ch & 0xFF) * FONT_HEIGHT); unsigned char bg = (ch >> 12) & 0xF; unsigned char fg = (ch >> 8) & 0xF; u32 fgval = 0, bgval = 0; u16 *dst16; u32 *dst32; int x, y; if (FI->bits_per_pixel > 8) { bgval = ((((vga_colors[bg] >> 0) & 0xff) >> (8 - FI->blue_mask_size)) << FI->blue_mask_pos) | ((((vga_colors[bg] >> 8) & 0xff) >> (8 - FI->green_mask_size)) << FI->green_mask_pos) | ((((vga_colors[bg] >> 16) & 0xff) >> (8 - FI->red_mask_size)) << FI->red_mask_pos); fgval = ((((vga_colors[fg] >> 0) & 0xff) >> (8 - FI->blue_mask_size)) << FI->blue_mask_pos) | ((((vga_colors[fg] >> 8) & 0xff) >> (8 - FI->green_mask_size)) << FI->green_mask_pos) | ((((vga_colors[fg] >> 16) & 0xff) >> (8 - FI->red_mask_size)) << FI->red_mask_pos); } dst = FB + ((row * FONT_HEIGHT) * FI->bytes_per_line); dst += (col * FONT_WIDTH * (FI->bits_per_pixel >> 3)); for(y = 0; y < FONT_HEIGHT; y++) { for(x = FONT_WIDTH - 1; x >= 0; x--) { switch (FI->bits_per_pixel) { case 8: /* Indexed */ dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3)] = (*glyph & (1 << x)) ? fg : bg; break; case 16: /* 16 bpp */ dst16 = (u16 *)(dst + (FONT_WIDTH - x) * (FI->bits_per_pixel >> 3)); *dst16 = (*glyph & (1 << x)) ? fgval : bgval; break; case 24: /* 24 bpp */ if (*glyph & (1 << x)) { dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 0] = fgval & 0xff; dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 1] = (fgval >> 8) & 0xff; dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 2] = (fgval >> 16) & 0xff; } else { dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 0] = bgval & 0xff; dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 1] = (bgval >> 8) & 0xff; dst[(FONT_WIDTH - x) * (FI->bits_per_pixel >> 3) + 2] = (bgval >> 16) & 0xff; } break; case 32: /* 32 bpp */ dst32 = (u32 *)(dst + (FONT_WIDTH - x) * (FI->bits_per_pixel >> 3)); *dst32 = (*glyph & (1 << x)) ? fgval : bgval; break; } } dst += FI->bytes_per_line; glyph++; } } static void corebootfb_putc(u8 row, u8 col, unsigned int ch) { CHARS[row * coreboot_video_console.columns + col] = ch; corebootfb_putchar(row, col, ch); } static void corebootfb_update_cursor(void) { int ch, paint; if(cursor_en) { ch = CHARS[cursor_y * coreboot_video_console.columns + cursor_x]; paint = (ch & 0xff) | ((ch<<4) & 0xf000) | ((ch >> 4) & 0x0f00); } else { paint = CHARS[cursor_y * coreboot_video_console.columns + cursor_x]; } if (cursor_y < coreboot_video_console.rows) corebootfb_putchar(cursor_y, cursor_x, paint); } static void corebootfb_enable_cursor(int state) { cursor_en = state; corebootfb_update_cursor(); } static void corebootfb_get_cursor(unsigned int *x, unsigned int *y, unsigned int *en) { *x = cursor_x; *y = cursor_y; *en = cursor_en; } static void corebootfb_set_cursor(unsigned int x, unsigned int y) { int cursor_remember = cursor_en; if (cursor_remember) corebootfb_enable_cursor(0); cursor_x = x; cursor_y = y; if (cursor_remember) corebootfb_enable_cursor(1); } static int corebootfb_init(void) { if (lib_sysinfo.framebuffer == NULL) return -1; /* We might have been called before relocation (like FILO does). So just keep the physical address which won't break on relocation. */ fbinfo = virt_to_phys(lib_sysinfo.framebuffer); fbaddr = FI->physical_address; coreboot_video_console.columns = FI->x_resolution / FONT_WIDTH; coreboot_video_console.rows = FI->y_resolution / FONT_HEIGHT; /* See setting of fbinfo above. */ chars = virt_to_phys(malloc(coreboot_video_console.rows * coreboot_video_console.columns * 2)); // clear boot splash screen if there is one. corebootfb_clear(); return 0; } struct video_console coreboot_video_console = { .init = corebootfb_init, .putc = corebootfb_putc, .clear = corebootfb_clear, .scroll_up = corebootfb_scroll_up, .get_cursor = corebootfb_get_cursor, .set_cursor = corebootfb_set_cursor, .enable_cursor = corebootfb_enable_cursor, .columns = 80, .rows = 25 };