]>
Commit | Line | Data |
---|---|---|
2223af38 JT |
1 | /* |
2 | * Copyright 2012 Intel Corporation | |
3 | * Author: Josh Triplett <josh@joshtriplett.org> | |
4 | * | |
5 | * Based on the bgrt driver: | |
6 | * Copyright 2012 Red Hat, Inc <mjg@redhat.com> | |
7 | * Author: Matthew Garrett | |
8 | * | |
9 | * This program is free software; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License version 2 as | |
11 | * published by the Free Software Foundation. | |
12 | */ | |
26d7f65f MF |
13 | |
14 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt | |
15 | ||
2223af38 | 16 | #include <linux/kernel.h> |
13f0e4d2 | 17 | #include <linux/init.h> |
2223af38 JT |
18 | #include <linux/acpi.h> |
19 | #include <linux/efi.h> | |
20 | #include <linux/efi-bgrt.h> | |
21 | ||
7b0a9114 | 22 | struct acpi_table_bgrt bgrt_tab; |
13f0e4d2 | 23 | size_t __initdata bgrt_image_size; |
2223af38 JT |
24 | |
25 | struct bmp_header { | |
26 | u16 id; | |
27 | u32 size; | |
28 | } __packed; | |
29 | ||
7b0a9114 | 30 | void __init efi_bgrt_init(struct acpi_table_header *table) |
2223af38 | 31 | { |
50a0cb56 | 32 | void *image; |
2223af38 | 33 | struct bmp_header bmp_header; |
7b0a9114 | 34 | struct acpi_table_bgrt *bgrt = &bgrt_tab; |
2223af38 JT |
35 | |
36 | if (acpi_disabled) | |
37 | return; | |
38 | ||
792ef14d | 39 | if (!efi_enabled(EFI_MEMMAP)) |
7425826f DY |
40 | return; |
41 | ||
7b0a9114 | 42 | if (table->length < sizeof(bgrt_tab)) { |
7f9b474c | 43 | pr_notice("Ignoring BGRT: invalid length %u (expected %zu)\n", |
7b0a9114 | 44 | table->length, sizeof(bgrt_tab)); |
5d6d578c | 45 | return; |
1282278e | 46 | } |
7b0a9114 DY |
47 | *bgrt = *(struct acpi_table_bgrt *)table; |
48 | if (bgrt->version != 1) { | |
7f9b474c | 49 | pr_notice("Ignoring BGRT: invalid version %u (expected 1)\n", |
7b0a9114 DY |
50 | bgrt->version); |
51 | goto out; | |
1282278e | 52 | } |
7b0a9114 | 53 | if (bgrt->image_type != 0) { |
7f9b474c | 54 | pr_notice("Ignoring BGRT: invalid image type %u (expected 0)\n", |
7b0a9114 DY |
55 | bgrt->image_type); |
56 | goto out; | |
1282278e | 57 | } |
7b0a9114 | 58 | if (!bgrt->image_address) { |
7f9b474c | 59 | pr_notice("Ignoring BGRT: null image address\n"); |
7b0a9114 | 60 | goto out; |
1282278e | 61 | } |
2223af38 | 62 | |
6de47a5e | 63 | if (efi_mem_type(bgrt->image_address) != EFI_BOOT_SERVICES_DATA) { |
792ef14d DY |
64 | pr_notice("Ignoring BGRT: invalid image address\n"); |
65 | goto out; | |
66 | } | |
7b0a9114 | 67 | image = early_memremap(bgrt->image_address, sizeof(bmp_header)); |
2223af38 | 68 | if (!image) { |
7f9b474c | 69 | pr_notice("Ignoring BGRT: failed to map image header memory\n"); |
7b0a9114 | 70 | goto out; |
2223af38 JT |
71 | } |
72 | ||
50a0cb56 | 73 | memcpy(&bmp_header, image, sizeof(bmp_header)); |
7b0a9114 | 74 | early_memunmap(image, sizeof(bmp_header)); |
66dbe99c | 75 | if (bmp_header.id != 0x4d42) { |
7f9b474c | 76 | pr_notice("Ignoring BGRT: Incorrect BMP magic number 0x%x (expected 0x4d42)\n", |
66dbe99c | 77 | bmp_header.id); |
7b0a9114 | 78 | goto out; |
66dbe99c | 79 | } |
2223af38 | 80 | bgrt_image_size = bmp_header.size; |
7b0a9114 | 81 | efi_mem_reserve(bgrt->image_address, bgrt_image_size); |
2223af38 | 82 | |
7b0a9114 DY |
83 | return; |
84 | out: | |
85 | memset(bgrt, 0, sizeof(bgrt_tab)); | |
2223af38 | 86 | } |