1*c942fddfSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2aaf6fabfSChris Packham /* 3aaf6fabfSChris Packham * tc654.c - Linux kernel modules for fan speed controller 4aaf6fabfSChris Packham * 5aaf6fabfSChris Packham * Copyright (C) 2016 Allied Telesis Labs NZ 6aaf6fabfSChris Packham */ 7aaf6fabfSChris Packham 8aaf6fabfSChris Packham #include <linux/bitops.h> 9aaf6fabfSChris Packham #include <linux/err.h> 10aaf6fabfSChris Packham #include <linux/hwmon.h> 11aaf6fabfSChris Packham #include <linux/hwmon-sysfs.h> 12aaf6fabfSChris Packham #include <linux/i2c.h> 13aaf6fabfSChris Packham #include <linux/init.h> 14aaf6fabfSChris Packham #include <linux/jiffies.h> 15aaf6fabfSChris Packham #include <linux/module.h> 16aaf6fabfSChris Packham #include <linux/mutex.h> 17aaf6fabfSChris Packham #include <linux/slab.h> 18aaf6fabfSChris Packham #include <linux/util_macros.h> 19aaf6fabfSChris Packham 20aaf6fabfSChris Packham enum tc654_regs { 21aaf6fabfSChris Packham TC654_REG_RPM1 = 0x00, /* RPM Output 1 */ 22aaf6fabfSChris Packham TC654_REG_RPM2 = 0x01, /* RPM Output 2 */ 23aaf6fabfSChris Packham TC654_REG_FAN_FAULT1 = 0x02, /* Fan Fault 1 Threshold */ 24aaf6fabfSChris Packham TC654_REG_FAN_FAULT2 = 0x03, /* Fan Fault 2 Threshold */ 25aaf6fabfSChris Packham TC654_REG_CONFIG = 0x04, /* Configuration */ 26aaf6fabfSChris Packham TC654_REG_STATUS = 0x05, /* Status */ 27aaf6fabfSChris Packham TC654_REG_DUTY_CYCLE = 0x06, /* Fan Speed Duty Cycle */ 28aaf6fabfSChris Packham TC654_REG_MFR_ID = 0x07, /* Manufacturer Identification */ 29aaf6fabfSChris Packham TC654_REG_VER_ID = 0x08, /* Version Identification */ 30aaf6fabfSChris Packham }; 31aaf6fabfSChris Packham 32aaf6fabfSChris Packham /* Macros to easily index the registers */ 33aaf6fabfSChris Packham #define TC654_REG_RPM(idx) (TC654_REG_RPM1 + (idx)) 34aaf6fabfSChris Packham #define TC654_REG_FAN_FAULT(idx) (TC654_REG_FAN_FAULT1 + (idx)) 35aaf6fabfSChris Packham 36aaf6fabfSChris Packham /* Config register bits */ 37aaf6fabfSChris Packham #define TC654_REG_CONFIG_RES BIT(6) /* Resolution Selection */ 38aaf6fabfSChris Packham #define TC654_REG_CONFIG_DUTYC BIT(5) /* Duty Cycle Control */ 39aaf6fabfSChris Packham #define TC654_REG_CONFIG_SDM BIT(0) /* Shutdown Mode */ 40aaf6fabfSChris Packham 41aaf6fabfSChris Packham /* Status register bits */ 42aaf6fabfSChris Packham #define TC654_REG_STATUS_F2F BIT(1) /* Fan 2 Fault */ 43aaf6fabfSChris Packham #define TC654_REG_STATUS_F1F BIT(0) /* Fan 1 Fault */ 44aaf6fabfSChris Packham 45aaf6fabfSChris Packham /* RPM resolution for RPM Output registers */ 46aaf6fabfSChris Packham #define TC654_HIGH_RPM_RESOLUTION 25 /* 25 RPM resolution */ 47aaf6fabfSChris Packham #define TC654_LOW_RPM_RESOLUTION 50 /* 50 RPM resolution */ 48aaf6fabfSChris Packham 49aaf6fabfSChris Packham /* Convert to the fan fault RPM threshold from register value */ 50aaf6fabfSChris Packham #define TC654_FAN_FAULT_FROM_REG(val) ((val) * 50) /* 50 RPM resolution */ 51aaf6fabfSChris Packham 52aaf6fabfSChris Packham /* Convert to register value from the fan fault RPM threshold */ 53aaf6fabfSChris Packham #define TC654_FAN_FAULT_TO_REG(val) (((val) / 50) & 0xff) 54aaf6fabfSChris Packham 55aaf6fabfSChris Packham /* Register data is read (and cached) at most once per second. */ 56aaf6fabfSChris Packham #define TC654_UPDATE_INTERVAL HZ 57aaf6fabfSChris Packham 58aaf6fabfSChris Packham struct tc654_data { 59aaf6fabfSChris Packham struct i2c_client *client; 60aaf6fabfSChris Packham 61aaf6fabfSChris Packham /* update mutex */ 62aaf6fabfSChris Packham struct mutex update_lock; 63aaf6fabfSChris Packham 64aaf6fabfSChris Packham /* tc654 register cache */ 65aaf6fabfSChris Packham bool valid; 66aaf6fabfSChris Packham unsigned long last_updated; /* in jiffies */ 67aaf6fabfSChris Packham 68aaf6fabfSChris Packham u8 rpm_output[2]; /* The fan RPM data for fans 1 and 2 is then 69aaf6fabfSChris Packham * written to registers RPM1 and RPM2 70aaf6fabfSChris Packham */ 71aaf6fabfSChris Packham u8 fan_fault[2]; /* The Fan Fault Threshold Registers are used to 72aaf6fabfSChris Packham * set the fan fault threshold levels for fan 1 73aaf6fabfSChris Packham * and fan 2 74aaf6fabfSChris Packham */ 75aaf6fabfSChris Packham u8 config; /* The Configuration Register is an 8-bit read/ 76aaf6fabfSChris Packham * writable multi-function control register 77aaf6fabfSChris Packham * 7: Fan Fault Clear 78aaf6fabfSChris Packham * 1 = Clear Fan Fault 79aaf6fabfSChris Packham * 0 = Normal Operation (default) 80aaf6fabfSChris Packham * 6: Resolution Selection for RPM Output Registers 81aaf6fabfSChris Packham * RPM Output Registers (RPM1 and RPM2) will be 82aaf6fabfSChris Packham * set for 83aaf6fabfSChris Packham * 1 = 25 RPM (9-bit) resolution 84aaf6fabfSChris Packham * 0 = 50 RPM (8-bit) resolution (default) 85aaf6fabfSChris Packham * 5: Duty Cycle Control Method 86aaf6fabfSChris Packham * The V OUT duty cycle will be controlled via 87aaf6fabfSChris Packham * 1 = the SMBus interface. 88aaf6fabfSChris Packham * 0 = via the V IN analog input pin. (default) 89aaf6fabfSChris Packham * 4,3: Fan 2 Pulses Per Rotation 90aaf6fabfSChris Packham * 00 = 1 91aaf6fabfSChris Packham * 01 = 2 (default) 92aaf6fabfSChris Packham * 10 = 4 93aaf6fabfSChris Packham * 11 = 8 94aaf6fabfSChris Packham * 2,1: Fan 1 Pulses Per Rotation 95aaf6fabfSChris Packham * 00 = 1 96aaf6fabfSChris Packham * 01 = 2 (default) 97aaf6fabfSChris Packham * 10 = 4 98aaf6fabfSChris Packham * 11 = 8 99aaf6fabfSChris Packham * 0: Shutdown Mode 100aaf6fabfSChris Packham * 1 = Shutdown mode. 101aaf6fabfSChris Packham * 0 = Normal operation. (default) 102aaf6fabfSChris Packham */ 103aaf6fabfSChris Packham u8 status; /* The Status register provides all the information 104aaf6fabfSChris Packham * about what is going on within the TC654/TC655 105aaf6fabfSChris Packham * devices. 106aaf6fabfSChris Packham * 7,6: Unimplemented, Read as '0' 107aaf6fabfSChris Packham * 5: Over-Temperature Fault Condition 108aaf6fabfSChris Packham * 1 = Over-Temperature condition has occurred 109aaf6fabfSChris Packham * 0 = Normal operation. V IN is less than 2.6V 110aaf6fabfSChris Packham * 4: RPM2 Counter Overflow 111aaf6fabfSChris Packham * 1 = Fault condition 112aaf6fabfSChris Packham * 0 = Normal operation 113aaf6fabfSChris Packham * 3: RPM1 Counter Overflow 114aaf6fabfSChris Packham * 1 = Fault condition 115aaf6fabfSChris Packham * 0 = Normal operation 116aaf6fabfSChris Packham * 2: V IN Input Status 117aaf6fabfSChris Packham * 1 = V IN is open 118aaf6fabfSChris Packham * 0 = Normal operation. voltage present at V IN 119aaf6fabfSChris Packham * 1: Fan 2 Fault 120aaf6fabfSChris Packham * 1 = Fault condition 121aaf6fabfSChris Packham * 0 = Normal operation 122aaf6fabfSChris Packham * 0: Fan 1 Fault 123aaf6fabfSChris Packham * 1 = Fault condition 124aaf6fabfSChris Packham * 0 = Normal operation 125aaf6fabfSChris Packham */ 126aaf6fabfSChris Packham u8 duty_cycle; /* The DUTY_CYCLE register is a 4-bit read/ 127aaf6fabfSChris Packham * writable register used to control the duty 128aaf6fabfSChris Packham * cycle of the V OUT output. 129aaf6fabfSChris Packham */ 130aaf6fabfSChris Packham }; 131aaf6fabfSChris Packham 132aaf6fabfSChris Packham /* helper to grab and cache data, at most one time per second */ 133aaf6fabfSChris Packham static struct tc654_data *tc654_update_client(struct device *dev) 134aaf6fabfSChris Packham { 135aaf6fabfSChris Packham struct tc654_data *data = dev_get_drvdata(dev); 136aaf6fabfSChris Packham struct i2c_client *client = data->client; 137aaf6fabfSChris Packham int ret = 0; 138aaf6fabfSChris Packham 139aaf6fabfSChris Packham mutex_lock(&data->update_lock); 140aaf6fabfSChris Packham if (time_before(jiffies, data->last_updated + TC654_UPDATE_INTERVAL) && 141aaf6fabfSChris Packham likely(data->valid)) 142aaf6fabfSChris Packham goto out; 143aaf6fabfSChris Packham 144aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_RPM(0)); 145aaf6fabfSChris Packham if (ret < 0) 146aaf6fabfSChris Packham goto out; 147aaf6fabfSChris Packham data->rpm_output[0] = ret; 148aaf6fabfSChris Packham 149aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_RPM(1)); 150aaf6fabfSChris Packham if (ret < 0) 151aaf6fabfSChris Packham goto out; 152aaf6fabfSChris Packham data->rpm_output[1] = ret; 153aaf6fabfSChris Packham 154aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_FAN_FAULT(0)); 155aaf6fabfSChris Packham if (ret < 0) 156aaf6fabfSChris Packham goto out; 157aaf6fabfSChris Packham data->fan_fault[0] = ret; 158aaf6fabfSChris Packham 159aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_FAN_FAULT(1)); 160aaf6fabfSChris Packham if (ret < 0) 161aaf6fabfSChris Packham goto out; 162aaf6fabfSChris Packham data->fan_fault[1] = ret; 163aaf6fabfSChris Packham 164aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_CONFIG); 165aaf6fabfSChris Packham if (ret < 0) 166aaf6fabfSChris Packham goto out; 167aaf6fabfSChris Packham data->config = ret; 168aaf6fabfSChris Packham 169aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_STATUS); 170aaf6fabfSChris Packham if (ret < 0) 171aaf6fabfSChris Packham goto out; 172aaf6fabfSChris Packham data->status = ret; 173aaf6fabfSChris Packham 174aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_DUTY_CYCLE); 175aaf6fabfSChris Packham if (ret < 0) 176aaf6fabfSChris Packham goto out; 177aaf6fabfSChris Packham data->duty_cycle = ret & 0x0f; 178aaf6fabfSChris Packham 179aaf6fabfSChris Packham data->last_updated = jiffies; 180aaf6fabfSChris Packham data->valid = true; 181aaf6fabfSChris Packham out: 182aaf6fabfSChris Packham mutex_unlock(&data->update_lock); 183aaf6fabfSChris Packham 184aaf6fabfSChris Packham if (ret < 0) /* upon error, encode it in return value */ 185aaf6fabfSChris Packham data = ERR_PTR(ret); 186aaf6fabfSChris Packham 187aaf6fabfSChris Packham return data; 188aaf6fabfSChris Packham } 189aaf6fabfSChris Packham 190aaf6fabfSChris Packham /* 191aaf6fabfSChris Packham * sysfs attributes 192aaf6fabfSChris Packham */ 193aaf6fabfSChris Packham 1941acd2e29SGuenter Roeck static ssize_t fan_show(struct device *dev, struct device_attribute *da, 195aaf6fabfSChris Packham char *buf) 196aaf6fabfSChris Packham { 197aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 198aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 199aaf6fabfSChris Packham int val; 200aaf6fabfSChris Packham 201aaf6fabfSChris Packham if (IS_ERR(data)) 202aaf6fabfSChris Packham return PTR_ERR(data); 203aaf6fabfSChris Packham 204aaf6fabfSChris Packham if (data->config & TC654_REG_CONFIG_RES) 205aaf6fabfSChris Packham val = data->rpm_output[nr] * TC654_HIGH_RPM_RESOLUTION; 206aaf6fabfSChris Packham else 207aaf6fabfSChris Packham val = data->rpm_output[nr] * TC654_LOW_RPM_RESOLUTION; 208aaf6fabfSChris Packham 209aaf6fabfSChris Packham return sprintf(buf, "%d\n", val); 210aaf6fabfSChris Packham } 211aaf6fabfSChris Packham 2121acd2e29SGuenter Roeck static ssize_t fan_min_show(struct device *dev, struct device_attribute *da, 213aaf6fabfSChris Packham char *buf) 214aaf6fabfSChris Packham { 215aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 216aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 217aaf6fabfSChris Packham 218aaf6fabfSChris Packham if (IS_ERR(data)) 219aaf6fabfSChris Packham return PTR_ERR(data); 220aaf6fabfSChris Packham 221aaf6fabfSChris Packham return sprintf(buf, "%d\n", 222aaf6fabfSChris Packham TC654_FAN_FAULT_FROM_REG(data->fan_fault[nr])); 223aaf6fabfSChris Packham } 224aaf6fabfSChris Packham 2251acd2e29SGuenter Roeck static ssize_t fan_min_store(struct device *dev, struct device_attribute *da, 226aaf6fabfSChris Packham const char *buf, size_t count) 227aaf6fabfSChris Packham { 228aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 229aaf6fabfSChris Packham struct tc654_data *data = dev_get_drvdata(dev); 230aaf6fabfSChris Packham struct i2c_client *client = data->client; 231aaf6fabfSChris Packham unsigned long val; 232aaf6fabfSChris Packham int ret; 233aaf6fabfSChris Packham 234aaf6fabfSChris Packham if (kstrtoul(buf, 10, &val)) 235aaf6fabfSChris Packham return -EINVAL; 236aaf6fabfSChris Packham 237aaf6fabfSChris Packham val = clamp_val(val, 0, 12750); 238aaf6fabfSChris Packham 239aaf6fabfSChris Packham mutex_lock(&data->update_lock); 240aaf6fabfSChris Packham 241aaf6fabfSChris Packham data->fan_fault[nr] = TC654_FAN_FAULT_TO_REG(val); 242aaf6fabfSChris Packham ret = i2c_smbus_write_byte_data(client, TC654_REG_FAN_FAULT(nr), 243aaf6fabfSChris Packham data->fan_fault[nr]); 244aaf6fabfSChris Packham 245aaf6fabfSChris Packham mutex_unlock(&data->update_lock); 246aaf6fabfSChris Packham return ret < 0 ? ret : count; 247aaf6fabfSChris Packham } 248aaf6fabfSChris Packham 2491acd2e29SGuenter Roeck static ssize_t fan_alarm_show(struct device *dev, struct device_attribute *da, 250aaf6fabfSChris Packham char *buf) 251aaf6fabfSChris Packham { 252aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 253aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 254aaf6fabfSChris Packham int val; 255aaf6fabfSChris Packham 256aaf6fabfSChris Packham if (IS_ERR(data)) 257aaf6fabfSChris Packham return PTR_ERR(data); 258aaf6fabfSChris Packham 259aaf6fabfSChris Packham if (nr == 0) 260aaf6fabfSChris Packham val = !!(data->status & TC654_REG_STATUS_F1F); 261aaf6fabfSChris Packham else 262aaf6fabfSChris Packham val = !!(data->status & TC654_REG_STATUS_F2F); 263aaf6fabfSChris Packham 264aaf6fabfSChris Packham return sprintf(buf, "%d\n", val); 265aaf6fabfSChris Packham } 266aaf6fabfSChris Packham 267aaf6fabfSChris Packham static const u8 TC654_FAN_PULSE_SHIFT[] = { 1, 3 }; 268aaf6fabfSChris Packham 2691acd2e29SGuenter Roeck static ssize_t fan_pulses_show(struct device *dev, 2701acd2e29SGuenter Roeck struct device_attribute *da, char *buf) 271aaf6fabfSChris Packham { 272aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 273aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 274aaf6fabfSChris Packham u8 val; 275aaf6fabfSChris Packham 276aaf6fabfSChris Packham if (IS_ERR(data)) 277aaf6fabfSChris Packham return PTR_ERR(data); 278aaf6fabfSChris Packham 279aaf6fabfSChris Packham val = BIT((data->config >> TC654_FAN_PULSE_SHIFT[nr]) & 0x03); 280aaf6fabfSChris Packham return sprintf(buf, "%d\n", val); 281aaf6fabfSChris Packham } 282aaf6fabfSChris Packham 2831acd2e29SGuenter Roeck static ssize_t fan_pulses_store(struct device *dev, 2841acd2e29SGuenter Roeck struct device_attribute *da, const char *buf, 2851acd2e29SGuenter Roeck size_t count) 286aaf6fabfSChris Packham { 287aaf6fabfSChris Packham int nr = to_sensor_dev_attr(da)->index; 288aaf6fabfSChris Packham struct tc654_data *data = dev_get_drvdata(dev); 289aaf6fabfSChris Packham struct i2c_client *client = data->client; 290aaf6fabfSChris Packham u8 config; 291aaf6fabfSChris Packham unsigned long val; 292aaf6fabfSChris Packham int ret; 293aaf6fabfSChris Packham 294aaf6fabfSChris Packham if (kstrtoul(buf, 10, &val)) 295aaf6fabfSChris Packham return -EINVAL; 296aaf6fabfSChris Packham 297aaf6fabfSChris Packham switch (val) { 298aaf6fabfSChris Packham case 1: 299aaf6fabfSChris Packham config = 0; 300aaf6fabfSChris Packham break; 301aaf6fabfSChris Packham case 2: 302aaf6fabfSChris Packham config = 1; 303aaf6fabfSChris Packham break; 304aaf6fabfSChris Packham case 4: 305aaf6fabfSChris Packham config = 2; 306aaf6fabfSChris Packham break; 307aaf6fabfSChris Packham case 8: 308aaf6fabfSChris Packham config = 3; 309aaf6fabfSChris Packham break; 310aaf6fabfSChris Packham default: 311aaf6fabfSChris Packham return -EINVAL; 312aaf6fabfSChris Packham } 313aaf6fabfSChris Packham 314aaf6fabfSChris Packham mutex_lock(&data->update_lock); 315aaf6fabfSChris Packham 316aaf6fabfSChris Packham data->config &= ~(0x03 << TC654_FAN_PULSE_SHIFT[nr]); 317aaf6fabfSChris Packham data->config |= (config << TC654_FAN_PULSE_SHIFT[nr]); 318aaf6fabfSChris Packham ret = i2c_smbus_write_byte_data(client, TC654_REG_CONFIG, data->config); 319aaf6fabfSChris Packham 320aaf6fabfSChris Packham mutex_unlock(&data->update_lock); 321aaf6fabfSChris Packham return ret < 0 ? ret : count; 322aaf6fabfSChris Packham } 323aaf6fabfSChris Packham 3241acd2e29SGuenter Roeck static ssize_t pwm_mode_show(struct device *dev, struct device_attribute *da, 3251acd2e29SGuenter Roeck char *buf) 326aaf6fabfSChris Packham { 327aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 328aaf6fabfSChris Packham 329aaf6fabfSChris Packham if (IS_ERR(data)) 330aaf6fabfSChris Packham return PTR_ERR(data); 331aaf6fabfSChris Packham 332aaf6fabfSChris Packham return sprintf(buf, "%d\n", !!(data->config & TC654_REG_CONFIG_DUTYC)); 333aaf6fabfSChris Packham } 334aaf6fabfSChris Packham 3351acd2e29SGuenter Roeck static ssize_t pwm_mode_store(struct device *dev, struct device_attribute *da, 336aaf6fabfSChris Packham const char *buf, size_t count) 337aaf6fabfSChris Packham { 338aaf6fabfSChris Packham struct tc654_data *data = dev_get_drvdata(dev); 339aaf6fabfSChris Packham struct i2c_client *client = data->client; 340aaf6fabfSChris Packham unsigned long val; 341aaf6fabfSChris Packham int ret; 342aaf6fabfSChris Packham 343aaf6fabfSChris Packham if (kstrtoul(buf, 10, &val)) 344aaf6fabfSChris Packham return -EINVAL; 345aaf6fabfSChris Packham 346aaf6fabfSChris Packham if (val != 0 && val != 1) 347aaf6fabfSChris Packham return -EINVAL; 348aaf6fabfSChris Packham 349aaf6fabfSChris Packham mutex_lock(&data->update_lock); 350aaf6fabfSChris Packham 351aaf6fabfSChris Packham if (val) 352aaf6fabfSChris Packham data->config |= TC654_REG_CONFIG_DUTYC; 353aaf6fabfSChris Packham else 354aaf6fabfSChris Packham data->config &= ~TC654_REG_CONFIG_DUTYC; 355aaf6fabfSChris Packham 356aaf6fabfSChris Packham ret = i2c_smbus_write_byte_data(client, TC654_REG_CONFIG, data->config); 357aaf6fabfSChris Packham 358aaf6fabfSChris Packham mutex_unlock(&data->update_lock); 359aaf6fabfSChris Packham return ret < 0 ? ret : count; 360aaf6fabfSChris Packham } 361aaf6fabfSChris Packham 362aaf6fabfSChris Packham static const int tc654_pwm_map[16] = { 77, 88, 102, 112, 124, 136, 148, 160, 363aaf6fabfSChris Packham 172, 184, 196, 207, 219, 231, 243, 255}; 364aaf6fabfSChris Packham 3651acd2e29SGuenter Roeck static ssize_t pwm_show(struct device *dev, struct device_attribute *da, 366aaf6fabfSChris Packham char *buf) 367aaf6fabfSChris Packham { 368aaf6fabfSChris Packham struct tc654_data *data = tc654_update_client(dev); 369aaf6fabfSChris Packham int pwm; 370aaf6fabfSChris Packham 371aaf6fabfSChris Packham if (IS_ERR(data)) 372aaf6fabfSChris Packham return PTR_ERR(data); 373aaf6fabfSChris Packham 374aaf6fabfSChris Packham if (data->config & TC654_REG_CONFIG_SDM) 375aaf6fabfSChris Packham pwm = 0; 376aaf6fabfSChris Packham else 377aaf6fabfSChris Packham pwm = tc654_pwm_map[data->duty_cycle]; 378aaf6fabfSChris Packham 379aaf6fabfSChris Packham return sprintf(buf, "%d\n", pwm); 380aaf6fabfSChris Packham } 381aaf6fabfSChris Packham 3821acd2e29SGuenter Roeck static ssize_t pwm_store(struct device *dev, struct device_attribute *da, 383aaf6fabfSChris Packham const char *buf, size_t count) 384aaf6fabfSChris Packham { 385aaf6fabfSChris Packham struct tc654_data *data = dev_get_drvdata(dev); 386aaf6fabfSChris Packham struct i2c_client *client = data->client; 387aaf6fabfSChris Packham unsigned long val; 388aaf6fabfSChris Packham int ret; 389aaf6fabfSChris Packham 390aaf6fabfSChris Packham if (kstrtoul(buf, 10, &val)) 391aaf6fabfSChris Packham return -EINVAL; 392aaf6fabfSChris Packham if (val > 255) 393aaf6fabfSChris Packham return -EINVAL; 394aaf6fabfSChris Packham 395aaf6fabfSChris Packham mutex_lock(&data->update_lock); 396aaf6fabfSChris Packham 397aaf6fabfSChris Packham if (val == 0) 398aaf6fabfSChris Packham data->config |= TC654_REG_CONFIG_SDM; 399aaf6fabfSChris Packham else 400aaf6fabfSChris Packham data->config &= ~TC654_REG_CONFIG_SDM; 401aaf6fabfSChris Packham 402aaf6fabfSChris Packham data->duty_cycle = find_closest(val, tc654_pwm_map, 403aaf6fabfSChris Packham ARRAY_SIZE(tc654_pwm_map)); 404aaf6fabfSChris Packham 405aaf6fabfSChris Packham ret = i2c_smbus_write_byte_data(client, TC654_REG_CONFIG, data->config); 406aaf6fabfSChris Packham if (ret < 0) 407aaf6fabfSChris Packham goto out; 408aaf6fabfSChris Packham 409aaf6fabfSChris Packham ret = i2c_smbus_write_byte_data(client, TC654_REG_DUTY_CYCLE, 410aaf6fabfSChris Packham data->duty_cycle); 411aaf6fabfSChris Packham 412aaf6fabfSChris Packham out: 413aaf6fabfSChris Packham mutex_unlock(&data->update_lock); 414aaf6fabfSChris Packham return ret < 0 ? ret : count; 415aaf6fabfSChris Packham } 416aaf6fabfSChris Packham 4171acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0); 4181acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1); 4191acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(fan1_min, fan_min, 0); 4201acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(fan2_min, fan_min, 1); 4211acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RO(fan1_alarm, fan_alarm, 0); 4221acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RO(fan2_alarm, fan_alarm, 1); 4231acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(fan1_pulses, fan_pulses, 0); 4241acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(fan2_pulses, fan_pulses, 1); 4251acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(pwm1_mode, pwm_mode, 0); 4261acd2e29SGuenter Roeck static SENSOR_DEVICE_ATTR_RW(pwm1, pwm, 0); 427aaf6fabfSChris Packham 428aaf6fabfSChris Packham /* Driver data */ 429aaf6fabfSChris Packham static struct attribute *tc654_attrs[] = { 430aaf6fabfSChris Packham &sensor_dev_attr_fan1_input.dev_attr.attr, 431aaf6fabfSChris Packham &sensor_dev_attr_fan2_input.dev_attr.attr, 432aaf6fabfSChris Packham &sensor_dev_attr_fan1_min.dev_attr.attr, 433aaf6fabfSChris Packham &sensor_dev_attr_fan2_min.dev_attr.attr, 434aaf6fabfSChris Packham &sensor_dev_attr_fan1_alarm.dev_attr.attr, 435aaf6fabfSChris Packham &sensor_dev_attr_fan2_alarm.dev_attr.attr, 436aaf6fabfSChris Packham &sensor_dev_attr_fan1_pulses.dev_attr.attr, 437aaf6fabfSChris Packham &sensor_dev_attr_fan2_pulses.dev_attr.attr, 438aaf6fabfSChris Packham &sensor_dev_attr_pwm1_mode.dev_attr.attr, 439aaf6fabfSChris Packham &sensor_dev_attr_pwm1.dev_attr.attr, 440aaf6fabfSChris Packham NULL 441aaf6fabfSChris Packham }; 442aaf6fabfSChris Packham 443aaf6fabfSChris Packham ATTRIBUTE_GROUPS(tc654); 444aaf6fabfSChris Packham 445aaf6fabfSChris Packham /* 446aaf6fabfSChris Packham * device probe and removal 447aaf6fabfSChris Packham */ 448aaf6fabfSChris Packham 449aaf6fabfSChris Packham static int tc654_probe(struct i2c_client *client, 450aaf6fabfSChris Packham const struct i2c_device_id *id) 451aaf6fabfSChris Packham { 452aaf6fabfSChris Packham struct device *dev = &client->dev; 453aaf6fabfSChris Packham struct tc654_data *data; 454aaf6fabfSChris Packham struct device *hwmon_dev; 455aaf6fabfSChris Packham int ret; 456aaf6fabfSChris Packham 457aaf6fabfSChris Packham if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) 458aaf6fabfSChris Packham return -ENODEV; 459aaf6fabfSChris Packham 460aaf6fabfSChris Packham data = devm_kzalloc(dev, sizeof(struct tc654_data), GFP_KERNEL); 461aaf6fabfSChris Packham if (!data) 462aaf6fabfSChris Packham return -ENOMEM; 463aaf6fabfSChris Packham 464aaf6fabfSChris Packham data->client = client; 465aaf6fabfSChris Packham mutex_init(&data->update_lock); 466aaf6fabfSChris Packham 467aaf6fabfSChris Packham ret = i2c_smbus_read_byte_data(client, TC654_REG_CONFIG); 468aaf6fabfSChris Packham if (ret < 0) 469aaf6fabfSChris Packham return ret; 470aaf6fabfSChris Packham 471aaf6fabfSChris Packham data->config = ret; 472aaf6fabfSChris Packham 473aaf6fabfSChris Packham hwmon_dev = 474aaf6fabfSChris Packham devm_hwmon_device_register_with_groups(dev, client->name, data, 475aaf6fabfSChris Packham tc654_groups); 476aaf6fabfSChris Packham return PTR_ERR_OR_ZERO(hwmon_dev); 477aaf6fabfSChris Packham } 478aaf6fabfSChris Packham 479aaf6fabfSChris Packham static const struct i2c_device_id tc654_id[] = { 480aaf6fabfSChris Packham {"tc654", 0}, 481aaf6fabfSChris Packham {"tc655", 0}, 482aaf6fabfSChris Packham {} 483aaf6fabfSChris Packham }; 484aaf6fabfSChris Packham 485aaf6fabfSChris Packham MODULE_DEVICE_TABLE(i2c, tc654_id); 486aaf6fabfSChris Packham 487aaf6fabfSChris Packham static struct i2c_driver tc654_driver = { 488aaf6fabfSChris Packham .driver = { 489aaf6fabfSChris Packham .name = "tc654", 490aaf6fabfSChris Packham }, 491aaf6fabfSChris Packham .probe = tc654_probe, 492aaf6fabfSChris Packham .id_table = tc654_id, 493aaf6fabfSChris Packham }; 494aaf6fabfSChris Packham 495aaf6fabfSChris Packham module_i2c_driver(tc654_driver); 496aaf6fabfSChris Packham 497aaf6fabfSChris Packham MODULE_AUTHOR("Allied Telesis Labs"); 498aaf6fabfSChris Packham MODULE_DESCRIPTION("Microchip TC654/TC655 driver"); 499aaf6fabfSChris Packham MODULE_LICENSE("GPL"); 500