xref: /freebsd/usr.sbin/acpi/acpidump/acpi_user.c (revision e1e9a4bf77df02678428853e90647d58934683e1)
1e1e9a4bfSMitsuru IWASAKI /*-
2e1e9a4bfSMitsuru IWASAKI  * Copyright (c) 1999 Doug Rabson
3e1e9a4bfSMitsuru IWASAKI  * Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
4e1e9a4bfSMitsuru IWASAKI  * All rights reserved.
5e1e9a4bfSMitsuru IWASAKI  *
6e1e9a4bfSMitsuru IWASAKI  * Redistribution and use in source and binary forms, with or without
7e1e9a4bfSMitsuru IWASAKI  * modification, are permitted provided that the following conditions
8e1e9a4bfSMitsuru IWASAKI  * are met:
9e1e9a4bfSMitsuru IWASAKI  * 1. Redistributions of source code must retain the above copyright
10e1e9a4bfSMitsuru IWASAKI  *    notice, this list of conditions and the following disclaimer.
11e1e9a4bfSMitsuru IWASAKI  * 2. Redistributions in binary form must reproduce the above copyright
12e1e9a4bfSMitsuru IWASAKI  *    notice, this list of conditions and the following disclaimer in the
13e1e9a4bfSMitsuru IWASAKI  *    documentation and/or other materials provided with the distribution.
14e1e9a4bfSMitsuru IWASAKI  *
15e1e9a4bfSMitsuru IWASAKI  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16e1e9a4bfSMitsuru IWASAKI  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17e1e9a4bfSMitsuru IWASAKI  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18e1e9a4bfSMitsuru IWASAKI  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19e1e9a4bfSMitsuru IWASAKI  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20e1e9a4bfSMitsuru IWASAKI  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21e1e9a4bfSMitsuru IWASAKI  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22e1e9a4bfSMitsuru IWASAKI  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23e1e9a4bfSMitsuru IWASAKI  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24e1e9a4bfSMitsuru IWASAKI  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25e1e9a4bfSMitsuru IWASAKI  * SUCH DAMAGE.
26e1e9a4bfSMitsuru IWASAKI  *
27e1e9a4bfSMitsuru IWASAKI  *	$Id: acpi_user.c,v 1.5 2000/08/09 14:47:52 iwasaki Exp $
28e1e9a4bfSMitsuru IWASAKI  *	$FreeBSD$
29e1e9a4bfSMitsuru IWASAKI  */
30e1e9a4bfSMitsuru IWASAKI 
31e1e9a4bfSMitsuru IWASAKI #include <sys/param.h>
32e1e9a4bfSMitsuru IWASAKI #include <sys/mman.h>
33e1e9a4bfSMitsuru IWASAKI #include <sys/queue.h>
34e1e9a4bfSMitsuru IWASAKI #include <sys/stat.h>
35e1e9a4bfSMitsuru IWASAKI #include <sys/acpi.h>
36e1e9a4bfSMitsuru IWASAKI 
37e1e9a4bfSMitsuru IWASAKI #include <err.h>
38e1e9a4bfSMitsuru IWASAKI #include <fcntl.h>
39e1e9a4bfSMitsuru IWASAKI #include <stdlib.h>
40e1e9a4bfSMitsuru IWASAKI #include <string.h>
41e1e9a4bfSMitsuru IWASAKI #include <unistd.h>
42e1e9a4bfSMitsuru IWASAKI 
43e1e9a4bfSMitsuru IWASAKI #include "acpidump.h"
44e1e9a4bfSMitsuru IWASAKI 
45e1e9a4bfSMitsuru IWASAKI static int      acpi_mem_fd = -1;
46e1e9a4bfSMitsuru IWASAKI 
47e1e9a4bfSMitsuru IWASAKI struct acpi_user_mapping {
48e1e9a4bfSMitsuru IWASAKI 	LIST_ENTRY(acpi_user_mapping) link;
49e1e9a4bfSMitsuru IWASAKI 	vm_offset_t     pa;
50e1e9a4bfSMitsuru IWASAKI 	caddr_t         va;
51e1e9a4bfSMitsuru IWASAKI 	size_t          size;
52e1e9a4bfSMitsuru IWASAKI };
53e1e9a4bfSMitsuru IWASAKI 
54e1e9a4bfSMitsuru IWASAKI LIST_HEAD(acpi_user_mapping_list, acpi_user_mapping) maplist;
55e1e9a4bfSMitsuru IWASAKI 
56e1e9a4bfSMitsuru IWASAKI static void
57e1e9a4bfSMitsuru IWASAKI acpi_user_init()
58e1e9a4bfSMitsuru IWASAKI {
59e1e9a4bfSMitsuru IWASAKI 
60e1e9a4bfSMitsuru IWASAKI 	if (acpi_mem_fd == -1) {
61e1e9a4bfSMitsuru IWASAKI 		acpi_mem_fd = open("/dev/mem", O_RDONLY);
62e1e9a4bfSMitsuru IWASAKI 		if (acpi_mem_fd == -1)
63e1e9a4bfSMitsuru IWASAKI 			err(1, "opening /dev/mem");
64e1e9a4bfSMitsuru IWASAKI 		LIST_INIT(&maplist);
65e1e9a4bfSMitsuru IWASAKI 	}
66e1e9a4bfSMitsuru IWASAKI }
67e1e9a4bfSMitsuru IWASAKI 
68e1e9a4bfSMitsuru IWASAKI static struct acpi_user_mapping *
69e1e9a4bfSMitsuru IWASAKI acpi_user_find_mapping(vm_offset_t pa, size_t size)
70e1e9a4bfSMitsuru IWASAKI {
71e1e9a4bfSMitsuru IWASAKI 	struct	acpi_user_mapping *map;
72e1e9a4bfSMitsuru IWASAKI 
73e1e9a4bfSMitsuru IWASAKI 	/* First search for an existing mapping */
74e1e9a4bfSMitsuru IWASAKI 	for (map = LIST_FIRST(&maplist); map; map = LIST_NEXT(map, link)) {
75e1e9a4bfSMitsuru IWASAKI 		if (map->pa <= pa && map->size >= pa + size - map->pa)
76e1e9a4bfSMitsuru IWASAKI 			return (map);
77e1e9a4bfSMitsuru IWASAKI 	}
78e1e9a4bfSMitsuru IWASAKI 
79e1e9a4bfSMitsuru IWASAKI 	/* Then create a new one */
80e1e9a4bfSMitsuru IWASAKI 	size = round_page(pa + size) - trunc_page(pa);
81e1e9a4bfSMitsuru IWASAKI 	pa = trunc_page(pa);
82e1e9a4bfSMitsuru IWASAKI 	map = malloc(sizeof(struct acpi_user_mapping));
83e1e9a4bfSMitsuru IWASAKI 	if (!map)
84e1e9a4bfSMitsuru IWASAKI 		errx(1, "out of memory");
85e1e9a4bfSMitsuru IWASAKI 	map->pa = pa;
86e1e9a4bfSMitsuru IWASAKI 	map->va = mmap(0, size, PROT_READ, MAP_SHARED, acpi_mem_fd, pa);
87e1e9a4bfSMitsuru IWASAKI 	map->size = size;
88e1e9a4bfSMitsuru IWASAKI 	if ((intptr_t) map->va == -1)
89e1e9a4bfSMitsuru IWASAKI 		err(1, "can't map address");
90e1e9a4bfSMitsuru IWASAKI 	LIST_INSERT_HEAD(&maplist, map, link);
91e1e9a4bfSMitsuru IWASAKI 
92e1e9a4bfSMitsuru IWASAKI 	return (map);
93e1e9a4bfSMitsuru IWASAKI }
94e1e9a4bfSMitsuru IWASAKI 
95e1e9a4bfSMitsuru IWASAKI /*
96e1e9a4bfSMitsuru IWASAKI  * Public interfaces
97e1e9a4bfSMitsuru IWASAKI  */
98e1e9a4bfSMitsuru IWASAKI 
99e1e9a4bfSMitsuru IWASAKI struct ACPIrsdp *
100e1e9a4bfSMitsuru IWASAKI acpi_find_rsd_ptr()
101e1e9a4bfSMitsuru IWASAKI {
102e1e9a4bfSMitsuru IWASAKI 	int		i;
103e1e9a4bfSMitsuru IWASAKI 	u_int8_t	buf[sizeof(struct ACPIrsdp)];
104e1e9a4bfSMitsuru IWASAKI 
105e1e9a4bfSMitsuru IWASAKI 	acpi_user_init();
106e1e9a4bfSMitsuru IWASAKI 	for (i = 0; i < 1024 * 1024; i += 16) {
107e1e9a4bfSMitsuru IWASAKI 		read(acpi_mem_fd, buf, 16);
108e1e9a4bfSMitsuru IWASAKI 		if (!memcmp(buf, "RSD PTR ", 8)) {
109e1e9a4bfSMitsuru IWASAKI 			/* Read the rest of the structure */
110e1e9a4bfSMitsuru IWASAKI 			read(acpi_mem_fd, buf + 16, sizeof(struct ACPIrsdp) - 16);
111e1e9a4bfSMitsuru IWASAKI 
112e1e9a4bfSMitsuru IWASAKI 			/* Verify checksum before accepting it. */
113e1e9a4bfSMitsuru IWASAKI 			if (acpi_checksum(buf, sizeof(struct ACPIrsdp)))
114e1e9a4bfSMitsuru IWASAKI 				continue;
115e1e9a4bfSMitsuru IWASAKI 			return (acpi_map_physical(i, sizeof(struct ACPIrsdp)));
116e1e9a4bfSMitsuru IWASAKI 		}
117e1e9a4bfSMitsuru IWASAKI 	}
118e1e9a4bfSMitsuru IWASAKI 
119e1e9a4bfSMitsuru IWASAKI 	return (0);
120e1e9a4bfSMitsuru IWASAKI }
121e1e9a4bfSMitsuru IWASAKI 
122e1e9a4bfSMitsuru IWASAKI void *
123e1e9a4bfSMitsuru IWASAKI acpi_map_physical(vm_offset_t pa, size_t size)
124e1e9a4bfSMitsuru IWASAKI {
125e1e9a4bfSMitsuru IWASAKI 	struct	acpi_user_mapping *map;
126e1e9a4bfSMitsuru IWASAKI 
127e1e9a4bfSMitsuru IWASAKI 	map = acpi_user_find_mapping(pa, size);
128e1e9a4bfSMitsuru IWASAKI 	return (map->va + (pa - map->pa));
129e1e9a4bfSMitsuru IWASAKI }
130e1e9a4bfSMitsuru IWASAKI 
131e1e9a4bfSMitsuru IWASAKI void
132e1e9a4bfSMitsuru IWASAKI acpi_load_dsdt(char *dumpfile, u_int8_t **dpp, u_int8_t **endp)
133e1e9a4bfSMitsuru IWASAKI {
134e1e9a4bfSMitsuru IWASAKI 	u_int8_t	*dp;
135e1e9a4bfSMitsuru IWASAKI 	u_int8_t	*end;
136e1e9a4bfSMitsuru IWASAKI 	struct	stat sb;
137e1e9a4bfSMitsuru IWASAKI 
138e1e9a4bfSMitsuru IWASAKI 	if ((acpi_mem_fd = open(dumpfile, O_RDONLY)) == -1) {
139e1e9a4bfSMitsuru IWASAKI 		errx(1, "opening %s\n", dumpfile);
140e1e9a4bfSMitsuru IWASAKI 	}
141e1e9a4bfSMitsuru IWASAKI 
142e1e9a4bfSMitsuru IWASAKI 	LIST_INIT(&maplist);
143e1e9a4bfSMitsuru IWASAKI 
144e1e9a4bfSMitsuru IWASAKI 	if (fstat(acpi_mem_fd, &sb) == -1) {
145e1e9a4bfSMitsuru IWASAKI 		errx(1, "fstat %s\n", dumpfile);
146e1e9a4bfSMitsuru IWASAKI 	}
147e1e9a4bfSMitsuru IWASAKI 
148e1e9a4bfSMitsuru IWASAKI 	dp = mmap(0, sb.st_size, PROT_READ, MAP_PRIVATE, acpi_mem_fd, 0);
149e1e9a4bfSMitsuru IWASAKI 	if (dp == NULL) {
150e1e9a4bfSMitsuru IWASAKI 		errx(1, "mmap %s\n", dumpfile);
151e1e9a4bfSMitsuru IWASAKI 	}
152e1e9a4bfSMitsuru IWASAKI 
153e1e9a4bfSMitsuru IWASAKI 	/*
154e1e9a4bfSMitsuru IWASAKI 	 * Microsoft asl.exe generates 0x23 byte additional info.
155e1e9a4bfSMitsuru IWASAKI 	 * at the begining of the file, so just ignore it.
156e1e9a4bfSMitsuru IWASAKI 	 */
157e1e9a4bfSMitsuru IWASAKI         if (strncmp(dp, "DSDT", 4) == 0) {
158e1e9a4bfSMitsuru IWASAKI                 dp += 0x23;
159e1e9a4bfSMitsuru IWASAKI 		sb.st_size -= 0x23;
160e1e9a4bfSMitsuru IWASAKI         }
161e1e9a4bfSMitsuru IWASAKI 
162e1e9a4bfSMitsuru IWASAKI 	end = (u_int8_t *) dp + sb.st_size;
163e1e9a4bfSMitsuru IWASAKI 	*dpp = dp;
164e1e9a4bfSMitsuru IWASAKI 	*endp = end;
165e1e9a4bfSMitsuru IWASAKI }
166