Loading...
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);
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/of_device.h>
24#include <linux/init.h>
25#include <linux/err.h>
26#include <linux/slab.h>
27#include <linux/i2c.h>
28#include <linux/pmbus.h>
29#include "pmbus.h"
30
31#define UCD9200_PHASE_INFO 0xd2
32#define UCD9200_DEVICE_ID 0xfd
33
34enum chips { ucd9200, ucd9220, ucd9222, ucd9224, ucd9240, ucd9244, ucd9246,
35 ucd9248 };
36
37static const struct i2c_device_id ucd9200_id[] = {
38 {"ucd9200", ucd9200},
39 {"ucd9220", ucd9220},
40 {"ucd9222", ucd9222},
41 {"ucd9224", ucd9224},
42 {"ucd9240", ucd9240},
43 {"ucd9244", ucd9244},
44 {"ucd9246", ucd9246},
45 {"ucd9248", ucd9248},
46 {}
47};
48MODULE_DEVICE_TABLE(i2c, ucd9200_id);
49
50static const struct of_device_id ucd9200_of_match[] = {
51 {
52 .compatible = "ti,cd9200",
53 .data = (void *)ucd9200
54 },
55 {
56 .compatible = "ti,cd9220",
57 .data = (void *)ucd9220
58 },
59 {
60 .compatible = "ti,cd9222",
61 .data = (void *)ucd9222
62 },
63 {
64 .compatible = "ti,cd9224",
65 .data = (void *)ucd9224
66 },
67 {
68 .compatible = "ti,cd9240",
69 .data = (void *)ucd9240
70 },
71 {
72 .compatible = "ti,cd9244",
73 .data = (void *)ucd9244
74 },
75 {
76 .compatible = "ti,cd9246",
77 .data = (void *)ucd9246
78 },
79 {
80 .compatible = "ti,cd9248",
81 .data = (void *)ucd9248
82 },
83 { },
84};
85MODULE_DEVICE_TABLE(of, ucd9200_of_match);
86
87static int ucd9200_probe(struct i2c_client *client,
88 const struct i2c_device_id *id)
89{
90 u8 block_buffer[I2C_SMBUS_BLOCK_MAX + 1];
91 struct pmbus_driver_info *info;
92 const struct i2c_device_id *mid;
93 enum chips chip;
94 int i, j, ret;
95
96 if (!i2c_check_functionality(client->adapter,
97 I2C_FUNC_SMBUS_BYTE_DATA |
98 I2C_FUNC_SMBUS_BLOCK_DATA))
99 return -ENODEV;
100
101 ret = i2c_smbus_read_block_data(client, UCD9200_DEVICE_ID,
102 block_buffer);
103 if (ret < 0) {
104 dev_err(&client->dev, "Failed to read device ID\n");
105 return ret;
106 }
107 block_buffer[ret] = '\0';
108 dev_info(&client->dev, "Device ID %s\n", block_buffer);
109
110 for (mid = ucd9200_id; mid->name[0]; mid++) {
111 if (!strncasecmp(mid->name, block_buffer, strlen(mid->name)))
112 break;
113 }
114 if (!mid->name[0]) {
115 dev_err(&client->dev, "Unsupported device\n");
116 return -ENODEV;
117 }
118
119 if (client->dev.of_node)
120 chip = (enum chips)of_device_get_match_data(&client->dev);
121 else
122 chip = id->driver_data;
123
124 if (chip != ucd9200 && chip != mid->driver_data)
125 dev_notice(&client->dev,
126 "Device mismatch: Configured %s, detected %s\n",
127 id->name, mid->name);
128
129 info = devm_kzalloc(&client->dev, sizeof(struct pmbus_driver_info),
130 GFP_KERNEL);
131 if (!info)
132 return -ENOMEM;
133
134 ret = i2c_smbus_read_block_data(client, UCD9200_PHASE_INFO,
135 block_buffer);
136 if (ret < 0) {
137 dev_err(&client->dev, "Failed to read phase information\n");
138 return ret;
139 }
140
141 /*
142 * Calculate number of configured pages (rails) from PHASE_INFO
143 * register.
144 * Rails have to be sequential, so we can abort after finding
145 * the first unconfigured rail.
146 */
147 info->pages = 0;
148 for (i = 0; i < ret; i++) {
149 if (!block_buffer[i])
150 break;
151 info->pages++;
152 }
153 if (!info->pages) {
154 dev_err(&client->dev, "No rails configured\n");
155 return -ENODEV;
156 }
157 dev_info(&client->dev, "%d rails configured\n", info->pages);
158
159 /*
160 * Set PHASE registers on all pages to 0xff to ensure that phase
161 * specific commands will apply to all phases of a given page (rail).
162 * This only affects the READ_IOUT and READ_TEMPERATURE2 registers.
163 * READ_IOUT will return the sum of currents of all phases of a rail,
164 * and READ_TEMPERATURE2 will return the maximum temperature detected
165 * for the the phases of the rail.
166 */
167 for (i = 0; i < info->pages; i++) {
168 /*
169 * Setting PAGE & PHASE fails once in a while for no obvious
170 * reason, so we need to retry a couple of times.
171 */
172 for (j = 0; j < 3; j++) {
173 ret = i2c_smbus_write_byte_data(client, PMBUS_PAGE, i);
174 if (ret < 0)
175 continue;
176 ret = i2c_smbus_write_byte_data(client, PMBUS_PHASE,
177 0xff);
178 if (ret < 0)
179 continue;
180 break;
181 }
182 if (ret < 0) {
183 dev_err(&client->dev,
184 "Failed to initialize PHASE registers\n");
185 return ret;
186 }
187 }
188 if (info->pages > 1)
189 i2c_smbus_write_byte_data(client, PMBUS_PAGE, 0);
190
191 info->func[0] = PMBUS_HAVE_VIN | PMBUS_HAVE_STATUS_INPUT |
192 PMBUS_HAVE_IIN | PMBUS_HAVE_PIN |
193 PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
194 PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
195 PMBUS_HAVE_POUT | PMBUS_HAVE_TEMP |
196 PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
197
198 for (i = 1; i < info->pages; i++)
199 info->func[i] = PMBUS_HAVE_VOUT | PMBUS_HAVE_STATUS_VOUT |
200 PMBUS_HAVE_IOUT | PMBUS_HAVE_STATUS_IOUT |
201 PMBUS_HAVE_POUT |
202 PMBUS_HAVE_TEMP2 | PMBUS_HAVE_STATUS_TEMP;
203
204 /* ucd9240 supports a single fan */
205 if (mid->driver_data == ucd9240)
206 info->func[0] |= PMBUS_HAVE_FAN12 | PMBUS_HAVE_STATUS_FAN12;
207
208 return pmbus_do_probe(client, mid, info);
209}
210
211/* This is the driver that will be inserted */
212static struct i2c_driver ucd9200_driver = {
213 .driver = {
214 .name = "ucd9200",
215 .of_match_table = of_match_ptr(ucd9200_of_match),
216 },
217 .probe = ucd9200_probe,
218 .remove = pmbus_do_remove,
219 .id_table = ucd9200_id,
220};
221
222module_i2c_driver(ucd9200_driver);
223
224MODULE_AUTHOR("Guenter Roeck");
225MODULE_DESCRIPTION("PMBus driver for TI UCD922x, UCD924x");
226MODULE_LICENSE("GPL");