acpi.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775
  1. /* acpi.c - modify acpi tables. */
  2. /*
  3. * GRUB -- GRand Unified Bootloader
  4. * Copyright (C) 2009 Free Software Foundation, Inc.
  5. *
  6. * GRUB is free software: you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation, either version 3 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * GRUB is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with GRUB. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #include <grub/dl.h>
  20. #include <grub/extcmd.h>
  21. #include <grub/file.h>
  22. #include <grub/disk.h>
  23. #include <grub/term.h>
  24. #include <grub/misc.h>
  25. #include <grub/acpi.h>
  26. #include <grub/mm.h>
  27. #include <grub/memory.h>
  28. #include <grub/i18n.h>
  29. #ifdef GRUB_MACHINE_EFI
  30. #include <grub/efi/efi.h>
  31. #include <grub/efi/api.h>
  32. #endif
  33. GRUB_MOD_LICENSE ("GPLv3+");
  34. static const struct grub_arg_option options[] = {
  35. {"exclude", 'x', 0,
  36. N_("Don't load host tables specified by comma-separated list."),
  37. 0, ARG_TYPE_STRING},
  38. {"load-only", 'n', 0,
  39. N_("Load only tables specified by comma-separated list."), 0, ARG_TYPE_STRING},
  40. {"v1", '1', 0, N_("Expose v1 tables."), 0, ARG_TYPE_NONE},
  41. {"v2", '2', 0, N_("Expose v2 and v3 tables."), 0, ARG_TYPE_NONE},
  42. {"oemid", 'o', 0, N_("Set OEMID of RSDP, XSDT and RSDT."), 0, ARG_TYPE_STRING},
  43. {"oemtable", 't', 0,
  44. N_("Set OEMTABLE ID of RSDP, XSDT and RSDT."), 0, ARG_TYPE_STRING},
  45. {"oemtablerev", 'r', 0,
  46. N_("Set OEMTABLE revision of RSDP, XSDT and RSDT."), 0, ARG_TYPE_INT},
  47. {"oemtablecreator", 'c', 0,
  48. N_("Set creator field of RSDP, XSDT and RSDT."), 0, ARG_TYPE_STRING},
  49. {"oemtablecreatorrev", 'd', 0,
  50. N_("Set creator revision of RSDP, XSDT and RSDT."), 0, ARG_TYPE_INT},
  51. {"no-ebda", 'e', 0, N_("Don't update EBDA. May fix failures or hangs on some."
  52. " BIOSes but makes it ineffective with OS not receiving RSDP from GRUB."),
  53. 0, ARG_TYPE_NONE},
  54. {0, 0, 0, 0, 0, 0}
  55. };
  56. /* Simple checksum by summing all bytes. Used by ACPI and SMBIOS. */
  57. grub_uint8_t
  58. grub_byte_checksum (void *base, grub_size_t size)
  59. {
  60. grub_uint8_t *ptr;
  61. grub_uint8_t ret = 0;
  62. for (ptr = (grub_uint8_t *) base; ptr < ((grub_uint8_t *) base) + size;
  63. ptr++)
  64. ret += *ptr;
  65. return ret;
  66. }
  67. /* rev1 is 1 if ACPIv1 is to be generated, 0 otherwise.
  68. rev2 contains the revision of ACPIv2+ to generate or 0 if none. */
  69. static int rev1, rev2;
  70. /* OEMID of RSDP, RSDT and XSDT. */
  71. static char root_oemid[6];
  72. /* OEMTABLE of the same tables. */
  73. static char root_oemtable[8];
  74. /* OEMREVISION of the same tables. */
  75. static grub_uint32_t root_oemrev;
  76. /* CreatorID of the same tables. */
  77. static char root_creator_id[4];
  78. /* CreatorRevision of the same tables. */
  79. static grub_uint32_t root_creator_rev;
  80. static struct grub_acpi_rsdp_v10 *rsdpv1_new = 0;
  81. static struct grub_acpi_rsdp_v20 *rsdpv2_new = 0;
  82. static char *playground = 0, *playground_ptr = 0;
  83. static int playground_size = 0;
  84. /* Linked list of ACPI tables. */
  85. struct efiemu_acpi_table
  86. {
  87. void *addr;
  88. grub_size_t size;
  89. struct efiemu_acpi_table *next;
  90. };
  91. static struct efiemu_acpi_table *acpi_tables = 0;
  92. /* DSDT isn't in RSDT. So treat it specially. */
  93. static void *table_dsdt = 0;
  94. /* Pointer to recreated RSDT. */
  95. static void *rsdt_addr = 0;
  96. /* Allocation handles for different tables. */
  97. static grub_size_t dsdt_size = 0;
  98. /* Address of original FACS. */
  99. static grub_uint32_t facs_addr = 0;
  100. struct grub_acpi_rsdp_v20 *
  101. grub_acpi_get_rsdpv2 (void)
  102. {
  103. if (rsdpv2_new)
  104. return rsdpv2_new;
  105. if (rsdpv1_new)
  106. return 0;
  107. return grub_machine_acpi_get_rsdpv2 ();
  108. }
  109. struct grub_acpi_rsdp_v10 *
  110. grub_acpi_get_rsdpv1 (void)
  111. {
  112. if (rsdpv1_new)
  113. return rsdpv1_new;
  114. if (rsdpv2_new)
  115. return 0;
  116. return grub_machine_acpi_get_rsdpv1 ();
  117. }
  118. static inline int
  119. iszero (grub_uint8_t *reg, int size)
  120. {
  121. int i;
  122. for (i = 0; i < size; i++)
  123. if (reg[i])
  124. return 0;
  125. return 1;
  126. }
  127. grub_err_t
  128. grub_acpi_create_ebda (void)
  129. {
  130. int ebda_kb_len;
  131. int ebda_len;
  132. int mmapregion = 0;
  133. grub_uint8_t *ebda, *v1inebda = 0, *v2inebda = 0;
  134. grub_uint64_t highestlow = 0;
  135. grub_uint8_t *targetebda, *target;
  136. struct grub_acpi_rsdp_v10 *v1;
  137. struct grub_acpi_rsdp_v20 *v2;
  138. auto int NESTED_FUNC_ATTR find_hook (grub_uint64_t, grub_uint64_t,
  139. grub_uint32_t);
  140. int NESTED_FUNC_ATTR find_hook (grub_uint64_t start, grub_uint64_t size,
  141. grub_memory_type_t type)
  142. {
  143. grub_uint64_t end = start + size;
  144. if (type != GRUB_MEMORY_AVAILABLE)
  145. return 0;
  146. if (end > 0x100000)
  147. end = 0x100000;
  148. if (end > start + ebda_len
  149. && highestlow < ((end - ebda_len) & (~0xf)) )
  150. highestlow = (end - ebda_len) & (~0xf);
  151. return 0;
  152. }
  153. ebda = (grub_uint8_t *) UINT_TO_PTR ((*((grub_uint16_t *)0x40e)) << 4);
  154. ebda_kb_len = *(grub_uint16_t *) ebda;
  155. if (! ebda || ebda_kb_len > 16)
  156. ebda_kb_len = 0;
  157. ebda_len = (ebda_kb_len + 1) << 10;
  158. /* FIXME: use low-memory mm allocation once it's available. */
  159. grub_mmap_iterate (find_hook);
  160. targetebda = (grub_uint8_t *) UINT_TO_PTR (highestlow);
  161. grub_dprintf ("acpi", "creating ebda @%llx\n",
  162. (unsigned long long) highestlow);
  163. if (! highestlow)
  164. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  165. "couldn't find space for the new EBDA");
  166. mmapregion = grub_mmap_register (PTR_TO_UINT64 (targetebda), ebda_len,
  167. GRUB_MEMORY_RESERVED);
  168. if (! mmapregion)
  169. return grub_errno;
  170. /* XXX: EBDA is unstandardized, so this implementation is heuristical. */
  171. if (ebda_kb_len)
  172. grub_memcpy (targetebda, ebda, 0x400);
  173. else
  174. grub_memset (targetebda, 0, 0x400);
  175. *((grub_uint16_t *) targetebda) = ebda_kb_len + 1;
  176. target = targetebda;
  177. v1 = grub_acpi_get_rsdpv1 ();
  178. v2 = grub_acpi_get_rsdpv2 ();
  179. if (v2 && v2->length > 40)
  180. v2 = 0;
  181. /* First try to replace already existing rsdp. */
  182. if (v2)
  183. {
  184. grub_dprintf ("acpi", "Scanning EBDA for old rsdpv2\n");
  185. for (; target < targetebda + 0x400 - v2->length; target += 0x10)
  186. if (grub_memcmp (target, "RSD PTR ", 8) == 0
  187. && grub_byte_checksum (target,
  188. sizeof (struct grub_acpi_rsdp_v10)) == 0
  189. && ((struct grub_acpi_rsdp_v10 *) target)->revision != 0
  190. && ((struct grub_acpi_rsdp_v20 *) target)->length <= v2->length)
  191. {
  192. grub_memcpy (target, v2, v2->length);
  193. grub_dprintf ("acpi", "Copying rsdpv2 to %p\n", target);
  194. v2inebda = target;
  195. target += v2->length;
  196. target = (grub_uint8_t *) ((((long) target - 1) | 0xf) + 1);
  197. v2 = 0;
  198. break;
  199. }
  200. }
  201. if (v1)
  202. {
  203. grub_dprintf ("acpi", "Scanning EBDA for old rsdpv1\n");
  204. for (; target < targetebda + 0x400 - sizeof (struct grub_acpi_rsdp_v10);
  205. target += 0x10)
  206. if (grub_memcmp (target, "RSD PTR ", 8) == 0
  207. && grub_byte_checksum (target,
  208. sizeof (struct grub_acpi_rsdp_v10)) == 0)
  209. {
  210. grub_memcpy (target, v1, sizeof (struct grub_acpi_rsdp_v10));
  211. grub_dprintf ("acpi", "Copying rsdpv1 to %p\n", target);
  212. v1inebda = target;
  213. target += sizeof (struct grub_acpi_rsdp_v10);
  214. target = (grub_uint8_t *) ((((long) target - 1) | 0xf) + 1);
  215. v1 = 0;
  216. break;
  217. }
  218. }
  219. target = targetebda + 0x100;
  220. /* Try contiguous zeros. */
  221. if (v2)
  222. {
  223. grub_dprintf ("acpi", "Scanning EBDA for block of zeros\n");
  224. for (; target < targetebda + 0x400 - v2->length; target += 0x10)
  225. if (iszero (target, v2->length))
  226. {
  227. grub_dprintf ("acpi", "Copying rsdpv2 to %p\n", target);
  228. grub_memcpy (target, v2, v2->length);
  229. v2inebda = target;
  230. target += v2->length;
  231. target = (grub_uint8_t *) ((((long) target - 1) | 0xf) + 1);
  232. v2 = 0;
  233. break;
  234. }
  235. }
  236. if (v1)
  237. {
  238. grub_dprintf ("acpi", "Scanning EBDA for block of zeros\n");
  239. for (; target < targetebda + 0x400 - sizeof (struct grub_acpi_rsdp_v10);
  240. target += 0x10)
  241. if (iszero (target, sizeof (struct grub_acpi_rsdp_v10)))
  242. {
  243. grub_dprintf ("acpi", "Copying rsdpv1 to %p\n", target);
  244. grub_memcpy (target, v1, sizeof (struct grub_acpi_rsdp_v10));
  245. v1inebda = target;
  246. target += sizeof (struct grub_acpi_rsdp_v10);
  247. target = (grub_uint8_t *) ((((long) target - 1) | 0xf) + 1);
  248. v1 = 0;
  249. break;
  250. }
  251. }
  252. if (v1 || v2)
  253. {
  254. grub_mmap_unregister (mmapregion);
  255. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  256. "couldn't find suitable spot in EBDA");
  257. }
  258. /* Remove any other RSDT. */
  259. for (target = targetebda;
  260. target < targetebda + 0x400 - sizeof (struct grub_acpi_rsdp_v10);
  261. target += 0x10)
  262. if (grub_memcmp (target, "RSD PTR ", 8) == 0
  263. && grub_byte_checksum (target,
  264. sizeof (struct grub_acpi_rsdp_v10)) == 0
  265. && target != v1inebda && target != v2inebda)
  266. *target = 0;
  267. grub_dprintf ("acpi", "Switching EBDA\n");
  268. (*((grub_uint16_t *) 0x40e)) = ((long)targetebda) >> 4;
  269. grub_dprintf ("acpi", "EBDA switched\n");
  270. return GRUB_ERR_NONE;
  271. }
  272. /* Create tables common to ACPIv1 and ACPIv2+ */
  273. static void
  274. setup_common_tables (void)
  275. {
  276. struct efiemu_acpi_table *cur;
  277. struct grub_acpi_table_header *rsdt;
  278. grub_uint32_t *rsdt_entry;
  279. int numoftables;
  280. /* Treat DSDT. */
  281. grub_memcpy (playground_ptr, table_dsdt, dsdt_size);
  282. grub_free (table_dsdt);
  283. table_dsdt = playground_ptr;
  284. playground_ptr += dsdt_size;
  285. /* Treat other tables. */
  286. for (cur = acpi_tables; cur; cur = cur->next)
  287. {
  288. struct grub_acpi_fadt *fadt;
  289. grub_memcpy (playground_ptr, cur->addr, cur->size);
  290. grub_free (cur->addr);
  291. cur->addr = playground_ptr;
  292. playground_ptr += cur->size;
  293. /* If it's FADT correct DSDT and FACS addresses. */
  294. fadt = (struct grub_acpi_fadt *) cur->addr;
  295. if (grub_memcmp (fadt->hdr.signature, GRUB_ACPI_FADT_SIGNATURE,
  296. sizeof (fadt->hdr.signature)) == 0)
  297. {
  298. fadt->dsdt_addr = PTR_TO_UINT32 (table_dsdt);
  299. fadt->facs_addr = facs_addr;
  300. /* Does a revision 2 exist at all? */
  301. if (fadt->hdr.revision >= 3)
  302. {
  303. fadt->dsdt_xaddr = PTR_TO_UINT64 (table_dsdt);
  304. fadt->facs_xaddr = facs_addr;
  305. }
  306. /* Recompute checksum. */
  307. fadt->hdr.checksum = 0;
  308. fadt->hdr.checksum = 1 + ~grub_byte_checksum (fadt, fadt->hdr.length);
  309. }
  310. }
  311. /* Fill RSDT entries. */
  312. numoftables = 0;
  313. for (cur = acpi_tables; cur; cur = cur->next)
  314. numoftables++;
  315. rsdt_addr = rsdt = (struct grub_acpi_table_header *) playground_ptr;
  316. playground_ptr += sizeof (struct grub_acpi_table_header) + 4 * numoftables;
  317. rsdt_entry = (grub_uint32_t *) (rsdt + 1);
  318. /* Fill RSDT header. */
  319. grub_memcpy (&(rsdt->signature), "RSDT", 4);
  320. rsdt->length = sizeof (struct grub_acpi_table_header) + 4 * numoftables;
  321. rsdt->revision = 1;
  322. grub_memcpy (&(rsdt->oemid), root_oemid, sizeof (rsdt->oemid));
  323. grub_memcpy (&(rsdt->oemtable), root_oemtable, sizeof (rsdt->oemtable));
  324. rsdt->oemrev = root_oemrev;
  325. grub_memcpy (&(rsdt->creator_id), root_creator_id, sizeof (rsdt->creator_id));
  326. rsdt->creator_rev = root_creator_rev;
  327. for (cur = acpi_tables; cur; cur = cur->next)
  328. *(rsdt_entry++) = PTR_TO_UINT32 (cur->addr);
  329. /* Recompute checksum. */
  330. rsdt->checksum = 0;
  331. rsdt->checksum = 1 + ~grub_byte_checksum (rsdt, rsdt->length);
  332. }
  333. /* Regenerate ACPIv1 RSDP */
  334. static void
  335. setv1table (void)
  336. {
  337. /* Create RSDP. */
  338. rsdpv1_new = (struct grub_acpi_rsdp_v10 *) playground_ptr;
  339. playground_ptr += sizeof (struct grub_acpi_rsdp_v10);
  340. grub_memcpy (&(rsdpv1_new->signature), "RSD PTR ",
  341. sizeof (rsdpv1_new->signature));
  342. grub_memcpy (&(rsdpv1_new->oemid), root_oemid, sizeof (rsdpv1_new->oemid));
  343. rsdpv1_new->revision = 0;
  344. rsdpv1_new->rsdt_addr = PTR_TO_UINT32 (rsdt_addr);
  345. rsdpv1_new->checksum = 0;
  346. rsdpv1_new->checksum = 1 + ~grub_byte_checksum (rsdpv1_new,
  347. sizeof (*rsdpv1_new));
  348. grub_dprintf ("acpi", "Generated ACPIv1 tables\n");
  349. }
  350. static void
  351. setv2table (void)
  352. {
  353. struct grub_acpi_table_header *xsdt;
  354. struct efiemu_acpi_table *cur;
  355. grub_uint64_t *xsdt_entry;
  356. int numoftables;
  357. numoftables = 0;
  358. for (cur = acpi_tables; cur; cur = cur->next)
  359. numoftables++;
  360. /* Create XSDT. */
  361. xsdt = (struct grub_acpi_table_header *) playground_ptr;
  362. playground_ptr += sizeof (struct grub_acpi_table_header) + 8 * numoftables;
  363. xsdt_entry = (grub_uint64_t *)(xsdt + 1);
  364. for (cur = acpi_tables; cur; cur = cur->next)
  365. *(xsdt_entry++) = PTR_TO_UINT64 (cur->addr);
  366. grub_memcpy (&(xsdt->signature), "XSDT", 4);
  367. xsdt->length = sizeof (struct grub_acpi_table_header) + 8 * numoftables;
  368. xsdt->revision = 1;
  369. grub_memcpy (&(xsdt->oemid), root_oemid, sizeof (xsdt->oemid));
  370. grub_memcpy (&(xsdt->oemtable), root_oemtable, sizeof (xsdt->oemtable));
  371. xsdt->oemrev = root_oemrev;
  372. grub_memcpy (&(xsdt->creator_id), root_creator_id, sizeof (xsdt->creator_id));
  373. xsdt->creator_rev = root_creator_rev;
  374. xsdt->checksum = 0;
  375. xsdt->checksum = 1 + ~grub_byte_checksum (xsdt, xsdt->length);
  376. /* Create RSDPv2. */
  377. rsdpv2_new = (struct grub_acpi_rsdp_v20 *) playground_ptr;
  378. playground_ptr += sizeof (struct grub_acpi_rsdp_v20);
  379. grub_memcpy (&(rsdpv2_new->rsdpv1.signature), "RSD PTR ",
  380. sizeof (rsdpv2_new->rsdpv1.signature));
  381. grub_memcpy (&(rsdpv2_new->rsdpv1.oemid), root_oemid,
  382. sizeof (rsdpv2_new->rsdpv1.oemid));
  383. rsdpv2_new->rsdpv1.revision = rev2;
  384. rsdpv2_new->rsdpv1.rsdt_addr = PTR_TO_UINT32 (rsdt_addr);
  385. rsdpv2_new->rsdpv1.checksum = 0;
  386. rsdpv2_new->rsdpv1.checksum = 1 + ~grub_byte_checksum
  387. (&(rsdpv2_new->rsdpv1), sizeof (rsdpv2_new->rsdpv1));
  388. rsdpv2_new->length = sizeof (*rsdpv2_new);
  389. rsdpv2_new->xsdt_addr = PTR_TO_UINT64 (xsdt);
  390. rsdpv2_new->checksum = 0;
  391. rsdpv2_new->checksum = 1 + ~grub_byte_checksum (rsdpv2_new,
  392. rsdpv2_new->length);
  393. grub_dprintf ("acpi", "Generated ACPIv2 tables\n");
  394. }
  395. static void
  396. free_tables (void)
  397. {
  398. struct efiemu_acpi_table *cur, *t;
  399. if (table_dsdt)
  400. grub_free (table_dsdt);
  401. for (cur = acpi_tables; cur;)
  402. {
  403. t = cur;
  404. grub_free (cur->addr);
  405. cur = cur->next;
  406. grub_free (t);
  407. }
  408. acpi_tables = 0;
  409. table_dsdt = 0;
  410. }
  411. static grub_err_t
  412. grub_cmd_acpi (struct grub_extcmd_context *ctxt, int argc, char **args)
  413. {
  414. struct grub_arg_list *state = ctxt->state;
  415. struct grub_acpi_rsdp_v10 *rsdp;
  416. struct efiemu_acpi_table *cur, *t;
  417. grub_err_t err;
  418. int i, mmapregion;
  419. int numoftables;
  420. /* Default values if no RSDP is found. */
  421. rev1 = 1;
  422. rev2 = 3;
  423. facs_addr = 0;
  424. playground = playground_ptr = 0;
  425. playground_size = 0;
  426. rsdp = (struct grub_acpi_rsdp_v10 *) grub_machine_acpi_get_rsdpv2 ();
  427. if (! rsdp)
  428. rsdp = grub_machine_acpi_get_rsdpv1 ();
  429. if (rsdp)
  430. {
  431. grub_uint32_t *entry_ptr;
  432. char *exclude = 0;
  433. char *load_only = 0;
  434. char *ptr;
  435. /* RSDT consists of header and an array of 32-bit pointers. */
  436. struct grub_acpi_table_header *rsdt;
  437. exclude = state[0].set ? grub_strdup (state[0].arg) : 0;
  438. if (exclude)
  439. {
  440. for (ptr = exclude; *ptr; ptr++)
  441. *ptr = grub_tolower (*ptr);
  442. }
  443. load_only = state[1].set ? grub_strdup (state[1].arg) : 0;
  444. if (load_only)
  445. {
  446. for (ptr = load_only; *ptr; ptr++)
  447. *ptr = grub_tolower (*ptr);
  448. }
  449. /* Set revision variables to replicate the same version as host. */
  450. rev1 = ! rsdp->revision;
  451. rev2 = rsdp->revision;
  452. rsdt = (struct grub_acpi_table_header *) UINT_TO_PTR (rsdp->rsdt_addr);
  453. /* Load host tables. */
  454. for (entry_ptr = (grub_uint32_t *) (rsdt + 1);
  455. entry_ptr < (grub_uint32_t *) (((grub_uint8_t *) rsdt)
  456. + rsdt->length);
  457. entry_ptr++)
  458. {
  459. char signature[5];
  460. struct efiemu_acpi_table *table;
  461. struct grub_acpi_table_header *curtable
  462. = (struct grub_acpi_table_header *) UINT_TO_PTR (*entry_ptr);
  463. signature[4] = 0;
  464. for (i = 0; i < 4;i++)
  465. signature[i] = grub_tolower (curtable->signature[i]);
  466. /* If it's FADT it contains addresses of DSDT and FACS. */
  467. if (grub_strcmp (signature, "facp") == 0)
  468. {
  469. struct grub_acpi_table_header *dsdt;
  470. struct grub_acpi_fadt *fadt = (struct grub_acpi_fadt *) curtable;
  471. /* Set root header variables to the same values
  472. as FADT by default. */
  473. grub_memcpy (&root_oemid, &(fadt->hdr.oemid),
  474. sizeof (root_oemid));
  475. grub_memcpy (&root_oemtable, &(fadt->hdr.oemtable),
  476. sizeof (root_oemtable));
  477. root_oemrev = fadt->hdr.oemrev;
  478. grub_memcpy (&root_creator_id, &(fadt->hdr.creator_id),
  479. sizeof (root_creator_id));
  480. root_creator_rev = fadt->hdr.creator_rev;
  481. /* Load DSDT if not excluded. */
  482. dsdt = (struct grub_acpi_table_header *)
  483. UINT_TO_PTR (fadt->dsdt_addr);
  484. if (dsdt && (! exclude || ! grub_strword (exclude, "dsdt"))
  485. && (! load_only || grub_strword (load_only, "dsdt"))
  486. && dsdt->length >= sizeof (*dsdt))
  487. {
  488. dsdt_size = dsdt->length;
  489. table_dsdt = grub_malloc (dsdt->length);
  490. if (! table_dsdt)
  491. {
  492. free_tables ();
  493. grub_free (exclude);
  494. grub_free (load_only);
  495. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  496. "couldn't allocate table");
  497. }
  498. grub_memcpy (table_dsdt, dsdt, dsdt->length);
  499. }
  500. /* Save FACS address. FACS shouldn't be overridden. */
  501. facs_addr = fadt->facs_addr;
  502. }
  503. /* Skip excluded tables. */
  504. if (exclude && grub_strword (exclude, signature))
  505. continue;
  506. if (load_only && ! grub_strword (load_only, signature))
  507. continue;
  508. /* Sanity check. */
  509. if (curtable->length < sizeof (*curtable))
  510. continue;
  511. table = (struct efiemu_acpi_table *) grub_malloc
  512. (sizeof (struct efiemu_acpi_table));
  513. if (! table)
  514. {
  515. free_tables ();
  516. grub_free (exclude);
  517. grub_free (load_only);
  518. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  519. "couldn't allocate table structure");
  520. }
  521. table->size = curtable->length;
  522. table->addr = grub_malloc (table->size);
  523. playground_size += table->size;
  524. if (! table->addr)
  525. {
  526. free_tables ();
  527. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  528. "couldn't allocate table");
  529. }
  530. table->next = acpi_tables;
  531. acpi_tables = table;
  532. grub_memcpy (table->addr, curtable, table->size);
  533. }
  534. grub_free (exclude);
  535. grub_free (load_only);
  536. }
  537. /* Does user specify versions to generate? */
  538. if (state[2].set || state[3].set)
  539. {
  540. rev1 = state[2].set;
  541. if (state[3].set)
  542. rev2 = rev2 ? : 2;
  543. else
  544. rev2 = 0;
  545. }
  546. /* Does user override root header information? */
  547. if (state[4].set)
  548. grub_strncpy (root_oemid, state[4].arg, sizeof (root_oemid));
  549. if (state[5].set)
  550. grub_strncpy (root_oemtable, state[5].arg, sizeof (root_oemtable));
  551. if (state[6].set)
  552. root_oemrev = grub_strtoul (state[6].arg, 0, 0);
  553. if (state[7].set)
  554. grub_strncpy (root_creator_id, state[7].arg, sizeof (root_creator_id));
  555. if (state[8].set)
  556. root_creator_rev = grub_strtoul (state[8].arg, 0, 0);
  557. /* Load user tables */
  558. for (i = 0; i < argc; i++)
  559. {
  560. grub_file_t file;
  561. grub_size_t size;
  562. char *buf;
  563. file = grub_file_open (args[i]);
  564. if (! file)
  565. {
  566. free_tables ();
  567. return grub_error (GRUB_ERR_BAD_OS, "couldn't open file %s", args[i]);
  568. }
  569. size = grub_file_size (file);
  570. if (size < sizeof (struct grub_acpi_table_header))
  571. {
  572. grub_file_close (file);
  573. free_tables ();
  574. return grub_error (GRUB_ERR_BAD_OS, "file %s is too small", args[i]);
  575. }
  576. buf = (char *) grub_malloc (size);
  577. if (! buf)
  578. {
  579. grub_file_close (file);
  580. free_tables ();
  581. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  582. "couldn't read file %s", args[i]);
  583. }
  584. if (grub_file_read (file, buf, size) != (int) size)
  585. {
  586. grub_file_close (file);
  587. free_tables ();
  588. return grub_error (GRUB_ERR_BAD_OS, "couldn't read file %s", args[i]);
  589. }
  590. grub_file_close (file);
  591. if (grub_memcmp (((struct grub_acpi_table_header *) buf)->signature,
  592. "DSDT", 4) == 0)
  593. {
  594. grub_free (table_dsdt);
  595. table_dsdt = buf;
  596. dsdt_size = size;
  597. }
  598. else
  599. {
  600. struct efiemu_acpi_table *table;
  601. table = (struct efiemu_acpi_table *) grub_malloc
  602. (sizeof (struct efiemu_acpi_table));
  603. if (! table)
  604. {
  605. free_tables ();
  606. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  607. "couldn't allocate table structure");
  608. }
  609. table->size = size;
  610. table->addr = buf;
  611. playground_size += table->size;
  612. table->next = acpi_tables;
  613. acpi_tables = table;
  614. }
  615. }
  616. numoftables = 0;
  617. for (cur = acpi_tables; cur; cur = cur->next)
  618. numoftables++;
  619. /* DSDT. */
  620. playground_size += dsdt_size;
  621. /* RSDT. */
  622. playground_size += sizeof (struct grub_acpi_table_header) + 4 * numoftables;
  623. /* RSDPv1. */
  624. playground_size += sizeof (struct grub_acpi_rsdp_v10);
  625. /* XSDT. */
  626. playground_size += sizeof (struct grub_acpi_table_header) + 8 * numoftables;
  627. /* RSDPv2. */
  628. playground_size += sizeof (struct grub_acpi_rsdp_v20);
  629. playground = playground_ptr
  630. = grub_mmap_malign_and_register (1, playground_size, &mmapregion,
  631. GRUB_MEMORY_ACPI, 0);
  632. if (! playground)
  633. {
  634. free_tables ();
  635. return grub_error (GRUB_ERR_OUT_OF_MEMORY,
  636. "couldn't allocate space for ACPI tables");
  637. }
  638. setup_common_tables ();
  639. /* Request space for RSDPv1. */
  640. if (rev1)
  641. setv1table ();
  642. /* Request space for RSDPv2+ and XSDT. */
  643. if (rev2)
  644. setv2table ();
  645. for (cur = acpi_tables; cur;)
  646. {
  647. t = cur;
  648. cur = cur->next;
  649. grub_free (t);
  650. }
  651. acpi_tables = 0;
  652. if (! state[9].set && (err = grub_acpi_create_ebda ()))
  653. {
  654. rsdpv1_new = 0;
  655. rsdpv2_new = 0;
  656. grub_mmap_free_and_unregister (mmapregion);
  657. return err;
  658. }
  659. #ifdef GRUB_MACHINE_EFI
  660. {
  661. struct grub_efi_guid acpi = GRUB_EFI_ACPI_TABLE_GUID;
  662. struct grub_efi_guid acpi20 = GRUB_EFI_ACPI_20_TABLE_GUID;
  663. grub_efi_system_table->boot_services->install_configuration_table
  664. (&acpi20, grub_acpi_get_rsdpv2 ());
  665. grub_efi_system_table->boot_services->install_configuration_table
  666. (&acpi, grub_acpi_get_rsdpv1 ());
  667. }
  668. #endif
  669. return GRUB_ERR_NONE;
  670. }
  671. static grub_extcmd_t cmd;
  672. GRUB_MOD_INIT(acpi)
  673. {
  674. cmd = grub_register_extcmd ("acpi", grub_cmd_acpi, 0,
  675. N_("[-1|-2] [--exclude=TABLE1,TABLE2|"
  676. "--load-only=table1,table2] FILE1"
  677. " [FILE2] [...]"),
  678. N_("Load host ACPI tables and tables "
  679. "specified by arguments."),
  680. options);
  681. }
  682. GRUB_MOD_FINI(acpi)
  683. {
  684. grub_unregister_extcmd (cmd);
  685. }