/* * GRUB -- GRand Unified Bootloader * Copyright (C) 2000,2001,2002,2003,2004,2005,2007,2008,2009,2010 Free Software Foundation, Inc. * * GRUB is free software: you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation, either version 3 of the License, or * (at your option) any later version. * * GRUB is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with GRUB. If not, see . */ #define grub_video_render_target grub_video_fbrender_target #include #include #include #include #include #include #include #include #include #include GRUB_MOD_LICENSE ("GPLv3+"); #define VGA_WIDTH 640 #define VGA_MEM ((grub_uint8_t *) 0xa0000) #define PAGE_OFFSET(x) ((x) * (VGA_WIDTH * vga_height / 8)) static unsigned char text_mode; static unsigned char saved_map_mask; static int vga_height; static struct { struct grub_video_mode_info mode_info; struct grub_video_render_target *render_target; grub_uint8_t *temporary_buffer; int front_page; int back_page; } framebuffer; static unsigned char grub_vga_set_mode (unsigned char mode) { struct grub_bios_int_registers regs; unsigned char ret; /* get current mode */ regs.eax = 0x0f00; regs.ebx = 0; regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT; grub_bios_interrupt (0x10, ®s); ret = regs.eax & 0xff; regs.eax = mode; regs.flags = GRUB_CPU_INT_FLAGS_DEFAULT; grub_bios_interrupt (0x10, ®s); return ret; } static inline void wait_vretrace (void) { /* Wait until there is a vertical retrace. */ while (! (grub_inb (GRUB_VGA_IO_INPUT_STATUS1_REGISTER) & GRUB_VGA_IO_INPUT_STATUS1_VERTR_BIT)); } /* Get Map Mask Register. */ static unsigned char get_map_mask (void) { return grub_vga_sr_read (GRUB_VGA_SR_MAP_MASK_REGISTER); } /* Set Map Mask Register. */ static void set_map_mask (unsigned char mask) { grub_vga_sr_write (mask, GRUB_VGA_SR_MAP_MASK_REGISTER); } #if 0 /* Set Read Map Register. */ static void set_read_map (unsigned char map) { grub_vga_gr_write (map, GRUB_VGA_GR_READ_MAP_REGISTER); } #endif /* Set start address. */ static void set_start_address (unsigned int start) { grub_vga_cr_write (start & 0xFF, GRUB_VGA_CR_START_ADDR_LOW_REGISTER); grub_vga_cr_write (start >> 8, GRUB_VGA_CR_START_ADDR_HIGH_REGISTER); } static int setup = 0; static int is_target = 0; static grub_err_t grub_video_vga_init (void) { return GRUB_ERR_NONE; } static grub_err_t grub_video_vga_setup (unsigned int width, unsigned int height, grub_video_mode_type_t mode_type, grub_video_mode_type_t mode_mask) { grub_err_t err; if ((width && width != VGA_WIDTH) || (height && height != 350 && height != 480)) return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "no matching mode found"); vga_height = height ? : 480; framebuffer.temporary_buffer = grub_malloc (vga_height * VGA_WIDTH); framebuffer.front_page = 0; framebuffer.back_page = 0; if (!framebuffer.temporary_buffer) return grub_errno; saved_map_mask = get_map_mask (); text_mode = grub_vga_set_mode (vga_height == 480 ? 0x12 : 0x10); setup = 1; set_map_mask (0x0f); set_start_address (PAGE_OFFSET (framebuffer.front_page)); framebuffer.mode_info.width = VGA_WIDTH; framebuffer.mode_info.height = vga_height; framebuffer.mode_info.mode_type = GRUB_VIDEO_MODE_TYPE_INDEX_COLOR; if (grub_video_check_mode_flag (mode_type, mode_mask, GRUB_VIDEO_MODE_TYPE_DOUBLE_BUFFERED, (VGA_WIDTH * vga_height <= (1 << 18)))) { framebuffer.back_page = 1; framebuffer.mode_info.mode_type |= GRUB_VIDEO_MODE_TYPE_DOUBLE_BUFFERED | GRUB_VIDEO_MODE_TYPE_UPDATING_SWAP; } framebuffer.mode_info.bpp = 8; framebuffer.mode_info.bytes_per_pixel = 1; framebuffer.mode_info.pitch = VGA_WIDTH; framebuffer.mode_info.number_of_colors = 16; framebuffer.mode_info.red_mask_size = 0; framebuffer.mode_info.red_field_pos = 0; framebuffer.mode_info.green_mask_size = 0; framebuffer.mode_info.green_field_pos = 0; framebuffer.mode_info.blue_mask_size = 0; framebuffer.mode_info.blue_field_pos = 0; framebuffer.mode_info.reserved_mask_size = 0; framebuffer.mode_info.reserved_field_pos = 0; framebuffer.mode_info.blit_format = grub_video_get_blit_format (&framebuffer.mode_info); err = grub_video_fb_create_render_target_from_pointer (&framebuffer.render_target, &framebuffer.mode_info, framebuffer.temporary_buffer); if (err) { grub_dprintf ("video", "Couldn't create FB target\n"); return err; } is_target = 1; err = grub_video_fb_set_active_render_target (framebuffer.render_target); if (err) return err; err = grub_video_fb_set_palette (0, GRUB_VIDEO_FBSTD_NUMCOLORS, grub_video_fbstd_colors); return GRUB_ERR_NONE; } static grub_err_t grub_video_vga_fini (void) { if (setup) { set_map_mask (saved_map_mask); grub_vga_set_mode (text_mode); } setup = 0; grub_free (framebuffer.temporary_buffer); framebuffer.temporary_buffer = 0; return GRUB_ERR_NONE; } static inline void update_target (void) { int plane; if (!is_target) return; for (plane = 0x01; plane <= 0x08; plane <<= 1) { grub_uint8_t *ptr; volatile grub_uint8_t *ptr2; unsigned cbyte = 0; int shift = 7; set_map_mask (plane); for (ptr = framebuffer.temporary_buffer, ptr2 = VGA_MEM + PAGE_OFFSET (framebuffer.back_page); ptr < framebuffer.temporary_buffer + VGA_WIDTH * vga_height; ptr++) { cbyte |= (!!(plane & *ptr)) << shift; shift--; if (shift == -1) { *ptr2++ = cbyte; shift = 7; cbyte = 0; } } } } static grub_err_t grub_video_vga_blit_bitmap (struct grub_video_bitmap *bitmap, enum grub_video_blit_operators oper, int x, int y, int offset_x, int offset_y, unsigned int width, unsigned int height) { grub_err_t ret; ret = grub_video_fb_blit_bitmap (bitmap, oper, x, y, offset_x, offset_y, width, height); if (!(framebuffer.mode_info.mode_type & GRUB_VIDEO_MODE_TYPE_DOUBLE_BUFFERED)) update_target (); return ret; } static grub_err_t grub_video_vga_blit_render_target (struct grub_video_fbrender_target *source, enum grub_video_blit_operators oper, int x, int y, int offset_x, int offset_y, unsigned int width, unsigned int height) { grub_err_t ret; ret = grub_video_fb_blit_render_target (source, oper, x, y, offset_x, offset_y, width, height); if (!(framebuffer.mode_info.mode_type & GRUB_VIDEO_MODE_TYPE_DOUBLE_BUFFERED)) update_target (); return ret; } static grub_err_t grub_video_vga_set_active_render_target (struct grub_video_render_target *target) { if (target == GRUB_VIDEO_RENDER_TARGET_DISPLAY) { is_target = 1; target = framebuffer.render_target; } else is_target = 0; return grub_video_fb_set_active_render_target (target); } static grub_err_t grub_video_vga_get_active_render_target (struct grub_video_render_target **target) { grub_err_t err; err = grub_video_fb_get_active_render_target (target); if (err) return err; if (*target == framebuffer.render_target) *target = GRUB_VIDEO_RENDER_TARGET_DISPLAY; return GRUB_ERR_NONE; } static grub_err_t grub_video_vga_swap_buffers (void) { if (!(framebuffer.mode_info.mode_type & GRUB_VIDEO_MODE_TYPE_DOUBLE_BUFFERED)) return GRUB_ERR_NONE; update_target (); if ((VGA_WIDTH * vga_height <= (1 << 18))) { /* Activate the other page. */ framebuffer.front_page = !framebuffer.front_page; framebuffer.back_page = !framebuffer.back_page; wait_vretrace (); set_start_address (PAGE_OFFSET (framebuffer.front_page)); } return GRUB_ERR_NONE; } static grub_err_t grub_video_vga_set_palette (unsigned int start __attribute__ ((unused)), unsigned int count __attribute__ ((unused)), struct grub_video_palette_data *palette_data __attribute__ ((unused))) { return grub_error (GRUB_ERR_IO, "can't change palette"); } static grub_err_t grub_video_vga_get_info_and_fini (struct grub_video_mode_info *mode_info, void **framebuf) { set_map_mask (0xf); grub_memcpy (mode_info, &(framebuffer.mode_info), sizeof (*mode_info)); mode_info->bpp = 1; mode_info->bytes_per_pixel = 0; mode_info->pitch = VGA_WIDTH / 8; mode_info->number_of_colors = 1; mode_info->bg_red = 0; mode_info->bg_green = 0; mode_info->bg_blue = 0; mode_info->bg_alpha = 255; mode_info->fg_red = 255; mode_info->fg_green = 255; mode_info->fg_blue = 255; mode_info->fg_alpha = 255; *framebuf = VGA_MEM + PAGE_OFFSET (framebuffer.front_page); grub_video_fb_fini (); grub_free (framebuffer.temporary_buffer); framebuffer.temporary_buffer = 0; setup = 0; return GRUB_ERR_NONE; } static struct grub_video_adapter grub_video_vga_adapter = { .name = "VGA Video Driver", .id = GRUB_VIDEO_DRIVER_VGA, .prio = GRUB_VIDEO_ADAPTER_PRIO_FALLBACK, .init = grub_video_vga_init, .fini = grub_video_vga_fini, .setup = grub_video_vga_setup, .get_info = grub_video_fb_get_info, .get_info_and_fini = grub_video_vga_get_info_and_fini, .set_palette = grub_video_vga_set_palette, .get_palette = grub_video_fb_get_palette, .set_viewport = grub_video_fb_set_viewport, .get_viewport = grub_video_fb_get_viewport, .map_color = grub_video_fb_map_color, .map_rgb = grub_video_fb_map_rgb, .map_rgba = grub_video_fb_map_rgba, .unmap_color = grub_video_fb_unmap_color, .fill_rect = grub_video_fb_fill_rect, .blit_bitmap = grub_video_vga_blit_bitmap, .blit_render_target = grub_video_vga_blit_render_target, .scroll = grub_video_fb_scroll, .swap_buffers = grub_video_vga_swap_buffers, .create_render_target = grub_video_fb_create_render_target, .delete_render_target = grub_video_fb_delete_render_target, .set_active_render_target = grub_video_vga_set_active_render_target, .get_active_render_target = grub_video_vga_get_active_render_target, .next = 0 }; GRUB_MOD_INIT(vga) { grub_video_register (&grub_video_vga_adapter); } GRUB_MOD_FINI(vga) { grub_video_unregister (&grub_video_vga_adapter); }