2 * Copyright (c) 2000-2002 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * $FreeBSD: src/usr.sbin/acpi/acpidb/acpidb.c,v 1.1 2003/08/07 16:51:50 njl Exp $
27 * $DragonFly: src/usr.sbin/acpi/acpidb/acpidb.c,v 1.2 2007/01/17 17:31:19 y0netan1 Exp $
30 #include <sys/param.h>
31 #include <sys/queue.h>
34 #include <sys/types.h>
55 * Dummy DSDT Table Header
58 ACPI_TABLE_HEADER dummy_dsdt_table = {
59 "DSDT", 123, 1, 123, "OEMID", "OEMTBLID", 1, "CRID", 1
63 * Region space I/O routines on virtual machine
66 int aml_debug_prompt = 1;
68 UINT8 AcpiGbl_RegionFillValue = 0;
70 struct ACPIRegionContent {
71 TAILQ_ENTRY(ACPIRegionContent) links;
73 ACPI_PHYSICAL_ADDRESS addr;
77 TAILQ_HEAD(ACPIRegionContentList, ACPIRegionContent);
78 struct ACPIRegionContentList RegionContentList;
80 static int aml_simulation_initialized = 0;
82 static void aml_simulation_init(void);
83 static int aml_simulate_regcontent_add(int regtype,
84 ACPI_PHYSICAL_ADDRESS addr,
86 static int aml_simulate_regcontent_read(int regtype,
87 ACPI_PHYSICAL_ADDRESS addr,
89 static int aml_simulate_regcontent_write(int regtype,
90 ACPI_PHYSICAL_ADDRESS addr,
92 static ACPI_INTEGER aml_simulate_prompt(char *msg, ACPI_INTEGER def_val);
93 static void aml_simulation_regload(const char *dumpfile);
94 static void aml_simulation_regdump(const char *dumpfile);
97 aml_simulation_init(void)
100 aml_simulation_initialized = 1;
101 TAILQ_INIT(&RegionContentList);
102 aml_simulation_regload("region.ini");
106 aml_simulate_regcontent_add(int regtype, ACPI_PHYSICAL_ADDRESS addr, UINT8 value)
108 struct ACPIRegionContent *rc;
110 rc = malloc(sizeof(struct ACPIRegionContent));
112 return (-1); /* malloc fail */
114 rc->regtype = regtype;
118 TAILQ_INSERT_TAIL(&RegionContentList, rc, links);
123 aml_simulate_regcontent_read(int regtype, ACPI_PHYSICAL_ADDRESS addr, UINT8 *valuep)
125 struct ACPIRegionContent *rc;
127 if (!aml_simulation_initialized) {
128 aml_simulation_init();
130 TAILQ_FOREACH(rc, &RegionContentList, links) {
131 if (rc->regtype == regtype && rc->addr == addr) {
133 return (1); /* found */
138 return (aml_simulate_regcontent_add(regtype, addr, *valuep));
142 aml_simulate_regcontent_write(int regtype, ACPI_PHYSICAL_ADDRESS addr, UINT8 *valuep)
144 struct ACPIRegionContent *rc;
146 if (!aml_simulation_initialized) {
147 aml_simulation_init();
149 TAILQ_FOREACH(rc, &RegionContentList, links) {
150 if (rc->regtype == regtype && rc->addr == addr) {
152 return (1); /* exists */
156 return (aml_simulate_regcontent_add(regtype, addr, *valuep));
160 aml_simulate_prompt(char *msg, ACPI_INTEGER def_val)
170 printf("(default: 0x%x ", val);
171 printf(" / %u) >>", val);
174 bzero(buf, sizeof buf);
176 if (read(0, buf, sizeof buf) == 0) {
179 if (buf[0] == '\n') {
180 break; /* use default value */
182 if (buf[0] == '0' && buf[1] == 'x') {
183 val = strtoq(buf, &ep, 16);
185 val = strtoq(buf, &ep, 10);
193 aml_simulation_regload(const char *dumpfile)
195 char buf[256], *np, *ep;
196 struct ACPIRegionContent rc;
199 if (!aml_simulation_initialized) {
203 if ((fp = fopen(dumpfile, "r")) == NULL) {
207 while (fgets(buf, sizeof buf, fp) != NULL) {
209 /* reading region type */
210 rc.regtype = strtoq(np, &ep, 10);
216 /* reading address */
217 rc.addr = strtoq(np, &ep, 16);
224 rc.value = strtoq(np, &ep, 16);
228 aml_simulate_regcontent_write(rc.regtype, rc.addr, &rc.value);
235 aml_simulation_regdump(const char *dumpfile)
237 struct ACPIRegionContent *rc;
240 if (!aml_simulation_initialized) {
243 if ((fp = fopen(dumpfile, "w")) == NULL) {
244 warn("%s", dumpfile);
247 while (!TAILQ_EMPTY(&RegionContentList)) {
248 rc = TAILQ_FIRST(&RegionContentList);
249 fprintf(fp, "%d 0x%x 0x%x\n",
250 rc->regtype, rc->addr, rc->value);
251 TAILQ_REMOVE(&RegionContentList, rc, links);
256 TAILQ_INIT(&RegionContentList);
260 * Space handlers on virtual machine
264 aml_vm_space_handler(
267 ACPI_PHYSICAL_ADDRESS Address,
274 ACPI_INTEGER value, i;
276 static char *space_names[] = {
277 "SYSTEM_MEMORY", "SYSTEM_IO", "PCI_CONFIG",
278 "EC", "SMBUS", "CMOS", "PCI_BAR_TARGET"};
283 for (i = 0; (i * 8) < BitWidth; i++) {
284 state = aml_simulate_regcontent_read(SpaceID,
287 return (AE_NO_MEMORY);
289 value |= val << (i * 8);
293 sprintf(msg, "[read (%s, %2d, 0x%x)]",
294 space_names[SpaceID], BitWidth, Address);
295 *Value = aml_simulate_prompt(msg, value);
296 if (*Value != value) {
297 return(aml_vm_space_handler(SpaceID,
299 Address, BitWidth, Value, 0));
307 sprintf(msg, "[write(%s, %2d, 0x%x)]",
308 space_names[SpaceID], BitWidth, Address);
309 value = aml_simulate_prompt(msg, *Value);
312 for (i = 0; (i * 8) < BitWidth; i++) {
314 state = aml_simulate_regcontent_write(SpaceID,
317 return (AE_NO_MEMORY);
326 #define DECLARE_VM_SPACE_HANDLER(name, id); \
328 aml_vm_space_handler_##name ( \
330 ACPI_PHYSICAL_ADDRESS Address, \
332 ACPI_INTEGER *Value, \
333 void *HandlerContext, \
334 void *RegionContext) \
336 return (aml_vm_space_handler(id, Function, Address, \
337 BitWidth, Value, aml_debug_prompt)); \
340 DECLARE_VM_SPACE_HANDLER(system_memory, ACPI_ADR_SPACE_SYSTEM_MEMORY);
341 DECLARE_VM_SPACE_HANDLER(system_io, ACPI_ADR_SPACE_SYSTEM_IO);
342 DECLARE_VM_SPACE_HANDLER(pci_config, ACPI_ADR_SPACE_PCI_CONFIG);
343 DECLARE_VM_SPACE_HANDLER(ec, ACPI_ADR_SPACE_EC);
344 DECLARE_VM_SPACE_HANDLER(smbus, ACPI_ADR_SPACE_SMBUS);
345 DECLARE_VM_SPACE_HANDLER(cmos, ACPI_ADR_SPACE_CMOS);
346 DECLARE_VM_SPACE_HANDLER(pci_bar_target,ACPI_ADR_SPACE_PCI_BAR_TARGET);
348 static u_int8_t *mapped_rsdp;
349 #define ACPI_MAX_INIT_TABLES (16)
350 static ACPI_TABLE_DESC Tables[ACPI_MAX_INIT_TABLES];
353 * Load DSDT data file and invoke debugger
357 load_dsdt(const char *dsdtfile)
359 char filetmp[PATH_MAX];
360 u_int8_t *code, *amlptr;
364 ACPI_TABLE_HEADER *Table;
366 fd = open(dsdtfile, O_RDONLY, 0);
371 if (fstat(fd, &sb) == -1) {
375 code = mmap(NULL, (size_t)sb.st_size, PROT_READ, MAP_PRIVATE, fd, (off_t)0);
381 if ((error = AcpiInitializeSubsystem()) != AE_OK) {
382 err(1, "AcpiInitializeSubsystem returned %d", error);
387 * make sure DSDT data contains table header or not.
389 if (strncmp((char *)code, "DSDT", 4) == 0) {
390 strncpy(filetmp, dsdtfile, sizeof(filetmp));
392 mode_t mode = (S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
393 dummy_dsdt_table.Length = sizeof(ACPI_TABLE_HEADER) + sb.st_size;
394 snprintf(filetmp, sizeof(filetmp), "%s.tmp", dsdtfile);
395 fd2 = open(filetmp, O_WRONLY | O_CREAT | O_TRUNC, mode);
400 write(fd2, &dummy_dsdt_table, sizeof(ACPI_TABLE_HEADER));
402 write(fd2, code, sb.st_size);
407 * Install the virtual machine version of address space handlers.
409 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
410 ACPI_ADR_SPACE_SYSTEM_MEMORY,
411 aml_vm_space_handler_system_memory,
412 NULL, NULL)) != AE_OK) {
413 fprintf(stderr, "could not initialise SystemMemory handler: %d\n", error);
416 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
417 ACPI_ADR_SPACE_SYSTEM_IO,
418 aml_vm_space_handler_system_io,
419 NULL, NULL)) != AE_OK) {
420 fprintf(stderr, "could not initialise SystemIO handler: %d\n", error);
423 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
424 ACPI_ADR_SPACE_PCI_CONFIG,
425 aml_vm_space_handler_pci_config,
426 NULL, NULL)) != AE_OK) {
427 fprintf(stderr, "could not initialise PciConfig handler: %d\n", error);
430 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
432 aml_vm_space_handler_ec,
433 NULL, NULL)) != AE_OK) {
434 fprintf(stderr, "could not initialise EC handler: %d\n", error);
437 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
438 ACPI_ADR_SPACE_SMBUS,
439 aml_vm_space_handler_smbus,
440 NULL, NULL)) != AE_OK) {
441 fprintf(stderr, "could not initialise SMBUS handler: %d\n", error);
444 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
446 aml_vm_space_handler_cmos,
447 NULL, NULL)) != AE_OK) {
448 fprintf(stderr, "could not initialise CMOS handler: %d\n", error);
451 if ((error = AcpiInstallAddressSpaceHandler(ACPI_ROOT_OBJECT,
452 ACPI_ADR_SPACE_PCI_BAR_TARGET,
453 aml_vm_space_handler_pci_bar_target,
454 NULL, NULL)) != AE_OK) {
455 fprintf(stderr, "could not initialise PCI BAR TARGET handler: %d\n", error);
459 AcpiGbl_GlobalLockPresent = TRUE;
461 error = AcpiDbReadTableFromFile (filetmp, &Table);
462 if (ACPI_FAILURE(error)) {
463 fprintf(stderr, "AcpiDbReadTableFromFile failed: %s\n",
464 AcpiFormatException(error));
467 AeBuildLocalTables(Table);
468 if (ACPI_FAILURE(error = AeInstallTables())) {
469 fprintf(stderr, "AeInstallTables failed: %s\n",
470 AcpiFormatException(error));
474 AcpiUtSetIntegerWidth (Table->Revision);
477 AcpiGbl_DebuggerConfiguration = 0;
478 AcpiDbUserCommands(':', NULL);
480 if (strcmp(dsdtfile, filetmp) != 0) {
488 usage(const char *progname)
491 printf("usage: %s dsdt_file\n", progname);
495 BOOLEAN AcpiGbl_IgnoreErrors = FALSE;
498 main(int argc, char *argv[])
508 AcpiDbgLevel = ACPI_DEBUG_DEFAULT;
509 AcpiGbl_EnableInterpreterSlack = TRUE;
511 aml_simulation_regload("region.ini");
512 if (load_dsdt(argv[1]) == 0) {
513 aml_simulation_regdump("region.dmp");