Linux Audio

Check our new training course

Loading...
v3.1
 
  1/*
  2 * Hardware monitoring driver for ucd9200 series Digital PWM System Controllers
  3 *
  4 * Copyright (C) 2011 Ericsson AB.
  5 *
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or
  9 * (at your option) any later version.
 10 *
 11 * This program is distributed in the hope that it will be useful,
 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 14 * GNU General Public License for more details.
 15 *
 16 * You should have received a copy of the GNU General Public License
 17 * along with this program; if not, write to the Free Software
 18 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 19 */
 20
 21#include <linux/kernel.h>
 22#include <linux/module.h>
 
 23#include <linux/init.h>
 24#include <linux/err.h>
 25#include <linux/slab.h>
 26#include <linux/i2c.h>
 27#include <linux/i2c/pmbus.h>
 28#include "pmbus.h"
 29
 30#define UCD9200_PHASE_INFO	0xd2
 31#define UCD9200_DEVICE_ID	0xfd
 32
 33enum chips { ucd9200, ucd9220, ucd9222, ucd9224, ucd9240, ucd9244, ucd9246,
 34	     ucd9248 };
 35
 36static const struct i2c_device_id ucd9200_id[] = {
 37	{"ucd9200", ucd9200},
 38	{"ucd9220", ucd9220},
 39	{"ucd9222", ucd9222},
 40	{"ucd9224", ucd9224},
 41	{"ucd9240", ucd9240},
 42	{"ucd9244", ucd9244},
 43	{"ucd9246", ucd9246},
 44	{"ucd9248", ucd9248},
 45	{}
 46};
 47MODULE_DEVICE_TABLE(i2c, ucd9200_id);
 48
 49static int ucd9200_probe(struct i2c_client *client,
 50			 const struct i2c_device_id *id)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 51{
 52	u8 block_buffer[I2C_SMBUS_BLOCK_MAX + 1];
 53	struct pmbus_driver_info *info;
 54	const struct i2c_device_id *mid;
 
 55	int i, j, ret;
 56
 57	if (!i2c_check_functionality(client->adapter,
 58				     I2C_FUNC_SMBUS_BYTE_DATA |
 59				     I2C_FUNC_SMBUS_BLOCK_DATA))
 60		return -ENODEV;
 61
 62	ret = i2c_smbus_read_block_data(client, UCD9200_DEVICE_ID,
 63					block_buffer);
 64	if (ret < 0) {
 65		dev_err(&client->dev, "Failed to read device ID\n");
 66		return ret;
 67	}
 68	block_buffer[ret] = '\0';
 69	dev_info(&client->dev, "Device ID %s\n", block_buffer);
 70
 71	for (mid = ucd9200_id; mid->name[0]; mid++) {
 72		if (!strncasecmp(mid->name, block_buffer, strlen(mid->name)))
 73			break;
 74	}
 75	if (!mid->name[0]) {
 76		dev_err(&client->dev, "Unsupported device\n");
 77		return -ENODEV;
 78	}
 79	if (id->driver_data != ucd9200 && id->driver_data != mid->driver_data)
 
 
 
 
 
 
 80		dev_notice(&client->dev,
 81			   "Device mismatch: Configured %s, detected %s\n",
 82			   id->name, mid->name);
 83
 84	info = kzalloc(sizeof(struct pmbus_driver_info), GFP_KERNEL);
 
 85	if (!info)
 86		return -ENOMEM;
 87
 88	ret = i2c_smbus_read_block_data(client, UCD9200_PHASE_INFO,
 89					block_buffer);
 90	if (ret < 0) {
 91		dev_err(&client->dev, "Failed to read phase information\n");
 92		goto out;
 93	}
 94
 95	/*
 96	 * Calculate number of configured pages (rails) from PHASE_INFO
 97	 * register.
 98	 * Rails have to be sequential, so we can abort after finding
 99	 * the first unconfigured rail.
100	 */
101	info->pages = 0;
102	for (i = 0; i < ret; i++) {
103		if (!block_buffer[i])
104			break;
105		info->pages++;
106	}
107	if (!info->pages) {
108		dev_err(&client->dev, "No rails configured\n");
109		ret = -ENODEV;
110		goto out;
111	}
112	dev_info(&client->dev, "%d rails configured\n", info->pages);
113
114	/*
115	 * Set PHASE registers on all pages to 0xff to ensure that phase
116	 * specific commands will apply to all phases of a given page (rail).
117	 * This only affects the READ_IOUT and READ_TEMPERATURE2 registers.
118	 * READ_IOUT will return the sum of currents of all phases of a rail,
119	 * and READ_TEMPERATURE2 will return the maximum temperature detected
120	 * for the the phases of the rail.
121	 */
122	for (i = 0; i < info->pages; i++) {
123		/*
124		 * Setting PAGE & PHASE fails once in a while for no obvious
125		 * reason, so we need to retry a couple of times.
126		 */
127		for (j = 0; j < 3; j++) {
128			ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
129			if (ret < 0)
130				continue;
131			ret = i2c_smbus_write_byte_data(client, PMBUS_PHASE,
132							0xff);
133			if (ret < 0)
134				continue;
135			break;
136		}
137		if (ret < 0) {
138			dev_err(&client->dev,
139				"Failed to initialize PHASE registers\n");
140			goto out;
141		}
142	}
143	if (info->pages > 1)
144		i2c_smbus_write_byte_data(client, PMBUS_PAGE, 0);
145
146	info->func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_STATUS_INPUT |
147			PMBUS_HAVE_IIN | PMBUS_HAVE_PIN |
148			PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
149			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
150			PMBUS_HAVE_POUT | PMBUS_HAVE_TEMP |
151			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
152
153	for (i = 1; i < info->pages; i++)
154		info->func[i] = PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
155			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
156			PMBUS_HAVE_POUT |
157			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
158
159	/* ucd9240 supports a single fan */
160	if (mid->driver_data == ucd9240)
161		info->func[0] |= PMBUS_HAVE_FAN12 | PMBUS_HAVE_STATUS_FAN12;
162
163	ret = pmbus_do_probe(client, mid, info);
164	if (ret < 0)
165		goto out;
166	return 0;
167out:
168	kfree(info);
169	return ret;
170}
171
172static int ucd9200_remove(struct i2c_client *client)
173{
174	int ret;
175	const struct pmbus_driver_info *info;
176
177	info = pmbus_get_driver_info(client);
178	ret = pmbus_do_remove(client);
179	kfree(info);
180	return ret;
181}
182
183
184/* This is the driver that will be inserted */
185static struct i2c_driver ucd9200_driver = {
186	.driver = {
187		.name = "ucd9200",
 
188	},
189	.probe = ucd9200_probe,
190	.remove = ucd9200_remove,
191	.id_table = ucd9200_id,
192};
193
194static int __init ucd9200_init(void)
195{
196	return i2c_add_driver(&ucd9200_driver);
197}
198
199static void __exit ucd9200_exit(void)
200{
201	i2c_del_driver(&ucd9200_driver);
202}
203
204MODULE_AUTHOR("Guenter Roeck");
205MODULE_DESCRIPTION("PMBus driver for TI UCD922x, UCD924x");
206MODULE_LICENSE("GPL");
207module_init(ucd9200_init);
208module_exit(ucd9200_exit);
v6.2
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * Hardware monitoring driver for ucd9200 series Digital PWM System Controllers
  4 *
  5 * Copyright (C) 2011 Ericsson AB.
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  6 */
  7
  8#include <linux/kernel.h>
  9#include <linux/module.h>
 10#include <linux/of_device.h>
 11#include <linux/init.h>
 12#include <linux/err.h>
 13#include <linux/slab.h>
 14#include <linux/i2c.h>
 15#include <linux/pmbus.h>
 16#include "pmbus.h"
 17
 18#define UCD9200_PHASE_INFO	0xd2
 19#define UCD9200_DEVICE_ID	0xfd
 20
 21enum chips { ucd9200, ucd9220, ucd9222, ucd9224, ucd9240, ucd9244, ucd9246,
 22	     ucd9248 };
 23
 24static const struct i2c_device_id ucd9200_id[] = {
 25	{"ucd9200", ucd9200},
 26	{"ucd9220", ucd9220},
 27	{"ucd9222", ucd9222},
 28	{"ucd9224", ucd9224},
 29	{"ucd9240", ucd9240},
 30	{"ucd9244", ucd9244},
 31	{"ucd9246", ucd9246},
 32	{"ucd9248", ucd9248},
 33	{}
 34};
 35MODULE_DEVICE_TABLE(i2c, ucd9200_id);
 36
 37static const struct of_device_id __maybe_unused ucd9200_of_match[] = {
 38	{
 39		.compatible = "ti,cd9200",
 40		.data = (void *)ucd9200
 41	},
 42	{
 43		.compatible = "ti,cd9220",
 44		.data = (void *)ucd9220
 45	},
 46	{
 47		.compatible = "ti,cd9222",
 48		.data = (void *)ucd9222
 49	},
 50	{
 51		.compatible = "ti,cd9224",
 52		.data = (void *)ucd9224
 53	},
 54	{
 55		.compatible = "ti,cd9240",
 56		.data = (void *)ucd9240
 57	},
 58	{
 59		.compatible = "ti,cd9244",
 60		.data = (void *)ucd9244
 61	},
 62	{
 63		.compatible = "ti,cd9246",
 64		.data = (void *)ucd9246
 65	},
 66	{
 67		.compatible = "ti,cd9248",
 68		.data = (void *)ucd9248
 69	},
 70	{ },
 71};
 72MODULE_DEVICE_TABLE(of, ucd9200_of_match);
 73
 74static int ucd9200_probe(struct i2c_client *client)
 75{
 76	u8 block_buffer[I2C_SMBUS_BLOCK_MAX + 1];
 77	struct pmbus_driver_info *info;
 78	const struct i2c_device_id *mid;
 79	enum chips chip;
 80	int i, j, ret;
 81
 82	if (!i2c_check_functionality(client->adapter,
 83				     I2C_FUNC_SMBUS_BYTE_DATA |
 84				     I2C_FUNC_SMBUS_BLOCK_DATA))
 85		return -ENODEV;
 86
 87	ret = i2c_smbus_read_block_data(client, UCD9200_DEVICE_ID,
 88					block_buffer);
 89	if (ret < 0) {
 90		dev_err(&client->dev, "Failed to read device ID\n");
 91		return ret;
 92	}
 93	block_buffer[ret] = '\0';
 94	dev_info(&client->dev, "Device ID %s\n", block_buffer);
 95
 96	for (mid = ucd9200_id; mid->name[0]; mid++) {
 97		if (!strncasecmp(mid->name, block_buffer, strlen(mid->name)))
 98			break;
 99	}
100	if (!mid->name[0]) {
101		dev_err(&client->dev, "Unsupported device\n");
102		return -ENODEV;
103	}
104
105	if (client->dev.of_node)
106		chip = (enum chips)of_device_get_match_data(&client->dev);
107	else
108		chip = mid->driver_data;
109
110	if (chip != ucd9200 && strcmp(client->name, mid->name) != 0)
111		dev_notice(&client->dev,
112			   "Device mismatch: Configured %s, detected %s\n",
113			   client->name, mid->name);
114
115	info = devm_kzalloc(&client->dev, sizeof(struct pmbus_driver_info),
116			    GFP_KERNEL);
117	if (!info)
118		return -ENOMEM;
119
120	ret = i2c_smbus_read_block_data(client, UCD9200_PHASE_INFO,
121					block_buffer);
122	if (ret < 0) {
123		dev_err(&client->dev, "Failed to read phase information\n");
124		return ret;
125	}
126
127	/*
128	 * Calculate number of configured pages (rails) from PHASE_INFO
129	 * register.
130	 * Rails have to be sequential, so we can abort after finding
131	 * the first unconfigured rail.
132	 */
133	info->pages = 0;
134	for (i = 0; i < ret; i++) {
135		if (!block_buffer[i])
136			break;
137		info->pages++;
138	}
139	if (!info->pages) {
140		dev_err(&client->dev, "No rails configured\n");
141		return -ENODEV;
 
142	}
143	dev_info(&client->dev, "%d rails configured\n", info->pages);
144
145	/*
146	 * Set PHASE registers on all pages to 0xff to ensure that phase
147	 * specific commands will apply to all phases of a given page (rail).
148	 * This only affects the READ_IOUT and READ_TEMPERATURE2 registers.
149	 * READ_IOUT will return the sum of currents of all phases of a rail,
150	 * and READ_TEMPERATURE2 will return the maximum temperature detected
151	 * for the phases of the rail.
152	 */
153	for (i = 0; i < info->pages; i++) {
154		/*
155		 * Setting PAGE & PHASE fails once in a while for no obvious
156		 * reason, so we need to retry a couple of times.
157		 */
158		for (j = 0; j < 3; j++) {
159			ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
160			if (ret < 0)
161				continue;
162			ret = i2c_smbus_write_byte_data(client, PMBUS_PHASE,
163							0xff);
164			if (ret < 0)
165				continue;
166			break;
167		}
168		if (ret < 0) {
169			dev_err(&client->dev,
170				"Failed to initialize PHASE registers\n");
171			return ret;
172		}
173	}
174	if (info->pages > 1)
175		i2c_smbus_write_byte_data(client, PMBUS_PAGE, 0);
176
177	info->func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_STATUS_INPUT |
178			PMBUS_HAVE_IIN | PMBUS_HAVE_PIN |
179			PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
180			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
181			PMBUS_HAVE_POUT | PMBUS_HAVE_TEMP |
182			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
183
184	for (i = 1; i < info->pages; i++)
185		info->func[i] = PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
186			PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
187			PMBUS_HAVE_POUT |
188			PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
189
190	/* ucd9240 supports a single fan */
191	if (mid->driver_data == ucd9240)
192		info->func[0] |= PMBUS_HAVE_FAN12 | PMBUS_HAVE_STATUS_FAN12;
193
194	return pmbus_do_probe(client, info);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
195}
196
 
197/* This is the driver that will be inserted */
198static struct i2c_driver ucd9200_driver = {
199	.driver = {
200		.name = "ucd9200",
201		.of_match_table = of_match_ptr(ucd9200_of_match),
202	},
203	.probe_new = ucd9200_probe,
 
204	.id_table = ucd9200_id,
205};
206
207module_i2c_driver(ucd9200_driver);
 
 
 
 
 
 
 
 
208
209MODULE_AUTHOR("Guenter Roeck");
210MODULE_DESCRIPTION("PMBus driver for TI UCD922x, UCD924x");
211MODULE_LICENSE("GPL");
212MODULE_IMPORT_NS(PMBUS);