19df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* 2bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * emc2103.c - Support for SMSC EMC2103 3bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * Copyright (c) 2010 SMSC 4bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * 5bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * This program is free software; you can redistribute it and/or modify 6bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * it under the terms of the GNU General Public License as published by 7bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * the Free Software Foundation; either version 2 of the License, or 8bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * (at your option) any later version. 9bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * 10bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * This program is distributed in the hope that it will be useful, 11bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * but WITHOUT ANY WARRANTY; without even the implied warranty of 12bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * GNU General Public License for more details. 14bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * 15bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * You should have received a copy of the GNU General Public License 16bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * along with this program; if not, write to the Free Software 17bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 18bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck */ 199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/module.h> 219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/init.h> 229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/slab.h> 239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/jiffies.h> 249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/i2c.h> 259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/hwmon.h> 269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/hwmon-sysfs.h> 279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/err.h> 289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#include <linux/mutex.h> 299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* Addresses scanned */ 319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const unsigned short normal_i2c[] = { 0x2E, I2C_CLIENT_END }; 329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const u8 REG_TEMP[4] = { 0x00, 0x02, 0x04, 0x06 }; 349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const u8 REG_TEMP_MIN[4] = { 0x3c, 0x38, 0x39, 0x3a }; 359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const u8 REG_TEMP_MAX[4] = { 0x34, 0x30, 0x31, 0x32 }; 369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_CONF1 0x20 389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_TEMP_MAX_ALARM 0x24 399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_TEMP_MIN_ALARM 0x25 409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_FAN_CONF1 0x42 419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_FAN_TARGET_LO 0x4c 429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_FAN_TARGET_HI 0x4d 439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_FAN_TACH_HI 0x4e 449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_FAN_TACH_LO 0x4f 459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_PRODUCT_ID 0xfd 469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define REG_MFG_ID 0xfe 479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* equation 4 from datasheet: rpm = (3932160 * multipler) / count */ 499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning#define FAN_RPM_FACTOR 3932160 509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 51bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck/* 52bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * 2103-2 and 2103-4's 3rd temperature sensor can be connected to two diodes 539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning * in anti-parallel mode, and in this configuration both can be read 549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning * independently (so we have 4 temperature inputs). The device can't 559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning * detect if it's connected in this mode, so we have to manually enable 569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning * it. Default is to leave the device in the state it's already in (-1). 57bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * This parameter allows APD mode to be optionally forced on or off 58bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck */ 599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic int apd = -1; 6069116f279a9eaf4c540934269342d9149538fc79Rusty Russellmodule_param(apd, bint, 0); 619df7305b5a8651eb940e98496bc1d4742379c578Steve GlendinningMODULE_PARM_DESC(init, "Set to zero to disable anti-parallel diode mode"); 629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstruct temperature { 649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning s8 degrees; 659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 fraction; /* 0-7 multiples of 0.125 */ 669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstruct emc2103_data { 699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct device *hwmon_dev; 709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct mutex update_lock; 719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool valid; /* registers are valid */ 729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool fan_rpm_control; 739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int temp_count; /* num of temp sensors */ 749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning unsigned long last_updated; /* in jiffies */ 759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct temperature temp[4]; /* internal + 3 external */ 769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning s8 temp_min[4]; /* no fractional part */ 779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning s8 temp_max[4]; /* no fractional part */ 789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 temp_min_alarm; 799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 temp_max_alarm; 809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 fan_multiplier; 819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u16 fan_tach; 829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u16 fan_target; 839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic int read_u8_from_i2c(struct i2c_client *client, u8 i2c_reg, u8 *output) 869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int status = i2c_smbus_read_byte_data(client, i2c_reg); 889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status < 0) { 899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning dev_warn(&client->dev, "reg 0x%02x, err %d\n", 909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_reg, status); 919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } else { 929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning *output = status; 939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return status; 959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic void read_temp_from_i2c(struct i2c_client *client, u8 i2c_reg, 989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct temperature *temp) 999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 degrees, fractional; 1019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (read_u8_from_i2c(client, i2c_reg, °rees) < 0) 1039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return; 1049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (read_u8_from_i2c(client, i2c_reg + 1, &fractional) < 0) 1069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return; 1079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning temp->degrees = degrees; 1099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning temp->fraction = (fractional & 0xe0) >> 5; 1109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic void read_fan_from_i2c(struct i2c_client *client, u16 *output, 1139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 hi_addr, u8 lo_addr) 1149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 high_byte, lo_byte; 1169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (read_u8_from_i2c(client, hi_addr, &high_byte) < 0) 1189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return; 1199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (read_u8_from_i2c(client, lo_addr, &lo_byte) < 0) 1219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return; 1229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning *output = ((u16)high_byte << 5) | (lo_byte >> 3); 1249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic void write_fan_target_to_i2c(struct i2c_client *client, u16 new_target) 1279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 high_byte = (new_target & 0x1fe0) >> 5; 1299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 low_byte = (new_target & 0x001f) << 3; 1309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_FAN_TARGET_LO, low_byte); 1319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_FAN_TARGET_HI, high_byte); 1329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic void read_fan_config_from_i2c(struct i2c_client *client) 1359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 1389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 conf1; 1399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (read_u8_from_i2c(client, REG_FAN_CONF1, &conf1) < 0) 1419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return; 1429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_multiplier = 1 << ((conf1 & 0x60) >> 5); 1449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_rpm_control = (conf1 & 0x80) != 0; 1459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic struct emc2103_data *emc2103_update_device(struct device *dev) 1489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 1509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 1519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 1539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (time_after(jiffies, data->last_updated + HZ + HZ / 2) 1559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning || !data->valid) { 1569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int i; 1579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning for (i = 0; i < data->temp_count; i++) { 1599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_temp_from_i2c(client, REG_TEMP[i], &data->temp[i]); 1609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_u8_from_i2c(client, REG_TEMP_MIN[i], 1619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &data->temp_min[i]); 1629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_u8_from_i2c(client, REG_TEMP_MAX[i], 1639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &data->temp_max[i]); 1649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 1659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_u8_from_i2c(client, REG_TEMP_MIN_ALARM, 1679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &data->temp_min_alarm); 1689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_u8_from_i2c(client, REG_TEMP_MAX_ALARM, 1699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &data->temp_max_alarm); 1709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_fan_from_i2c(client, &data->fan_tach, 1729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning REG_FAN_TACH_HI, REG_FAN_TACH_LO); 1739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_fan_from_i2c(client, &data->fan_target, 1749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning REG_FAN_TARGET_HI, REG_FAN_TARGET_LO); 1759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_fan_config_from_i2c(client); 1769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->last_updated = jiffies; 1789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->valid = true; 1799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 1809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 1829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return data; 1849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 1879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp(struct device *dev, struct device_attribute *da, char *buf) 1889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 1909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 1919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int millidegrees = data->temp[nr].degrees * 1000 1929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning + data->temp[nr].fraction * 125; 1939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", millidegrees); 1949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 1959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 1969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 1979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp_min(struct device *dev, struct device_attribute *da, char *buf) 1989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 1999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int millidegrees = data->temp_min[nr] * 1000; 2029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", millidegrees); 2039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 2069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp_max(struct device *dev, struct device_attribute *da, char *buf) 2079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int millidegrees = data->temp_max[nr] * 1000; 2119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", millidegrees); 2129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 2159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp_fault(struct device *dev, struct device_attribute *da, char *buf) 2169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool fault = (data->temp[nr].degrees == -128); 2209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", fault ? 1 : 0); 2219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 2249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp_min_alarm(struct device *dev, struct device_attribute *da, char *buf) 2259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool alarm = data->temp_min_alarm & (1 << nr); 2299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", alarm ? 1 : 0); 2309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 2339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_temp_max_alarm(struct device *dev, struct device_attribute *da, char *buf) 2349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool alarm = data->temp_max_alarm & (1 << nr); 2389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", alarm ? 1 : 0); 2399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t set_temp_min(struct device *dev, struct device_attribute *da, 2429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning const char *buf, size_t count) 2439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 2469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 2479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning long val; 2489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 249179c4fdb565dd2157e5dfe89318b74868e3b523dFrans Meulenbroeks int result = kstrtol(buf, 10, &val); 2509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (result < 0) 2519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 2529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning val = DIV_ROUND_CLOSEST(val, 1000); 2549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((val < -63) || (val > 127)) 2559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 2569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 2589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_min[nr] = val; 2599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_TEMP_MIN[nr], val); 2609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 2619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 2639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t set_temp_max(struct device *dev, struct device_attribute *da, 2669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning const char *buf, size_t count) 2679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int nr = to_sensor_dev_attr(da)->index; 2699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 2709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 2719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning long val; 2729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 273179c4fdb565dd2157e5dfe89318b74868e3b523dFrans Meulenbroeks int result = kstrtol(buf, 10, &val); 2749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (result < 0) 2759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 2769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning val = DIV_ROUND_CLOSEST(val, 1000); 2789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((val < -63) || (val > 127)) 2799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 2809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 2829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_max[nr] = val; 2839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_TEMP_MAX[nr], val); 2849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 2859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 2879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 2909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_fan(struct device *dev, struct device_attribute *da, char *buf) 2919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 2929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 2939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int rpm = 0; 2949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->fan_tach != 0) 2959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning rpm = (FAN_RPM_FACTOR * data->fan_multiplier) / data->fan_tach; 2969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", rpm); 2979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 2989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 2999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 3009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_fan_div(struct device *dev, struct device_attribute *da, char *buf) 3019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 3029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 3039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int fan_div = 8 / data->fan_multiplier; 3049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", fan_div); 3059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 3069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 307bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck/* 308bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * Note: we also update the fan target here, because its value is 309bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * determined in part by the fan clock divider. This follows the principle 310bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * of least surprise; the user doesn't expect the fan target to change just 311bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck * because the divider changed. 312bf0f3a0430b7cc33fd65d21acfd41840cba76d48Guenter Roeck */ 3139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t set_fan_div(struct device *dev, struct device_attribute *da, 3149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning const char *buf, size_t count) 3159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 3169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 3179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 3189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int new_range_bits, old_div = 8 / data->fan_multiplier; 3199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning long new_div; 3209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 321179c4fdb565dd2157e5dfe89318b74868e3b523dFrans Meulenbroeks int status = kstrtol(buf, 10, &new_div); 3229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status < 0) 3239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 3249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (new_div == old_div) /* No change */ 3269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 3279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning switch (new_div) { 3299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 1: 3309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning new_range_bits = 3; 3319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 3329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 2: 3339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning new_range_bits = 2; 3349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 3359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 4: 3369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning new_range_bits = 1; 3379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 3389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 8: 3399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning new_range_bits = 0; 3409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 3419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning default: 3429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 3439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 3449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 3469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = i2c_smbus_read_byte_data(client, REG_FAN_CONF1); 3489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status < 0) { 3499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning dev_dbg(&client->dev, "reg 0x%02x, err %d\n", 3509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning REG_FAN_CONF1, status); 3519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 3529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EIO; 3539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 3549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status &= 0x9F; 3559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status |= (new_range_bits << 5); 3569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_FAN_CONF1, status); 3579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_multiplier = 8 / new_div; 3599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* update fan target if high byte is not disabled */ 3619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((data->fan_target & 0x1fe0) != 0x1fe0) { 3629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u16 new_target = (data->fan_target * old_div) / new_div; 3639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_target = min(new_target, (u16)0x1fff); 3649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning write_fan_target_to_i2c(client, data->fan_target); 3659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 3669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* invalidate data to force re-read from hardware */ 3689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->valid = false; 3699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 3719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 3729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 3739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 3759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_fan_target(struct device *dev, struct device_attribute *da, char *buf) 3769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 3779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 3789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int rpm = 0; 3799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* high byte of 0xff indicates disabled so return 0 */ 3819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((data->fan_target != 0) && ((data->fan_target & 0x1fe0) != 0x1fe0)) 3829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning rpm = (FAN_RPM_FACTOR * data->fan_multiplier) 3839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning / data->fan_target; 3849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", rpm); 3869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 3879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t set_fan_target(struct device *dev, struct device_attribute *da, 3899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning const char *buf, size_t count) 3909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 3919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 3929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 3939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning long rpm_target; 3949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 395179c4fdb565dd2157e5dfe89318b74868e3b523dFrans Meulenbroeks int result = kstrtol(buf, 10, &rpm_target); 3969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (result < 0) 3979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 3989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 3999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* Datasheet states 16384 as maximum RPM target (table 3.2) */ 4009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((rpm_target < 0) || (rpm_target > 16384)) 4019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 4029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 4049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (rpm_target == 0) 4069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_target = 0x1fff; 4079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning else 4089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_target = SENSORS_LIMIT( 4099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning (FAN_RPM_FACTOR * data->fan_multiplier) / rpm_target, 4109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 0, 0x1fff); 4119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning write_fan_target_to_i2c(client, data->fan_target); 4139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 4159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 4169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 4179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 4199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_fan_fault(struct device *dev, struct device_attribute *da, char *buf) 4209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 4219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 4229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning bool fault = ((data->fan_tach & 0x1fe0) == 0x1fe0); 4239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", fault ? 1 : 0); 4249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 4259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t 4279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningshow_pwm_enable(struct device *dev, struct device_attribute *da, char *buf) 4289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 4299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = emc2103_update_device(dev); 4309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return sprintf(buf, "%d\n", data->fan_rpm_control ? 3 : 0); 4319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 4329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic ssize_t set_pwm_enable(struct device *dev, struct device_attribute *da, 4349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning const char *buf, size_t count) 4359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 4369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_client *client = to_i2c_client(dev); 4379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 4389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning long new_value; 4399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning u8 conf_reg; 4409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 441179c4fdb565dd2157e5dfe89318b74868e3b523dFrans Meulenbroeks int result = kstrtol(buf, 10, &new_value); 4429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (result < 0) 4439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 4449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_lock(&data->update_lock); 4469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning switch (new_value) { 4479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 0: 4489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_rpm_control = false; 4499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 4509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning case 3: 4519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->fan_rpm_control = true; 4529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning break; 4539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning default: 4549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 4559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EINVAL; 4569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 4579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning read_u8_from_i2c(client, REG_FAN_CONF1, &conf_reg); 4599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->fan_rpm_control) 4619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning conf_reg |= 0x80; 4629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning else 4639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning conf_reg &= ~0x80; 4649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_FAN_CONF1, conf_reg); 4669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_unlock(&data->update_lock); 4689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return count; 4699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 4709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp, NULL, 0); 4729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_min, S_IRUGO | S_IWUSR, show_temp_min, 4739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_min, 0); 4749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_max, S_IRUGO | S_IWUSR, show_temp_max, 4759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_max, 0); 4769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0); 4779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_min_alarm, S_IRUGO, show_temp_min_alarm, 4789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 0); 4799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_temp_max_alarm, 4809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 0); 4819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp, NULL, 1); 4839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_min, S_IRUGO | S_IWUSR, show_temp_min, 4849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_min, 1); 4859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_max, S_IRUGO | S_IWUSR, show_temp_max, 4869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_max, 1); 4879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_temp_fault, NULL, 1); 4889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_min_alarm, S_IRUGO, show_temp_min_alarm, 4899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 1); 4909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_temp_max_alarm, 4919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 1); 4929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 4939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_input, S_IRUGO, show_temp, NULL, 2); 4949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_min, S_IRUGO | S_IWUSR, show_temp_min, 4959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_min, 2); 4969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_max, S_IRUGO | S_IWUSR, show_temp_max, 4979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_max, 2); 4989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_fault, S_IRUGO, show_temp_fault, NULL, 2); 4999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_min_alarm, S_IRUGO, show_temp_min_alarm, 5009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 2); 5019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp3_max_alarm, S_IRUGO, show_temp_max_alarm, 5029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 2); 5039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_input, S_IRUGO, show_temp, NULL, 3); 5059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_min, S_IRUGO | S_IWUSR, show_temp_min, 5069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_min, 3); 5079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_max, S_IRUGO | S_IWUSR, show_temp_max, 5089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_temp_max, 3); 5099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_fault, S_IRUGO, show_temp_fault, NULL, 3); 5109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_min_alarm, S_IRUGO, show_temp_min_alarm, 5119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 3); 5129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic SENSOR_DEVICE_ATTR(temp4_max_alarm, S_IRUGO, show_temp_max_alarm, 5139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL, 3); 5149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL); 5169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR, show_fan_div, set_fan_div); 5179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic DEVICE_ATTR(fan1_target, S_IRUGO | S_IWUSR, show_fan_target, 5189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_fan_target); 5199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic DEVICE_ATTR(fan1_fault, S_IRUGO, show_fan_fault, NULL); 5209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic DEVICE_ATTR(pwm1_enable, S_IRUGO | S_IWUSR, show_pwm_enable, 5229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning set_pwm_enable); 5239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* sensors present on all models */ 5259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic struct attribute *emc2103_attributes[] = { 5269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_input.dev_attr.attr, 5279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_min.dev_attr.attr, 5289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_max.dev_attr.attr, 5299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_fault.dev_attr.attr, 5309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_min_alarm.dev_attr.attr, 5319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp1_max_alarm.dev_attr.attr, 5329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_input.dev_attr.attr, 5339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_min.dev_attr.attr, 5349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_max.dev_attr.attr, 5359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_fault.dev_attr.attr, 5369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_min_alarm.dev_attr.attr, 5379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp2_max_alarm.dev_attr.attr, 5389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &dev_attr_fan1_input.attr, 5399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &dev_attr_fan1_div.attr, 5409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &dev_attr_fan1_target.attr, 5419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &dev_attr_fan1_fault.attr, 5429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &dev_attr_pwm1_enable.attr, 5439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL 5449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* extra temperature sensors only present on 2103-2 and 2103-4 */ 5479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic struct attribute *emc2103_attributes_temp3[] = { 5489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_input.dev_attr.attr, 5499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_min.dev_attr.attr, 5509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_max.dev_attr.attr, 5519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_fault.dev_attr.attr, 5529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_min_alarm.dev_attr.attr, 5539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp3_max_alarm.dev_attr.attr, 5549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL 5559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* extra temperature sensors only present on 2103-2 and 2103-4 in APD mode */ 5589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic struct attribute *emc2103_attributes_temp4[] = { 5599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_input.dev_attr.attr, 5609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_min.dev_attr.attr, 5619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_max.dev_attr.attr, 5629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_fault.dev_attr.attr, 5639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_min_alarm.dev_attr.attr, 5649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &sensor_dev_attr_temp4_max_alarm.dev_attr.attr, 5659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning NULL 5669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const struct attribute_group emc2103_group = { 5699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .attrs = emc2103_attributes, 5709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const struct attribute_group emc2103_temp3_group = { 5739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .attrs = emc2103_attributes_temp3, 5749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const struct attribute_group emc2103_temp4_group = { 5779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .attrs = emc2103_attributes_temp4, 5789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 5799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic int 5819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningemc2103_probe(struct i2c_client *client, const struct i2c_device_id *id) 5829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 5839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data; 5849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int status; 5859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 5879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -EIO; 5889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data = kzalloc(sizeof(struct emc2103_data), GFP_KERNEL); 5909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (!data) 5919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -ENOMEM; 5929df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_set_clientdata(client, data); 5949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning mutex_init(&data->update_lock); 5959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 5969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* 2103-2 and 2103-4 have 3 external diodes, 2103-1 has 1 */ 5979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = i2c_smbus_read_byte_data(client, REG_PRODUCT_ID); 5989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status == 0x24) { 5999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* 2103-1 only has 1 external diode */ 6009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_count = 2; 6019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } else { 6029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* 2103-2 and 2103-4 have 3 or 4 external diodes */ 6039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = i2c_smbus_read_byte_data(client, REG_CONF1); 6049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status < 0) { 6059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning dev_dbg(&client->dev, "reg 0x%02x, err %d\n", REG_CONF1, 6069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status); 6079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning goto exit_free; 6089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* detect current state of hardware */ 6119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_count = (status & 0x01) ? 4 : 3; 6129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* force APD state if module parameter is set */ 6149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (apd == 0) { 6159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* force APD mode off */ 6169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_count = 3; 6179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status &= ~(0x01); 6189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_CONF1, status); 6199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } else if (apd == 1) { 6209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* force APD mode on */ 6219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->temp_count = 4; 6229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status |= 0x01; 6239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning i2c_smbus_write_byte_data(client, REG_CONF1, status); 6249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning /* Register sysfs hooks */ 6289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = sysfs_create_group(&client->dev.kobj, &emc2103_group); 6299df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status) 6309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning goto exit_free; 6319df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6329df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count >= 3) { 6339df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = sysfs_create_group(&client->dev.kobj, 6349df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &emc2103_temp3_group); 6359df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status) 6369df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning goto exit_remove; 6379df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6389df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6399df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count == 4) { 6409df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = sysfs_create_group(&client->dev.kobj, 6419df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning &emc2103_temp4_group); 6429df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (status) 6439df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning goto exit_remove_temp3; 6449df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6459df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6469df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning data->hwmon_dev = hwmon_device_register(&client->dev); 6479df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (IS_ERR(data->hwmon_dev)) { 6489df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning status = PTR_ERR(data->hwmon_dev); 6499df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning goto exit_remove_temp4; 6509df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning } 6519df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6529df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning dev_info(&client->dev, "%s: sensor '%s'\n", 6539df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning dev_name(data->hwmon_dev), client->name); 6549df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6559df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return 0; 6569df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6579df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningexit_remove_temp4: 6589df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count == 4) 6599df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_temp4_group); 6609df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningexit_remove_temp3: 6619df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count >= 3) 6629df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_temp3_group); 6639df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningexit_remove: 6649df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_group); 6659df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningexit_free: 6669df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning kfree(data); 6679df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return status; 6689df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 6699df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6709df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic int emc2103_remove(struct i2c_client *client) 6719df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 6729df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct emc2103_data *data = i2c_get_clientdata(client); 6739df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6749df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning hwmon_device_unregister(data->hwmon_dev); 6759df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6769df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count == 4) 6779df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_temp4_group); 6789df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6799df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (data->temp_count >= 3) 6809df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_temp3_group); 6819df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6829df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning sysfs_remove_group(&client->dev.kobj, &emc2103_group); 6839df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6849df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning kfree(data); 6859df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return 0; 6869df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 6879df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6889df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic const struct i2c_device_id emc2103_ids[] = { 6899df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning { "emc2103", 0, }, 6909df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning { /* LIST END */ } 6919df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 6929df7305b5a8651eb940e98496bc1d4742379c578Steve GlendinningMODULE_DEVICE_TABLE(i2c, emc2103_ids); 6939df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 6949df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning/* Return 0 if detection is successful, -ENODEV otherwise */ 6959df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic int 6969df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningemc2103_detect(struct i2c_client *new_client, struct i2c_board_info *info) 6979df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning{ 6989df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning struct i2c_adapter *adapter = new_client->adapter; 6999df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning int manufacturer, product; 7009df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7019df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 7029df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -ENODEV; 7039df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7049df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning manufacturer = i2c_smbus_read_byte_data(new_client, REG_MFG_ID); 7059df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if (manufacturer != 0x5D) 7069df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -ENODEV; 7079df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7089df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning product = i2c_smbus_read_byte_data(new_client, REG_PRODUCT_ID); 7099df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning if ((product != 0x24) && (product != 0x26)) 7109df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return -ENODEV; 7119df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7129df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning strlcpy(info->type, "emc2103", I2C_NAME_SIZE); 7139df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7149df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning return 0; 7159df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning} 7169df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7179df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinningstatic struct i2c_driver emc2103_driver = { 7189df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .class = I2C_CLASS_HWMON, 7199df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .driver = { 7209df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .name = "emc2103", 7219df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning }, 7229df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .probe = emc2103_probe, 7239df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .remove = emc2103_remove, 7249df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .id_table = emc2103_ids, 7259df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .detect = emc2103_detect, 7269df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning .address_list = normal_i2c, 7279df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning}; 7289df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 729f0967eea80ec2a19a4fe1ad27e3ff1b22c79a3c7Axel Linmodule_i2c_driver(emc2103_driver); 7309df7305b5a8651eb940e98496bc1d4742379c578Steve Glendinning 7319df7305b5a8651eb940e98496bc1d4742379c578Steve GlendinningMODULE_AUTHOR("Steve Glendinning <steve.glendinning@smsc.com>"); 7329df7305b5a8651eb940e98496bc1d4742379c578Steve GlendinningMODULE_DESCRIPTION("SMSC EMC2103 hwmon driver"); 7339df7305b5a8651eb940e98496bc1d4742379c578Steve GlendinningMODULE_LICENSE("GPL"); 734