Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 | // SPDX-License-Identifier: GPL-2.0 /* * Export Runtime Configuration Interface Table Version 2 (RCI2) * to sysfs * * Copyright (C) 2019 Dell Inc * by Narendra K <Narendra.K@dell.com> * * System firmware advertises the address of the RCI2 Table via * an EFI Configuration Table entry. This code retrieves the RCI2 * table from the address and exports it to sysfs as a binary * attribute 'rci2' under /sys/firmware/efi/tables directory. */ #include <linux/kobject.h> #include <linux/device.h> #include <linux/sysfs.h> #include <linux/efi.h> #include <linux/types.h> #include <linux/io.h> #define RCI_SIGNATURE "_RC_" struct rci2_table_global_hdr { u16 type; u16 resvd0; u16 hdr_len; u8 rci2_sig[4]; u16 resvd1; u32 resvd2; u32 resvd3; u8 major_rev; u8 minor_rev; u16 num_of_structs; u32 rci2_len; u16 rci2_chksum; } __packed; static u8 *rci2_base; static u32 rci2_table_len; unsigned long rci2_table_phys __ro_after_init = EFI_INVALID_TABLE_ADDR; static BIN_ATTR_SIMPLE_ADMIN_RO(rci2); static u16 checksum(void) { u8 len_is_odd = rci2_table_len % 2; u32 chksum_len = rci2_table_len; u16 *base = (u16 *)rci2_base; u8 buf[2] = {0}; u32 offset = 0; u16 chksum = 0; if (len_is_odd) chksum_len -= 1; while (offset < chksum_len) { chksum += *base; offset += 2; base++; } if (len_is_odd) { buf[0] = *(u8 *)base; chksum += *(u16 *)(buf); } return chksum; } static int __init efi_rci2_sysfs_init(void) { struct kobject *tables_kobj; int ret = -ENOMEM; if (rci2_table_phys == EFI_INVALID_TABLE_ADDR) return 0; rci2_base = memremap(rci2_table_phys, sizeof(struct rci2_table_global_hdr), MEMREMAP_WB); if (!rci2_base) { pr_debug("RCI2 table init failed - could not map RCI2 table\n"); goto err; } if (strncmp(rci2_base + offsetof(struct rci2_table_global_hdr, rci2_sig), RCI_SIGNATURE, 4)) { pr_debug("RCI2 table init failed - incorrect signature\n"); ret = -ENODEV; goto err_unmap; } rci2_table_len = *(u32 *)(rci2_base + offsetof(struct rci2_table_global_hdr, rci2_len)); memunmap(rci2_base); if (!rci2_table_len) { pr_debug("RCI2 table init failed - incorrect table length\n"); goto err; } rci2_base = memremap(rci2_table_phys, rci2_table_len, MEMREMAP_WB); if (!rci2_base) { pr_debug("RCI2 table - could not map RCI2 table\n"); goto err; } if (checksum() != 0) { pr_debug("RCI2 table - incorrect checksum\n"); ret = -ENODEV; goto err_unmap; } tables_kobj = kobject_create_and_add("tables", efi_kobj); if (!tables_kobj) { pr_debug("RCI2 table - tables_kobj creation failed\n"); goto err_unmap; } bin_attr_rci2.size = rci2_table_len; bin_attr_rci2.private = rci2_base; ret = sysfs_create_bin_file(tables_kobj, &bin_attr_rci2); if (ret != 0) { pr_debug("RCI2 table - rci2 sysfs bin file creation failed\n"); kobject_del(tables_kobj); kobject_put(tables_kobj); goto err_unmap; } return 0; err_unmap: memunmap(rci2_base); err: pr_debug("RCI2 table - sysfs initialization failed\n"); return ret; } late_initcall(efi_rci2_sysfs_init); |