18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * SMBus driver for ACPI SMBus CMI
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * Copyright (C) 2009 Crane Cai <crane.cai@amd.com>
68c2ecf20Sopenharmony_ci */
78c2ecf20Sopenharmony_ci
88c2ecf20Sopenharmony_ci#include <linux/module.h>
98c2ecf20Sopenharmony_ci#include <linux/slab.h>
108c2ecf20Sopenharmony_ci#include <linux/kernel.h>
118c2ecf20Sopenharmony_ci#include <linux/stddef.h>
128c2ecf20Sopenharmony_ci#include <linux/i2c.h>
138c2ecf20Sopenharmony_ci#include <linux/acpi.h>
148c2ecf20Sopenharmony_ci
158c2ecf20Sopenharmony_ci#define ACPI_SMBUS_HC_CLASS		"smbus"
168c2ecf20Sopenharmony_ci#define ACPI_SMBUS_HC_DEVICE_NAME	"cmi"
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci/* SMBUS HID definition as supported by Microsoft Windows */
198c2ecf20Sopenharmony_ci#define ACPI_SMBUS_MS_HID		"SMB0001"
208c2ecf20Sopenharmony_ci
218c2ecf20Sopenharmony_ciACPI_MODULE_NAME("smbus_cmi");
228c2ecf20Sopenharmony_ci
238c2ecf20Sopenharmony_cistruct smbus_methods_t {
248c2ecf20Sopenharmony_ci	char *mt_info;
258c2ecf20Sopenharmony_ci	char *mt_sbr;
268c2ecf20Sopenharmony_ci	char *mt_sbw;
278c2ecf20Sopenharmony_ci};
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_cistruct acpi_smbus_cmi {
308c2ecf20Sopenharmony_ci	acpi_handle handle;
318c2ecf20Sopenharmony_ci	struct i2c_adapter adapter;
328c2ecf20Sopenharmony_ci	u8 cap_info:1;
338c2ecf20Sopenharmony_ci	u8 cap_read:1;
348c2ecf20Sopenharmony_ci	u8 cap_write:1;
358c2ecf20Sopenharmony_ci	struct smbus_methods_t *methods;
368c2ecf20Sopenharmony_ci};
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_cistatic const struct smbus_methods_t smbus_methods = {
398c2ecf20Sopenharmony_ci	.mt_info = "_SBI",
408c2ecf20Sopenharmony_ci	.mt_sbr  = "_SBR",
418c2ecf20Sopenharmony_ci	.mt_sbw  = "_SBW",
428c2ecf20Sopenharmony_ci};
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_ci/* Some IBM BIOSes omit the leading underscore */
458c2ecf20Sopenharmony_cistatic const struct smbus_methods_t ibm_smbus_methods = {
468c2ecf20Sopenharmony_ci	.mt_info = "SBI_",
478c2ecf20Sopenharmony_ci	.mt_sbr  = "SBR_",
488c2ecf20Sopenharmony_ci	.mt_sbw  = "SBW_",
498c2ecf20Sopenharmony_ci};
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_cistatic const struct acpi_device_id acpi_smbus_cmi_ids[] = {
528c2ecf20Sopenharmony_ci	{"SMBUS01", (kernel_ulong_t)&smbus_methods},
538c2ecf20Sopenharmony_ci	{ACPI_SMBUS_IBM_HID, (kernel_ulong_t)&ibm_smbus_methods},
548c2ecf20Sopenharmony_ci	{ACPI_SMBUS_MS_HID, (kernel_ulong_t)&smbus_methods},
558c2ecf20Sopenharmony_ci	{"", 0}
568c2ecf20Sopenharmony_ci};
578c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(acpi, acpi_smbus_cmi_ids);
588c2ecf20Sopenharmony_ci
598c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_OK			0x00
608c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_FAIL			0x07
618c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_DNAK			0x10
628c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_DERR			0x11
638c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_CMD_DENY		0x12
648c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_UNKNOWN		0x13
658c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_ACC_DENY		0x17
668c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_TIMEOUT		0x18
678c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_NOTSUP		0x19
688c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_BUSY			0x1a
698c2ecf20Sopenharmony_ci#define ACPI_SMBUS_STATUS_PEC			0x1f
708c2ecf20Sopenharmony_ci
718c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_WRITE			0x00
728c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_READ			0x01
738c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_QUICK			0x02
748c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_BYTE			0x04
758c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_BYTE_DATA		0x06
768c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_WORD_DATA		0x08
778c2ecf20Sopenharmony_ci#define ACPI_SMBUS_PRTCL_BLOCK_DATA		0x0a
788c2ecf20Sopenharmony_ci
798c2ecf20Sopenharmony_ci
808c2ecf20Sopenharmony_cistatic int
818c2ecf20Sopenharmony_ciacpi_smbus_cmi_access(struct i2c_adapter *adap, u16 addr, unsigned short flags,
828c2ecf20Sopenharmony_ci		   char read_write, u8 command, int size,
838c2ecf20Sopenharmony_ci		   union i2c_smbus_data *data)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	int result = 0;
868c2ecf20Sopenharmony_ci	struct acpi_smbus_cmi *smbus_cmi = adap->algo_data;
878c2ecf20Sopenharmony_ci	unsigned char protocol;
888c2ecf20Sopenharmony_ci	acpi_status status = 0;
898c2ecf20Sopenharmony_ci	struct acpi_object_list input;
908c2ecf20Sopenharmony_ci	union acpi_object mt_params[5];
918c2ecf20Sopenharmony_ci	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
928c2ecf20Sopenharmony_ci	union acpi_object *obj;
938c2ecf20Sopenharmony_ci	union acpi_object *pkg;
948c2ecf20Sopenharmony_ci	char *method;
958c2ecf20Sopenharmony_ci	int len = 0;
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	dev_dbg(&adap->dev, "access size: %d %s\n", size,
988c2ecf20Sopenharmony_ci		(read_write) ? "READ" : "WRITE");
998c2ecf20Sopenharmony_ci	switch (size) {
1008c2ecf20Sopenharmony_ci	case I2C_SMBUS_QUICK:
1018c2ecf20Sopenharmony_ci		protocol = ACPI_SMBUS_PRTCL_QUICK;
1028c2ecf20Sopenharmony_ci		command = 0;
1038c2ecf20Sopenharmony_ci		if (read_write == I2C_SMBUS_WRITE) {
1048c2ecf20Sopenharmony_ci			mt_params[3].type = ACPI_TYPE_INTEGER;
1058c2ecf20Sopenharmony_ci			mt_params[3].integer.value = 0;
1068c2ecf20Sopenharmony_ci			mt_params[4].type = ACPI_TYPE_INTEGER;
1078c2ecf20Sopenharmony_ci			mt_params[4].integer.value = 0;
1088c2ecf20Sopenharmony_ci		}
1098c2ecf20Sopenharmony_ci		break;
1108c2ecf20Sopenharmony_ci
1118c2ecf20Sopenharmony_ci	case I2C_SMBUS_BYTE:
1128c2ecf20Sopenharmony_ci		protocol = ACPI_SMBUS_PRTCL_BYTE;
1138c2ecf20Sopenharmony_ci		if (read_write == I2C_SMBUS_WRITE) {
1148c2ecf20Sopenharmony_ci			mt_params[3].type = ACPI_TYPE_INTEGER;
1158c2ecf20Sopenharmony_ci			mt_params[3].integer.value = 0;
1168c2ecf20Sopenharmony_ci			mt_params[4].type = ACPI_TYPE_INTEGER;
1178c2ecf20Sopenharmony_ci			mt_params[4].integer.value = 0;
1188c2ecf20Sopenharmony_ci		} else {
1198c2ecf20Sopenharmony_ci			command = 0;
1208c2ecf20Sopenharmony_ci		}
1218c2ecf20Sopenharmony_ci		break;
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	case I2C_SMBUS_BYTE_DATA:
1248c2ecf20Sopenharmony_ci		protocol = ACPI_SMBUS_PRTCL_BYTE_DATA;
1258c2ecf20Sopenharmony_ci		if (read_write == I2C_SMBUS_WRITE) {
1268c2ecf20Sopenharmony_ci			mt_params[3].type = ACPI_TYPE_INTEGER;
1278c2ecf20Sopenharmony_ci			mt_params[3].integer.value = 1;
1288c2ecf20Sopenharmony_ci			mt_params[4].type = ACPI_TYPE_INTEGER;
1298c2ecf20Sopenharmony_ci			mt_params[4].integer.value = data->byte;
1308c2ecf20Sopenharmony_ci		}
1318c2ecf20Sopenharmony_ci		break;
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci	case I2C_SMBUS_WORD_DATA:
1348c2ecf20Sopenharmony_ci		protocol = ACPI_SMBUS_PRTCL_WORD_DATA;
1358c2ecf20Sopenharmony_ci		if (read_write == I2C_SMBUS_WRITE) {
1368c2ecf20Sopenharmony_ci			mt_params[3].type = ACPI_TYPE_INTEGER;
1378c2ecf20Sopenharmony_ci			mt_params[3].integer.value = 2;
1388c2ecf20Sopenharmony_ci			mt_params[4].type = ACPI_TYPE_INTEGER;
1398c2ecf20Sopenharmony_ci			mt_params[4].integer.value = data->word;
1408c2ecf20Sopenharmony_ci		}
1418c2ecf20Sopenharmony_ci		break;
1428c2ecf20Sopenharmony_ci
1438c2ecf20Sopenharmony_ci	case I2C_SMBUS_BLOCK_DATA:
1448c2ecf20Sopenharmony_ci		protocol = ACPI_SMBUS_PRTCL_BLOCK_DATA;
1458c2ecf20Sopenharmony_ci		if (read_write == I2C_SMBUS_WRITE) {
1468c2ecf20Sopenharmony_ci			len = data->block[0];
1478c2ecf20Sopenharmony_ci			if (len == 0 || len > I2C_SMBUS_BLOCK_MAX)
1488c2ecf20Sopenharmony_ci				return -EINVAL;
1498c2ecf20Sopenharmony_ci			mt_params[3].type = ACPI_TYPE_INTEGER;
1508c2ecf20Sopenharmony_ci			mt_params[3].integer.value = len;
1518c2ecf20Sopenharmony_ci			mt_params[4].type = ACPI_TYPE_BUFFER;
1528c2ecf20Sopenharmony_ci			mt_params[4].buffer.length = len;
1538c2ecf20Sopenharmony_ci			mt_params[4].buffer.pointer = data->block + 1;
1548c2ecf20Sopenharmony_ci		}
1558c2ecf20Sopenharmony_ci		break;
1568c2ecf20Sopenharmony_ci
1578c2ecf20Sopenharmony_ci	default:
1588c2ecf20Sopenharmony_ci		dev_warn(&adap->dev, "Unsupported transaction %d\n", size);
1598c2ecf20Sopenharmony_ci		return -EOPNOTSUPP;
1608c2ecf20Sopenharmony_ci	}
1618c2ecf20Sopenharmony_ci
1628c2ecf20Sopenharmony_ci	if (read_write == I2C_SMBUS_READ) {
1638c2ecf20Sopenharmony_ci		protocol |= ACPI_SMBUS_PRTCL_READ;
1648c2ecf20Sopenharmony_ci		method = smbus_cmi->methods->mt_sbr;
1658c2ecf20Sopenharmony_ci		input.count = 3;
1668c2ecf20Sopenharmony_ci	} else {
1678c2ecf20Sopenharmony_ci		protocol |= ACPI_SMBUS_PRTCL_WRITE;
1688c2ecf20Sopenharmony_ci		method = smbus_cmi->methods->mt_sbw;
1698c2ecf20Sopenharmony_ci		input.count = 5;
1708c2ecf20Sopenharmony_ci	}
1718c2ecf20Sopenharmony_ci
1728c2ecf20Sopenharmony_ci	input.pointer = mt_params;
1738c2ecf20Sopenharmony_ci	mt_params[0].type = ACPI_TYPE_INTEGER;
1748c2ecf20Sopenharmony_ci	mt_params[0].integer.value = protocol;
1758c2ecf20Sopenharmony_ci	mt_params[1].type = ACPI_TYPE_INTEGER;
1768c2ecf20Sopenharmony_ci	mt_params[1].integer.value = addr;
1778c2ecf20Sopenharmony_ci	mt_params[2].type = ACPI_TYPE_INTEGER;
1788c2ecf20Sopenharmony_ci	mt_params[2].integer.value = command;
1798c2ecf20Sopenharmony_ci
1808c2ecf20Sopenharmony_ci	status = acpi_evaluate_object(smbus_cmi->handle, method, &input,
1818c2ecf20Sopenharmony_ci				      &buffer);
1828c2ecf20Sopenharmony_ci	if (ACPI_FAILURE(status)) {
1838c2ecf20Sopenharmony_ci		acpi_handle_err(smbus_cmi->handle,
1848c2ecf20Sopenharmony_ci				"Failed to evaluate %s: %i\n", method, status);
1858c2ecf20Sopenharmony_ci		return -EIO;
1868c2ecf20Sopenharmony_ci	}
1878c2ecf20Sopenharmony_ci
1888c2ecf20Sopenharmony_ci	pkg = buffer.pointer;
1898c2ecf20Sopenharmony_ci	if (pkg && pkg->type == ACPI_TYPE_PACKAGE)
1908c2ecf20Sopenharmony_ci		obj = pkg->package.elements;
1918c2ecf20Sopenharmony_ci	else {
1928c2ecf20Sopenharmony_ci		acpi_handle_err(smbus_cmi->handle, "Invalid argument type\n");
1938c2ecf20Sopenharmony_ci		result = -EIO;
1948c2ecf20Sopenharmony_ci		goto out;
1958c2ecf20Sopenharmony_ci	}
1968c2ecf20Sopenharmony_ci	if (obj == NULL || obj->type != ACPI_TYPE_INTEGER) {
1978c2ecf20Sopenharmony_ci		acpi_handle_err(smbus_cmi->handle, "Invalid argument type\n");
1988c2ecf20Sopenharmony_ci		result = -EIO;
1998c2ecf20Sopenharmony_ci		goto out;
2008c2ecf20Sopenharmony_ci	}
2018c2ecf20Sopenharmony_ci
2028c2ecf20Sopenharmony_ci	result = obj->integer.value;
2038c2ecf20Sopenharmony_ci	acpi_handle_debug(smbus_cmi->handle,  "%s return status: %i\n", method,
2048c2ecf20Sopenharmony_ci			  result);
2058c2ecf20Sopenharmony_ci
2068c2ecf20Sopenharmony_ci	switch (result) {
2078c2ecf20Sopenharmony_ci	case ACPI_SMBUS_STATUS_OK:
2088c2ecf20Sopenharmony_ci		result = 0;
2098c2ecf20Sopenharmony_ci		break;
2108c2ecf20Sopenharmony_ci	case ACPI_SMBUS_STATUS_BUSY:
2118c2ecf20Sopenharmony_ci		result = -EBUSY;
2128c2ecf20Sopenharmony_ci		goto out;
2138c2ecf20Sopenharmony_ci	case ACPI_SMBUS_STATUS_TIMEOUT:
2148c2ecf20Sopenharmony_ci		result = -ETIMEDOUT;
2158c2ecf20Sopenharmony_ci		goto out;
2168c2ecf20Sopenharmony_ci	case ACPI_SMBUS_STATUS_DNAK:
2178c2ecf20Sopenharmony_ci		result = -ENXIO;
2188c2ecf20Sopenharmony_ci		goto out;
2198c2ecf20Sopenharmony_ci	default:
2208c2ecf20Sopenharmony_ci		result = -EIO;
2218c2ecf20Sopenharmony_ci		goto out;
2228c2ecf20Sopenharmony_ci	}
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	if (read_write == I2C_SMBUS_WRITE || size == I2C_SMBUS_QUICK)
2258c2ecf20Sopenharmony_ci		goto out;
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	obj = pkg->package.elements + 1;
2288c2ecf20Sopenharmony_ci	if (obj->type != ACPI_TYPE_INTEGER) {
2298c2ecf20Sopenharmony_ci		acpi_handle_err(smbus_cmi->handle, "Invalid argument type\n");
2308c2ecf20Sopenharmony_ci		result = -EIO;
2318c2ecf20Sopenharmony_ci		goto out;
2328c2ecf20Sopenharmony_ci	}
2338c2ecf20Sopenharmony_ci
2348c2ecf20Sopenharmony_ci	len = obj->integer.value;
2358c2ecf20Sopenharmony_ci	obj = pkg->package.elements + 2;
2368c2ecf20Sopenharmony_ci	switch (size) {
2378c2ecf20Sopenharmony_ci	case I2C_SMBUS_BYTE:
2388c2ecf20Sopenharmony_ci	case I2C_SMBUS_BYTE_DATA:
2398c2ecf20Sopenharmony_ci	case I2C_SMBUS_WORD_DATA:
2408c2ecf20Sopenharmony_ci		if (obj->type != ACPI_TYPE_INTEGER) {
2418c2ecf20Sopenharmony_ci			acpi_handle_err(smbus_cmi->handle,
2428c2ecf20Sopenharmony_ci					"Invalid argument type\n");
2438c2ecf20Sopenharmony_ci			result = -EIO;
2448c2ecf20Sopenharmony_ci			goto out;
2458c2ecf20Sopenharmony_ci		}
2468c2ecf20Sopenharmony_ci		if (len == 2)
2478c2ecf20Sopenharmony_ci			data->word = obj->integer.value;
2488c2ecf20Sopenharmony_ci		else
2498c2ecf20Sopenharmony_ci			data->byte = obj->integer.value;
2508c2ecf20Sopenharmony_ci		break;
2518c2ecf20Sopenharmony_ci	case I2C_SMBUS_BLOCK_DATA:
2528c2ecf20Sopenharmony_ci		if (obj->type != ACPI_TYPE_BUFFER) {
2538c2ecf20Sopenharmony_ci			acpi_handle_err(smbus_cmi->handle,
2548c2ecf20Sopenharmony_ci					"Invalid argument type\n");
2558c2ecf20Sopenharmony_ci			result = -EIO;
2568c2ecf20Sopenharmony_ci			goto out;
2578c2ecf20Sopenharmony_ci		}
2588c2ecf20Sopenharmony_ci		if (len == 0 || len > I2C_SMBUS_BLOCK_MAX)
2598c2ecf20Sopenharmony_ci			return -EPROTO;
2608c2ecf20Sopenharmony_ci		data->block[0] = len;
2618c2ecf20Sopenharmony_ci		memcpy(data->block + 1, obj->buffer.pointer, len);
2628c2ecf20Sopenharmony_ci		break;
2638c2ecf20Sopenharmony_ci	}
2648c2ecf20Sopenharmony_ci
2658c2ecf20Sopenharmony_ciout:
2668c2ecf20Sopenharmony_ci	kfree(buffer.pointer);
2678c2ecf20Sopenharmony_ci	dev_dbg(&adap->dev, "Transaction status: %i\n", result);
2688c2ecf20Sopenharmony_ci	return result;
2698c2ecf20Sopenharmony_ci}
2708c2ecf20Sopenharmony_ci
2718c2ecf20Sopenharmony_cistatic u32 acpi_smbus_cmi_func(struct i2c_adapter *adapter)
2728c2ecf20Sopenharmony_ci{
2738c2ecf20Sopenharmony_ci	struct acpi_smbus_cmi *smbus_cmi = adapter->algo_data;
2748c2ecf20Sopenharmony_ci	u32 ret;
2758c2ecf20Sopenharmony_ci
2768c2ecf20Sopenharmony_ci	ret = smbus_cmi->cap_read | smbus_cmi->cap_write ?
2778c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_QUICK : 0;
2788c2ecf20Sopenharmony_ci
2798c2ecf20Sopenharmony_ci	ret |= smbus_cmi->cap_read ?
2808c2ecf20Sopenharmony_ci		(I2C_FUNC_SMBUS_READ_BYTE |
2818c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_READ_BYTE_DATA |
2828c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_READ_WORD_DATA |
2838c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_READ_BLOCK_DATA) : 0;
2848c2ecf20Sopenharmony_ci
2858c2ecf20Sopenharmony_ci	ret |= smbus_cmi->cap_write ?
2868c2ecf20Sopenharmony_ci		(I2C_FUNC_SMBUS_WRITE_BYTE |
2878c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_WRITE_BYTE_DATA |
2888c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_WRITE_WORD_DATA |
2898c2ecf20Sopenharmony_ci		I2C_FUNC_SMBUS_WRITE_BLOCK_DATA) : 0;
2908c2ecf20Sopenharmony_ci
2918c2ecf20Sopenharmony_ci	return ret;
2928c2ecf20Sopenharmony_ci}
2938c2ecf20Sopenharmony_ci
2948c2ecf20Sopenharmony_cistatic const struct i2c_algorithm acpi_smbus_cmi_algorithm = {
2958c2ecf20Sopenharmony_ci	.smbus_xfer = acpi_smbus_cmi_access,
2968c2ecf20Sopenharmony_ci	.functionality = acpi_smbus_cmi_func,
2978c2ecf20Sopenharmony_ci};
2988c2ecf20Sopenharmony_ci
2998c2ecf20Sopenharmony_ci
3008c2ecf20Sopenharmony_cistatic int acpi_smbus_cmi_add_cap(struct acpi_smbus_cmi *smbus_cmi,
3018c2ecf20Sopenharmony_ci				  const char *name)
3028c2ecf20Sopenharmony_ci{
3038c2ecf20Sopenharmony_ci	struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
3048c2ecf20Sopenharmony_ci	struct acpi_handle *handle = smbus_cmi->handle;
3058c2ecf20Sopenharmony_ci	union acpi_object *obj;
3068c2ecf20Sopenharmony_ci	acpi_status status;
3078c2ecf20Sopenharmony_ci
3088c2ecf20Sopenharmony_ci	if (!strcmp(name, smbus_cmi->methods->mt_info)) {
3098c2ecf20Sopenharmony_ci		status = acpi_evaluate_object(smbus_cmi->handle,
3108c2ecf20Sopenharmony_ci					smbus_cmi->methods->mt_info,
3118c2ecf20Sopenharmony_ci					NULL, &buffer);
3128c2ecf20Sopenharmony_ci		if (ACPI_FAILURE(status)) {
3138c2ecf20Sopenharmony_ci			acpi_handle_err(handle, "Failed to evaluate %s: %i\n",
3148c2ecf20Sopenharmony_ci					smbus_cmi->methods->mt_info, status);
3158c2ecf20Sopenharmony_ci			return -EIO;
3168c2ecf20Sopenharmony_ci		}
3178c2ecf20Sopenharmony_ci
3188c2ecf20Sopenharmony_ci		obj = buffer.pointer;
3198c2ecf20Sopenharmony_ci		if (obj && obj->type == ACPI_TYPE_PACKAGE)
3208c2ecf20Sopenharmony_ci			obj = obj->package.elements;
3218c2ecf20Sopenharmony_ci		else {
3228c2ecf20Sopenharmony_ci			acpi_handle_err(handle, "Invalid argument type\n");
3238c2ecf20Sopenharmony_ci			kfree(buffer.pointer);
3248c2ecf20Sopenharmony_ci			return -EIO;
3258c2ecf20Sopenharmony_ci		}
3268c2ecf20Sopenharmony_ci
3278c2ecf20Sopenharmony_ci		if (obj->type != ACPI_TYPE_INTEGER) {
3288c2ecf20Sopenharmony_ci			acpi_handle_err(handle, "Invalid argument type\n");
3298c2ecf20Sopenharmony_ci			kfree(buffer.pointer);
3308c2ecf20Sopenharmony_ci			return -EIO;
3318c2ecf20Sopenharmony_ci		} else
3328c2ecf20Sopenharmony_ci			acpi_handle_debug(handle, "SMBus CMI Version %x\n",
3338c2ecf20Sopenharmony_ci					  (int)obj->integer.value);
3348c2ecf20Sopenharmony_ci
3358c2ecf20Sopenharmony_ci		kfree(buffer.pointer);
3368c2ecf20Sopenharmony_ci		smbus_cmi->cap_info = 1;
3378c2ecf20Sopenharmony_ci	} else if (!strcmp(name, smbus_cmi->methods->mt_sbr))
3388c2ecf20Sopenharmony_ci		smbus_cmi->cap_read = 1;
3398c2ecf20Sopenharmony_ci	else if (!strcmp(name, smbus_cmi->methods->mt_sbw))
3408c2ecf20Sopenharmony_ci		smbus_cmi->cap_write = 1;
3418c2ecf20Sopenharmony_ci	else
3428c2ecf20Sopenharmony_ci		acpi_handle_debug(handle, "Unsupported CMI method: %s\n", name);
3438c2ecf20Sopenharmony_ci
3448c2ecf20Sopenharmony_ci	return 0;
3458c2ecf20Sopenharmony_ci}
3468c2ecf20Sopenharmony_ci
3478c2ecf20Sopenharmony_cistatic acpi_status acpi_smbus_cmi_query_methods(acpi_handle handle, u32 level,
3488c2ecf20Sopenharmony_ci			void *context, void **return_value)
3498c2ecf20Sopenharmony_ci{
3508c2ecf20Sopenharmony_ci	char node_name[5];
3518c2ecf20Sopenharmony_ci	struct acpi_buffer buffer = { sizeof(node_name), node_name };
3528c2ecf20Sopenharmony_ci	struct acpi_smbus_cmi *smbus_cmi = context;
3538c2ecf20Sopenharmony_ci	acpi_status status;
3548c2ecf20Sopenharmony_ci
3558c2ecf20Sopenharmony_ci	status = acpi_get_name(handle, ACPI_SINGLE_NAME, &buffer);
3568c2ecf20Sopenharmony_ci
3578c2ecf20Sopenharmony_ci	if (ACPI_SUCCESS(status))
3588c2ecf20Sopenharmony_ci		acpi_smbus_cmi_add_cap(smbus_cmi, node_name);
3598c2ecf20Sopenharmony_ci
3608c2ecf20Sopenharmony_ci	return AE_OK;
3618c2ecf20Sopenharmony_ci}
3628c2ecf20Sopenharmony_ci
3638c2ecf20Sopenharmony_cistatic int acpi_smbus_cmi_add(struct acpi_device *device)
3648c2ecf20Sopenharmony_ci{
3658c2ecf20Sopenharmony_ci	struct acpi_smbus_cmi *smbus_cmi;
3668c2ecf20Sopenharmony_ci	const struct acpi_device_id *id;
3678c2ecf20Sopenharmony_ci	int ret;
3688c2ecf20Sopenharmony_ci
3698c2ecf20Sopenharmony_ci	smbus_cmi = kzalloc(sizeof(struct acpi_smbus_cmi), GFP_KERNEL);
3708c2ecf20Sopenharmony_ci	if (!smbus_cmi)
3718c2ecf20Sopenharmony_ci		return -ENOMEM;
3728c2ecf20Sopenharmony_ci
3738c2ecf20Sopenharmony_ci	smbus_cmi->handle = device->handle;
3748c2ecf20Sopenharmony_ci	strcpy(acpi_device_name(device), ACPI_SMBUS_HC_DEVICE_NAME);
3758c2ecf20Sopenharmony_ci	strcpy(acpi_device_class(device), ACPI_SMBUS_HC_CLASS);
3768c2ecf20Sopenharmony_ci	device->driver_data = smbus_cmi;
3778c2ecf20Sopenharmony_ci	smbus_cmi->cap_info = 0;
3788c2ecf20Sopenharmony_ci	smbus_cmi->cap_read = 0;
3798c2ecf20Sopenharmony_ci	smbus_cmi->cap_write = 0;
3808c2ecf20Sopenharmony_ci
3818c2ecf20Sopenharmony_ci	for (id = acpi_smbus_cmi_ids; id->id[0]; id++)
3828c2ecf20Sopenharmony_ci		if (!strcmp(id->id, acpi_device_hid(device)))
3838c2ecf20Sopenharmony_ci			smbus_cmi->methods =
3848c2ecf20Sopenharmony_ci				(struct smbus_methods_t *) id->driver_data;
3858c2ecf20Sopenharmony_ci
3868c2ecf20Sopenharmony_ci	acpi_walk_namespace(ACPI_TYPE_METHOD, smbus_cmi->handle, 1,
3878c2ecf20Sopenharmony_ci			    acpi_smbus_cmi_query_methods, NULL, smbus_cmi, NULL);
3888c2ecf20Sopenharmony_ci
3898c2ecf20Sopenharmony_ci	if (smbus_cmi->cap_info == 0) {
3908c2ecf20Sopenharmony_ci		ret = -ENODEV;
3918c2ecf20Sopenharmony_ci		goto err;
3928c2ecf20Sopenharmony_ci	}
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	snprintf(smbus_cmi->adapter.name, sizeof(smbus_cmi->adapter.name),
3958c2ecf20Sopenharmony_ci		"SMBus CMI adapter %s",
3968c2ecf20Sopenharmony_ci		acpi_device_name(device));
3978c2ecf20Sopenharmony_ci	smbus_cmi->adapter.owner = THIS_MODULE;
3988c2ecf20Sopenharmony_ci	smbus_cmi->adapter.algo = &acpi_smbus_cmi_algorithm;
3998c2ecf20Sopenharmony_ci	smbus_cmi->adapter.algo_data = smbus_cmi;
4008c2ecf20Sopenharmony_ci	smbus_cmi->adapter.class = I2C_CLASS_HWMON | I2C_CLASS_SPD;
4018c2ecf20Sopenharmony_ci	smbus_cmi->adapter.dev.parent = &device->dev;
4028c2ecf20Sopenharmony_ci
4038c2ecf20Sopenharmony_ci	ret = i2c_add_adapter(&smbus_cmi->adapter);
4048c2ecf20Sopenharmony_ci	if (ret) {
4058c2ecf20Sopenharmony_ci		dev_err(&device->dev, "Couldn't register adapter!\n");
4068c2ecf20Sopenharmony_ci		goto err;
4078c2ecf20Sopenharmony_ci	}
4088c2ecf20Sopenharmony_ci
4098c2ecf20Sopenharmony_ci	return 0;
4108c2ecf20Sopenharmony_ci
4118c2ecf20Sopenharmony_cierr:
4128c2ecf20Sopenharmony_ci	kfree(smbus_cmi);
4138c2ecf20Sopenharmony_ci	device->driver_data = NULL;
4148c2ecf20Sopenharmony_ci	return ret;
4158c2ecf20Sopenharmony_ci}
4168c2ecf20Sopenharmony_ci
4178c2ecf20Sopenharmony_cistatic int acpi_smbus_cmi_remove(struct acpi_device *device)
4188c2ecf20Sopenharmony_ci{
4198c2ecf20Sopenharmony_ci	struct acpi_smbus_cmi *smbus_cmi = acpi_driver_data(device);
4208c2ecf20Sopenharmony_ci
4218c2ecf20Sopenharmony_ci	i2c_del_adapter(&smbus_cmi->adapter);
4228c2ecf20Sopenharmony_ci	kfree(smbus_cmi);
4238c2ecf20Sopenharmony_ci	device->driver_data = NULL;
4248c2ecf20Sopenharmony_ci
4258c2ecf20Sopenharmony_ci	return 0;
4268c2ecf20Sopenharmony_ci}
4278c2ecf20Sopenharmony_ci
4288c2ecf20Sopenharmony_cistatic struct acpi_driver acpi_smbus_cmi_driver = {
4298c2ecf20Sopenharmony_ci	.name = ACPI_SMBUS_HC_DEVICE_NAME,
4308c2ecf20Sopenharmony_ci	.class = ACPI_SMBUS_HC_CLASS,
4318c2ecf20Sopenharmony_ci	.ids = acpi_smbus_cmi_ids,
4328c2ecf20Sopenharmony_ci	.ops = {
4338c2ecf20Sopenharmony_ci		.add = acpi_smbus_cmi_add,
4348c2ecf20Sopenharmony_ci		.remove = acpi_smbus_cmi_remove,
4358c2ecf20Sopenharmony_ci	},
4368c2ecf20Sopenharmony_ci};
4378c2ecf20Sopenharmony_cimodule_acpi_driver(acpi_smbus_cmi_driver);
4388c2ecf20Sopenharmony_ci
4398c2ecf20Sopenharmony_ciMODULE_LICENSE("GPL");
4408c2ecf20Sopenharmony_ciMODULE_AUTHOR("Crane Cai <crane.cai@amd.com>");
4418c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("ACPI SMBus CMI driver");
442