1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.h>
24#include <linux/init.h>
25#include <linux/slab.h>
26#include <linux/i2c.h>
27#include <linux/hwmon.h>
28#include <linux/hwmon-sysfs.h>
29#include <linux/err.h>
30#include <linux/mutex.h>
31
32MODULE_LICENSE("GPL");
33
34
35static const unsigned short normal_i2c[] = { 0x2c, 0x2d, 0x2e, I2C_CLIENT_END };
36
37
38enum chips { thmc50, adm1022 };
39
40static unsigned short adm1022_temp3[16];
41static unsigned int adm1022_temp3_num;
42module_param_array(adm1022_temp3, ushort, &adm1022_temp3_num, 0);
43MODULE_PARM_DESC(adm1022_temp3, "List of adapter,address pairs "
44 "to enable 3rd temperature (ADM1022 only)");
45
46
47
48
49#define THMC50_REG_CONF 0x40
50#define THMC50_REG_COMPANY_ID 0x3E
51#define THMC50_REG_DIE_CODE 0x3F
52#define THMC50_REG_ANALOG_OUT 0x19
53
54
55
56
57#define THMC50_REG_INTR 0x41
58
59static const u8 THMC50_REG_TEMP[] = { 0x27, 0x26, 0x20 };
60static const u8 THMC50_REG_TEMP_MIN[] = { 0x3A, 0x38, 0x2C };
61static const u8 THMC50_REG_TEMP_MAX[] = { 0x39, 0x37, 0x2B };
62static const u8 THMC50_REG_TEMP_CRITICAL[] = { 0x13, 0x14, 0x14 };
63static const u8 THMC50_REG_TEMP_DEFAULT[] = { 0x17, 0x18, 0x18 };
64
65#define THMC50_REG_CONF_nFANOFF 0x20
66#define THMC50_REG_CONF_PROGRAMMED 0x08
67
68
69struct thmc50_data {
70 struct device *hwmon_dev;
71
72 struct mutex update_lock;
73 enum chips type;
74 unsigned long last_updated;
75 char has_temp3;
76 char valid;
77
78
79 s8 temp_input[3];
80 s8 temp_max[3];
81 s8 temp_min[3];
82 s8 temp_critical[3];
83 u8 analog_out;
84 u8 alarms;
85};
86
87static int thmc50_detect(struct i2c_client *client,
88 struct i2c_board_info *info);
89static int thmc50_probe(struct i2c_client *client,
90 const struct i2c_device_id *id);
91static int thmc50_remove(struct i2c_client *client);
92static void thmc50_init_client(struct i2c_client *client);
93static struct thmc50_data *thmc50_update_device(struct device *dev);
94
95static const struct i2c_device_id thmc50_id[] = {
96 { "adm1022", adm1022 },
97 { "thmc50", thmc50 },
98 { }
99};
100MODULE_DEVICE_TABLE(i2c, thmc50_id);
101
102static struct i2c_driver thmc50_driver = {
103 .class = I2C_CLASS_HWMON,
104 .driver = {
105 .name = "thmc50",
106 },
107 .probe = thmc50_probe,
108 .remove = thmc50_remove,
109 .id_table = thmc50_id,
110 .detect = thmc50_detect,
111 .address_list = normal_i2c,
112};
113
114static ssize_t show_analog_out(struct device *dev,
115 struct device_attribute *attr, char *buf)
116{
117 struct thmc50_data *data = thmc50_update_device(dev);
118 return sprintf(buf, "%d\n", data->analog_out);
119}
120
121static ssize_t set_analog_out(struct device *dev,
122 struct device_attribute *attr,
123 const char *buf, size_t count)
124{
125 struct i2c_client *client = to_i2c_client(dev);
126 struct thmc50_data *data = i2c_get_clientdata(client);
127 int config;
128 unsigned long tmp;
129 int err;
130
131 err = kstrtoul(buf, 10, &tmp);
132 if (err)
133 return err;
134
135 mutex_lock(&data->update_lock);
136 data->analog_out = SENSORS_LIMIT(tmp, 0, 255);
137 i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
138 data->analog_out);
139
140 config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
141 if (data->analog_out == 0)
142 config &= ~THMC50_REG_CONF_nFANOFF;
143 else
144 config |= THMC50_REG_CONF_nFANOFF;
145 i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
146
147 mutex_unlock(&data->update_lock);
148 return count;
149}
150
151
152static ssize_t show_pwm_mode(struct device *dev, struct device_attribute *attr,
153 char *buf)
154{
155 return sprintf(buf, "0\n");
156}
157
158
159static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
160 char *buf)
161{
162 int nr = to_sensor_dev_attr(attr)->index;
163 struct thmc50_data *data = thmc50_update_device(dev);
164 return sprintf(buf, "%d\n", data->temp_input[nr] * 1000);
165}
166
167static ssize_t show_temp_min(struct device *dev, struct device_attribute *attr,
168 char *buf)
169{
170 int nr = to_sensor_dev_attr(attr)->index;
171 struct thmc50_data *data = thmc50_update_device(dev);
172 return sprintf(buf, "%d\n", data->temp_min[nr] * 1000);
173}
174
175static ssize_t set_temp_min(struct device *dev, struct device_attribute *attr,
176 const char *buf, size_t count)
177{
178 int nr = to_sensor_dev_attr(attr)->index;
179 struct i2c_client *client = to_i2c_client(dev);
180 struct thmc50_data *data = i2c_get_clientdata(client);
181 long val;
182 int err;
183
184 err = kstrtol(buf, 10, &val);
185 if (err)
186 return err;
187
188 mutex_lock(&data->update_lock);
189 data->temp_min[nr] = SENSORS_LIMIT(val / 1000, -128, 127);
190 i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MIN[nr],
191 data->temp_min[nr]);
192 mutex_unlock(&data->update_lock);
193 return count;
194}
195
196static ssize_t show_temp_max(struct device *dev, struct device_attribute *attr,
197 char *buf)
198{
199 int nr = to_sensor_dev_attr(attr)->index;
200 struct thmc50_data *data = thmc50_update_device(dev);
201 return sprintf(buf, "%d\n", data->temp_max[nr] * 1000);
202}
203
204static ssize_t set_temp_max(struct device *dev, struct device_attribute *attr,
205 const char *buf, size_t count)
206{
207 int nr = to_sensor_dev_attr(attr)->index;
208 struct i2c_client *client = to_i2c_client(dev);
209 struct thmc50_data *data = i2c_get_clientdata(client);
210 long val;
211 int err;
212
213 err = kstrtol(buf, 10, &val);
214 if (err)
215 return err;
216
217 mutex_lock(&data->update_lock);
218 data->temp_max[nr] = SENSORS_LIMIT(val / 1000, -128, 127);
219 i2c_smbus_write_byte_data(client, THMC50_REG_TEMP_MAX[nr],
220 data->temp_max[nr]);
221 mutex_unlock(&data->update_lock);
222 return count;
223}
224
225static ssize_t show_temp_critical(struct device *dev,
226 struct device_attribute *attr,
227 char *buf)
228{
229 int nr = to_sensor_dev_attr(attr)->index;
230 struct thmc50_data *data = thmc50_update_device(dev);
231 return sprintf(buf, "%d\n", data->temp_critical[nr] * 1000);
232}
233
234static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
235 char *buf)
236{
237 int index = to_sensor_dev_attr(attr)->index;
238 struct thmc50_data *data = thmc50_update_device(dev);
239
240 return sprintf(buf, "%u\n", (data->alarms >> index) & 1);
241}
242
243#define temp_reg(offset) \
244static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, show_temp, \
245 NULL, offset - 1); \
246static SENSOR_DEVICE_ATTR(temp##offset##_min, S_IRUGO | S_IWUSR, \
247 show_temp_min, set_temp_min, offset - 1); \
248static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
249 show_temp_max, set_temp_max, offset - 1); \
250static SENSOR_DEVICE_ATTR(temp##offset##_crit, S_IRUGO, \
251 show_temp_critical, NULL, offset - 1);
252
253temp_reg(1);
254temp_reg(2);
255temp_reg(3);
256
257static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 0);
258static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
259static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_alarm, NULL, 1);
260static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_alarm, NULL, 7);
261static SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_alarm, NULL, 2);
262
263static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_analog_out,
264 set_analog_out, 0);
265static SENSOR_DEVICE_ATTR(pwm1_mode, S_IRUGO, show_pwm_mode, NULL, 0);
266
267static struct attribute *thmc50_attributes[] = {
268 &sensor_dev_attr_temp1_max.dev_attr.attr,
269 &sensor_dev_attr_temp1_min.dev_attr.attr,
270 &sensor_dev_attr_temp1_input.dev_attr.attr,
271 &sensor_dev_attr_temp1_crit.dev_attr.attr,
272 &sensor_dev_attr_temp1_alarm.dev_attr.attr,
273 &sensor_dev_attr_temp2_max.dev_attr.attr,
274 &sensor_dev_attr_temp2_min.dev_attr.attr,
275 &sensor_dev_attr_temp2_input.dev_attr.attr,
276 &sensor_dev_attr_temp2_crit.dev_attr.attr,
277 &sensor_dev_attr_temp2_alarm.dev_attr.attr,
278 &sensor_dev_attr_temp2_fault.dev_attr.attr,
279 &sensor_dev_attr_pwm1.dev_attr.attr,
280 &sensor_dev_attr_pwm1_mode.dev_attr.attr,
281 NULL
282};
283
284static const struct attribute_group thmc50_group = {
285 .attrs = thmc50_attributes,
286};
287
288
289static struct attribute *temp3_attributes[] = {
290 &sensor_dev_attr_temp3_max.dev_attr.attr,
291 &sensor_dev_attr_temp3_min.dev_attr.attr,
292 &sensor_dev_attr_temp3_input.dev_attr.attr,
293 &sensor_dev_attr_temp3_crit.dev_attr.attr,
294 &sensor_dev_attr_temp3_alarm.dev_attr.attr,
295 &sensor_dev_attr_temp3_fault.dev_attr.attr,
296 NULL
297};
298
299static const struct attribute_group temp3_group = {
300 .attrs = temp3_attributes,
301};
302
303
304static int thmc50_detect(struct i2c_client *client,
305 struct i2c_board_info *info)
306{
307 unsigned company;
308 unsigned revision;
309 unsigned config;
310 struct i2c_adapter *adapter = client->adapter;
311 const char *type_name;
312
313 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
314 pr_debug("thmc50: detect failed, "
315 "smbus byte data not supported!\n");
316 return -ENODEV;
317 }
318
319 pr_debug("thmc50: Probing for THMC50 at 0x%2X on bus %d\n",
320 client->addr, i2c_adapter_id(client->adapter));
321
322 company = i2c_smbus_read_byte_data(client, THMC50_REG_COMPANY_ID);
323 revision = i2c_smbus_read_byte_data(client, THMC50_REG_DIE_CODE);
324 config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
325 if (revision < 0xc0 || (config & 0x10))
326 return -ENODEV;
327
328 if (company == 0x41) {
329 int id = i2c_adapter_id(client->adapter);
330 int i;
331
332 type_name = "adm1022";
333 for (i = 0; i + 1 < adm1022_temp3_num; i += 2)
334 if (adm1022_temp3[i] == id &&
335 adm1022_temp3[i + 1] == client->addr) {
336
337 config |= (1 << 7);
338 i2c_smbus_write_byte_data(client,
339 THMC50_REG_CONF,
340 config);
341 break;
342 }
343 } else if (company == 0x49) {
344 type_name = "thmc50";
345 } else {
346 pr_debug("thmc50: Detection of THMC50/ADM1022 failed\n");
347 return -ENODEV;
348 }
349
350 pr_debug("thmc50: Detected %s (version %x, revision %x)\n",
351 type_name, (revision >> 4) - 0xc, revision & 0xf);
352
353 strlcpy(info->type, type_name, I2C_NAME_SIZE);
354
355 return 0;
356}
357
358static int thmc50_probe(struct i2c_client *client,
359 const struct i2c_device_id *id)
360{
361 struct thmc50_data *data;
362 int err;
363
364 data = devm_kzalloc(&client->dev, sizeof(struct thmc50_data),
365 GFP_KERNEL);
366 if (!data)
367 return -ENOMEM;
368
369 i2c_set_clientdata(client, data);
370 data->type = id->driver_data;
371 mutex_init(&data->update_lock);
372
373 thmc50_init_client(client);
374
375
376 err = sysfs_create_group(&client->dev.kobj, &thmc50_group);
377 if (err)
378 return err;
379
380
381 if (data->has_temp3) {
382 err = sysfs_create_group(&client->dev.kobj, &temp3_group);
383 if (err)
384 goto exit_remove_sysfs_thmc50;
385 }
386
387
388 data->hwmon_dev = hwmon_device_register(&client->dev);
389 if (IS_ERR(data->hwmon_dev)) {
390 err = PTR_ERR(data->hwmon_dev);
391 goto exit_remove_sysfs;
392 }
393
394 return 0;
395
396exit_remove_sysfs:
397 if (data->has_temp3)
398 sysfs_remove_group(&client->dev.kobj, &temp3_group);
399exit_remove_sysfs_thmc50:
400 sysfs_remove_group(&client->dev.kobj, &thmc50_group);
401 return err;
402}
403
404static int thmc50_remove(struct i2c_client *client)
405{
406 struct thmc50_data *data = i2c_get_clientdata(client);
407
408 hwmon_device_unregister(data->hwmon_dev);
409 sysfs_remove_group(&client->dev.kobj, &thmc50_group);
410 if (data->has_temp3)
411 sysfs_remove_group(&client->dev.kobj, &temp3_group);
412
413 return 0;
414}
415
416static void thmc50_init_client(struct i2c_client *client)
417{
418 struct thmc50_data *data = i2c_get_clientdata(client);
419 int config;
420
421 data->analog_out = i2c_smbus_read_byte_data(client,
422 THMC50_REG_ANALOG_OUT);
423
424 if (data->analog_out == 0) {
425 data->analog_out = 1;
426 i2c_smbus_write_byte_data(client, THMC50_REG_ANALOG_OUT,
427 data->analog_out);
428 }
429 config = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
430 config |= 0x1;
431 if (data->type == adm1022 && (config & (1 << 7)))
432 data->has_temp3 = 1;
433 i2c_smbus_write_byte_data(client, THMC50_REG_CONF, config);
434}
435
436static struct thmc50_data *thmc50_update_device(struct device *dev)
437{
438 struct i2c_client *client = to_i2c_client(dev);
439 struct thmc50_data *data = i2c_get_clientdata(client);
440 int timeout = HZ / 5 + (data->type == thmc50 ? HZ : 0);
441
442 mutex_lock(&data->update_lock);
443
444 if (time_after(jiffies, data->last_updated + timeout)
445 || !data->valid) {
446
447 int temps = data->has_temp3 ? 3 : 2;
448 int i;
449 int prog = i2c_smbus_read_byte_data(client, THMC50_REG_CONF);
450
451 prog &= THMC50_REG_CONF_PROGRAMMED;
452
453 for (i = 0; i < temps; i++) {
454 data->temp_input[i] = i2c_smbus_read_byte_data(client,
455 THMC50_REG_TEMP[i]);
456 data->temp_max[i] = i2c_smbus_read_byte_data(client,
457 THMC50_REG_TEMP_MAX[i]);
458 data->temp_min[i] = i2c_smbus_read_byte_data(client,
459 THMC50_REG_TEMP_MIN[i]);
460 data->temp_critical[i] =
461 i2c_smbus_read_byte_data(client,
462 prog ? THMC50_REG_TEMP_CRITICAL[i]
463 : THMC50_REG_TEMP_DEFAULT[i]);
464 }
465 data->analog_out =
466 i2c_smbus_read_byte_data(client, THMC50_REG_ANALOG_OUT);
467 data->alarms =
468 i2c_smbus_read_byte_data(client, THMC50_REG_INTR);
469 data->last_updated = jiffies;
470 data->valid = 1;
471 }
472
473 mutex_unlock(&data->update_lock);
474
475 return data;
476}
477
478module_i2c_driver(thmc50_driver);
479
480MODULE_AUTHOR("Krzysztof Helt <krzysztof.h1@wp.pl>");
481MODULE_DESCRIPTION("THMC50 driver");
482
