This adds a DM video driver for U-Boot as the EFI payload. The driver makes use of all necessary information from the passed EFI GOP info to create a linear framebuffer device, as if it were initialized by U-Boot itself. Signed-off-by: Bin Meng <bmeng.cn@gmail.com> Reviewed-by: Anatolij Gustschin <agust@denx.de>lime2-spi
parent
d1fe992746
commit
4a08c74697
@ -0,0 +1,146 @@ |
|||||||
|
// SPDX-License-Identifier: GPL-2.0+
|
||||||
|
/*
|
||||||
|
* Copyright (C) 2018, Bin Meng <bmeng.cn@gmail.com> |
||||||
|
* |
||||||
|
* EFI framebuffer driver based on GOP |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <common.h> |
||||||
|
#include <dm.h> |
||||||
|
#include <efi_api.h> |
||||||
|
#include <vbe.h> |
||||||
|
#include <video.h> |
||||||
|
|
||||||
|
struct pixel { |
||||||
|
u8 pos; |
||||||
|
u8 size; |
||||||
|
}; |
||||||
|
|
||||||
|
static const struct efi_framebuffer { |
||||||
|
struct pixel red; |
||||||
|
struct pixel green; |
||||||
|
struct pixel blue; |
||||||
|
struct pixel rsvd; |
||||||
|
} efi_framebuffer_format_map[] = { |
||||||
|
[EFI_GOT_RGBA8] = { {0, 8}, {8, 8}, {16, 8}, {24, 8} }, |
||||||
|
[EFI_GOT_BGRA8] = { {16, 8}, {8, 8}, {0, 8}, {24, 8} }, |
||||||
|
}; |
||||||
|
|
||||||
|
static void efi_find_pixel_bits(u32 mask, u8 *pos, u8 *size) |
||||||
|
{ |
||||||
|
u8 first, len; |
||||||
|
|
||||||
|
first = 0; |
||||||
|
len = 0; |
||||||
|
|
||||||
|
if (mask) { |
||||||
|
while (!(mask & 0x1)) { |
||||||
|
mask = mask >> 1; |
||||||
|
first++; |
||||||
|
} |
||||||
|
|
||||||
|
while (mask & 0x1) { |
||||||
|
mask = mask >> 1; |
||||||
|
len++; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
*pos = first; |
||||||
|
*size = len; |
||||||
|
} |
||||||
|
|
||||||
|
static int save_vesa_mode(struct vesa_mode_info *vesa) |
||||||
|
{ |
||||||
|
struct efi_entry_gopmode *mode; |
||||||
|
const struct efi_framebuffer *fbinfo; |
||||||
|
int size; |
||||||
|
int ret; |
||||||
|
|
||||||
|
ret = efi_info_get(EFIET_GOP_MODE, (void **)&mode, &size); |
||||||
|
if (ret == -ENOENT) { |
||||||
|
debug("efi graphics output protocol mode not found\n"); |
||||||
|
return -ENXIO; |
||||||
|
} |
||||||
|
|
||||||
|
vesa->phys_base_ptr = mode->fb_base; |
||||||
|
vesa->x_resolution = mode->info->width; |
||||||
|
vesa->y_resolution = mode->info->height; |
||||||
|
|
||||||
|
if (mode->info->pixel_format < EFI_GOT_BITMASK) { |
||||||
|
fbinfo = &efi_framebuffer_format_map[mode->info->pixel_format]; |
||||||
|
vesa->red_mask_size = fbinfo->red.size; |
||||||
|
vesa->red_mask_pos = fbinfo->red.pos; |
||||||
|
vesa->green_mask_size = fbinfo->green.size; |
||||||
|
vesa->green_mask_pos = fbinfo->green.pos; |
||||||
|
vesa->blue_mask_size = fbinfo->blue.size; |
||||||
|
vesa->blue_mask_pos = fbinfo->blue.pos; |
||||||
|
vesa->reserved_mask_size = fbinfo->rsvd.size; |
||||||
|
vesa->reserved_mask_pos = fbinfo->rsvd.pos; |
||||||
|
|
||||||
|
vesa->bits_per_pixel = 32; |
||||||
|
vesa->bytes_per_scanline = mode->info->pixels_per_scanline * 4; |
||||||
|
} else if (mode->info->pixel_format == EFI_GOT_BITMASK) { |
||||||
|
efi_find_pixel_bits(mode->info->pixel_bitmask[0], |
||||||
|
&vesa->red_mask_pos, |
||||||
|
&vesa->red_mask_size); |
||||||
|
efi_find_pixel_bits(mode->info->pixel_bitmask[1], |
||||||
|
&vesa->green_mask_pos, |
||||||
|
&vesa->green_mask_size); |
||||||
|
efi_find_pixel_bits(mode->info->pixel_bitmask[2], |
||||||
|
&vesa->blue_mask_pos, |
||||||
|
&vesa->blue_mask_size); |
||||||
|
efi_find_pixel_bits(mode->info->pixel_bitmask[3], |
||||||
|
&vesa->reserved_mask_pos, |
||||||
|
&vesa->reserved_mask_size); |
||||||
|
vesa->bits_per_pixel = vesa->red_mask_size + |
||||||
|
vesa->green_mask_size + |
||||||
|
vesa->blue_mask_size + |
||||||
|
vesa->reserved_mask_size; |
||||||
|
vesa->bytes_per_scanline = (mode->info->pixels_per_scanline * |
||||||
|
vesa->bits_per_pixel) / 8; |
||||||
|
} else { |
||||||
|
debug("efi set unknown framebuffer format: %d\n", |
||||||
|
mode->info->pixel_format); |
||||||
|
return -EINVAL; |
||||||
|
} |
||||||
|
|
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static int efi_video_probe(struct udevice *dev) |
||||||
|
{ |
||||||
|
struct video_uc_platdata *plat = dev_get_uclass_platdata(dev); |
||||||
|
struct video_priv *uc_priv = dev_get_uclass_priv(dev); |
||||||
|
struct vesa_mode_info *vesa = &mode_info.vesa; |
||||||
|
int ret; |
||||||
|
|
||||||
|
/* Initialize vesa_mode_info structure */ |
||||||
|
ret = save_vesa_mode(vesa); |
||||||
|
if (ret) |
||||||
|
goto err; |
||||||
|
|
||||||
|
ret = vbe_setup_video_priv(vesa, uc_priv, plat); |
||||||
|
if (ret) |
||||||
|
goto err; |
||||||
|
|
||||||
|
printf("Video: %dx%dx%d\n", uc_priv->xsize, uc_priv->ysize, |
||||||
|
vesa->bits_per_pixel); |
||||||
|
|
||||||
|
return 0; |
||||||
|
|
||||||
|
err: |
||||||
|
printf("No video mode configured in EFI!\n"); |
||||||
|
return ret; |
||||||
|
} |
||||||
|
|
||||||
|
static const struct udevice_id efi_video_ids[] = { |
||||||
|
{ .compatible = "efi-fb" }, |
||||||
|
{ } |
||||||
|
}; |
||||||
|
|
||||||
|
U_BOOT_DRIVER(efi_video) = { |
||||||
|
.name = "efi_video", |
||||||
|
.id = UCLASS_VIDEO, |
||||||
|
.of_match = efi_video_ids, |
||||||
|
.probe = efi_video_probe, |
||||||
|
}; |
Loading…
Reference in new issue