14febfb8dSArd Biesheuvel // SPDX-License-Identifier: GPL-2.0
275def552SBhupesh Sharma /*
375def552SBhupesh Sharma * Copyright 2012 Intel Corporation
475def552SBhupesh Sharma * Author: Josh Triplett <josh@joshtriplett.org>
575def552SBhupesh Sharma *
675def552SBhupesh Sharma * Based on the bgrt driver:
775def552SBhupesh Sharma * Copyright 2012 Red Hat, Inc <mjg@redhat.com>
875def552SBhupesh Sharma * Author: Matthew Garrett
975def552SBhupesh Sharma */
1075def552SBhupesh Sharma
1175def552SBhupesh Sharma #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
1275def552SBhupesh Sharma
1375def552SBhupesh Sharma #include <linux/kernel.h>
1475def552SBhupesh Sharma #include <linux/init.h>
1575def552SBhupesh Sharma #include <linux/acpi.h>
1675def552SBhupesh Sharma #include <linux/efi.h>
1775def552SBhupesh Sharma #include <linux/efi-bgrt.h>
1875def552SBhupesh Sharma
1975def552SBhupesh Sharma struct acpi_table_bgrt bgrt_tab;
200c925036SHans de Goede size_t bgrt_image_size;
2175def552SBhupesh Sharma
2275def552SBhupesh Sharma struct bmp_header {
2375def552SBhupesh Sharma u16 id;
2475def552SBhupesh Sharma u32 size;
2575def552SBhupesh Sharma } __packed;
2675def552SBhupesh Sharma
efi_bgrt_init(struct acpi_table_header * table)2775def552SBhupesh Sharma void __init efi_bgrt_init(struct acpi_table_header *table)
2875def552SBhupesh Sharma {
2975def552SBhupesh Sharma void *image;
3075def552SBhupesh Sharma struct bmp_header bmp_header;
3175def552SBhupesh Sharma struct acpi_table_bgrt *bgrt = &bgrt_tab;
3275def552SBhupesh Sharma
3375def552SBhupesh Sharma if (acpi_disabled)
3475def552SBhupesh Sharma return;
3575def552SBhupesh Sharma
36792ef14dSDave Young if (!efi_enabled(EFI_MEMMAP))
377425826fSDave Young return;
387425826fSDave Young
3975def552SBhupesh Sharma if (table->length < sizeof(bgrt_tab)) {
4075def552SBhupesh Sharma pr_notice("Ignoring BGRT: invalid length %u (expected %zu)\n",
4175def552SBhupesh Sharma table->length, sizeof(bgrt_tab));
4275def552SBhupesh Sharma return;
4375def552SBhupesh Sharma }
4475def552SBhupesh Sharma *bgrt = *(struct acpi_table_bgrt *)table;
45*55087c57SHans de Goede /*
46*55087c57SHans de Goede * Only version 1 is defined but some older laptops (seen on Lenovo
47*55087c57SHans de Goede * Ivy Bridge models) have a correct version 1 BGRT table with the
48*55087c57SHans de Goede * version set to 0, so we accept version 0 and 1.
49*55087c57SHans de Goede */
50*55087c57SHans de Goede if (bgrt->version > 1) {
5175def552SBhupesh Sharma pr_notice("Ignoring BGRT: invalid version %u (expected 1)\n",
5275def552SBhupesh Sharma bgrt->version);
5375def552SBhupesh Sharma goto out;
5475def552SBhupesh Sharma }
5575def552SBhupesh Sharma if (bgrt->image_type != 0) {
5675def552SBhupesh Sharma pr_notice("Ignoring BGRT: invalid image type %u (expected 0)\n",
5775def552SBhupesh Sharma bgrt->image_type);
5875def552SBhupesh Sharma goto out;
5975def552SBhupesh Sharma }
6075def552SBhupesh Sharma if (!bgrt->image_address) {
6175def552SBhupesh Sharma pr_notice("Ignoring BGRT: null image address\n");
6275def552SBhupesh Sharma goto out;
6375def552SBhupesh Sharma }
6475def552SBhupesh Sharma
656de47a5eSJan Beulich if (efi_mem_type(bgrt->image_address) != EFI_BOOT_SERVICES_DATA) {
66792ef14dSDave Young pr_notice("Ignoring BGRT: invalid image address\n");
67792ef14dSDave Young goto out;
68792ef14dSDave Young }
6975def552SBhupesh Sharma image = early_memremap(bgrt->image_address, sizeof(bmp_header));
7075def552SBhupesh Sharma if (!image) {
7175def552SBhupesh Sharma pr_notice("Ignoring BGRT: failed to map image header memory\n");
7275def552SBhupesh Sharma goto out;
7375def552SBhupesh Sharma }
7475def552SBhupesh Sharma
7575def552SBhupesh Sharma memcpy(&bmp_header, image, sizeof(bmp_header));
7675def552SBhupesh Sharma early_memunmap(image, sizeof(bmp_header));
7775def552SBhupesh Sharma if (bmp_header.id != 0x4d42) {
7875def552SBhupesh Sharma pr_notice("Ignoring BGRT: Incorrect BMP magic number 0x%x (expected 0x4d42)\n",
7975def552SBhupesh Sharma bmp_header.id);
8075def552SBhupesh Sharma goto out;
8175def552SBhupesh Sharma }
8275def552SBhupesh Sharma bgrt_image_size = bmp_header.size;
8375def552SBhupesh Sharma efi_mem_reserve(bgrt->image_address, bgrt_image_size);
8475def552SBhupesh Sharma
8575def552SBhupesh Sharma return;
8675def552SBhupesh Sharma out:
8775def552SBhupesh Sharma memset(bgrt, 0, sizeof(bgrt_tab));
8875def552SBhupesh Sharma }
89