1 // SPDX-License-Identifier: GPL-2.0-only 2 3 /* 4 * FPDT support for exporting boot and suspend/resume performance data 5 * 6 * Copyright (C) 2021 Intel Corporation. All rights reserved. 7 */ 8 9 #define pr_fmt(fmt) "ACPI FPDT: " fmt 10 11 #include <linux/acpi.h> 12 13 /* 14 * FPDT contains ACPI table header and a number of fpdt_subtable_entries. 15 * Each fpdt_subtable_entry points to a subtable: FBPT or S3PT. 16 * Each FPDT subtable (FBPT/S3PT) is composed of a fpdt_subtable_header 17 * and a number of fpdt performance records. 18 * Each FPDT performance record is composed of a fpdt_record_header and 19 * performance data fields, for boot or suspend or resume phase. 20 */ 21 enum fpdt_subtable_type { 22 SUBTABLE_FBPT, 23 SUBTABLE_S3PT, 24 }; 25 26 struct fpdt_subtable_entry { 27 u16 type; /* refer to enum fpdt_subtable_type */ 28 u8 length; 29 u8 revision; 30 u32 reserved; 31 u64 address; /* physical address of the S3PT/FBPT table */ 32 }; 33 34 struct fpdt_subtable_header { 35 u32 signature; 36 u32 length; 37 }; 38 39 enum fpdt_record_type { 40 RECORD_S3_RESUME, 41 RECORD_S3_SUSPEND, 42 RECORD_BOOT, 43 }; 44 45 struct fpdt_record_header { 46 u16 type; /* refer to enum fpdt_record_type */ 47 u8 length; 48 u8 revision; 49 }; 50 51 struct resume_performance_record { 52 struct fpdt_record_header header; 53 u32 resume_count; 54 u64 resume_prev; 55 u64 resume_avg; 56 } __attribute__((packed)); 57 58 struct boot_performance_record { 59 struct fpdt_record_header header; 60 u32 reserved; 61 u64 firmware_start; 62 u64 bootloader_load; 63 u64 bootloader_launch; 64 u64 exitbootservice_start; 65 u64 exitbootservice_end; 66 } __attribute__((packed)); 67 68 struct suspend_performance_record { 69 struct fpdt_record_header header; 70 u64 suspend_start; 71 u64 suspend_end; 72 } __attribute__((packed)); 73 74 75 static struct resume_performance_record *record_resume; 76 static struct suspend_performance_record *record_suspend; 77 static struct boot_performance_record *record_boot; 78 79 #define FPDT_ATTR(phase, name) \ 80 static ssize_t name##_show(struct kobject *kobj, \ 81 struct kobj_attribute *attr, char *buf) \ 82 { \ 83 return sprintf(buf, "%llu\n", record_##phase->name); \ 84 } \ 85 static struct kobj_attribute name##_attr = \ 86 __ATTR(name##_ns, 0444, name##_show, NULL) 87 88 FPDT_ATTR(resume, resume_prev); 89 FPDT_ATTR(resume, resume_avg); 90 FPDT_ATTR(suspend, suspend_start); 91 FPDT_ATTR(suspend, suspend_end); 92 FPDT_ATTR(boot, firmware_start); 93 FPDT_ATTR(boot, bootloader_load); 94 FPDT_ATTR(boot, bootloader_launch); 95 FPDT_ATTR(boot, exitbootservice_start); 96 FPDT_ATTR(boot, exitbootservice_end); 97 98 static ssize_t resume_count_show(struct kobject *kobj, 99 struct kobj_attribute *attr, char *buf) 100 { 101 return sprintf(buf, "%u\n", record_resume->resume_count); 102 } 103 104 static struct kobj_attribute resume_count_attr = 105 __ATTR_RO(resume_count); 106 107 static struct attribute *resume_attrs[] = { 108 &resume_count_attr.attr, 109 &resume_prev_attr.attr, 110 &resume_avg_attr.attr, 111 NULL 112 }; 113 114 static const struct attribute_group resume_attr_group = { 115 .attrs = resume_attrs, 116 .name = "resume", 117 }; 118 119 static struct attribute *suspend_attrs[] = { 120 &suspend_start_attr.attr, 121 &suspend_end_attr.attr, 122 NULL 123 }; 124 125 static const struct attribute_group suspend_attr_group = { 126 .attrs = suspend_attrs, 127 .name = "suspend", 128 }; 129 130 static struct attribute *boot_attrs[] = { 131 &firmware_start_attr.attr, 132 &bootloader_load_attr.attr, 133 &bootloader_launch_attr.attr, 134 &exitbootservice_start_attr.attr, 135 &exitbootservice_end_attr.attr, 136 NULL 137 }; 138 139 static const struct attribute_group boot_attr_group = { 140 .attrs = boot_attrs, 141 .name = "boot", 142 }; 143 144 static BIN_ATTR(FBPT, 0400, sysfs_bin_attr_simple_read, NULL, 0); 145 static BIN_ATTR(S3PT, 0400, sysfs_bin_attr_simple_read, NULL, 0); 146 147 static struct kobject *fpdt_kobj; 148 149 #if defined CONFIG_X86 && defined CONFIG_PHYS_ADDR_T_64BIT 150 #include <linux/processor.h> 151 static bool fpdt_address_valid(u64 address) 152 { 153 /* 154 * On some systems the table contains invalid addresses 155 * with unsuppored high address bits set, check for this. 156 */ 157 return !(address >> boot_cpu_data.x86_phys_bits); 158 } 159 #else 160 static bool fpdt_address_valid(u64 address) 161 { 162 return true; 163 } 164 #endif 165 166 static int fpdt_process_subtable(u64 address, u32 subtable_type) 167 { 168 struct fpdt_subtable_header *subtable_header; 169 struct fpdt_record_header *record_header; 170 char *signature = (subtable_type == SUBTABLE_FBPT ? "FBPT" : "S3PT"); 171 u32 length, offset; 172 int result; 173 174 if (!fpdt_address_valid(address)) { 175 pr_info(FW_BUG "invalid physical address: 0x%llx!\n", address); 176 return -EINVAL; 177 } 178 179 subtable_header = acpi_os_map_memory(address, sizeof(*subtable_header)); 180 if (!subtable_header) 181 return -ENOMEM; 182 183 if (strncmp((char *)&subtable_header->signature, signature, 4)) { 184 pr_info(FW_BUG "subtable signature and type mismatch!\n"); 185 return -EINVAL; 186 } 187 188 length = subtable_header->length; 189 acpi_os_unmap_memory(subtable_header, sizeof(*subtable_header)); 190 191 subtable_header = acpi_os_map_memory(address, length); 192 if (!subtable_header) 193 return -ENOMEM; 194 195 offset = sizeof(*subtable_header); 196 while (offset < length) { 197 record_header = (void *)subtable_header + offset; 198 offset += record_header->length; 199 200 if (!record_header->length) { 201 pr_err(FW_BUG "Zero-length record found in FPTD.\n"); 202 result = -EINVAL; 203 goto err; 204 } 205 206 switch (record_header->type) { 207 case RECORD_S3_RESUME: 208 if (subtable_type != SUBTABLE_S3PT) { 209 pr_err(FW_BUG "Invalid record %d for subtable %s\n", 210 record_header->type, signature); 211 result = -EINVAL; 212 goto err; 213 } 214 if (record_resume) { 215 pr_err("Duplicate resume performance record found.\n"); 216 continue; 217 } 218 record_resume = (struct resume_performance_record *)record_header; 219 result = sysfs_create_group(fpdt_kobj, &resume_attr_group); 220 if (result) 221 goto err; 222 break; 223 case RECORD_S3_SUSPEND: 224 if (subtable_type != SUBTABLE_S3PT) { 225 pr_err(FW_BUG "Invalid %d for subtable %s\n", 226 record_header->type, signature); 227 continue; 228 } 229 if (record_suspend) { 230 pr_err("Duplicate suspend performance record found.\n"); 231 continue; 232 } 233 record_suspend = (struct suspend_performance_record *)record_header; 234 result = sysfs_create_group(fpdt_kobj, &suspend_attr_group); 235 if (result) 236 goto err; 237 break; 238 case RECORD_BOOT: 239 if (subtable_type != SUBTABLE_FBPT) { 240 pr_err(FW_BUG "Invalid %d for subtable %s\n", 241 record_header->type, signature); 242 result = -EINVAL; 243 goto err; 244 } 245 if (record_boot) { 246 pr_err("Duplicate boot performance record found.\n"); 247 continue; 248 } 249 record_boot = (struct boot_performance_record *)record_header; 250 result = sysfs_create_group(fpdt_kobj, &boot_attr_group); 251 if (result) 252 goto err; 253 break; 254 255 default: 256 /* Other types are reserved in ACPI 6.4 spec. */ 257 break; 258 } 259 } 260 261 if (subtable_type == SUBTABLE_FBPT) { 262 bin_attr_FBPT.private = subtable_header; 263 bin_attr_FBPT.size = length; 264 result = sysfs_create_bin_file(fpdt_kobj, &bin_attr_FBPT); 265 if (result) 266 pr_warn("Failed to create FBPT sysfs attribute.\n"); 267 } else if (subtable_type == SUBTABLE_S3PT) { 268 bin_attr_S3PT.private = subtable_header; 269 bin_attr_S3PT.size = length; 270 result = sysfs_create_bin_file(fpdt_kobj, &bin_attr_S3PT); 271 if (result) 272 pr_warn("Failed to create S3PT sysfs attribute.\n"); 273 } 274 275 return 0; 276 277 err: 278 if (bin_attr_FBPT.private) { 279 sysfs_remove_bin_file(fpdt_kobj, &bin_attr_FBPT); 280 bin_attr_FBPT.private = NULL; 281 } 282 283 if (bin_attr_S3PT.private) { 284 sysfs_remove_bin_file(fpdt_kobj, &bin_attr_S3PT); 285 bin_attr_S3PT.private = NULL; 286 } 287 288 if (record_boot) 289 sysfs_remove_group(fpdt_kobj, &boot_attr_group); 290 291 if (record_suspend) 292 sysfs_remove_group(fpdt_kobj, &suspend_attr_group); 293 294 if (record_resume) 295 sysfs_remove_group(fpdt_kobj, &resume_attr_group); 296 297 return result; 298 } 299 300 static int __init acpi_init_fpdt(void) 301 { 302 acpi_status status; 303 struct acpi_table_header *header; 304 struct fpdt_subtable_entry *subtable; 305 u32 offset = sizeof(*header); 306 int result; 307 308 status = acpi_get_table(ACPI_SIG_FPDT, 0, &header); 309 310 if (ACPI_FAILURE(status)) 311 return 0; 312 313 fpdt_kobj = kobject_create_and_add("fpdt", acpi_kobj); 314 if (!fpdt_kobj) { 315 result = -ENOMEM; 316 goto err_nomem; 317 } 318 319 while (offset < header->length) { 320 subtable = (void *)header + offset; 321 switch (subtable->type) { 322 case SUBTABLE_FBPT: 323 case SUBTABLE_S3PT: 324 result = fpdt_process_subtable(subtable->address, 325 subtable->type); 326 if (result) 327 goto err_subtable; 328 break; 329 default: 330 /* Other types are reserved in ACPI 6.4 spec. */ 331 break; 332 } 333 offset += sizeof(*subtable); 334 } 335 return 0; 336 err_subtable: 337 kobject_put(fpdt_kobj); 338 339 err_nomem: 340 acpi_put_table(header); 341 return result; 342 } 343 344 fs_initcall(acpi_init_fpdt); 345