2005-08-15 21:25:41 +00:00
|
|
|
/*
|
|
|
|
* GRUB -- GRand Unified Bootloader
|
2009-01-02 15:26:06 +00:00
|
|
|
* Copyright (C) 2005,2006,2007,2008,2009 Free Software Foundation, Inc.
|
2005-08-15 21:25:41 +00:00
|
|
|
*
|
2007-07-21 23:32:33 +00:00
|
|
|
* GRUB is free software: you can redistribute it and/or modify
|
2005-08-15 21:25:41 +00:00
|
|
|
* it under the terms of the GNU General Public License as published by
|
2007-07-21 23:32:33 +00:00
|
|
|
* the Free Software Foundation, either version 3 of the License, or
|
2005-08-15 21:25:41 +00:00
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
2007-07-21 23:32:33 +00:00
|
|
|
* GRUB is distributed in the hope that it will be useful,
|
2005-08-15 21:25:41 +00:00
|
|
|
* 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
|
2007-07-21 23:32:33 +00:00
|
|
|
* along with GRUB. If not, see <http://www.gnu.org/licenses/>.
|
2005-08-15 21:25:41 +00:00
|
|
|
*/
|
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
#define grub_video_render_target grub_video_fbrender_target
|
|
|
|
|
2005-08-15 21:25:41 +00:00
|
|
|
#include <grub/err.h>
|
|
|
|
#include <grub/machine/memory.h>
|
2008-01-21 15:48:27 +00:00
|
|
|
#include <grub/machine/vga.h>
|
2005-08-15 21:25:41 +00:00
|
|
|
#include <grub/machine/vbe.h>
|
|
|
|
#include <grub/types.h>
|
|
|
|
#include <grub/dl.h>
|
|
|
|
#include <grub/misc.h>
|
|
|
|
#include <grub/mm.h>
|
2006-03-14 19:08:34 +00:00
|
|
|
#include <grub/video.h>
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
static int vbe_detected = -1;
|
|
|
|
|
|
|
|
static struct grub_vbe_info_block controller_info;
|
2009-08-17 13:37:22 +00:00
|
|
|
static struct grub_vbe_mode_info_block active_vbe_mode_info;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
static struct
|
|
|
|
{
|
2009-08-14 12:41:58 +00:00
|
|
|
struct grub_video_mode_info mode_info;
|
|
|
|
struct grub_video_render_target *render_target;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
|
|
|
unsigned int bytes_per_scan_line;
|
|
|
|
unsigned int bytes_per_pixel;
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_uint32_t active_vbe_mode;
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_uint8_t *ptr;
|
|
|
|
int index_color_mode;
|
2006-07-29 11:22:52 +00:00
|
|
|
} framebuffer;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
static grub_uint32_t initial_vbe_mode;
|
|
|
|
static grub_uint16_t *vbe_mode_list;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
|
|
|
static void *
|
|
|
|
real2pm (grub_vbe_farptr_t ptr)
|
|
|
|
{
|
|
|
|
return (void *) ((((unsigned long) ptr & 0xFFFF0000) >> 12UL)
|
|
|
|
+ ((unsigned long) ptr & 0x0000FFFF));
|
|
|
|
}
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
grub_err_t
|
|
|
|
grub_vbe_probe (struct grub_vbe_info_block *info_block)
|
|
|
|
{
|
|
|
|
struct grub_vbe_info_block *vbe_ib;
|
2005-08-19 00:32:01 +00:00
|
|
|
grub_vbe_status_t status;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-15 21:25:41 +00:00
|
|
|
/* Clear caller's controller info block. */
|
2005-08-19 00:32:01 +00:00
|
|
|
if (info_block)
|
|
|
|
grub_memset (info_block, 0, sizeof (*info_block));
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Do not probe more than one time, if not necessary. */
|
|
|
|
if (vbe_detected == -1 || info_block)
|
2005-08-15 21:25:41 +00:00
|
|
|
{
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Clear old copy of controller info block. */
|
|
|
|
grub_memset (&controller_info, 0, sizeof (controller_info));
|
|
|
|
|
|
|
|
/* Mark VESA BIOS extension as undetected. */
|
|
|
|
vbe_detected = 0;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Use low memory scratch area as temporary storage
|
2006-07-29 11:22:52 +00:00
|
|
|
for VESA BIOS call. */
|
2005-08-19 00:32:01 +00:00
|
|
|
vbe_ib = (struct grub_vbe_info_block *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Prepare info block. */
|
|
|
|
grub_memset (vbe_ib, 0, sizeof (*vbe_ib));
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
vbe_ib->signature[0] = 'V';
|
|
|
|
vbe_ib->signature[1] = 'B';
|
|
|
|
vbe_ib->signature[2] = 'E';
|
|
|
|
vbe_ib->signature[3] = '2';
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Try to get controller info block. */
|
2006-03-14 19:08:34 +00:00
|
|
|
status = grub_vbe_bios_get_controller_info (vbe_ib);
|
2009-08-04 21:28:19 +00:00
|
|
|
if (status == GRUB_VBE_STATUS_OK)
|
2006-07-29 11:22:52 +00:00
|
|
|
{
|
|
|
|
/* Copy it for later usage. */
|
|
|
|
grub_memcpy (&controller_info, vbe_ib, sizeof (controller_info));
|
|
|
|
|
|
|
|
/* Mark VESA BIOS extension as detected. */
|
|
|
|
vbe_detected = 1;
|
|
|
|
}
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
if (! vbe_detected)
|
|
|
|
return grub_error (GRUB_ERR_BAD_DEVICE, "VESA BIOS Extension not found");
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Make copy of controller info block to caller. */
|
|
|
|
if (info_block)
|
|
|
|
grub_memcpy (info_block, &controller_info, sizeof (*info_block));
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
grub_err_t
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_vbe_set_video_mode (grub_uint32_t vbe_mode,
|
2009-08-17 13:44:07 +00:00
|
|
|
struct grub_vbe_mode_info_block *vbe_mode_info)
|
2005-08-15 21:25:41 +00:00
|
|
|
{
|
2005-08-19 00:32:01 +00:00
|
|
|
grub_vbe_status_t status;
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_uint32_t old_vbe_mode;
|
2009-08-17 13:44:07 +00:00
|
|
|
struct grub_vbe_mode_info_block new_vbe_mode_info;
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_err_t err;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Make sure that VBE is supported. */
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_vbe_probe (0);
|
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_errno;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* Try to get mode info. */
|
2009-08-17 13:44:07 +00:00
|
|
|
grub_vbe_get_video_mode_info (vbe_mode, &new_vbe_mode_info);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_errno;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* For all VESA BIOS modes, force linear frame buffer. */
|
2009-08-17 13:37:22 +00:00
|
|
|
if (vbe_mode >= 0x100)
|
2005-08-15 21:25:41 +00:00
|
|
|
{
|
|
|
|
/* We only want linear frame buffer modes. */
|
2009-08-17 13:37:22 +00:00
|
|
|
vbe_mode |= 1 << 14;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* Determine frame buffer pixel format. */
|
2009-08-17 13:44:07 +00:00
|
|
|
switch (new_vbe_mode_info.memory_model)
|
2006-07-29 11:22:52 +00:00
|
|
|
{
|
|
|
|
case GRUB_VBE_MEMORY_MODEL_PACKED_PIXEL:
|
|
|
|
framebuffer.index_color_mode = 1;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case GRUB_VBE_MEMORY_MODEL_DIRECT_COLOR:
|
|
|
|
framebuffer.index_color_mode = 0;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
return grub_error (GRUB_ERR_NOT_IMPLEMENTED_YET,
|
|
|
|
"unsupported pixel format 0x%x",
|
2009-08-17 13:44:07 +00:00
|
|
|
new_vbe_mode_info.memory_model);
|
2006-07-29 11:22:52 +00:00
|
|
|
}
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Get current mode. */
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_vbe_get_video_mode (&old_vbe_mode);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_errno;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2005-08-15 21:25:41 +00:00
|
|
|
/* Try to set video mode. */
|
2009-08-17 13:37:22 +00:00
|
|
|
status = grub_vbe_bios_set_mode (vbe_mode, 0);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (status != GRUB_VBE_STATUS_OK)
|
2009-08-17 13:37:22 +00:00
|
|
|
return grub_error (GRUB_ERR_BAD_DEVICE, "cannot set VBE mode %x", vbe_mode);
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* Save information for later usage. */
|
2009-08-17 13:37:22 +00:00
|
|
|
framebuffer.active_vbe_mode = vbe_mode;
|
2009-08-17 13:44:07 +00:00
|
|
|
grub_memcpy (&active_vbe_mode_info, &new_vbe_mode_info, sizeof (active_vbe_mode_info));
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if (vbe_mode < 0x100)
|
2005-08-15 21:25:41 +00:00
|
|
|
{
|
|
|
|
/* If this is not a VESA mode, guess address. */
|
2008-01-21 15:48:27 +00:00
|
|
|
framebuffer.ptr = (grub_uint8_t *) GRUB_MEMORY_MACHINE_VGA_ADDR;
|
2006-03-14 19:08:34 +00:00
|
|
|
framebuffer.index_color_mode = 1;
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
2009-08-17 13:44:07 +00:00
|
|
|
framebuffer.ptr = (grub_uint8_t *) new_vbe_mode_info.phys_base_addr;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
if (controller_info.version >= 0x300)
|
2009-08-17 13:44:07 +00:00
|
|
|
framebuffer.bytes_per_scan_line = new_vbe_mode_info.lin_bytes_per_scan_line;
|
2005-08-15 21:25:41 +00:00
|
|
|
else
|
2009-08-17 13:44:07 +00:00
|
|
|
framebuffer.bytes_per_scan_line = new_vbe_mode_info.bytes_per_scan_line;
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-02-05 18:28:58 +00:00
|
|
|
/* Check whether mode is text mode or graphics mode. */
|
2009-08-17 13:44:07 +00:00
|
|
|
if (new_vbe_mode_info.memory_model == GRUB_VBE_MEMORY_MODEL_TEXT)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-02-05 18:28:58 +00:00
|
|
|
/* Text mode. */
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2009-02-05 18:28:58 +00:00
|
|
|
/* No special action needed for text mode as it is not supported for
|
|
|
|
graphical support. */
|
|
|
|
}
|
|
|
|
else
|
2005-08-15 21:25:41 +00:00
|
|
|
{
|
2009-02-05 18:28:58 +00:00
|
|
|
/* Graphics mode. */
|
|
|
|
|
|
|
|
/* Calculate bytes_per_pixel value. */
|
2009-08-17 13:44:07 +00:00
|
|
|
switch(new_vbe_mode_info.bits_per_pixel)
|
2009-02-05 18:28:58 +00:00
|
|
|
{
|
|
|
|
case 32: framebuffer.bytes_per_pixel = 4; break;
|
|
|
|
case 24: framebuffer.bytes_per_pixel = 3; break;
|
|
|
|
case 16: framebuffer.bytes_per_pixel = 2; break;
|
|
|
|
case 15: framebuffer.bytes_per_pixel = 2; break;
|
|
|
|
case 8: framebuffer.bytes_per_pixel = 1; break;
|
|
|
|
default:
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_vbe_bios_set_mode (old_vbe_mode, 0);
|
2009-02-05 18:28:58 +00:00
|
|
|
return grub_error (GRUB_ERR_BAD_DEVICE,
|
|
|
|
"cannot set VBE mode %x",
|
2009-08-17 13:37:22 +00:00
|
|
|
vbe_mode);
|
2009-02-05 18:28:58 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* If video mode is in indexed color, setup default VGA palette. */
|
|
|
|
if (framebuffer.index_color_mode)
|
|
|
|
{
|
|
|
|
struct grub_vbe_palette_data *palette
|
|
|
|
= (struct grub_vbe_palette_data *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
|
2009-08-14 12:41:58 +00:00
|
|
|
unsigned i;
|
2009-02-05 18:28:58 +00:00
|
|
|
|
|
|
|
/* Make sure that the BIOS can reach the palette. */
|
2009-08-14 12:41:58 +00:00
|
|
|
for (i = 0; i < GRUB_VIDEO_FBSTD_NUMCOLORS; i++)
|
|
|
|
{
|
|
|
|
palette[i].red = grub_video_fbstd_colors[i].r;
|
|
|
|
palette[i].green = grub_video_fbstd_colors[i].g;
|
|
|
|
palette[i].blue = grub_video_fbstd_colors[i].b;
|
|
|
|
palette[i].alignment = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
status = grub_vbe_bios_set_palette_data (GRUB_VIDEO_FBSTD_NUMCOLORS,
|
|
|
|
0, palette);
|
2009-02-05 18:28:58 +00:00
|
|
|
|
|
|
|
/* Just ignore the status. */
|
2009-08-14 12:41:58 +00:00
|
|
|
err = grub_video_fb_set_palette (0, GRUB_VIDEO_FBSTD_NUMCOLORS,
|
|
|
|
grub_video_fbstd_colors);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
2009-02-05 18:28:58 +00:00
|
|
|
}
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Copy mode info for caller. */
|
2009-08-17 13:37:22 +00:00
|
|
|
if (vbe_mode_info)
|
2009-08-17 13:44:07 +00:00
|
|
|
grub_memcpy (vbe_mode_info, &new_vbe_mode_info, sizeof (*vbe_mode_info));
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
grub_err_t
|
|
|
|
grub_vbe_get_video_mode (grub_uint32_t *mode)
|
|
|
|
{
|
2005-08-19 00:32:01 +00:00
|
|
|
grub_vbe_status_t status;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Make sure that VBE is supported. */
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_vbe_probe (0);
|
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_errno;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* Try to query current mode from VESA BIOS. */
|
2006-03-14 19:08:34 +00:00
|
|
|
status = grub_vbe_bios_get_mode (mode);
|
|
|
|
if (status != GRUB_VBE_STATUS_OK)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_error (GRUB_ERR_BAD_DEVICE, "cannot get current VBE mode");
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
grub_err_t
|
|
|
|
grub_vbe_get_video_mode_info (grub_uint32_t mode,
|
|
|
|
struct grub_vbe_mode_info_block *mode_info)
|
|
|
|
{
|
2005-08-19 00:32:01 +00:00
|
|
|
struct grub_vbe_mode_info_block *mi_tmp
|
|
|
|
= (struct grub_vbe_mode_info_block *) GRUB_MEMORY_MACHINE_SCRATCH_ADDR;
|
|
|
|
grub_vbe_status_t status;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Make sure that VBE is supported. */
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_vbe_probe (0);
|
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
2005-08-19 00:32:01 +00:00
|
|
|
return grub_errno;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* If mode is not VESA mode, skip mode info query. */
|
|
|
|
if (mode >= 0x100)
|
|
|
|
{
|
|
|
|
/* Try to get mode info from VESA BIOS. */
|
2006-03-14 19:08:34 +00:00
|
|
|
status = grub_vbe_bios_get_mode_info (mode, mi_tmp);
|
|
|
|
if (status != GRUB_VBE_STATUS_OK)
|
2006-07-29 11:22:52 +00:00
|
|
|
return grub_error (GRUB_ERR_BAD_DEVICE,
|
|
|
|
"cannot get information on the mode %x", mode);
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
/* Make copy of mode info block. */
|
2005-08-19 00:32:01 +00:00
|
|
|
grub_memcpy (mode_info, mi_tmp, sizeof (*mode_info));
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|
|
|
|
else
|
2005-08-19 00:32:01 +00:00
|
|
|
/* Just clear mode info block if it isn't a VESA mode. */
|
|
|
|
grub_memset (mode_info, 0, sizeof (*mode_info));
|
2005-08-15 21:25:41 +00:00
|
|
|
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
static grub_err_t
|
|
|
|
grub_video_vbe_init (void)
|
|
|
|
{
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_uint16_t *rm_vbe_mode_list;
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_uint16_t *p;
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_size_t vbe_mode_list_size;
|
2006-03-14 19:08:34 +00:00
|
|
|
struct grub_vbe_info_block info_block;
|
2005-08-15 21:25:41 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Check if there is adapter present.
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
Firmware note: There has been a report that some cards store video mode
|
|
|
|
list in temporary memory. So we must first use vbe probe to get
|
|
|
|
refreshed information to receive valid pointers and data, and then
|
|
|
|
copy this information to somewhere safe. */
|
|
|
|
grub_vbe_probe (&info_block);
|
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
|
|
|
return grub_errno;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Copy modelist to local memory. */
|
2009-08-17 13:37:22 +00:00
|
|
|
p = rm_vbe_mode_list = real2pm (info_block.video_mode_ptr);
|
2006-03-14 19:08:34 +00:00
|
|
|
while(*p++ != 0xFFFF)
|
|
|
|
;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
vbe_mode_list_size = (grub_addr_t) p - (grub_addr_t) rm_vbe_mode_list;
|
|
|
|
vbe_mode_list = grub_malloc (vbe_mode_list_size);
|
|
|
|
if (! vbe_mode_list)
|
2006-03-14 19:08:34 +00:00
|
|
|
return grub_errno;
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_memcpy (vbe_mode_list, rm_vbe_mode_list, vbe_mode_list_size);
|
2006-03-14 19:08:34 +00:00
|
|
|
|
|
|
|
/* Adapter could be found, figure out initial video mode. */
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_vbe_get_video_mode (&initial_vbe_mode);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
|
|
|
{
|
|
|
|
/* Free allocated resources. */
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_free (vbe_mode_list);
|
|
|
|
vbe_mode_list = NULL;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
return grub_errno;
|
|
|
|
}
|
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
/* Reset frame buffer. */
|
2006-07-31 14:21:36 +00:00
|
|
|
grub_memset (&framebuffer, 0, sizeof(framebuffer));
|
2006-03-14 19:08:34 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
return grub_video_fb_init ();
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static grub_err_t
|
|
|
|
grub_video_vbe_fini (void)
|
|
|
|
{
|
|
|
|
grub_vbe_status_t status;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Restore old video mode. */
|
2009-08-17 13:37:22 +00:00
|
|
|
status = grub_vbe_bios_set_mode (initial_vbe_mode, 0);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (status != GRUB_VBE_STATUS_OK)
|
|
|
|
/* TODO: Decide, is this something we want to do. */
|
|
|
|
return grub_errno;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* TODO: Free any resources allocated by driver. */
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_free (vbe_mode_list);
|
|
|
|
vbe_mode_list = NULL;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
|
|
|
/* TODO: destroy render targets. */
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
return grub_video_fb_fini ();
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static grub_err_t
|
|
|
|
grub_video_vbe_setup (unsigned int width, unsigned int height,
|
2009-11-14 15:25:50 +00:00
|
|
|
unsigned int mode_type, unsigned int mode_mask)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
|
|
|
grub_uint16_t *p;
|
2009-08-17 13:37:22 +00:00
|
|
|
struct grub_vbe_mode_info_block vbe_mode_info;
|
|
|
|
struct grub_vbe_mode_info_block best_vbe_mode_info;
|
|
|
|
grub_uint32_t best_vbe_mode = 0;
|
2006-03-14 19:08:34 +00:00
|
|
|
int depth;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Decode depth from mode_type. If it is zero, then autodetect. */
|
2008-09-07 15:55:58 +00:00
|
|
|
depth = (mode_type & GRUB_VIDEO_MODE_TYPE_DEPTH_MASK)
|
2006-03-14 19:08:34 +00:00
|
|
|
>> GRUB_VIDEO_MODE_TYPE_DEPTH_POS;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Walk thru mode list and try to find matching mode. */
|
2009-08-17 13:37:22 +00:00
|
|
|
for (p = vbe_mode_list; *p != 0xFFFF; p++)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_uint32_t vbe_mode = *p;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_vbe_get_video_mode_info (vbe_mode, &vbe_mode_info);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
|
|
|
{
|
|
|
|
/* Could not retrieve mode info, retreat. */
|
|
|
|
grub_errno = GRUB_ERR_NONE;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.mode_attributes & 0x001) == 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* If not available, skip it. */
|
|
|
|
continue;
|
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.mode_attributes & 0x002) == 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Not enough information. */
|
|
|
|
continue;
|
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.mode_attributes & 0x008) == 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Monochrome is unusable. */
|
|
|
|
continue;
|
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.mode_attributes & 0x080) == 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* We support only linear frame buffer modes. */
|
|
|
|
continue;
|
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.mode_attributes & 0x010) == 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* We allow only graphical modes. */
|
|
|
|
continue;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((vbe_mode_info.memory_model != GRUB_VBE_MEMORY_MODEL_PACKED_PIXEL)
|
|
|
|
&& (vbe_mode_info.memory_model != GRUB_VBE_MEMORY_MODEL_DIRECT_COLOR))
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Not compatible memory model. */
|
|
|
|
continue;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-11-14 15:25:50 +00:00
|
|
|
if (((vbe_mode_info.x_resolution != width)
|
|
|
|
|| (vbe_mode_info.y_resolution != height)) && width != 0 && height != 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Non matching resolution. */
|
|
|
|
continue;
|
|
|
|
|
|
|
|
/* Check if user requested RGB or index color mode. */
|
2009-11-14 15:25:50 +00:00
|
|
|
if ((mode_mask & GRUB_VIDEO_MODE_TYPE_COLOR_MASK) != 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-11-14 15:25:50 +00:00
|
|
|
unsigned my_mode_type = 0;
|
|
|
|
|
|
|
|
if (vbe_mode_info.memory_model == GRUB_VBE_MEMORY_MODEL_PACKED_PIXEL)
|
|
|
|
my_mode_type |= GRUB_VIDEO_MODE_TYPE_INDEX_COLOR;
|
|
|
|
|
|
|
|
if (vbe_mode_info.memory_model == GRUB_VBE_MEMORY_MODEL_DIRECT_COLOR)
|
|
|
|
my_mode_type |= GRUB_VIDEO_MODE_TYPE_RGB;
|
|
|
|
|
|
|
|
if ((my_mode_type & mode_mask
|
|
|
|
& (GRUB_VIDEO_MODE_TYPE_RGB | GRUB_VIDEO_MODE_TYPE_INDEX_COLOR))
|
|
|
|
!= (mode_type & mode_mask
|
|
|
|
& (GRUB_VIDEO_MODE_TYPE_RGB
|
|
|
|
| GRUB_VIDEO_MODE_TYPE_INDEX_COLOR)))
|
|
|
|
continue;
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* If there is a request for specific depth, ignore others. */
|
2009-08-17 13:37:22 +00:00
|
|
|
if ((depth != 0) && (vbe_mode_info.bits_per_pixel != depth))
|
2006-03-14 19:08:34 +00:00
|
|
|
continue;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-11-14 15:25:50 +00:00
|
|
|
/* Select mode with most of "volume" (size of framebuffer in bits). */
|
2009-08-17 13:37:22 +00:00
|
|
|
if (best_vbe_mode != 0)
|
2009-11-14 15:25:50 +00:00
|
|
|
if ((grub_uint64_t) vbe_mode_info.bits_per_pixel
|
|
|
|
* vbe_mode_info.x_resolution * vbe_mode_info.y_resolution
|
|
|
|
< (grub_uint64_t) best_vbe_mode_info.bits_per_pixel
|
|
|
|
* best_vbe_mode_info.x_resolution * best_vbe_mode_info.y_resolution)
|
2006-03-14 19:08:34 +00:00
|
|
|
continue;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
/* Save so far best mode information for later use. */
|
2009-08-17 13:37:22 +00:00
|
|
|
best_vbe_mode = vbe_mode;
|
|
|
|
grub_memcpy (&best_vbe_mode_info, &vbe_mode_info, sizeof (vbe_mode_info));
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Try to initialize best mode found. */
|
2009-08-17 13:37:22 +00:00
|
|
|
if (best_vbe_mode != 0)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_err_t err;
|
2008-09-07 15:55:58 +00:00
|
|
|
/* If this fails, then we have mode selection heuristics problem,
|
2006-03-14 19:08:34 +00:00
|
|
|
or adapter failure. */
|
2009-08-17 13:44:07 +00:00
|
|
|
/* grub_vbe_set_video_mode already sets active_vbe_mode_info. */
|
|
|
|
grub_vbe_set_video_mode (best_vbe_mode, NULL);
|
2006-03-14 19:08:34 +00:00
|
|
|
if (grub_errno != GRUB_ERR_NONE)
|
|
|
|
return grub_errno;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
/* Fill mode info details. */
|
2009-08-17 13:37:22 +00:00
|
|
|
framebuffer.mode_info.width = active_vbe_mode_info.x_resolution;
|
|
|
|
framebuffer.mode_info.height = active_vbe_mode_info.y_resolution;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
|
|
|
if (framebuffer.index_color_mode)
|
2009-08-14 12:41:58 +00:00
|
|
|
framebuffer.mode_info.mode_type = GRUB_VIDEO_MODE_TYPE_INDEX_COLOR;
|
2006-03-14 19:08:34 +00:00
|
|
|
else
|
2009-08-14 12:41:58 +00:00
|
|
|
framebuffer.mode_info.mode_type = GRUB_VIDEO_MODE_TYPE_RGB;
|
2006-03-14 19:08:34 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
framebuffer.mode_info.bpp = active_vbe_mode_info.bits_per_pixel;
|
2009-08-14 12:41:58 +00:00
|
|
|
framebuffer.mode_info.bytes_per_pixel = framebuffer.bytes_per_pixel;
|
|
|
|
framebuffer.mode_info.pitch = framebuffer.bytes_per_scan_line;
|
|
|
|
framebuffer.mode_info.number_of_colors = 256; /* TODO: fix me. */
|
2009-08-17 13:37:22 +00:00
|
|
|
framebuffer.mode_info.red_mask_size = active_vbe_mode_info.red_mask_size;
|
|
|
|
framebuffer.mode_info.red_field_pos = active_vbe_mode_info.red_field_position;
|
|
|
|
framebuffer.mode_info.green_mask_size = active_vbe_mode_info.green_mask_size;
|
|
|
|
framebuffer.mode_info.green_field_pos = active_vbe_mode_info.green_field_position;
|
|
|
|
framebuffer.mode_info.blue_mask_size = active_vbe_mode_info.blue_mask_size;
|
|
|
|
framebuffer.mode_info.blue_field_pos = active_vbe_mode_info.blue_field_position;
|
|
|
|
framebuffer.mode_info.reserved_mask_size = active_vbe_mode_info.rsvd_mask_size;
|
|
|
|
framebuffer.mode_info.reserved_field_pos = active_vbe_mode_info.rsvd_field_position;
|
2009-08-14 12:41:58 +00:00
|
|
|
|
|
|
|
framebuffer.mode_info.blit_format = grub_video_get_blit_format (&framebuffer.mode_info);
|
2006-03-14 19:08:34 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
err = grub_video_fb_create_render_target_from_pointer (&framebuffer.render_target, &framebuffer.mode_info, framebuffer.ptr);
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
err = grub_video_fb_set_active_render_target (framebuffer.render_target);
|
|
|
|
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
/* Copy default palette to initialize emulated palette. */
|
|
|
|
err = grub_video_fb_set_palette (0, GRUB_VIDEO_FBSTD_NUMCOLORS,
|
|
|
|
grub_video_fbstd_colors);
|
|
|
|
return err;
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Couldn't found matching mode. */
|
|
|
|
return grub_error (GRUB_ERR_UNKNOWN_DEVICE, "no matching mode found.");
|
|
|
|
}
|
|
|
|
|
|
|
|
static grub_err_t
|
|
|
|
grub_video_vbe_set_palette (unsigned int start, unsigned int count,
|
|
|
|
struct grub_video_palette_data *palette_data)
|
|
|
|
{
|
|
|
|
if (framebuffer.index_color_mode)
|
|
|
|
{
|
|
|
|
/* TODO: Implement setting indexed color mode palette to hardware. */
|
2008-09-07 15:55:58 +00:00
|
|
|
//status = grub_vbe_bios_set_palette_data (sizeof (vga_colors)
|
|
|
|
// / sizeof (struct grub_vbe_palette_data),
|
|
|
|
// 0,
|
2006-03-14 19:08:34 +00:00
|
|
|
// palette);
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Then set color to emulated palette. */
|
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
return grub_video_fb_set_palette (start, count, palette_data);
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
2008-09-07 15:55:58 +00:00
|
|
|
static grub_err_t
|
2006-03-14 19:08:34 +00:00
|
|
|
grub_video_vbe_swap_buffers (void)
|
|
|
|
{
|
|
|
|
/* TODO: Implement buffer swapping. */
|
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
static grub_err_t
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_video_vbe_set_active_render_target (struct grub_video_render_target *target)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-08-14 12:41:58 +00:00
|
|
|
if (target == GRUB_VIDEO_RENDER_TARGET_DISPLAY)
|
|
|
|
target = framebuffer.render_target;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
return grub_video_fb_set_active_render_target (target);
|
2006-03-14 19:08:34 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static grub_err_t
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_video_vbe_get_info_and_fini (struct grub_video_mode_info *mode_info,
|
|
|
|
void **framebuf)
|
2006-03-14 19:08:34 +00:00
|
|
|
{
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_memcpy (mode_info, &(framebuffer.mode_info), sizeof (*mode_info));
|
|
|
|
*framebuf = (char *) framebuffer.ptr;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-17 13:37:22 +00:00
|
|
|
grub_free (vbe_mode_list);
|
|
|
|
vbe_mode_list = NULL;
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2009-08-14 12:41:58 +00:00
|
|
|
grub_video_fb_fini ();
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
return GRUB_ERR_NONE;
|
|
|
|
}
|
|
|
|
|
2008-01-01 12:02:07 +00:00
|
|
|
|
2006-03-14 19:08:34 +00:00
|
|
|
static struct grub_video_adapter grub_video_vbe_adapter =
|
|
|
|
{
|
|
|
|
.name = "VESA BIOS Extension Video Driver",
|
|
|
|
|
|
|
|
.init = grub_video_vbe_init,
|
|
|
|
.fini = grub_video_vbe_fini,
|
|
|
|
.setup = grub_video_vbe_setup,
|
2009-08-14 12:41:58 +00:00
|
|
|
.get_info = grub_video_fb_get_info,
|
|
|
|
.get_info_and_fini = grub_video_vbe_get_info_and_fini,
|
2006-03-14 19:08:34 +00:00
|
|
|
.set_palette = grub_video_vbe_set_palette,
|
2009-08-14 12:41:58 +00:00
|
|
|
.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_fb_blit_bitmap,
|
|
|
|
.blit_render_target = grub_video_fb_blit_render_target,
|
|
|
|
.scroll = grub_video_fb_scroll,
|
2006-03-14 19:08:34 +00:00
|
|
|
.swap_buffers = grub_video_vbe_swap_buffers,
|
2009-08-14 12:41:58 +00:00
|
|
|
.create_render_target = grub_video_fb_create_render_target,
|
|
|
|
.delete_render_target = grub_video_fb_delete_render_target,
|
2006-03-14 19:08:34 +00:00
|
|
|
.set_active_render_target = grub_video_vbe_set_active_render_target,
|
2009-08-14 12:41:58 +00:00
|
|
|
.get_active_render_target = grub_video_fb_get_active_render_target,
|
2006-07-29 11:22:52 +00:00
|
|
|
|
2006-07-31 14:21:36 +00:00
|
|
|
.next = 0
|
2006-03-14 19:08:34 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
GRUB_MOD_INIT(video_i386_pc_vbe)
|
|
|
|
{
|
|
|
|
grub_video_register (&grub_video_vbe_adapter);
|
|
|
|
}
|
|
|
|
|
|
|
|
GRUB_MOD_FINI(video_i386_pc_vbe)
|
|
|
|
{
|
|
|
|
grub_video_unregister (&grub_video_vbe_adapter);
|
2005-08-15 21:25:41 +00:00
|
|
|
}
|