14febfb8dSArd Biesheuvel // SPDX-License-Identifier: GPL-2.0 2fc372064SArd Biesheuvel /* ----------------------------------------------------------------------- 3fc372064SArd Biesheuvel * 4fc372064SArd Biesheuvel * Copyright 2011 Intel Corporation; author Matt Fleming 5fc372064SArd Biesheuvel * 6fc372064SArd Biesheuvel * ----------------------------------------------------------------------- */ 7fc372064SArd Biesheuvel 8fc372064SArd Biesheuvel #include <linux/efi.h> 9fc372064SArd Biesheuvel #include <linux/screen_info.h> 10fc372064SArd Biesheuvel #include <asm/efi.h> 11fc372064SArd Biesheuvel #include <asm/setup.h> 12fc372064SArd Biesheuvel 132fcdad2aSArd Biesheuvel #include "efistub.h" 142fcdad2aSArd Biesheuvel 15fc372064SArd Biesheuvel static void find_bits(unsigned long mask, u8 *pos, u8 *size) 16fc372064SArd Biesheuvel { 17fc372064SArd Biesheuvel u8 first, len; 18fc372064SArd Biesheuvel 19fc372064SArd Biesheuvel first = 0; 20fc372064SArd Biesheuvel len = 0; 21fc372064SArd Biesheuvel 22fc372064SArd Biesheuvel if (mask) { 23fc372064SArd Biesheuvel while (!(mask & 0x1)) { 24fc372064SArd Biesheuvel mask = mask >> 1; 25fc372064SArd Biesheuvel first++; 26fc372064SArd Biesheuvel } 27fc372064SArd Biesheuvel 28fc372064SArd Biesheuvel while (mask & 0x1) { 29fc372064SArd Biesheuvel mask = mask >> 1; 30fc372064SArd Biesheuvel len++; 31fc372064SArd Biesheuvel } 32fc372064SArd Biesheuvel } 33fc372064SArd Biesheuvel 34fc372064SArd Biesheuvel *pos = first; 35fc372064SArd Biesheuvel *size = len; 36fc372064SArd Biesheuvel } 37fc372064SArd Biesheuvel 38fc372064SArd Biesheuvel static void 39fc372064SArd Biesheuvel setup_pixel_info(struct screen_info *si, u32 pixels_per_scan_line, 4044c84b4aSArvind Sankar efi_pixel_bitmask_t pixel_info, int pixel_format) 41fc372064SArd Biesheuvel { 42fc372064SArd Biesheuvel if (pixel_format == PIXEL_RGB_RESERVED_8BIT_PER_COLOR) { 43fc372064SArd Biesheuvel si->lfb_depth = 32; 44fc372064SArd Biesheuvel si->lfb_linelength = pixels_per_scan_line * 4; 45fc372064SArd Biesheuvel si->red_size = 8; 46fc372064SArd Biesheuvel si->red_pos = 0; 47fc372064SArd Biesheuvel si->green_size = 8; 48fc372064SArd Biesheuvel si->green_pos = 8; 49fc372064SArd Biesheuvel si->blue_size = 8; 50fc372064SArd Biesheuvel si->blue_pos = 16; 51fc372064SArd Biesheuvel si->rsvd_size = 8; 52fc372064SArd Biesheuvel si->rsvd_pos = 24; 53fc372064SArd Biesheuvel } else if (pixel_format == PIXEL_BGR_RESERVED_8BIT_PER_COLOR) { 54fc372064SArd Biesheuvel si->lfb_depth = 32; 55fc372064SArd Biesheuvel si->lfb_linelength = pixels_per_scan_line * 4; 56fc372064SArd Biesheuvel si->red_size = 8; 57fc372064SArd Biesheuvel si->red_pos = 16; 58fc372064SArd Biesheuvel si->green_size = 8; 59fc372064SArd Biesheuvel si->green_pos = 8; 60fc372064SArd Biesheuvel si->blue_size = 8; 61fc372064SArd Biesheuvel si->blue_pos = 0; 62fc372064SArd Biesheuvel si->rsvd_size = 8; 63fc372064SArd Biesheuvel si->rsvd_pos = 24; 64fc372064SArd Biesheuvel } else if (pixel_format == PIXEL_BIT_MASK) { 65fc372064SArd Biesheuvel find_bits(pixel_info.red_mask, &si->red_pos, &si->red_size); 66fc372064SArd Biesheuvel find_bits(pixel_info.green_mask, &si->green_pos, 67fc372064SArd Biesheuvel &si->green_size); 68fc372064SArd Biesheuvel find_bits(pixel_info.blue_mask, &si->blue_pos, &si->blue_size); 69fc372064SArd Biesheuvel find_bits(pixel_info.reserved_mask, &si->rsvd_pos, 70fc372064SArd Biesheuvel &si->rsvd_size); 71fc372064SArd Biesheuvel si->lfb_depth = si->red_size + si->green_size + 72fc372064SArd Biesheuvel si->blue_size + si->rsvd_size; 73fc372064SArd Biesheuvel si->lfb_linelength = (pixels_per_scan_line * si->lfb_depth) / 8; 74fc372064SArd Biesheuvel } else { 75fc372064SArd Biesheuvel si->lfb_depth = 4; 76fc372064SArd Biesheuvel si->lfb_linelength = si->lfb_width / 2; 77fc372064SArd Biesheuvel si->red_size = 0; 78fc372064SArd Biesheuvel si->red_pos = 0; 79fc372064SArd Biesheuvel si->green_size = 0; 80fc372064SArd Biesheuvel si->green_pos = 0; 81fc372064SArd Biesheuvel si->blue_size = 0; 82fc372064SArd Biesheuvel si->blue_pos = 0; 83fc372064SArd Biesheuvel si->rsvd_size = 0; 84fc372064SArd Biesheuvel si->rsvd_pos = 0; 85fc372064SArd Biesheuvel } 86fc372064SArd Biesheuvel } 87fc372064SArd Biesheuvel 888de8788dSArvind Sankar #define efi_gop_attr(table, attr, instance) \ 898de8788dSArvind Sankar (efi_table_attr(efi_graphics_output_protocol##table, attr, instance)) 908de8788dSArvind Sankar 91cd33a5c1SArd Biesheuvel static efi_status_t setup_gop(struct screen_info *si, efi_guid_t *proto, 92cd33a5c1SArd Biesheuvel unsigned long size, void **handles) 93fc372064SArd Biesheuvel { 948de8788dSArvind Sankar efi_graphics_output_protocol_t *gop, *first_gop; 95fc372064SArd Biesheuvel u16 width, height; 96fc372064SArd Biesheuvel u32 pixels_per_scan_line; 97fc372064SArd Biesheuvel u32 ext_lfb_base; 9844c84b4aSArvind Sankar efi_physical_addr_t fb_base; 9944c84b4aSArvind Sankar efi_pixel_bitmask_t pixel_info; 100fc372064SArd Biesheuvel int pixel_format; 1016fc3cec3SArvind Sankar efi_status_t status; 1022732ea0dSArd Biesheuvel efi_handle_t h; 103fc372064SArd Biesheuvel int i; 104fc372064SArd Biesheuvel 105fc372064SArd Biesheuvel first_gop = NULL; 1068de8788dSArvind Sankar gop = NULL; 107fc372064SArd Biesheuvel 1082732ea0dSArd Biesheuvel for_each_efi_handle(h, handles, size, i) { 1098de8788dSArvind Sankar efi_graphics_output_protocol_mode_t *mode; 11044c84b4aSArvind Sankar efi_graphics_output_mode_info_t *info = NULL; 111fc372064SArd Biesheuvel efi_guid_t conout_proto = EFI_CONSOLE_OUT_DEVICE_GUID; 112fc372064SArd Biesheuvel bool conout_found = false; 113fc372064SArd Biesheuvel void *dummy = NULL; 11444c84b4aSArvind Sankar efi_physical_addr_t current_fb_base; 115fc372064SArd Biesheuvel 116fc372064SArd Biesheuvel status = efi_call_early(handle_protocol, h, 1178de8788dSArvind Sankar proto, (void **)&gop); 118fc372064SArd Biesheuvel if (status != EFI_SUCCESS) 119fc372064SArd Biesheuvel continue; 120fc372064SArd Biesheuvel 121fc372064SArd Biesheuvel status = efi_call_early(handle_protocol, h, 122fc372064SArd Biesheuvel &conout_proto, &dummy); 123fc372064SArd Biesheuvel if (status == EFI_SUCCESS) 124fc372064SArd Biesheuvel conout_found = true; 125fc372064SArd Biesheuvel 1268de8788dSArvind Sankar mode = (void *)(unsigned long)efi_gop_attr(, mode, gop); 1278de8788dSArvind Sankar info = (void *)(unsigned long)efi_gop_attr(_mode, info, mode); 1288de8788dSArvind Sankar current_fb_base = efi_gop_attr(_mode, frame_buffer_base, mode); 129ff397be6SArvind Sankar 130ff397be6SArvind Sankar if ((!first_gop || conout_found) && 131540f4c0eSCohen, Eugene info->pixel_format != PIXEL_BLT_ONLY) { 132fc372064SArd Biesheuvel /* 133fc372064SArd Biesheuvel * Systems that use the UEFI Console Splitter may 134fc372064SArd Biesheuvel * provide multiple GOP devices, not all of which are 135fc372064SArd Biesheuvel * backed by real hardware. The workaround is to search 136fc372064SArd Biesheuvel * for a GOP implementing the ConOut protocol, and if 137fc372064SArd Biesheuvel * one isn't found, to just fall back to the first GOP. 138fc372064SArd Biesheuvel */ 139fc372064SArd Biesheuvel width = info->horizontal_resolution; 140fc372064SArd Biesheuvel height = info->vertical_resolution; 141fc372064SArd Biesheuvel pixel_format = info->pixel_format; 142fc372064SArd Biesheuvel pixel_info = info->pixel_information; 143fc372064SArd Biesheuvel pixels_per_scan_line = info->pixels_per_scan_line; 144fc372064SArd Biesheuvel fb_base = current_fb_base; 145fc372064SArd Biesheuvel 146fc372064SArd Biesheuvel /* 147fc372064SArd Biesheuvel * Once we've found a GOP supporting ConOut, 148fc372064SArd Biesheuvel * don't bother looking any further. 149fc372064SArd Biesheuvel */ 1508de8788dSArvind Sankar first_gop = gop; 151fc372064SArd Biesheuvel if (conout_found) 152fc372064SArd Biesheuvel break; 153fc372064SArd Biesheuvel } 154fc372064SArd Biesheuvel } 155fc372064SArd Biesheuvel 156fc372064SArd Biesheuvel /* Did we find any GOPs? */ 157fc372064SArd Biesheuvel if (!first_gop) 1586fc3cec3SArvind Sankar return EFI_NOT_FOUND; 159fc372064SArd Biesheuvel 160fc372064SArd Biesheuvel /* EFI framebuffer */ 161fc372064SArd Biesheuvel si->orig_video_isVGA = VIDEO_TYPE_EFI; 162fc372064SArd Biesheuvel 163fc372064SArd Biesheuvel si->lfb_width = width; 164fc372064SArd Biesheuvel si->lfb_height = height; 165fc372064SArd Biesheuvel si->lfb_base = fb_base; 166fc372064SArd Biesheuvel 167fc372064SArd Biesheuvel ext_lfb_base = (u64)(unsigned long)fb_base >> 32; 168fc372064SArd Biesheuvel if (ext_lfb_base) { 169fc372064SArd Biesheuvel si->capabilities |= VIDEO_CAPABILITY_64BIT_BASE; 170fc372064SArd Biesheuvel si->ext_lfb_base = ext_lfb_base; 171fc372064SArd Biesheuvel } 172fc372064SArd Biesheuvel 173fc372064SArd Biesheuvel si->pages = 1; 174fc372064SArd Biesheuvel 175fc372064SArd Biesheuvel setup_pixel_info(si, pixels_per_scan_line, pixel_info, pixel_format); 176fc372064SArd Biesheuvel 177fc372064SArd Biesheuvel si->lfb_size = si->lfb_linelength * si->lfb_height; 178fc372064SArd Biesheuvel 179fc372064SArd Biesheuvel si->capabilities |= VIDEO_CAPABILITY_SKIP_QUIRKS; 1806fc3cec3SArvind Sankar 181dbd89c30SArvind Sankar return EFI_SUCCESS; 182fc372064SArd Biesheuvel } 183fc372064SArd Biesheuvel 184fc372064SArd Biesheuvel /* 185fc372064SArd Biesheuvel * See if we have Graphics Output Protocol 186fc372064SArd Biesheuvel */ 187cd33a5c1SArd Biesheuvel efi_status_t efi_setup_gop(struct screen_info *si, efi_guid_t *proto, 188fc372064SArd Biesheuvel unsigned long size) 189fc372064SArd Biesheuvel { 190fc372064SArd Biesheuvel efi_status_t status; 191fc372064SArd Biesheuvel void **gop_handle = NULL; 192fc372064SArd Biesheuvel 193fc372064SArd Biesheuvel status = efi_call_early(allocate_pool, EFI_LOADER_DATA, 194fc372064SArd Biesheuvel size, (void **)&gop_handle); 195fc372064SArd Biesheuvel if (status != EFI_SUCCESS) 196fc372064SArd Biesheuvel return status; 197fc372064SArd Biesheuvel 198fc372064SArd Biesheuvel status = efi_call_early(locate_handle, 199fc372064SArd Biesheuvel EFI_LOCATE_BY_PROTOCOL, 200fc372064SArd Biesheuvel proto, NULL, &size, gop_handle); 201fc372064SArd Biesheuvel if (status != EFI_SUCCESS) 202fc372064SArd Biesheuvel goto free_handle; 203fc372064SArd Biesheuvel 204cd33a5c1SArd Biesheuvel status = setup_gop(si, proto, size, gop_handle); 205fc372064SArd Biesheuvel 206fc372064SArd Biesheuvel free_handle: 207fc372064SArd Biesheuvel efi_call_early(free_pool, gop_handle); 208fc372064SArd Biesheuvel return status; 209fc372064SArd Biesheuvel } 210