1f1e1ea51SMario Limonciello // SPDX-License-Identifier: GPL-2.0-only
2f1e1ea51SMario Limonciello /*
3f1e1ea51SMario Limonciello * Common functions for kernel modules using Dell SMBIOS
4f1e1ea51SMario Limonciello *
5f1e1ea51SMario Limonciello * Copyright (c) Red Hat <mjg@redhat.com>
6f1e1ea51SMario Limonciello * Copyright (c) 2014 Gabriele Mazzotta <gabriele.mzt@gmail.com>
7f1e1ea51SMario Limonciello * Copyright (c) 2014 Pali Rohár <pali@kernel.org>
8f1e1ea51SMario Limonciello *
9f1e1ea51SMario Limonciello * Based on documentation in the libsmbios package:
10f1e1ea51SMario Limonciello * Copyright (C) 2005-2014 Dell Inc.
11f1e1ea51SMario Limonciello */
12f1e1ea51SMario Limonciello #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
13f1e1ea51SMario Limonciello
14b07a62f8SArmin Wolf #include <linux/container_of.h>
15f1e1ea51SMario Limonciello #include <linux/kernel.h>
16f1e1ea51SMario Limonciello #include <linux/module.h>
17f1e1ea51SMario Limonciello #include <linux/capability.h>
18f1e1ea51SMario Limonciello #include <linux/dmi.h>
19f1e1ea51SMario Limonciello #include <linux/err.h>
20f1e1ea51SMario Limonciello #include <linux/mutex.h>
21f1e1ea51SMario Limonciello #include <linux/platform_device.h>
22f1e1ea51SMario Limonciello #include <linux/slab.h>
23f1e1ea51SMario Limonciello #include "dell-smbios.h"
24f1e1ea51SMario Limonciello
25f1e1ea51SMario Limonciello static u32 da_supported_commands;
26f1e1ea51SMario Limonciello static int da_num_tokens;
27f1e1ea51SMario Limonciello static struct platform_device *platform_device;
28f1e1ea51SMario Limonciello static struct calling_interface_token *da_tokens;
29b07a62f8SArmin Wolf static struct token_sysfs_data *token_entries;
30f1e1ea51SMario Limonciello static struct attribute **token_attrs;
31f1e1ea51SMario Limonciello static DEFINE_MUTEX(smbios_mutex);
32f1e1ea51SMario Limonciello
33b07a62f8SArmin Wolf struct token_sysfs_data {
34b07a62f8SArmin Wolf struct device_attribute location_attr;
35b07a62f8SArmin Wolf struct device_attribute value_attr;
36b07a62f8SArmin Wolf struct calling_interface_token *token;
37b07a62f8SArmin Wolf };
38b07a62f8SArmin Wolf
39f1e1ea51SMario Limonciello struct smbios_device {
40f1e1ea51SMario Limonciello struct list_head list;
41f1e1ea51SMario Limonciello struct device *device;
42f1e1ea51SMario Limonciello int (*call_fn)(struct calling_interface_buffer *arg);
43f1e1ea51SMario Limonciello };
44f1e1ea51SMario Limonciello
45f1e1ea51SMario Limonciello struct smbios_call {
46f1e1ea51SMario Limonciello u32 need_capability;
47f1e1ea51SMario Limonciello int cmd_class;
48f1e1ea51SMario Limonciello int cmd_select;
49f1e1ea51SMario Limonciello };
50f1e1ea51SMario Limonciello
51f1e1ea51SMario Limonciello /* calls that are whitelisted for given capabilities */
52f1e1ea51SMario Limonciello static struct smbios_call call_whitelist[] = {
53f1e1ea51SMario Limonciello /* generally tokens are allowed, but may be further filtered or
54f1e1ea51SMario Limonciello * restricted by token blacklist or whitelist
55f1e1ea51SMario Limonciello */
56f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_READ, SELECT_TOKEN_STD},
57f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_READ, SELECT_TOKEN_AC},
58f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_READ, SELECT_TOKEN_BAT},
59f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_WRITE, SELECT_TOKEN_STD},
60f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_WRITE, SELECT_TOKEN_AC},
61f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_TOKEN_WRITE, SELECT_TOKEN_BAT},
62f1e1ea51SMario Limonciello /* used by userspace: fwupdate */
63f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_ADMIN_PROP, SELECT_ADMIN_PROP},
64f1e1ea51SMario Limonciello /* used by userspace: fwupd */
65f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_INFO, SELECT_DOCK},
66f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CLASS_FLASH_INTERFACE, SELECT_FLASH_INTERFACE},
67f1e1ea51SMario Limonciello };
68f1e1ea51SMario Limonciello
69f1e1ea51SMario Limonciello /* calls that are explicitly blacklisted */
70f1e1ea51SMario Limonciello static struct smbios_call call_blacklist[] = {
71f1e1ea51SMario Limonciello {0x0000, 1, 7}, /* manufacturing use */
72f1e1ea51SMario Limonciello {0x0000, 6, 5}, /* manufacturing use */
73f1e1ea51SMario Limonciello {0x0000, 11, 3}, /* write once */
74f1e1ea51SMario Limonciello {0x0000, 11, 7}, /* write once */
75f1e1ea51SMario Limonciello {0x0000, 11, 11}, /* write once */
76f1e1ea51SMario Limonciello {0x0000, 19, -1}, /* diagnostics */
77f1e1ea51SMario Limonciello /* handled by kernel: dell-laptop */
78f1e1ea51SMario Limonciello {0x0000, CLASS_INFO, SELECT_RFKILL},
79f1e1ea51SMario Limonciello {0x0000, CLASS_KBD_BACKLIGHT, SELECT_KBD_BACKLIGHT},
80f1e1ea51SMario Limonciello };
81f1e1ea51SMario Limonciello
82f1e1ea51SMario Limonciello struct token_range {
83f1e1ea51SMario Limonciello u32 need_capability;
84f1e1ea51SMario Limonciello u16 min;
85f1e1ea51SMario Limonciello u16 max;
86f1e1ea51SMario Limonciello };
87f1e1ea51SMario Limonciello
88f1e1ea51SMario Limonciello /* tokens that are whitelisted for given capabilities */
89f1e1ea51SMario Limonciello static struct token_range token_whitelist[] = {
90f1e1ea51SMario Limonciello /* used by userspace: fwupdate */
91f1e1ea51SMario Limonciello {CAP_SYS_ADMIN, CAPSULE_EN_TOKEN, CAPSULE_DIS_TOKEN},
92f1e1ea51SMario Limonciello /* can indicate to userspace that WMI is needed */
93f1e1ea51SMario Limonciello {0x0000, WSMT_EN_TOKEN, WSMT_DIS_TOKEN}
94f1e1ea51SMario Limonciello };
95f1e1ea51SMario Limonciello
96f1e1ea51SMario Limonciello /* tokens that are explicitly blacklisted */
97f1e1ea51SMario Limonciello static struct token_range token_blacklist[] = {
98f1e1ea51SMario Limonciello {0x0000, 0x0058, 0x0059}, /* ME use */
99f1e1ea51SMario Limonciello {0x0000, 0x00CD, 0x00D0}, /* raid shadow copy */
100f1e1ea51SMario Limonciello {0x0000, 0x013A, 0x01FF}, /* sata shadow copy */
101f1e1ea51SMario Limonciello {0x0000, 0x0175, 0x0176}, /* write once */
102f1e1ea51SMario Limonciello {0x0000, 0x0195, 0x0197}, /* diagnostics */
103f1e1ea51SMario Limonciello {0x0000, 0x01DC, 0x01DD}, /* manufacturing use */
104f1e1ea51SMario Limonciello {0x0000, 0x027D, 0x0284}, /* diagnostics */
105f1e1ea51SMario Limonciello {0x0000, 0x02E3, 0x02E3}, /* manufacturing use */
106f1e1ea51SMario Limonciello {0x0000, 0x02FF, 0x02FF}, /* manufacturing use */
107f1e1ea51SMario Limonciello {0x0000, 0x0300, 0x0302}, /* manufacturing use */
108f1e1ea51SMario Limonciello {0x0000, 0x0325, 0x0326}, /* manufacturing use */
109f1e1ea51SMario Limonciello {0x0000, 0x0332, 0x0335}, /* fan control */
110f1e1ea51SMario Limonciello {0x0000, 0x0350, 0x0350}, /* manufacturing use */
111f1e1ea51SMario Limonciello {0x0000, 0x0363, 0x0363}, /* manufacturing use */
112f1e1ea51SMario Limonciello {0x0000, 0x0368, 0x0368}, /* manufacturing use */
113f1e1ea51SMario Limonciello {0x0000, 0x03F6, 0x03F7}, /* manufacturing use */
114f1e1ea51SMario Limonciello {0x0000, 0x049E, 0x049F}, /* manufacturing use */
115f1e1ea51SMario Limonciello {0x0000, 0x04A0, 0x04A3}, /* disagnostics */
116f1e1ea51SMario Limonciello {0x0000, 0x04E6, 0x04E7}, /* manufacturing use */
117f1e1ea51SMario Limonciello {0x0000, 0x4000, 0x7FFF}, /* internal BIOS use */
118f1e1ea51SMario Limonciello {0x0000, 0x9000, 0x9001}, /* internal BIOS use */
119f1e1ea51SMario Limonciello {0x0000, 0xA000, 0xBFFF}, /* write only */
120f1e1ea51SMario Limonciello {0x0000, 0xEFF0, 0xEFFF}, /* internal BIOS use */
121f1e1ea51SMario Limonciello /* handled by kernel: dell-laptop */
122f1e1ea51SMario Limonciello {0x0000, BRIGHTNESS_TOKEN, BRIGHTNESS_TOKEN},
123f1e1ea51SMario Limonciello {0x0000, KBD_LED_OFF_TOKEN, KBD_LED_AUTO_TOKEN},
124f1e1ea51SMario Limonciello {0x0000, KBD_LED_AC_TOKEN, KBD_LED_AC_TOKEN},
125f1e1ea51SMario Limonciello {0x0000, KBD_LED_AUTO_25_TOKEN, KBD_LED_AUTO_75_TOKEN},
126f1e1ea51SMario Limonciello {0x0000, KBD_LED_AUTO_100_TOKEN, KBD_LED_AUTO_100_TOKEN},
127f1e1ea51SMario Limonciello {0x0000, GLOBAL_MIC_MUTE_ENABLE, GLOBAL_MIC_MUTE_DISABLE},
128f1e1ea51SMario Limonciello };
129f1e1ea51SMario Limonciello
130f1e1ea51SMario Limonciello static LIST_HEAD(smbios_device_list);
131f1e1ea51SMario Limonciello
dell_smbios_error(int value)132f1e1ea51SMario Limonciello int dell_smbios_error(int value)
133f1e1ea51SMario Limonciello {
134f1e1ea51SMario Limonciello switch (value) {
135f1e1ea51SMario Limonciello case 0: /* Completed successfully */
136f1e1ea51SMario Limonciello return 0;
137f1e1ea51SMario Limonciello case -1: /* Completed with error */
138f1e1ea51SMario Limonciello return -EIO;
139f1e1ea51SMario Limonciello case -2: /* Function not supported */
140f1e1ea51SMario Limonciello return -ENXIO;
141f1e1ea51SMario Limonciello default: /* Unknown error */
142f1e1ea51SMario Limonciello return -EINVAL;
143f1e1ea51SMario Limonciello }
144f1e1ea51SMario Limonciello }
145f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_error);
146f1e1ea51SMario Limonciello
dell_smbios_register_device(struct device * d,void * call_fn)147f1e1ea51SMario Limonciello int dell_smbios_register_device(struct device *d, void *call_fn)
148f1e1ea51SMario Limonciello {
149f1e1ea51SMario Limonciello struct smbios_device *priv;
150f1e1ea51SMario Limonciello
151f1e1ea51SMario Limonciello priv = devm_kzalloc(d, sizeof(struct smbios_device), GFP_KERNEL);
152f1e1ea51SMario Limonciello if (!priv)
153f1e1ea51SMario Limonciello return -ENOMEM;
154f1e1ea51SMario Limonciello get_device(d);
155f1e1ea51SMario Limonciello priv->device = d;
156f1e1ea51SMario Limonciello priv->call_fn = call_fn;
157f1e1ea51SMario Limonciello mutex_lock(&smbios_mutex);
158f1e1ea51SMario Limonciello list_add_tail(&priv->list, &smbios_device_list);
159f1e1ea51SMario Limonciello mutex_unlock(&smbios_mutex);
160f1e1ea51SMario Limonciello dev_dbg(d, "Added device: %s\n", d->driver->name);
161f1e1ea51SMario Limonciello return 0;
162f1e1ea51SMario Limonciello }
163f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_register_device);
164f1e1ea51SMario Limonciello
dell_smbios_unregister_device(struct device * d)165f1e1ea51SMario Limonciello void dell_smbios_unregister_device(struct device *d)
166f1e1ea51SMario Limonciello {
167f1e1ea51SMario Limonciello struct smbios_device *priv;
168f1e1ea51SMario Limonciello
169f1e1ea51SMario Limonciello mutex_lock(&smbios_mutex);
170f1e1ea51SMario Limonciello list_for_each_entry(priv, &smbios_device_list, list) {
171f1e1ea51SMario Limonciello if (priv->device == d) {
172f1e1ea51SMario Limonciello list_del(&priv->list);
173f1e1ea51SMario Limonciello put_device(d);
174f1e1ea51SMario Limonciello break;
175f1e1ea51SMario Limonciello }
176f1e1ea51SMario Limonciello }
177f1e1ea51SMario Limonciello mutex_unlock(&smbios_mutex);
178f1e1ea51SMario Limonciello dev_dbg(d, "Remove device: %s\n", d->driver->name);
179f1e1ea51SMario Limonciello }
180f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_unregister_device);
181f1e1ea51SMario Limonciello
dell_smbios_call_filter(struct device * d,struct calling_interface_buffer * buffer)182f1e1ea51SMario Limonciello int dell_smbios_call_filter(struct device *d,
183f1e1ea51SMario Limonciello struct calling_interface_buffer *buffer)
184f1e1ea51SMario Limonciello {
185f1e1ea51SMario Limonciello u16 t = 0;
186f1e1ea51SMario Limonciello int i;
187f1e1ea51SMario Limonciello
188f1e1ea51SMario Limonciello /* can't make calls over 30 */
189f1e1ea51SMario Limonciello if (buffer->cmd_class > 30) {
190f1e1ea51SMario Limonciello dev_dbg(d, "class too big: %u\n", buffer->cmd_class);
191f1e1ea51SMario Limonciello return -EINVAL;
192f1e1ea51SMario Limonciello }
193f1e1ea51SMario Limonciello
194f1e1ea51SMario Limonciello /* supported calls on the particular system */
195f1e1ea51SMario Limonciello if (!(da_supported_commands & (1 << buffer->cmd_class))) {
196f1e1ea51SMario Limonciello dev_dbg(d, "invalid command, supported commands: 0x%8x\n",
197f1e1ea51SMario Limonciello da_supported_commands);
198f1e1ea51SMario Limonciello return -EINVAL;
199f1e1ea51SMario Limonciello }
200f1e1ea51SMario Limonciello
201f1e1ea51SMario Limonciello /* match against call blacklist */
202f1e1ea51SMario Limonciello for (i = 0; i < ARRAY_SIZE(call_blacklist); i++) {
203f1e1ea51SMario Limonciello if (buffer->cmd_class != call_blacklist[i].cmd_class)
204f1e1ea51SMario Limonciello continue;
205f1e1ea51SMario Limonciello if (buffer->cmd_select != call_blacklist[i].cmd_select &&
206f1e1ea51SMario Limonciello call_blacklist[i].cmd_select != -1)
207f1e1ea51SMario Limonciello continue;
208f1e1ea51SMario Limonciello dev_dbg(d, "blacklisted command: %u/%u\n",
209f1e1ea51SMario Limonciello buffer->cmd_class, buffer->cmd_select);
210f1e1ea51SMario Limonciello return -EINVAL;
211f1e1ea51SMario Limonciello }
212f1e1ea51SMario Limonciello
213f1e1ea51SMario Limonciello /* if a token call, find token ID */
214f1e1ea51SMario Limonciello
215f1e1ea51SMario Limonciello if ((buffer->cmd_class == CLASS_TOKEN_READ ||
216f1e1ea51SMario Limonciello buffer->cmd_class == CLASS_TOKEN_WRITE) &&
217f1e1ea51SMario Limonciello buffer->cmd_select < 3) {
218f1e1ea51SMario Limonciello /* tokens enabled ? */
219f1e1ea51SMario Limonciello if (!da_tokens) {
220f1e1ea51SMario Limonciello dev_dbg(d, "no token support on this system\n");
221f1e1ea51SMario Limonciello return -EINVAL;
222f1e1ea51SMario Limonciello }
223f1e1ea51SMario Limonciello
224f1e1ea51SMario Limonciello /* find the matching token ID */
225f1e1ea51SMario Limonciello for (i = 0; i < da_num_tokens; i++) {
226f1e1ea51SMario Limonciello if (da_tokens[i].location != buffer->input[0])
227f1e1ea51SMario Limonciello continue;
228f1e1ea51SMario Limonciello t = da_tokens[i].tokenID;
229f1e1ea51SMario Limonciello break;
230f1e1ea51SMario Limonciello }
231f1e1ea51SMario Limonciello
232f1e1ea51SMario Limonciello /* token call; but token didn't exist */
233f1e1ea51SMario Limonciello if (!t) {
234f1e1ea51SMario Limonciello dev_dbg(d, "token at location %04x doesn't exist\n",
235f1e1ea51SMario Limonciello buffer->input[0]);
236f1e1ea51SMario Limonciello return -EINVAL;
237f1e1ea51SMario Limonciello }
238f1e1ea51SMario Limonciello
239f1e1ea51SMario Limonciello /* match against token blacklist */
240f1e1ea51SMario Limonciello for (i = 0; i < ARRAY_SIZE(token_blacklist); i++) {
241f1e1ea51SMario Limonciello if (!token_blacklist[i].min || !token_blacklist[i].max)
242f1e1ea51SMario Limonciello continue;
243f1e1ea51SMario Limonciello if (t >= token_blacklist[i].min &&
244f1e1ea51SMario Limonciello t <= token_blacklist[i].max)
245f1e1ea51SMario Limonciello return -EINVAL;
246f1e1ea51SMario Limonciello }
247f1e1ea51SMario Limonciello
248f1e1ea51SMario Limonciello /* match against token whitelist */
249f1e1ea51SMario Limonciello for (i = 0; i < ARRAY_SIZE(token_whitelist); i++) {
250f1e1ea51SMario Limonciello if (!token_whitelist[i].min || !token_whitelist[i].max)
251f1e1ea51SMario Limonciello continue;
252f1e1ea51SMario Limonciello if (t < token_whitelist[i].min ||
253f1e1ea51SMario Limonciello t > token_whitelist[i].max)
254f1e1ea51SMario Limonciello continue;
255f1e1ea51SMario Limonciello if (!token_whitelist[i].need_capability ||
256f1e1ea51SMario Limonciello capable(token_whitelist[i].need_capability)) {
257f1e1ea51SMario Limonciello dev_dbg(d, "whitelisted token: %x\n", t);
258f1e1ea51SMario Limonciello return 0;
259f1e1ea51SMario Limonciello }
260f1e1ea51SMario Limonciello
261f1e1ea51SMario Limonciello }
262f1e1ea51SMario Limonciello }
263f1e1ea51SMario Limonciello /* match against call whitelist */
264f1e1ea51SMario Limonciello for (i = 0; i < ARRAY_SIZE(call_whitelist); i++) {
265f1e1ea51SMario Limonciello if (buffer->cmd_class != call_whitelist[i].cmd_class)
266f1e1ea51SMario Limonciello continue;
267f1e1ea51SMario Limonciello if (buffer->cmd_select != call_whitelist[i].cmd_select)
268f1e1ea51SMario Limonciello continue;
269f1e1ea51SMario Limonciello if (!call_whitelist[i].need_capability ||
270f1e1ea51SMario Limonciello capable(call_whitelist[i].need_capability)) {
271f1e1ea51SMario Limonciello dev_dbg(d, "whitelisted capable command: %u/%u\n",
272f1e1ea51SMario Limonciello buffer->cmd_class, buffer->cmd_select);
273f1e1ea51SMario Limonciello return 0;
274f1e1ea51SMario Limonciello }
275f1e1ea51SMario Limonciello dev_dbg(d, "missing capability %d for %u/%u\n",
276f1e1ea51SMario Limonciello call_whitelist[i].need_capability,
277f1e1ea51SMario Limonciello buffer->cmd_class, buffer->cmd_select);
278f1e1ea51SMario Limonciello
279f1e1ea51SMario Limonciello }
280f1e1ea51SMario Limonciello
281f1e1ea51SMario Limonciello /* not in a whitelist, only allow processes with capabilities */
282f1e1ea51SMario Limonciello if (capable(CAP_SYS_RAWIO)) {
283f1e1ea51SMario Limonciello dev_dbg(d, "Allowing %u/%u due to CAP_SYS_RAWIO\n",
284f1e1ea51SMario Limonciello buffer->cmd_class, buffer->cmd_select);
285f1e1ea51SMario Limonciello return 0;
286f1e1ea51SMario Limonciello }
287f1e1ea51SMario Limonciello
288f1e1ea51SMario Limonciello return -EACCES;
289f1e1ea51SMario Limonciello }
290f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_call_filter);
291f1e1ea51SMario Limonciello
dell_smbios_call(struct calling_interface_buffer * buffer)292f1e1ea51SMario Limonciello int dell_smbios_call(struct calling_interface_buffer *buffer)
293f1e1ea51SMario Limonciello {
294f1e1ea51SMario Limonciello int (*call_fn)(struct calling_interface_buffer *) = NULL;
295f1e1ea51SMario Limonciello struct device *selected_dev = NULL;
296f1e1ea51SMario Limonciello struct smbios_device *priv;
297f1e1ea51SMario Limonciello int ret;
298f1e1ea51SMario Limonciello
299f1e1ea51SMario Limonciello mutex_lock(&smbios_mutex);
300f1e1ea51SMario Limonciello list_for_each_entry(priv, &smbios_device_list, list) {
301f1e1ea51SMario Limonciello if (!selected_dev || priv->device->id >= selected_dev->id) {
302f1e1ea51SMario Limonciello dev_dbg(priv->device, "Trying device ID: %d\n",
303f1e1ea51SMario Limonciello priv->device->id);
304f1e1ea51SMario Limonciello call_fn = priv->call_fn;
305f1e1ea51SMario Limonciello selected_dev = priv->device;
306f1e1ea51SMario Limonciello }
307f1e1ea51SMario Limonciello }
308f1e1ea51SMario Limonciello
309f1e1ea51SMario Limonciello if (!selected_dev) {
310f1e1ea51SMario Limonciello ret = -ENODEV;
311f1e1ea51SMario Limonciello pr_err("No dell-smbios drivers are loaded\n");
312f1e1ea51SMario Limonciello goto out_smbios_call;
313f1e1ea51SMario Limonciello }
314f1e1ea51SMario Limonciello
315f1e1ea51SMario Limonciello ret = call_fn(buffer);
316f1e1ea51SMario Limonciello
317f1e1ea51SMario Limonciello out_smbios_call:
318f1e1ea51SMario Limonciello mutex_unlock(&smbios_mutex);
319f1e1ea51SMario Limonciello return ret;
320f1e1ea51SMario Limonciello }
321f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_call);
322f1e1ea51SMario Limonciello
dell_smbios_find_token(int tokenid)323f1e1ea51SMario Limonciello struct calling_interface_token *dell_smbios_find_token(int tokenid)
324f1e1ea51SMario Limonciello {
325f1e1ea51SMario Limonciello int i;
326f1e1ea51SMario Limonciello
327f1e1ea51SMario Limonciello if (!da_tokens)
328f1e1ea51SMario Limonciello return NULL;
329f1e1ea51SMario Limonciello
330f1e1ea51SMario Limonciello for (i = 0; i < da_num_tokens; i++) {
331f1e1ea51SMario Limonciello if (da_tokens[i].tokenID == tokenid)
332f1e1ea51SMario Limonciello return &da_tokens[i];
333f1e1ea51SMario Limonciello }
334f1e1ea51SMario Limonciello
335f1e1ea51SMario Limonciello return NULL;
336f1e1ea51SMario Limonciello }
337f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_smbios_find_token);
338f1e1ea51SMario Limonciello
339f1e1ea51SMario Limonciello static BLOCKING_NOTIFIER_HEAD(dell_laptop_chain_head);
340f1e1ea51SMario Limonciello
dell_laptop_register_notifier(struct notifier_block * nb)341f1e1ea51SMario Limonciello int dell_laptop_register_notifier(struct notifier_block *nb)
342f1e1ea51SMario Limonciello {
343f1e1ea51SMario Limonciello return blocking_notifier_chain_register(&dell_laptop_chain_head, nb);
344f1e1ea51SMario Limonciello }
345f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_laptop_register_notifier);
346f1e1ea51SMario Limonciello
dell_laptop_unregister_notifier(struct notifier_block * nb)347f1e1ea51SMario Limonciello int dell_laptop_unregister_notifier(struct notifier_block *nb)
348f1e1ea51SMario Limonciello {
349f1e1ea51SMario Limonciello return blocking_notifier_chain_unregister(&dell_laptop_chain_head, nb);
350f1e1ea51SMario Limonciello }
351f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_laptop_unregister_notifier);
352f1e1ea51SMario Limonciello
dell_laptop_call_notifier(unsigned long action,void * data)353f1e1ea51SMario Limonciello void dell_laptop_call_notifier(unsigned long action, void *data)
354f1e1ea51SMario Limonciello {
355f1e1ea51SMario Limonciello blocking_notifier_call_chain(&dell_laptop_chain_head, action, data);
356f1e1ea51SMario Limonciello }
357f1e1ea51SMario Limonciello EXPORT_SYMBOL_GPL(dell_laptop_call_notifier);
358f1e1ea51SMario Limonciello
parse_da_table(const struct dmi_header * dm)359f1e1ea51SMario Limonciello static void __init parse_da_table(const struct dmi_header *dm)
360f1e1ea51SMario Limonciello {
361f1e1ea51SMario Limonciello /* Final token is a terminator, so we don't want to copy it */
362f1e1ea51SMario Limonciello int tokens = (dm->length-11)/sizeof(struct calling_interface_token)-1;
363f1e1ea51SMario Limonciello struct calling_interface_token *new_da_tokens;
364f1e1ea51SMario Limonciello struct calling_interface_structure *table =
365f1e1ea51SMario Limonciello container_of(dm, struct calling_interface_structure, header);
366f1e1ea51SMario Limonciello
367f1e1ea51SMario Limonciello /*
368f1e1ea51SMario Limonciello * 4 bytes of table header, plus 7 bytes of Dell header
369f1e1ea51SMario Limonciello * plus at least 6 bytes of entry
370f1e1ea51SMario Limonciello */
371f1e1ea51SMario Limonciello
372f1e1ea51SMario Limonciello if (dm->length < 17)
373f1e1ea51SMario Limonciello return;
374f1e1ea51SMario Limonciello
375f1e1ea51SMario Limonciello da_supported_commands = table->supportedCmds;
376f1e1ea51SMario Limonciello
377f1e1ea51SMario Limonciello new_da_tokens = krealloc(da_tokens, (da_num_tokens + tokens) *
378f1e1ea51SMario Limonciello sizeof(struct calling_interface_token),
379f1e1ea51SMario Limonciello GFP_KERNEL);
380f1e1ea51SMario Limonciello
381f1e1ea51SMario Limonciello if (!new_da_tokens)
382f1e1ea51SMario Limonciello return;
383f1e1ea51SMario Limonciello da_tokens = new_da_tokens;
384f1e1ea51SMario Limonciello
385f1e1ea51SMario Limonciello memcpy(da_tokens+da_num_tokens, table->tokens,
386f1e1ea51SMario Limonciello sizeof(struct calling_interface_token) * tokens);
387f1e1ea51SMario Limonciello
388f1e1ea51SMario Limonciello da_num_tokens += tokens;
389f1e1ea51SMario Limonciello }
390f1e1ea51SMario Limonciello
zero_duplicates(struct device * dev)391f1e1ea51SMario Limonciello static void zero_duplicates(struct device *dev)
392f1e1ea51SMario Limonciello {
393f1e1ea51SMario Limonciello int i, j;
394f1e1ea51SMario Limonciello
395f1e1ea51SMario Limonciello for (i = 0; i < da_num_tokens; i++) {
396f1e1ea51SMario Limonciello if (da_tokens[i].tokenID == 0)
397f1e1ea51SMario Limonciello continue;
398f1e1ea51SMario Limonciello for (j = i+1; j < da_num_tokens; j++) {
399f1e1ea51SMario Limonciello if (da_tokens[j].tokenID == 0)
400f1e1ea51SMario Limonciello continue;
401f1e1ea51SMario Limonciello if (da_tokens[i].tokenID == da_tokens[j].tokenID) {
402f1e1ea51SMario Limonciello dev_dbg(dev, "Zeroing dup token ID %x(%x/%x)\n",
403f1e1ea51SMario Limonciello da_tokens[j].tokenID,
404f1e1ea51SMario Limonciello da_tokens[j].location,
405f1e1ea51SMario Limonciello da_tokens[j].value);
406f1e1ea51SMario Limonciello da_tokens[j].tokenID = 0;
407f1e1ea51SMario Limonciello }
408f1e1ea51SMario Limonciello }
409f1e1ea51SMario Limonciello }
410f1e1ea51SMario Limonciello }
411f1e1ea51SMario Limonciello
find_tokens(const struct dmi_header * dm,void * dummy)412f1e1ea51SMario Limonciello static void __init find_tokens(const struct dmi_header *dm, void *dummy)
413f1e1ea51SMario Limonciello {
414f1e1ea51SMario Limonciello switch (dm->type) {
415f1e1ea51SMario Limonciello case 0xd4: /* Indexed IO */
416f1e1ea51SMario Limonciello case 0xd5: /* Protected Area Type 1 */
417f1e1ea51SMario Limonciello case 0xd6: /* Protected Area Type 2 */
418f1e1ea51SMario Limonciello break;
419f1e1ea51SMario Limonciello case 0xda: /* Calling interface */
420f1e1ea51SMario Limonciello parse_da_table(dm);
421f1e1ea51SMario Limonciello break;
422f1e1ea51SMario Limonciello }
423f1e1ea51SMario Limonciello }
424f1e1ea51SMario Limonciello
location_show(struct device * dev,struct device_attribute * attr,char * buf)425f1e1ea51SMario Limonciello static ssize_t location_show(struct device *dev,
426f1e1ea51SMario Limonciello struct device_attribute *attr, char *buf)
427f1e1ea51SMario Limonciello {
428b07a62f8SArmin Wolf struct token_sysfs_data *data = container_of(attr, struct token_sysfs_data, location_attr);
429f1e1ea51SMario Limonciello
430f1e1ea51SMario Limonciello if (!capable(CAP_SYS_ADMIN))
431f1e1ea51SMario Limonciello return -EPERM;
432f1e1ea51SMario Limonciello
433b07a62f8SArmin Wolf return sysfs_emit(buf, "%08x", data->token->location);
434f1e1ea51SMario Limonciello }
435f1e1ea51SMario Limonciello
value_show(struct device * dev,struct device_attribute * attr,char * buf)436f1e1ea51SMario Limonciello static ssize_t value_show(struct device *dev,
437f1e1ea51SMario Limonciello struct device_attribute *attr, char *buf)
438f1e1ea51SMario Limonciello {
439b07a62f8SArmin Wolf struct token_sysfs_data *data = container_of(attr, struct token_sysfs_data, value_attr);
440f1e1ea51SMario Limonciello
441f1e1ea51SMario Limonciello if (!capable(CAP_SYS_ADMIN))
442f1e1ea51SMario Limonciello return -EPERM;
443f1e1ea51SMario Limonciello
444b07a62f8SArmin Wolf return sysfs_emit(buf, "%08x", data->token->value);
445f1e1ea51SMario Limonciello }
446f1e1ea51SMario Limonciello
447f1e1ea51SMario Limonciello static struct attribute_group smbios_attribute_group = {
448f1e1ea51SMario Limonciello .name = "tokens"
449f1e1ea51SMario Limonciello };
450f1e1ea51SMario Limonciello
451f1e1ea51SMario Limonciello static struct platform_driver platform_driver = {
452f1e1ea51SMario Limonciello .driver = {
453f1e1ea51SMario Limonciello .name = "dell-smbios",
454f1e1ea51SMario Limonciello },
455f1e1ea51SMario Limonciello };
456f1e1ea51SMario Limonciello
build_tokens_sysfs(struct platform_device * dev)457f1e1ea51SMario Limonciello static int build_tokens_sysfs(struct platform_device *dev)
458f1e1ea51SMario Limonciello {
459f1e1ea51SMario Limonciello char *location_name;
460f1e1ea51SMario Limonciello char *value_name;
461f1e1ea51SMario Limonciello int ret;
462f1e1ea51SMario Limonciello int i, j;
463f1e1ea51SMario Limonciello
464b07a62f8SArmin Wolf token_entries = kcalloc(da_num_tokens, sizeof(*token_entries), GFP_KERNEL);
465b07a62f8SArmin Wolf if (!token_entries)
466f1e1ea51SMario Limonciello return -ENOMEM;
467f1e1ea51SMario Limonciello
468f1e1ea51SMario Limonciello /* need to store both location and value + terminator*/
469b07a62f8SArmin Wolf token_attrs = kcalloc((2 * da_num_tokens) + 1, sizeof(*token_attrs), GFP_KERNEL);
470f1e1ea51SMario Limonciello if (!token_attrs)
471f1e1ea51SMario Limonciello goto out_allocate_attrs;
472f1e1ea51SMario Limonciello
473f1e1ea51SMario Limonciello for (i = 0, j = 0; i < da_num_tokens; i++) {
474f1e1ea51SMario Limonciello /* skip empty */
475f1e1ea51SMario Limonciello if (da_tokens[i].tokenID == 0)
476f1e1ea51SMario Limonciello continue;
477b07a62f8SArmin Wolf
478b07a62f8SArmin Wolf token_entries[i].token = &da_tokens[i];
479b07a62f8SArmin Wolf
480f1e1ea51SMario Limonciello /* add location */
481f1e1ea51SMario Limonciello location_name = kasprintf(GFP_KERNEL, "%04x_location",
482f1e1ea51SMario Limonciello da_tokens[i].tokenID);
483f1e1ea51SMario Limonciello if (location_name == NULL)
484f1e1ea51SMario Limonciello goto out_unwind_strings;
485b07a62f8SArmin Wolf
486b07a62f8SArmin Wolf sysfs_attr_init(&token_entries[i].location_attr.attr);
487b07a62f8SArmin Wolf token_entries[i].location_attr.attr.name = location_name;
488b07a62f8SArmin Wolf token_entries[i].location_attr.attr.mode = 0444;
489b07a62f8SArmin Wolf token_entries[i].location_attr.show = location_show;
490b07a62f8SArmin Wolf token_attrs[j++] = &token_entries[i].location_attr.attr;
491f1e1ea51SMario Limonciello
492f1e1ea51SMario Limonciello /* add value */
493f1e1ea51SMario Limonciello value_name = kasprintf(GFP_KERNEL, "%04x_value",
494f1e1ea51SMario Limonciello da_tokens[i].tokenID);
495f1e1ea51SMario Limonciello if (value_name == NULL)
496f1e1ea51SMario Limonciello goto loop_fail_create_value;
497b07a62f8SArmin Wolf
498b07a62f8SArmin Wolf sysfs_attr_init(&token_entries[i].value_attr.attr);
499b07a62f8SArmin Wolf token_entries[i].value_attr.attr.name = value_name;
500b07a62f8SArmin Wolf token_entries[i].value_attr.attr.mode = 0444;
501b07a62f8SArmin Wolf token_entries[i].value_attr.show = value_show;
502b07a62f8SArmin Wolf token_attrs[j++] = &token_entries[i].value_attr.attr;
503f1e1ea51SMario Limonciello continue;
504f1e1ea51SMario Limonciello
505f1e1ea51SMario Limonciello loop_fail_create_value:
506f1e1ea51SMario Limonciello kfree(location_name);
507f1e1ea51SMario Limonciello goto out_unwind_strings;
508f1e1ea51SMario Limonciello }
509f1e1ea51SMario Limonciello smbios_attribute_group.attrs = token_attrs;
510f1e1ea51SMario Limonciello
511f1e1ea51SMario Limonciello ret = sysfs_create_group(&dev->dev.kobj, &smbios_attribute_group);
512f1e1ea51SMario Limonciello if (ret)
513f1e1ea51SMario Limonciello goto out_unwind_strings;
514f1e1ea51SMario Limonciello return 0;
515f1e1ea51SMario Limonciello
516f1e1ea51SMario Limonciello out_unwind_strings:
517f1e1ea51SMario Limonciello while (i--) {
518b07a62f8SArmin Wolf kfree(token_entries[i].location_attr.attr.name);
519b07a62f8SArmin Wolf kfree(token_entries[i].value_attr.attr.name);
520f1e1ea51SMario Limonciello }
521f1e1ea51SMario Limonciello kfree(token_attrs);
522f1e1ea51SMario Limonciello out_allocate_attrs:
523b07a62f8SArmin Wolf kfree(token_entries);
524f1e1ea51SMario Limonciello
525f1e1ea51SMario Limonciello return -ENOMEM;
526f1e1ea51SMario Limonciello }
527f1e1ea51SMario Limonciello
free_group(struct platform_device * pdev)528f1e1ea51SMario Limonciello static void free_group(struct platform_device *pdev)
529f1e1ea51SMario Limonciello {
530f1e1ea51SMario Limonciello int i;
531f1e1ea51SMario Limonciello
532f1e1ea51SMario Limonciello sysfs_remove_group(&pdev->dev.kobj,
533f1e1ea51SMario Limonciello &smbios_attribute_group);
534f1e1ea51SMario Limonciello for (i = 0; i < da_num_tokens; i++) {
535b07a62f8SArmin Wolf kfree(token_entries[i].location_attr.attr.name);
536b07a62f8SArmin Wolf kfree(token_entries[i].value_attr.attr.name);
537f1e1ea51SMario Limonciello }
538f1e1ea51SMario Limonciello kfree(token_attrs);
539b07a62f8SArmin Wolf kfree(token_entries);
540f1e1ea51SMario Limonciello }
541f1e1ea51SMario Limonciello
dell_smbios_init(void)542f1e1ea51SMario Limonciello static int __init dell_smbios_init(void)
543f1e1ea51SMario Limonciello {
544f1e1ea51SMario Limonciello int ret, wmi, smm;
545f1e1ea51SMario Limonciello
546f1e1ea51SMario Limonciello if (!dmi_find_device(DMI_DEV_TYPE_OEM_STRING, "Dell System", NULL) &&
547*32660e18SKurt Borja !dmi_find_device(DMI_DEV_TYPE_OEM_STRING, "Alienware", NULL) &&
548f1e1ea51SMario Limonciello !dmi_find_device(DMI_DEV_TYPE_OEM_STRING, "www.dell.com", NULL)) {
549f1e1ea51SMario Limonciello pr_err("Unable to run on non-Dell system\n");
550f1e1ea51SMario Limonciello return -ENODEV;
551f1e1ea51SMario Limonciello }
552f1e1ea51SMario Limonciello
553f1e1ea51SMario Limonciello dmi_walk(find_tokens, NULL);
554f1e1ea51SMario Limonciello
555f1e1ea51SMario Limonciello ret = platform_driver_register(&platform_driver);
556f1e1ea51SMario Limonciello if (ret)
557f1e1ea51SMario Limonciello goto fail_platform_driver;
558f1e1ea51SMario Limonciello
559f1e1ea51SMario Limonciello platform_device = platform_device_alloc("dell-smbios", 0);
560f1e1ea51SMario Limonciello if (!platform_device) {
561f1e1ea51SMario Limonciello ret = -ENOMEM;
562f1e1ea51SMario Limonciello goto fail_platform_device_alloc;
563f1e1ea51SMario Limonciello }
564f1e1ea51SMario Limonciello ret = platform_device_add(platform_device);
565f1e1ea51SMario Limonciello if (ret)
566f1e1ea51SMario Limonciello goto fail_platform_device_add;
567f1e1ea51SMario Limonciello
568f1e1ea51SMario Limonciello /* register backends */
569f1e1ea51SMario Limonciello wmi = init_dell_smbios_wmi();
570f1e1ea51SMario Limonciello if (wmi)
571f1e1ea51SMario Limonciello pr_debug("Failed to initialize WMI backend: %d\n", wmi);
572f1e1ea51SMario Limonciello smm = init_dell_smbios_smm();
573f1e1ea51SMario Limonciello if (smm)
574f1e1ea51SMario Limonciello pr_debug("Failed to initialize SMM backend: %d\n", smm);
575f1e1ea51SMario Limonciello if (wmi && smm) {
576f1e1ea51SMario Limonciello pr_err("No SMBIOS backends available (wmi: %d, smm: %d)\n",
577f1e1ea51SMario Limonciello wmi, smm);
578f1e1ea51SMario Limonciello ret = -ENODEV;
579f1e1ea51SMario Limonciello goto fail_create_group;
580f1e1ea51SMario Limonciello }
581f1e1ea51SMario Limonciello
582f1e1ea51SMario Limonciello if (da_tokens) {
583f1e1ea51SMario Limonciello /* duplicate tokens will cause problems building sysfs files */
584f1e1ea51SMario Limonciello zero_duplicates(&platform_device->dev);
585f1e1ea51SMario Limonciello
586f1e1ea51SMario Limonciello ret = build_tokens_sysfs(platform_device);
587f1e1ea51SMario Limonciello if (ret)
588f1e1ea51SMario Limonciello goto fail_sysfs;
589f1e1ea51SMario Limonciello }
590f1e1ea51SMario Limonciello
591f1e1ea51SMario Limonciello return 0;
592f1e1ea51SMario Limonciello
593f1e1ea51SMario Limonciello fail_sysfs:
594dc2694e4SAleksandr Mishin if (!wmi)
595dc2694e4SAleksandr Mishin exit_dell_smbios_wmi();
596dc2694e4SAleksandr Mishin if (!smm)
597dc2694e4SAleksandr Mishin exit_dell_smbios_smm();
598f1e1ea51SMario Limonciello
599f1e1ea51SMario Limonciello fail_create_group:
600f1e1ea51SMario Limonciello platform_device_del(platform_device);
601f1e1ea51SMario Limonciello
602f1e1ea51SMario Limonciello fail_platform_device_add:
603f1e1ea51SMario Limonciello platform_device_put(platform_device);
604f1e1ea51SMario Limonciello
605f1e1ea51SMario Limonciello fail_platform_device_alloc:
606f1e1ea51SMario Limonciello platform_driver_unregister(&platform_driver);
607f1e1ea51SMario Limonciello
608f1e1ea51SMario Limonciello fail_platform_driver:
609f1e1ea51SMario Limonciello kfree(da_tokens);
610f1e1ea51SMario Limonciello return ret;
611f1e1ea51SMario Limonciello }
612f1e1ea51SMario Limonciello
dell_smbios_exit(void)613f1e1ea51SMario Limonciello static void __exit dell_smbios_exit(void)
614f1e1ea51SMario Limonciello {
615f1e1ea51SMario Limonciello exit_dell_smbios_wmi();
616f1e1ea51SMario Limonciello exit_dell_smbios_smm();
617f1e1ea51SMario Limonciello mutex_lock(&smbios_mutex);
618f1e1ea51SMario Limonciello if (platform_device) {
619f1e1ea51SMario Limonciello if (da_tokens)
620f1e1ea51SMario Limonciello free_group(platform_device);
621f1e1ea51SMario Limonciello platform_device_unregister(platform_device);
622f1e1ea51SMario Limonciello platform_driver_unregister(&platform_driver);
623f1e1ea51SMario Limonciello }
624f1e1ea51SMario Limonciello kfree(da_tokens);
625f1e1ea51SMario Limonciello mutex_unlock(&smbios_mutex);
626f1e1ea51SMario Limonciello }
627f1e1ea51SMario Limonciello
628f1e1ea51SMario Limonciello module_init(dell_smbios_init);
629f1e1ea51SMario Limonciello module_exit(dell_smbios_exit);
630f1e1ea51SMario Limonciello
631f1e1ea51SMario Limonciello MODULE_AUTHOR("Matthew Garrett <mjg@redhat.com>");
632f1e1ea51SMario Limonciello MODULE_AUTHOR("Gabriele Mazzotta <gabriele.mzt@gmail.com>");
633f1e1ea51SMario Limonciello MODULE_AUTHOR("Pali Rohár <pali@kernel.org>");
6341ea602e4SMario Limonciello MODULE_AUTHOR("Mario Limonciello <mario.limonciello@outlook.com>");
635f1e1ea51SMario Limonciello MODULE_DESCRIPTION("Common functions for kernel modules using Dell SMBIOS");
636f1e1ea51SMario Limonciello MODULE_LICENSE("GPL");
637