1f1e1ea51SMario Limonciello // SPDX-License-Identifier: GPL-2.0-only
2f1e1ea51SMario Limonciello /*
3f1e1ea51SMario Limonciello  *  SMI methods for use with 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  *  Copyright (c) 2017 Dell Inc.
9f1e1ea51SMario Limonciello  */
10f1e1ea51SMario Limonciello #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
11f1e1ea51SMario Limonciello 
12f1e1ea51SMario Limonciello #include <linux/dmi.h>
13f1e1ea51SMario Limonciello #include <linux/gfp.h>
14f1e1ea51SMario Limonciello #include <linux/io.h>
15f1e1ea51SMario Limonciello #include <linux/module.h>
16f1e1ea51SMario Limonciello #include <linux/mutex.h>
17f1e1ea51SMario Limonciello #include <linux/platform_device.h>
18f1e1ea51SMario Limonciello #include "dcdbas.h"
19f1e1ea51SMario Limonciello #include "dell-smbios.h"
20f1e1ea51SMario Limonciello 
21f1e1ea51SMario Limonciello static int da_command_address;
22f1e1ea51SMario Limonciello static int da_command_code;
23*77089467SJuergen Gross static struct smi_buffer smi_buf;
24f1e1ea51SMario Limonciello static struct calling_interface_buffer *buffer;
25f1e1ea51SMario Limonciello static struct platform_device *platform_device;
26f1e1ea51SMario Limonciello static DEFINE_MUTEX(smm_mutex);
27f1e1ea51SMario Limonciello 
parse_da_table(const struct dmi_header * dm)28f1e1ea51SMario Limonciello static void parse_da_table(const struct dmi_header *dm)
29f1e1ea51SMario Limonciello {
30f1e1ea51SMario Limonciello 	struct calling_interface_structure *table =
31f1e1ea51SMario Limonciello 		container_of(dm, struct calling_interface_structure, header);
32f1e1ea51SMario Limonciello 
33f1e1ea51SMario Limonciello 	/* 4 bytes of table header, plus 7 bytes of Dell header, plus at least
34f1e1ea51SMario Limonciello 	 * 6 bytes of entry
35f1e1ea51SMario Limonciello 	 */
36f1e1ea51SMario Limonciello 	if (dm->length < 17)
37f1e1ea51SMario Limonciello 		return;
38f1e1ea51SMario Limonciello 
39f1e1ea51SMario Limonciello 	da_command_address = table->cmdIOAddress;
40f1e1ea51SMario Limonciello 	da_command_code = table->cmdIOCode;
41f1e1ea51SMario Limonciello }
42f1e1ea51SMario Limonciello 
find_cmd_address(const struct dmi_header * dm,void * dummy)43f1e1ea51SMario Limonciello static void find_cmd_address(const struct dmi_header *dm, void *dummy)
44f1e1ea51SMario Limonciello {
45f1e1ea51SMario Limonciello 	switch (dm->type) {
46f1e1ea51SMario Limonciello 	case 0xda: /* Calling interface */
47f1e1ea51SMario Limonciello 		parse_da_table(dm);
48f1e1ea51SMario Limonciello 		break;
49f1e1ea51SMario Limonciello 	}
50f1e1ea51SMario Limonciello }
51f1e1ea51SMario Limonciello 
dell_smbios_smm_call(struct calling_interface_buffer * input)52f1e1ea51SMario Limonciello static int dell_smbios_smm_call(struct calling_interface_buffer *input)
53f1e1ea51SMario Limonciello {
54f1e1ea51SMario Limonciello 	struct smi_cmd command;
55f1e1ea51SMario Limonciello 	size_t size;
56f1e1ea51SMario Limonciello 
57f1e1ea51SMario Limonciello 	size = sizeof(struct calling_interface_buffer);
58f1e1ea51SMario Limonciello 	command.magic = SMI_CMD_MAGIC;
59f1e1ea51SMario Limonciello 	command.command_address = da_command_address;
60f1e1ea51SMario Limonciello 	command.command_code = da_command_code;
61*77089467SJuergen Gross 	command.ebx = smi_buf.dma;
62f1e1ea51SMario Limonciello 	command.ecx = 0x42534931;
63f1e1ea51SMario Limonciello 
64f1e1ea51SMario Limonciello 	mutex_lock(&smm_mutex);
65f1e1ea51SMario Limonciello 	memcpy(buffer, input, size);
66f1e1ea51SMario Limonciello 	dcdbas_smi_request(&command);
67f1e1ea51SMario Limonciello 	memcpy(input, buffer, size);
68f1e1ea51SMario Limonciello 	mutex_unlock(&smm_mutex);
69f1e1ea51SMario Limonciello 	return 0;
70f1e1ea51SMario Limonciello }
71f1e1ea51SMario Limonciello 
72f1e1ea51SMario Limonciello /* When enabled this indicates that SMM won't work */
test_wsmt_enabled(void)73f1e1ea51SMario Limonciello static bool test_wsmt_enabled(void)
74f1e1ea51SMario Limonciello {
75f1e1ea51SMario Limonciello 	struct calling_interface_token *wsmt;
76f1e1ea51SMario Limonciello 
77f1e1ea51SMario Limonciello 	/* if token doesn't exist, SMM will work */
78f1e1ea51SMario Limonciello 	wsmt = dell_smbios_find_token(WSMT_EN_TOKEN);
79f1e1ea51SMario Limonciello 	if (!wsmt)
80f1e1ea51SMario Limonciello 		return false;
81f1e1ea51SMario Limonciello 
82f1e1ea51SMario Limonciello 	/* If token exists, try to access over SMM but set a dummy return.
83f1e1ea51SMario Limonciello 	 * - If WSMT disabled it will be overwritten by SMM
84f1e1ea51SMario Limonciello 	 * - If WSMT enabled then dummy value will remain
85f1e1ea51SMario Limonciello 	 */
86f1e1ea51SMario Limonciello 	buffer->cmd_class = CLASS_TOKEN_READ;
87f1e1ea51SMario Limonciello 	buffer->cmd_select = SELECT_TOKEN_STD;
88f1e1ea51SMario Limonciello 	memset(buffer, 0, sizeof(struct calling_interface_buffer));
89f1e1ea51SMario Limonciello 	buffer->input[0] = wsmt->location;
90f1e1ea51SMario Limonciello 	buffer->output[0] = 99;
91f1e1ea51SMario Limonciello 	dell_smbios_smm_call(buffer);
92f1e1ea51SMario Limonciello 	if (buffer->output[0] == 99)
93f1e1ea51SMario Limonciello 		return true;
94f1e1ea51SMario Limonciello 
95f1e1ea51SMario Limonciello 	return false;
96f1e1ea51SMario Limonciello }
97f1e1ea51SMario Limonciello 
init_dell_smbios_smm(void)98f1e1ea51SMario Limonciello int init_dell_smbios_smm(void)
99f1e1ea51SMario Limonciello {
100f1e1ea51SMario Limonciello 	int ret;
101f1e1ea51SMario Limonciello 	/*
102f1e1ea51SMario Limonciello 	 * Allocate buffer below 4GB for SMI data--only 32-bit physical addr
103f1e1ea51SMario Limonciello 	 * is passed to SMI handler.
104f1e1ea51SMario Limonciello 	 */
105*77089467SJuergen Gross 	ret = dcdbas_smi_alloc(&smi_buf, PAGE_SIZE);
106*77089467SJuergen Gross 	if (ret)
107*77089467SJuergen Gross 		return ret;
108*77089467SJuergen Gross 	buffer = (void *)smi_buf.virt;
109f1e1ea51SMario Limonciello 
110f1e1ea51SMario Limonciello 	dmi_walk(find_cmd_address, NULL);
111f1e1ea51SMario Limonciello 
112f1e1ea51SMario Limonciello 	if (test_wsmt_enabled()) {
113f1e1ea51SMario Limonciello 		pr_debug("Disabling due to WSMT enabled\n");
114f1e1ea51SMario Limonciello 		ret = -ENODEV;
115f1e1ea51SMario Limonciello 		goto fail_wsmt;
116f1e1ea51SMario Limonciello 	}
117f1e1ea51SMario Limonciello 
118f1e1ea51SMario Limonciello 	platform_device = platform_device_alloc("dell-smbios", 1);
119f1e1ea51SMario Limonciello 	if (!platform_device) {
120f1e1ea51SMario Limonciello 		ret = -ENOMEM;
121f1e1ea51SMario Limonciello 		goto fail_platform_device_alloc;
122f1e1ea51SMario Limonciello 	}
123f1e1ea51SMario Limonciello 
124f1e1ea51SMario Limonciello 	ret = platform_device_add(platform_device);
125f1e1ea51SMario Limonciello 	if (ret)
126f1e1ea51SMario Limonciello 		goto fail_platform_device_add;
127f1e1ea51SMario Limonciello 
128f1e1ea51SMario Limonciello 	ret = dell_smbios_register_device(&platform_device->dev,
129f1e1ea51SMario Limonciello 					  &dell_smbios_smm_call);
130f1e1ea51SMario Limonciello 	if (ret)
131f1e1ea51SMario Limonciello 		goto fail_register;
132f1e1ea51SMario Limonciello 
133f1e1ea51SMario Limonciello 	return 0;
134f1e1ea51SMario Limonciello 
135f1e1ea51SMario Limonciello fail_register:
136f1e1ea51SMario Limonciello 	platform_device_del(platform_device);
137f1e1ea51SMario Limonciello 
138f1e1ea51SMario Limonciello fail_platform_device_add:
139f1e1ea51SMario Limonciello 	platform_device_put(platform_device);
140f1e1ea51SMario Limonciello 
141f1e1ea51SMario Limonciello fail_wsmt:
142f1e1ea51SMario Limonciello fail_platform_device_alloc:
143*77089467SJuergen Gross 	dcdbas_smi_free(&smi_buf);
144f1e1ea51SMario Limonciello 	return ret;
145f1e1ea51SMario Limonciello }
146f1e1ea51SMario Limonciello 
exit_dell_smbios_smm(void)147f1e1ea51SMario Limonciello void exit_dell_smbios_smm(void)
148f1e1ea51SMario Limonciello {
149f1e1ea51SMario Limonciello 	if (platform_device) {
150f1e1ea51SMario Limonciello 		dell_smbios_unregister_device(&platform_device->dev);
151f1e1ea51SMario Limonciello 		platform_device_unregister(platform_device);
152*77089467SJuergen Gross 		dcdbas_smi_free(&smi_buf);
153f1e1ea51SMario Limonciello 	}
154f1e1ea51SMario Limonciello }
155