einj.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765
  1. /*
  2. * APEI Error INJection support
  3. *
  4. * EINJ provides a hardware error injection mechanism, this is useful
  5. * for debugging and testing of other APEI and RAS features.
  6. *
  7. * For more information about EINJ, please refer to ACPI Specification
  8. * version 4.0, section 17.5.
  9. *
  10. * Copyright 2009-2010 Intel Corp.
  11. * Author: Huang Ying <ying.huang@intel.com>
  12. *
  13. * This program is free software; you can redistribute it and/or
  14. * modify it under the terms of the GNU General Public License version
  15. * 2 as published by the Free Software Foundation.
  16. *
  17. * This program is distributed in the hope that it will be useful,
  18. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  20. * GNU General Public License for more details.
  21. *
  22. * You should have received a copy of the GNU General Public License
  23. * along with this program; if not, write to the Free Software
  24. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  25. */
  26. #include <linux/kernel.h>
  27. #include <linux/module.h>
  28. #include <linux/init.h>
  29. #include <linux/io.h>
  30. #include <linux/debugfs.h>
  31. #include <linux/seq_file.h>
  32. #include <linux/nmi.h>
  33. #include <linux/delay.h>
  34. #include <acpi/acpi.h>
  35. #include "apei-internal.h"
  36. #define EINJ_PFX "EINJ: "
  37. #define SPIN_UNIT 100 /* 100ns */
  38. /* Firmware should respond within 1 milliseconds */
  39. #define FIRMWARE_TIMEOUT (1 * NSEC_PER_MSEC)
  40. /*
  41. * ACPI version 5 provides a SET_ERROR_TYPE_WITH_ADDRESS action.
  42. */
  43. static int acpi5;
  44. struct set_error_type_with_address {
  45. u32 type;
  46. u32 vendor_extension;
  47. u32 flags;
  48. u32 apicid;
  49. u64 memory_address;
  50. u64 memory_address_range;
  51. u32 pcie_sbdf;
  52. };
  53. enum {
  54. SETWA_FLAGS_APICID = 1,
  55. SETWA_FLAGS_MEM = 2,
  56. SETWA_FLAGS_PCIE_SBDF = 4,
  57. };
  58. /*
  59. * Vendor extensions for platform specific operations
  60. */
  61. struct vendor_error_type_extension {
  62. u32 length;
  63. u32 pcie_sbdf;
  64. u16 vendor_id;
  65. u16 device_id;
  66. u8 rev_id;
  67. u8 reserved[3];
  68. };
  69. static u32 vendor_flags;
  70. static struct debugfs_blob_wrapper vendor_blob;
  71. static char vendor_dev[64];
  72. /*
  73. * Some BIOSes allow parameters to the SET_ERROR_TYPE entries in the
  74. * EINJ table through an unpublished extension. Use with caution as
  75. * most will ignore the parameter and make their own choice of address
  76. * for error injection. This extension is used only if
  77. * param_extension module parameter is specified.
  78. */
  79. struct einj_parameter {
  80. u64 type;
  81. u64 reserved1;
  82. u64 reserved2;
  83. u64 param1;
  84. u64 param2;
  85. };
  86. #define EINJ_OP_BUSY 0x1
  87. #define EINJ_STATUS_SUCCESS 0x0
  88. #define EINJ_STATUS_FAIL 0x1
  89. #define EINJ_STATUS_INVAL 0x2
  90. #define EINJ_TAB_ENTRY(tab) \
  91. ((struct acpi_whea_header *)((char *)(tab) + \
  92. sizeof(struct acpi_table_einj)))
  93. static bool param_extension;
  94. module_param(param_extension, bool, 0);
  95. static struct acpi_table_einj *einj_tab;
  96. static struct apei_resources einj_resources;
  97. static struct apei_exec_ins_type einj_ins_type[] = {
  98. [ACPI_EINJ_READ_REGISTER] = {
  99. .flags = APEI_EXEC_INS_ACCESS_REGISTER,
  100. .run = apei_exec_read_register,
  101. },
  102. [ACPI_EINJ_READ_REGISTER_VALUE] = {
  103. .flags = APEI_EXEC_INS_ACCESS_REGISTER,
  104. .run = apei_exec_read_register_value,
  105. },
  106. [ACPI_EINJ_WRITE_REGISTER] = {
  107. .flags = APEI_EXEC_INS_ACCESS_REGISTER,
  108. .run = apei_exec_write_register,
  109. },
  110. [ACPI_EINJ_WRITE_REGISTER_VALUE] = {
  111. .flags = APEI_EXEC_INS_ACCESS_REGISTER,
  112. .run = apei_exec_write_register_value,
  113. },
  114. [ACPI_EINJ_NOOP] = {
  115. .flags = 0,
  116. .run = apei_exec_noop,
  117. },
  118. };
  119. /*
  120. * Prevent EINJ interpreter to run simultaneously, because the
  121. * corresponding firmware implementation may not work properly when
  122. * invoked simultaneously.
  123. */
  124. static DEFINE_MUTEX(einj_mutex);
  125. static void *einj_param;
  126. #ifndef readq
  127. static inline __u64 readq(volatile void __iomem *addr)
  128. {
  129. return ((__u64)readl(addr+4) << 32) + readl(addr);
  130. }
  131. #endif
  132. #ifndef writeq
  133. static inline void writeq(__u64 val, volatile void __iomem *addr)
  134. {
  135. writel(val, addr);
  136. writel(val >> 32, addr+4);
  137. }
  138. #endif
  139. static void einj_exec_ctx_init(struct apei_exec_context *ctx)
  140. {
  141. apei_exec_ctx_init(ctx, einj_ins_type, ARRAY_SIZE(einj_ins_type),
  142. EINJ_TAB_ENTRY(einj_tab), einj_tab->entries);
  143. }
  144. static int __einj_get_available_error_type(u32 *type)
  145. {
  146. struct apei_exec_context ctx;
  147. int rc;
  148. einj_exec_ctx_init(&ctx);
  149. rc = apei_exec_run(&ctx, ACPI_EINJ_GET_ERROR_TYPE);
  150. if (rc)
  151. return rc;
  152. *type = apei_exec_ctx_get_output(&ctx);
  153. return 0;
  154. }
  155. /* Get error injection capabilities of the platform */
  156. static int einj_get_available_error_type(u32 *type)
  157. {
  158. int rc;
  159. mutex_lock(&einj_mutex);
  160. rc = __einj_get_available_error_type(type);
  161. mutex_unlock(&einj_mutex);
  162. return rc;
  163. }
  164. static int einj_timedout(u64 *t)
  165. {
  166. if ((s64)*t < SPIN_UNIT) {
  167. pr_warning(FW_WARN EINJ_PFX
  168. "Firmware does not respond in time\n");
  169. return 1;
  170. }
  171. *t -= SPIN_UNIT;
  172. ndelay(SPIN_UNIT);
  173. touch_nmi_watchdog();
  174. return 0;
  175. }
  176. static void check_vendor_extension(u64 paddr,
  177. struct set_error_type_with_address *v5param)
  178. {
  179. int offset = readl(&v5param->vendor_extension);
  180. struct vendor_error_type_extension *v;
  181. u32 sbdf;
  182. if (!offset)
  183. return;
  184. v = ioremap(paddr + offset, sizeof(*v));
  185. if (!v)
  186. return;
  187. sbdf = readl(&v->pcie_sbdf);
  188. sprintf(vendor_dev, "%x:%x:%x.%x vendor_id=%x device_id=%x rev_id=%x\n",
  189. sbdf >> 24, (sbdf >> 16) & 0xff,
  190. (sbdf >> 11) & 0x1f, (sbdf >> 8) & 0x7,
  191. readw(&v->vendor_id), readw(&v->device_id),
  192. readb(&v->rev_id));
  193. iounmap(v);
  194. }
  195. static void *einj_get_parameter_address(void)
  196. {
  197. int i;
  198. u64 paddrv4 = 0, paddrv5 = 0;
  199. struct acpi_whea_header *entry;
  200. entry = EINJ_TAB_ENTRY(einj_tab);
  201. for (i = 0; i < einj_tab->entries; i++) {
  202. if (entry->action == ACPI_EINJ_SET_ERROR_TYPE &&
  203. entry->instruction == ACPI_EINJ_WRITE_REGISTER &&
  204. entry->register_region.space_id ==
  205. ACPI_ADR_SPACE_SYSTEM_MEMORY)
  206. memcpy(&paddrv4, &entry->register_region.address,
  207. sizeof(paddrv4));
  208. if (entry->action == ACPI_EINJ_SET_ERROR_TYPE_WITH_ADDRESS &&
  209. entry->instruction == ACPI_EINJ_WRITE_REGISTER &&
  210. entry->register_region.space_id ==
  211. ACPI_ADR_SPACE_SYSTEM_MEMORY)
  212. memcpy(&paddrv5, &entry->register_region.address,
  213. sizeof(paddrv5));
  214. entry++;
  215. }
  216. if (paddrv5) {
  217. struct set_error_type_with_address *v5param;
  218. v5param = ioremap(paddrv5, sizeof(*v5param));
  219. if (v5param) {
  220. acpi5 = 1;
  221. check_vendor_extension(paddrv5, v5param);
  222. return v5param;
  223. }
  224. }
  225. if (paddrv4) {
  226. struct einj_parameter *v4param;
  227. v4param = ioremap(paddrv4, sizeof(*v4param));
  228. if (!v4param)
  229. return 0;
  230. if (readq(&v4param->reserved1) || readq(&v4param->reserved2)) {
  231. iounmap(v4param);
  232. return 0;
  233. }
  234. return v4param;
  235. }
  236. return 0;
  237. }
  238. /* do sanity check to trigger table */
  239. static int einj_check_trigger_header(struct acpi_einj_trigger *trigger_tab)
  240. {
  241. if (trigger_tab->header_size != sizeof(struct acpi_einj_trigger))
  242. return -EINVAL;
  243. if (trigger_tab->table_size > PAGE_SIZE ||
  244. trigger_tab->table_size <= trigger_tab->header_size)
  245. return -EINVAL;
  246. if (trigger_tab->entry_count !=
  247. (trigger_tab->table_size - trigger_tab->header_size) /
  248. sizeof(struct acpi_einj_entry))
  249. return -EINVAL;
  250. return 0;
  251. }
  252. static struct acpi_generic_address *einj_get_trigger_parameter_region(
  253. struct acpi_einj_trigger *trigger_tab, u64 param1, u64 param2)
  254. {
  255. int i;
  256. struct acpi_whea_header *entry;
  257. entry = (struct acpi_whea_header *)
  258. ((char *)trigger_tab + sizeof(struct acpi_einj_trigger));
  259. for (i = 0; i < trigger_tab->entry_count; i++) {
  260. if (entry->action == ACPI_EINJ_TRIGGER_ERROR &&
  261. entry->instruction == ACPI_EINJ_WRITE_REGISTER_VALUE &&
  262. entry->register_region.space_id ==
  263. ACPI_ADR_SPACE_SYSTEM_MEMORY &&
  264. (entry->register_region.address & param2) == (param1 & param2))
  265. return &entry->register_region;
  266. entry++;
  267. }
  268. return NULL;
  269. }
  270. /* Execute instructions in trigger error action table */
  271. static int __einj_error_trigger(u64 trigger_paddr, u32 type,
  272. u64 param1, u64 param2)
  273. {
  274. struct acpi_einj_trigger *trigger_tab = NULL;
  275. struct apei_exec_context trigger_ctx;
  276. struct apei_resources trigger_resources;
  277. struct acpi_whea_header *trigger_entry;
  278. struct resource *r;
  279. u32 table_size;
  280. int rc = -EIO;
  281. struct acpi_generic_address *trigger_param_region = NULL;
  282. r = request_mem_region(trigger_paddr, sizeof(*trigger_tab),
  283. "APEI EINJ Trigger Table");
  284. if (!r) {
  285. pr_err(EINJ_PFX
  286. "Can not request [mem %#010llx-%#010llx] for Trigger table\n",
  287. (unsigned long long)trigger_paddr,
  288. (unsigned long long)trigger_paddr +
  289. sizeof(*trigger_tab) - 1);
  290. goto out;
  291. }
  292. trigger_tab = ioremap_cache(trigger_paddr, sizeof(*trigger_tab));
  293. if (!trigger_tab) {
  294. pr_err(EINJ_PFX "Failed to map trigger table!\n");
  295. goto out_rel_header;
  296. }
  297. rc = einj_check_trigger_header(trigger_tab);
  298. if (rc) {
  299. pr_warning(FW_BUG EINJ_PFX
  300. "The trigger error action table is invalid\n");
  301. goto out_rel_header;
  302. }
  303. rc = -EIO;
  304. table_size = trigger_tab->table_size;
  305. r = request_mem_region(trigger_paddr + sizeof(*trigger_tab),
  306. table_size - sizeof(*trigger_tab),
  307. "APEI EINJ Trigger Table");
  308. if (!r) {
  309. pr_err(EINJ_PFX
  310. "Can not request [mem %#010llx-%#010llx] for Trigger Table Entry\n",
  311. (unsigned long long)trigger_paddr + sizeof(*trigger_tab),
  312. (unsigned long long)trigger_paddr + table_size - 1);
  313. goto out_rel_header;
  314. }
  315. iounmap(trigger_tab);
  316. trigger_tab = ioremap_cache(trigger_paddr, table_size);
  317. if (!trigger_tab) {
  318. pr_err(EINJ_PFX "Failed to map trigger table!\n");
  319. goto out_rel_entry;
  320. }
  321. trigger_entry = (struct acpi_whea_header *)
  322. ((char *)trigger_tab + sizeof(struct acpi_einj_trigger));
  323. apei_resources_init(&trigger_resources);
  324. apei_exec_ctx_init(&trigger_ctx, einj_ins_type,
  325. ARRAY_SIZE(einj_ins_type),
  326. trigger_entry, trigger_tab->entry_count);
  327. rc = apei_exec_collect_resources(&trigger_ctx, &trigger_resources);
  328. if (rc)
  329. goto out_fini;
  330. rc = apei_resources_sub(&trigger_resources, &einj_resources);
  331. if (rc)
  332. goto out_fini;
  333. /*
  334. * Some firmware will access target address specified in
  335. * param1 to trigger the error when injecting memory error.
  336. * This will cause resource conflict with regular memory. So
  337. * remove it from trigger table resources.
  338. */
  339. if (param_extension && (type & 0x0038) && param2) {
  340. struct apei_resources addr_resources;
  341. apei_resources_init(&addr_resources);
  342. trigger_param_region = einj_get_trigger_parameter_region(
  343. trigger_tab, param1, param2);
  344. if (trigger_param_region) {
  345. rc = apei_resources_add(&addr_resources,
  346. trigger_param_region->address,
  347. trigger_param_region->bit_width/8, true);
  348. if (rc)
  349. goto out_fini;
  350. rc = apei_resources_sub(&trigger_resources,
  351. &addr_resources);
  352. }
  353. apei_resources_fini(&addr_resources);
  354. if (rc)
  355. goto out_fini;
  356. }
  357. rc = apei_resources_request(&trigger_resources, "APEI EINJ Trigger");
  358. if (rc)
  359. goto out_fini;
  360. rc = apei_exec_pre_map_gars(&trigger_ctx);
  361. if (rc)
  362. goto out_release;
  363. rc = apei_exec_run(&trigger_ctx, ACPI_EINJ_TRIGGER_ERROR);
  364. apei_exec_post_unmap_gars(&trigger_ctx);
  365. out_release:
  366. apei_resources_release(&trigger_resources);
  367. out_fini:
  368. apei_resources_fini(&trigger_resources);
  369. out_rel_entry:
  370. release_mem_region(trigger_paddr + sizeof(*trigger_tab),
  371. table_size - sizeof(*trigger_tab));
  372. out_rel_header:
  373. release_mem_region(trigger_paddr, sizeof(*trigger_tab));
  374. out:
  375. if (trigger_tab)
  376. iounmap(trigger_tab);
  377. return rc;
  378. }
  379. static int __einj_error_inject(u32 type, u64 param1, u64 param2)
  380. {
  381. struct apei_exec_context ctx;
  382. u64 val, trigger_paddr, timeout = FIRMWARE_TIMEOUT;
  383. int rc;
  384. einj_exec_ctx_init(&ctx);
  385. rc = apei_exec_run_optional(&ctx, ACPI_EINJ_BEGIN_OPERATION);
  386. if (rc)
  387. return rc;
  388. apei_exec_ctx_set_input(&ctx, type);
  389. if (acpi5) {
  390. struct set_error_type_with_address *v5param = einj_param;
  391. writel(type, &v5param->type);
  392. if (type & 0x80000000) {
  393. switch (vendor_flags) {
  394. case SETWA_FLAGS_APICID:
  395. writel(param1, &v5param->apicid);
  396. break;
  397. case SETWA_FLAGS_MEM:
  398. writeq(param1, &v5param->memory_address);
  399. writeq(param2, &v5param->memory_address_range);
  400. break;
  401. case SETWA_FLAGS_PCIE_SBDF:
  402. writel(param1, &v5param->pcie_sbdf);
  403. break;
  404. }
  405. writel(vendor_flags, &v5param->flags);
  406. } else {
  407. switch (type) {
  408. case ACPI_EINJ_PROCESSOR_CORRECTABLE:
  409. case ACPI_EINJ_PROCESSOR_UNCORRECTABLE:
  410. case ACPI_EINJ_PROCESSOR_FATAL:
  411. writel(param1, &v5param->apicid);
  412. writel(SETWA_FLAGS_APICID, &v5param->flags);
  413. break;
  414. case ACPI_EINJ_MEMORY_CORRECTABLE:
  415. case ACPI_EINJ_MEMORY_UNCORRECTABLE:
  416. case ACPI_EINJ_MEMORY_FATAL:
  417. writeq(param1, &v5param->memory_address);
  418. writeq(param2, &v5param->memory_address_range);
  419. writel(SETWA_FLAGS_MEM, &v5param->flags);
  420. break;
  421. case ACPI_EINJ_PCIX_CORRECTABLE:
  422. case ACPI_EINJ_PCIX_UNCORRECTABLE:
  423. case ACPI_EINJ_PCIX_FATAL:
  424. writel(param1, &v5param->pcie_sbdf);
  425. writel(SETWA_FLAGS_PCIE_SBDF, &v5param->flags);
  426. break;
  427. }
  428. }
  429. } else {
  430. rc = apei_exec_run(&ctx, ACPI_EINJ_SET_ERROR_TYPE);
  431. if (rc)
  432. return rc;
  433. if (einj_param) {
  434. struct einj_parameter *v4param = einj_param;
  435. writeq(param1, &v4param->param1);
  436. writeq(param2, &v4param->param2);
  437. }
  438. }
  439. rc = apei_exec_run(&ctx, ACPI_EINJ_EXECUTE_OPERATION);
  440. if (rc)
  441. return rc;
  442. for (;;) {
  443. rc = apei_exec_run(&ctx, ACPI_EINJ_CHECK_BUSY_STATUS);
  444. if (rc)
  445. return rc;
  446. val = apei_exec_ctx_get_output(&ctx);
  447. if (!(val & EINJ_OP_BUSY))
  448. break;
  449. if (einj_timedout(&timeout))
  450. return -EIO;
  451. }
  452. rc = apei_exec_run(&ctx, ACPI_EINJ_GET_COMMAND_STATUS);
  453. if (rc)
  454. return rc;
  455. val = apei_exec_ctx_get_output(&ctx);
  456. if (val != EINJ_STATUS_SUCCESS)
  457. return -EBUSY;
  458. rc = apei_exec_run(&ctx, ACPI_EINJ_GET_TRIGGER_TABLE);
  459. if (rc)
  460. return rc;
  461. trigger_paddr = apei_exec_ctx_get_output(&ctx);
  462. rc = __einj_error_trigger(trigger_paddr, type, param1, param2);
  463. if (rc)
  464. return rc;
  465. rc = apei_exec_run_optional(&ctx, ACPI_EINJ_END_OPERATION);
  466. return rc;
  467. }
  468. /* Inject the specified hardware error */
  469. static int einj_error_inject(u32 type, u64 param1, u64 param2)
  470. {
  471. int rc;
  472. mutex_lock(&einj_mutex);
  473. rc = __einj_error_inject(type, param1, param2);
  474. mutex_unlock(&einj_mutex);
  475. return rc;
  476. }
  477. static u32 error_type;
  478. static u64 error_param1;
  479. static u64 error_param2;
  480. static struct dentry *einj_debug_dir;
  481. static int available_error_type_show(struct seq_file *m, void *v)
  482. {
  483. int rc;
  484. u32 available_error_type = 0;
  485. rc = einj_get_available_error_type(&available_error_type);
  486. if (rc)
  487. return rc;
  488. if (available_error_type & 0x0001)
  489. seq_printf(m, "0x00000001\tProcessor Correctable\n");
  490. if (available_error_type & 0x0002)
  491. seq_printf(m, "0x00000002\tProcessor Uncorrectable non-fatal\n");
  492. if (available_error_type & 0x0004)
  493. seq_printf(m, "0x00000004\tProcessor Uncorrectable fatal\n");
  494. if (available_error_type & 0x0008)
  495. seq_printf(m, "0x00000008\tMemory Correctable\n");
  496. if (available_error_type & 0x0010)
  497. seq_printf(m, "0x00000010\tMemory Uncorrectable non-fatal\n");
  498. if (available_error_type & 0x0020)
  499. seq_printf(m, "0x00000020\tMemory Uncorrectable fatal\n");
  500. if (available_error_type & 0x0040)
  501. seq_printf(m, "0x00000040\tPCI Express Correctable\n");
  502. if (available_error_type & 0x0080)
  503. seq_printf(m, "0x00000080\tPCI Express Uncorrectable non-fatal\n");
  504. if (available_error_type & 0x0100)
  505. seq_printf(m, "0x00000100\tPCI Express Uncorrectable fatal\n");
  506. if (available_error_type & 0x0200)
  507. seq_printf(m, "0x00000200\tPlatform Correctable\n");
  508. if (available_error_type & 0x0400)
  509. seq_printf(m, "0x00000400\tPlatform Uncorrectable non-fatal\n");
  510. if (available_error_type & 0x0800)
  511. seq_printf(m, "0x00000800\tPlatform Uncorrectable fatal\n");
  512. return 0;
  513. }
  514. static int available_error_type_open(struct inode *inode, struct file *file)
  515. {
  516. return single_open(file, available_error_type_show, NULL);
  517. }
  518. static const struct file_operations available_error_type_fops = {
  519. .open = available_error_type_open,
  520. .read = seq_read,
  521. .llseek = seq_lseek,
  522. .release = single_release,
  523. };
  524. static int error_type_get(void *data, u64 *val)
  525. {
  526. *val = error_type;
  527. return 0;
  528. }
  529. static int error_type_set(void *data, u64 val)
  530. {
  531. int rc;
  532. u32 available_error_type = 0;
  533. u32 tval, vendor;
  534. /*
  535. * Vendor defined types have 0x80000000 bit set, and
  536. * are not enumerated by ACPI_EINJ_GET_ERROR_TYPE
  537. */
  538. vendor = val & 0x80000000;
  539. tval = val & 0x7fffffff;
  540. /* Only one error type can be specified */
  541. if (tval & (tval - 1))
  542. return -EINVAL;
  543. if (!vendor) {
  544. rc = einj_get_available_error_type(&available_error_type);
  545. if (rc)
  546. return rc;
  547. if (!(val & available_error_type))
  548. return -EINVAL;
  549. }
  550. error_type = val;
  551. return 0;
  552. }
  553. DEFINE_SIMPLE_ATTRIBUTE(error_type_fops, error_type_get,
  554. error_type_set, "0x%llx\n");
  555. static int error_inject_set(void *data, u64 val)
  556. {
  557. if (!error_type)
  558. return -EINVAL;
  559. return einj_error_inject(error_type, error_param1, error_param2);
  560. }
  561. DEFINE_SIMPLE_ATTRIBUTE(error_inject_fops, NULL,
  562. error_inject_set, "%llu\n");
  563. static int einj_check_table(struct acpi_table_einj *einj_tab)
  564. {
  565. if ((einj_tab->header_length !=
  566. (sizeof(struct acpi_table_einj) - sizeof(einj_tab->header)))
  567. && (einj_tab->header_length != sizeof(struct acpi_table_einj)))
  568. return -EINVAL;
  569. if (einj_tab->header.length < sizeof(struct acpi_table_einj))
  570. return -EINVAL;
  571. if (einj_tab->entries !=
  572. (einj_tab->header.length - sizeof(struct acpi_table_einj)) /
  573. sizeof(struct acpi_einj_entry))
  574. return -EINVAL;
  575. return 0;
  576. }
  577. static int __init einj_init(void)
  578. {
  579. int rc;
  580. acpi_status status;
  581. struct dentry *fentry;
  582. struct apei_exec_context ctx;
  583. if (acpi_disabled)
  584. return -ENODEV;
  585. status = acpi_get_table(ACPI_SIG_EINJ, 0,
  586. (struct acpi_table_header **)&einj_tab);
  587. if (status == AE_NOT_FOUND)
  588. return -ENODEV;
  589. else if (ACPI_FAILURE(status)) {
  590. const char *msg = acpi_format_exception(status);
  591. pr_err(EINJ_PFX "Failed to get table, %s\n", msg);
  592. return -EINVAL;
  593. }
  594. rc = einj_check_table(einj_tab);
  595. if (rc) {
  596. pr_warning(FW_BUG EINJ_PFX "EINJ table is invalid\n");
  597. return -EINVAL;
  598. }
  599. rc = -ENOMEM;
  600. einj_debug_dir = debugfs_create_dir("einj", apei_get_debugfs_dir());
  601. if (!einj_debug_dir)
  602. goto err_cleanup;
  603. fentry = debugfs_create_file("available_error_type", S_IRUSR,
  604. einj_debug_dir, NULL,
  605. &available_error_type_fops);
  606. if (!fentry)
  607. goto err_cleanup;
  608. fentry = debugfs_create_file("error_type", S_IRUSR | S_IWUSR,
  609. einj_debug_dir, NULL, &error_type_fops);
  610. if (!fentry)
  611. goto err_cleanup;
  612. fentry = debugfs_create_file("error_inject", S_IWUSR,
  613. einj_debug_dir, NULL, &error_inject_fops);
  614. if (!fentry)
  615. goto err_cleanup;
  616. apei_resources_init(&einj_resources);
  617. einj_exec_ctx_init(&ctx);
  618. rc = apei_exec_collect_resources(&ctx, &einj_resources);
  619. if (rc)
  620. goto err_fini;
  621. rc = apei_resources_request(&einj_resources, "APEI EINJ");
  622. if (rc)
  623. goto err_fini;
  624. rc = apei_exec_pre_map_gars(&ctx);
  625. if (rc)
  626. goto err_release;
  627. einj_param = einj_get_parameter_address();
  628. if ((param_extension || acpi5) && einj_param) {
  629. fentry = debugfs_create_x64("param1", S_IRUSR | S_IWUSR,
  630. einj_debug_dir, &error_param1);
  631. if (!fentry)
  632. goto err_unmap;
  633. fentry = debugfs_create_x64("param2", S_IRUSR | S_IWUSR,
  634. einj_debug_dir, &error_param2);
  635. if (!fentry)
  636. goto err_unmap;
  637. }
  638. if (vendor_dev[0]) {
  639. vendor_blob.data = vendor_dev;
  640. vendor_blob.size = strlen(vendor_dev);
  641. fentry = debugfs_create_blob("vendor", S_IRUSR,
  642. einj_debug_dir, &vendor_blob);
  643. if (!fentry)
  644. goto err_unmap;
  645. fentry = debugfs_create_x32("vendor_flags", S_IRUSR | S_IWUSR,
  646. einj_debug_dir, &vendor_flags);
  647. if (!fentry)
  648. goto err_unmap;
  649. }
  650. pr_info(EINJ_PFX "Error INJection is initialized.\n");
  651. return 0;
  652. err_unmap:
  653. if (einj_param)
  654. iounmap(einj_param);
  655. apei_exec_post_unmap_gars(&ctx);
  656. err_release:
  657. apei_resources_release(&einj_resources);
  658. err_fini:
  659. apei_resources_fini(&einj_resources);
  660. err_cleanup:
  661. debugfs_remove_recursive(einj_debug_dir);
  662. return rc;
  663. }
  664. static void __exit einj_exit(void)
  665. {
  666. struct apei_exec_context ctx;
  667. if (einj_param)
  668. iounmap(einj_param);
  669. einj_exec_ctx_init(&ctx);
  670. apei_exec_post_unmap_gars(&ctx);
  671. apei_resources_release(&einj_resources);
  672. apei_resources_fini(&einj_resources);
  673. debugfs_remove_recursive(einj_debug_dir);
  674. }
  675. module_init(einj_init);
  676. module_exit(einj_exit);
  677. MODULE_AUTHOR("Huang Ying");
  678. MODULE_DESCRIPTION("APEI Error INJection support");
  679. MODULE_LICENSE("GPL");