chiark / gitweb /
test-json: use fabs
[elogind.git] / src / shared / acpi-fpdt.c
1 /*-*- Mode: C; c-basic-offset: 8; indent-tabs-mode: nil -*-*/
2
3 /***
4   This file is part of systemd.
5
6   Copyright 2013 Kay Sievers
7
8   systemd is free software; you can redistribute it and/or modify it
9   under the terms of the GNU Lesser General Public License as published by
10   the Free Software Foundation; either version 2.1 of the License, or
11   (at your option) any later version.
12
13   systemd is distributed in the hope that it will be useful, but
14   WITHOUT ANY WARRANTY; without even the implied warranty of
15   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16   Lesser General Public License for more details.
17
18   You should have received a copy of the GNU Lesser General Public License
19   along with systemd; If not, see <http://www.gnu.org/licenses/>.
20 ***/
21
22 #include <stdlib.h>
23 #include <stdio.h>
24 #include <stdint.h>
25 #include <string.h>
26 #include <unistd.h>
27 #include <fcntl.h>
28 #include <sys/types.h>
29
30 #include <util.h>
31 #include <fileio.h>
32 #include <time-util.h>
33 #include <acpi-fpdt.h>
34
35 struct acpi_table_header {
36         char signature[4];
37         uint32_t length;
38         uint8_t revision;
39         uint8_t checksum;
40         char oem_id[6];
41         char oem_table_id[8];
42         uint32_t oem_revision;
43         char asl_compiler_id[4];
44         uint32_t asl_compiler_revision;
45 };
46
47 enum {
48         ACPI_FPDT_TYPE_BOOT =   0,
49         ACPI_FPDT_TYPE_S3PERF = 1,
50 };
51
52 struct acpi_fpdt_header {
53         uint16_t type;
54         uint8_t length;
55         uint8_t revision;
56         uint8_t reserved[4];
57         uint64_t ptr;
58 };
59
60 struct acpi_fpdt_boot_header {
61         char signature[4];
62         uint32_t length;
63 };
64
65 enum {
66         ACPI_FPDT_S3PERF_RESUME_REC =   0,
67         ACPI_FPDT_S3PERF_SUSPEND_REC =  1,
68         ACPI_FPDT_BOOT_REC =            2,
69 };
70
71 struct acpi_fpdt_boot {
72         uint16_t type;
73         uint8_t length;
74         uint8_t revision;
75         uint8_t reserved[4];
76         uint64_t reset_end;
77         uint64_t load_start;
78         uint64_t startup_start;
79         uint64_t exit_services_entry;
80         uint64_t exit_services_exit;
81 };
82
83 int acpi_get_boot_usec(usec_t *loader_start, usec_t *loader_exit) {
84         _cleanup_free_ char *buf = NULL;
85         struct acpi_table_header *tbl;
86         size_t l = 0;
87         struct acpi_fpdt_header *rec;
88         int r;
89         uint64_t ptr = 0;
90         _cleanup_close_ int fd = -1;
91         struct acpi_fpdt_boot_header hbrec;
92         struct acpi_fpdt_boot brec;
93
94         r = read_full_file("/sys/firmware/acpi/tables/FPDT", &buf, &l);
95         if (r < 0)
96                 return r;
97
98         if (l < sizeof(struct acpi_table_header) + sizeof(struct acpi_fpdt_header))
99                 return -EINVAL;
100
101         tbl = (struct acpi_table_header *)buf;
102         if (l != tbl->length)
103                 return -EINVAL;
104
105         if (memcmp(tbl->signature, "FPDT", 4) != 0)
106                 return -EINVAL;
107
108         /* find Firmware Basic Boot Performance Pointer Record */
109         for (rec = (struct acpi_fpdt_header *)(buf + sizeof(struct acpi_table_header));
110              (char *)rec < buf + l;
111              rec = (struct acpi_fpdt_header *)((char *)rec + rec->length)) {
112                 if (rec->length <= 0)
113                         break;
114                 if (rec->type != ACPI_FPDT_TYPE_BOOT)
115                         continue;
116                 if (rec->length != sizeof(struct acpi_fpdt_header))
117                         continue;
118
119                 ptr = rec->ptr;
120                 break;
121         }
122
123         if (ptr == 0)
124                 return -EINVAL;
125
126         /* read Firmware Basic Boot Performance Data Record */
127         fd = open("/dev/mem", O_CLOEXEC|O_RDONLY);
128         if (fd < 0)
129                 return -errno;
130
131         l = pread(fd, &hbrec, sizeof(struct acpi_fpdt_boot_header), ptr);
132         if (l != sizeof(struct acpi_fpdt_boot_header))
133                 return -EINVAL;
134
135         if (memcmp(hbrec.signature, "FBPT", 4) != 0)
136                 return -EINVAL;
137
138         if (hbrec.length < sizeof(struct acpi_fpdt_boot_header) + sizeof(struct acpi_fpdt_boot))
139                 return -EINVAL;
140
141         l = pread(fd, &brec, sizeof(struct acpi_fpdt_boot), ptr + sizeof(struct acpi_fpdt_boot_header));
142         if (l != sizeof(struct acpi_fpdt_boot))
143                 return -EINVAL;
144
145         if (brec.length != sizeof(struct acpi_fpdt_boot))
146                 return -EINVAL;
147
148         if (brec.type != ACPI_FPDT_BOOT_REC)
149                 return -EINVAL;
150
151         if (brec.startup_start == 0 || brec.exit_services_exit < brec.startup_start)
152                 return -EINVAL;
153         if (brec.exit_services_exit > NSEC_PER_HOUR)
154                 return -EINVAL;
155
156         if (loader_start)
157                 *loader_start = brec.startup_start / 1000;
158         if (loader_exit)
159                 *loader_exit = brec.exit_services_exit / 1000;
160
161         return 0;
162 }