162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Hardware monitoring driver for ucd9200 series Digital PWM System Controllers
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright (C) 2011 Ericsson AB.
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/kernel.h>
962306a36Sopenharmony_ci#include <linux/module.h>
1062306a36Sopenharmony_ci#include <linux/of.h>
1162306a36Sopenharmony_ci#include <linux/init.h>
1262306a36Sopenharmony_ci#include <linux/err.h>
1362306a36Sopenharmony_ci#include <linux/slab.h>
1462306a36Sopenharmony_ci#include <linux/i2c.h>
1562306a36Sopenharmony_ci#include <linux/pmbus.h>
1662306a36Sopenharmony_ci#include "pmbus.h"
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#define UCD9200_PHASE_INFO	0xd2
1962306a36Sopenharmony_ci#define UCD9200_DEVICE_ID	0xfd
2062306a36Sopenharmony_ci
2162306a36Sopenharmony_cienum chips { ucd9200, ucd9220, ucd9222, ucd9224, ucd9240, ucd9244, ucd9246,
2262306a36Sopenharmony_ci	     ucd9248 };
2362306a36Sopenharmony_ci
2462306a36Sopenharmony_cistatic const struct i2c_device_id ucd9200_id[] = {
2562306a36Sopenharmony_ci	{"ucd9200", ucd9200},
2662306a36Sopenharmony_ci	{"ucd9220", ucd9220},
2762306a36Sopenharmony_ci	{"ucd9222", ucd9222},
2862306a36Sopenharmony_ci	{"ucd9224", ucd9224},
2962306a36Sopenharmony_ci	{"ucd9240", ucd9240},
3062306a36Sopenharmony_ci	{"ucd9244", ucd9244},
3162306a36Sopenharmony_ci	{"ucd9246", ucd9246},
3262306a36Sopenharmony_ci	{"ucd9248", ucd9248},
3362306a36Sopenharmony_ci	{}
3462306a36Sopenharmony_ci};
3562306a36Sopenharmony_ciMODULE_DEVICE_TABLE(i2c, ucd9200_id);
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistatic const struct of_device_id __maybe_unused ucd9200_of_match[] = {
3862306a36Sopenharmony_ci	{
3962306a36Sopenharmony_ci		.compatible = "ti,cd9200",
4062306a36Sopenharmony_ci		.data = (void *)ucd9200
4162306a36Sopenharmony_ci	},
4262306a36Sopenharmony_ci	{
4362306a36Sopenharmony_ci		.compatible = "ti,cd9220",
4462306a36Sopenharmony_ci		.data = (void *)ucd9220
4562306a36Sopenharmony_ci	},
4662306a36Sopenharmony_ci	{
4762306a36Sopenharmony_ci		.compatible = "ti,cd9222",
4862306a36Sopenharmony_ci		.data = (void *)ucd9222
4962306a36Sopenharmony_ci	},
5062306a36Sopenharmony_ci	{
5162306a36Sopenharmony_ci		.compatible = "ti,cd9224",
5262306a36Sopenharmony_ci		.data = (void *)ucd9224
5362306a36Sopenharmony_ci	},
5462306a36Sopenharmony_ci	{
5562306a36Sopenharmony_ci		.compatible = "ti,cd9240",
5662306a36Sopenharmony_ci		.data = (void *)ucd9240
5762306a36Sopenharmony_ci	},
5862306a36Sopenharmony_ci	{
5962306a36Sopenharmony_ci		.compatible = "ti,cd9244",
6062306a36Sopenharmony_ci		.data = (void *)ucd9244
6162306a36Sopenharmony_ci	},
6262306a36Sopenharmony_ci	{
6362306a36Sopenharmony_ci		.compatible = "ti,cd9246",
6462306a36Sopenharmony_ci		.data = (void *)ucd9246
6562306a36Sopenharmony_ci	},
6662306a36Sopenharmony_ci	{
6762306a36Sopenharmony_ci		.compatible = "ti,cd9248",
6862306a36Sopenharmony_ci		.data = (void *)ucd9248
6962306a36Sopenharmony_ci	},
7062306a36Sopenharmony_ci	{ },
7162306a36Sopenharmony_ci};
7262306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, ucd9200_of_match);
7362306a36Sopenharmony_ci
7462306a36Sopenharmony_cistatic int ucd9200_probe(struct i2c_client *client)
7562306a36Sopenharmony_ci{
7662306a36Sopenharmony_ci	u8 block_buffer[I2C_SMBUS_BLOCK_MAX + 1];
7762306a36Sopenharmony_ci	struct pmbus_driver_info *info;
7862306a36Sopenharmony_ci	const struct i2c_device_id *mid;
7962306a36Sopenharmony_ci	enum chips chip;
8062306a36Sopenharmony_ci	int i, j, ret;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	if (!i2c_check_functionality(client->adapter,
8362306a36Sopenharmony_ci				     I2C_FUNC_SMBUS_BYTE_DATA |
8462306a36Sopenharmony_ci				     I2C_FUNC_SMBUS_BLOCK_DATA))
8562306a36Sopenharmony_ci		return -ENODEV;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	ret = i2c_smbus_read_block_data(client, UCD9200_DEVICE_ID,
8862306a36Sopenharmony_ci					block_buffer);
8962306a36Sopenharmony_ci	if (ret < 0) {
9062306a36Sopenharmony_ci		dev_err(&client->dev, "Failed to read device ID\n");
9162306a36Sopenharmony_ci		return ret;
9262306a36Sopenharmony_ci	}
9362306a36Sopenharmony_ci	block_buffer[ret] = '\0';
9462306a36Sopenharmony_ci	dev_info(&client->dev, "Device ID %s\n", block_buffer);
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	for (mid = ucd9200_id; mid->name[0]; mid++) {
9762306a36Sopenharmony_ci		if (!strncasecmp(mid->name, block_buffer, strlen(mid->name)))
9862306a36Sopenharmony_ci			break;
9962306a36Sopenharmony_ci	}
10062306a36Sopenharmony_ci	if (!mid->name[0]) {
10162306a36Sopenharmony_ci		dev_err(&client->dev, "Unsupported device\n");
10262306a36Sopenharmony_ci		return -ENODEV;
10362306a36Sopenharmony_ci	}
10462306a36Sopenharmony_ci
10562306a36Sopenharmony_ci	if (client->dev.of_node)
10662306a36Sopenharmony_ci		chip = (uintptr_t)of_device_get_match_data(&client->dev);
10762306a36Sopenharmony_ci	else
10862306a36Sopenharmony_ci		chip = mid->driver_data;
10962306a36Sopenharmony_ci
11062306a36Sopenharmony_ci	if (chip != ucd9200 && strcmp(client->name, mid->name) != 0)
11162306a36Sopenharmony_ci		dev_notice(&client->dev,
11262306a36Sopenharmony_ci			   "Device mismatch: Configured %s, detected %s\n",
11362306a36Sopenharmony_ci			   client->name, mid->name);
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	info = devm_kzalloc(&client->dev, sizeof(struct pmbus_driver_info),
11662306a36Sopenharmony_ci			    GFP_KERNEL);
11762306a36Sopenharmony_ci	if (!info)
11862306a36Sopenharmony_ci		return -ENOMEM;
11962306a36Sopenharmony_ci
12062306a36Sopenharmony_ci	ret = i2c_smbus_read_block_data(client, UCD9200_PHASE_INFO,
12162306a36Sopenharmony_ci					block_buffer);
12262306a36Sopenharmony_ci	if (ret < 0) {
12362306a36Sopenharmony_ci		dev_err(&client->dev, "Failed to read phase information\n");
12462306a36Sopenharmony_ci		return ret;
12562306a36Sopenharmony_ci	}
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	/*
12862306a36Sopenharmony_ci	 * Calculate number of configured pages (rails) from PHASE_INFO
12962306a36Sopenharmony_ci	 * register.
13062306a36Sopenharmony_ci	 * Rails have to be sequential, so we can abort after finding
13162306a36Sopenharmony_ci	 * the first unconfigured rail.
13262306a36Sopenharmony_ci	 */
13362306a36Sopenharmony_ci	info->pages = 0;
13462306a36Sopenharmony_ci	for (i = 0; i < ret; i++) {
13562306a36Sopenharmony_ci		if (!block_buffer[i])
13662306a36Sopenharmony_ci			break;
13762306a36Sopenharmony_ci		info->pages++;
13862306a36Sopenharmony_ci	}
13962306a36Sopenharmony_ci	if (!info->pages) {
14062306a36Sopenharmony_ci		dev_err(&client->dev, "No rails configured\n");
14162306a36Sopenharmony_ci		return -ENODEV;
14262306a36Sopenharmony_ci	}
14362306a36Sopenharmony_ci	dev_info(&client->dev, "%d rails configured\n", info->pages);
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	/*
14662306a36Sopenharmony_ci	 * Set PHASE registers on all pages to 0xff to ensure that phase
14762306a36Sopenharmony_ci	 * specific commands will apply to all phases of a given page (rail).
14862306a36Sopenharmony_ci	 * This only affects the READ_IOUT and READ_TEMPERATURE2 registers.
14962306a36Sopenharmony_ci	 * READ_IOUT will return the sum of currents of all phases of a rail,
15062306a36Sopenharmony_ci	 * and READ_TEMPERATURE2 will return the maximum temperature detected
15162306a36Sopenharmony_ci	 * for the phases of the rail.
15262306a36Sopenharmony_ci	 */
15362306a36Sopenharmony_ci	for (i = 0; i < info->pages; i++) {
15462306a36Sopenharmony_ci		/*
15562306a36Sopenharmony_ci		 * Setting PAGE & PHASE fails once in a while for no obvious
15662306a36Sopenharmony_ci		 * reason, so we need to retry a couple of times.
15762306a36Sopenharmony_ci		 */
15862306a36Sopenharmony_ci		for (j = 0; j < 3; j++) {
15962306a36Sopenharmony_ci			ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
16062306a36Sopenharmony_ci			if (ret < 0)
16162306a36Sopenharmony_ci				continue;
16262306a36Sopenharmony_ci			ret = i2c_smbus_write_byte_data(client, PMBUS_PHASE,
16362306a36Sopenharmony_ci							0xff);
16462306a36Sopenharmony_ci			if (ret < 0)
16562306a36Sopenharmony_ci				continue;
16662306a36Sopenharmony_ci			break;
16762306a36Sopenharmony_ci		}
16862306a36Sopenharmony_ci		if (ret < 0) {
16962306a36Sopenharmony_ci			dev_err(&client->dev,
17062306a36Sopenharmony_ci				"Failed to initialize PHASE registers\n");
17162306a36Sopenharmony_ci			return ret;
17262306a36Sopenharmony_ci		}
17362306a36Sopenharmony_ci	}
17462306a36Sopenharmony_ci	if (info->pages > 1)
17562306a36Sopenharmony_ci		i2c_smbus_write_byte_data(client, PMBUS_PAGE, 0);
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	info->func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_STATUS_INPUT |
17862306a36Sopenharmony_ci			PMBUS_HAVE_IIN | PMBUS_HAVE_PIN |
17962306a36Sopenharmony_ci			PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
18062306a36Sopenharmony_ci			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
18162306a36Sopenharmony_ci			PMBUS_HAVE_POUT | PMBUS_HAVE_TEMP |
18262306a36Sopenharmony_ci			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
18362306a36Sopenharmony_ci
18462306a36Sopenharmony_ci	for (i = 1; i < info->pages; i++)
18562306a36Sopenharmony_ci		info->func[i] = PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
18662306a36Sopenharmony_ci			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
18762306a36Sopenharmony_ci			PMBUS_HAVE_POUT |
18862306a36Sopenharmony_ci			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
18962306a36Sopenharmony_ci
19062306a36Sopenharmony_ci	/* ucd9240 supports a single fan */
19162306a36Sopenharmony_ci	if (mid->driver_data == ucd9240)
19262306a36Sopenharmony_ci		info->func[0] |= PMBUS_HAVE_FAN12 | PMBUS_HAVE_STATUS_FAN12;
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	return pmbus_do_probe(client, info);
19562306a36Sopenharmony_ci}
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci/* This is the driver that will be inserted */
19862306a36Sopenharmony_cistatic struct i2c_driver ucd9200_driver = {
19962306a36Sopenharmony_ci	.driver = {
20062306a36Sopenharmony_ci		.name = "ucd9200",
20162306a36Sopenharmony_ci		.of_match_table = of_match_ptr(ucd9200_of_match),
20262306a36Sopenharmony_ci	},
20362306a36Sopenharmony_ci	.probe = ucd9200_probe,
20462306a36Sopenharmony_ci	.id_table = ucd9200_id,
20562306a36Sopenharmony_ci};
20662306a36Sopenharmony_ci
20762306a36Sopenharmony_cimodule_i2c_driver(ucd9200_driver);
20862306a36Sopenharmony_ci
20962306a36Sopenharmony_ciMODULE_AUTHOR("Guenter Roeck");
21062306a36Sopenharmony_ciMODULE_DESCRIPTION("PMBus driver for TI UCD922x, UCD924x");
21162306a36Sopenharmony_ciMODULE_LICENSE("GPL");
21262306a36Sopenharmony_ciMODULE_IMPORT_NS(PMBUS);
213