11236441fSMark M. Hoffman /* 25ed04880SGuenter Roeck * hwmon.c - part of lm_sensors, Linux kernel modules for hardware monitoring 35ed04880SGuenter Roeck * 45ed04880SGuenter Roeck * This file defines the sysfs class "hwmon", for use by sensors drivers. 55ed04880SGuenter Roeck * 65ed04880SGuenter Roeck * Copyright (C) 2005 Mark M. Hoffman <mhoffman@lightlink.com> 75ed04880SGuenter Roeck * 85ed04880SGuenter Roeck * This program is free software; you can redistribute it and/or modify 95ed04880SGuenter Roeck * it under the terms of the GNU General Public License as published by 105ed04880SGuenter Roeck * the Free Software Foundation; version 2 of the License. 111236441fSMark M. Hoffman */ 121236441fSMark M. Hoffman 13c95df1aeSJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 14c95df1aeSJoe Perches 15d560168bSGuenter Roeck #include <linux/bitops.h> 161236441fSMark M. Hoffman #include <linux/device.h> 171236441fSMark M. Hoffman #include <linux/err.h> 188c65b4a6STim Schmielau #include <linux/gfp.h> 19c9ebbe6fSGuenter Roeck #include <linux/hwmon.h> 20c9ebbe6fSGuenter Roeck #include <linux/idr.h> 21c9ebbe6fSGuenter Roeck #include <linux/module.h> 222958b1ecSJean Delvare #include <linux/pci.h> 23c9ebbe6fSGuenter Roeck #include <linux/slab.h> 24648cd48cSGuenter Roeck #include <linux/string.h> 25d560168bSGuenter Roeck #include <linux/thermal.h> 261236441fSMark M. Hoffman 271236441fSMark M. Hoffman #define HWMON_ID_PREFIX "hwmon" 281236441fSMark M. Hoffman #define HWMON_ID_FORMAT HWMON_ID_PREFIX "%d" 291236441fSMark M. Hoffman 30bab2243cSGuenter Roeck struct hwmon_device { 31bab2243cSGuenter Roeck const char *name; 32bab2243cSGuenter Roeck struct device dev; 33d560168bSGuenter Roeck const struct hwmon_chip_info *chip; 34d560168bSGuenter Roeck 35d560168bSGuenter Roeck struct attribute_group group; 36d560168bSGuenter Roeck const struct attribute_group **groups; 37bab2243cSGuenter Roeck }; 38d560168bSGuenter Roeck 39bab2243cSGuenter Roeck #define to_hwmon_device(d) container_of(d, struct hwmon_device, dev) 40bab2243cSGuenter Roeck 41d560168bSGuenter Roeck struct hwmon_device_attribute { 42d560168bSGuenter Roeck struct device_attribute dev_attr; 43d560168bSGuenter Roeck const struct hwmon_ops *ops; 44d560168bSGuenter Roeck enum hwmon_sensor_types type; 45d560168bSGuenter Roeck u32 attr; 46d560168bSGuenter Roeck int index; 47d560168bSGuenter Roeck }; 48d560168bSGuenter Roeck 49d560168bSGuenter Roeck #define to_hwmon_attr(d) \ 50d560168bSGuenter Roeck container_of(d, struct hwmon_device_attribute, dev_attr) 51d560168bSGuenter Roeck 52d560168bSGuenter Roeck /* 53d560168bSGuenter Roeck * Thermal zone information 54d560168bSGuenter Roeck * In addition to the reference to the hwmon device, 55d560168bSGuenter Roeck * also provides the sensor index. 56d560168bSGuenter Roeck */ 57d560168bSGuenter Roeck struct hwmon_thermal_data { 58d560168bSGuenter Roeck struct hwmon_device *hwdev; /* Reference to hwmon device */ 59d560168bSGuenter Roeck int index; /* sensor index */ 60d560168bSGuenter Roeck }; 61d560168bSGuenter Roeck 62bab2243cSGuenter Roeck static ssize_t 63bab2243cSGuenter Roeck show_name(struct device *dev, struct device_attribute *attr, char *buf) 64bab2243cSGuenter Roeck { 65bab2243cSGuenter Roeck return sprintf(buf, "%s\n", to_hwmon_device(dev)->name); 66bab2243cSGuenter Roeck } 67bab2243cSGuenter Roeck static DEVICE_ATTR(name, S_IRUGO, show_name, NULL); 68bab2243cSGuenter Roeck 69bab2243cSGuenter Roeck static struct attribute *hwmon_dev_attrs[] = { 70bab2243cSGuenter Roeck &dev_attr_name.attr, 71bab2243cSGuenter Roeck NULL 72bab2243cSGuenter Roeck }; 73bab2243cSGuenter Roeck 74bab2243cSGuenter Roeck static umode_t hwmon_dev_name_is_visible(struct kobject *kobj, 75bab2243cSGuenter Roeck struct attribute *attr, int n) 76bab2243cSGuenter Roeck { 77bab2243cSGuenter Roeck struct device *dev = container_of(kobj, struct device, kobj); 78bab2243cSGuenter Roeck 79bab2243cSGuenter Roeck if (to_hwmon_device(dev)->name == NULL) 80bab2243cSGuenter Roeck return 0; 81bab2243cSGuenter Roeck 82bab2243cSGuenter Roeck return attr->mode; 83bab2243cSGuenter Roeck } 84bab2243cSGuenter Roeck 85bab2243cSGuenter Roeck static struct attribute_group hwmon_dev_attr_group = { 86bab2243cSGuenter Roeck .attrs = hwmon_dev_attrs, 87bab2243cSGuenter Roeck .is_visible = hwmon_dev_name_is_visible, 88bab2243cSGuenter Roeck }; 89bab2243cSGuenter Roeck 90bab2243cSGuenter Roeck static const struct attribute_group *hwmon_dev_attr_groups[] = { 91bab2243cSGuenter Roeck &hwmon_dev_attr_group, 92bab2243cSGuenter Roeck NULL 93bab2243cSGuenter Roeck }; 94bab2243cSGuenter Roeck 95bab2243cSGuenter Roeck static void hwmon_dev_release(struct device *dev) 96bab2243cSGuenter Roeck { 97bab2243cSGuenter Roeck kfree(to_hwmon_device(dev)); 98bab2243cSGuenter Roeck } 99bab2243cSGuenter Roeck 100bab2243cSGuenter Roeck static struct class hwmon_class = { 101bab2243cSGuenter Roeck .name = "hwmon", 102bab2243cSGuenter Roeck .owner = THIS_MODULE, 103bab2243cSGuenter Roeck .dev_groups = hwmon_dev_attr_groups, 104bab2243cSGuenter Roeck .dev_release = hwmon_dev_release, 105bab2243cSGuenter Roeck }; 1061236441fSMark M. Hoffman 1074ca5f468SJonathan Cameron static DEFINE_IDA(hwmon_ida); 1081236441fSMark M. Hoffman 109d560168bSGuenter Roeck /* Thermal zone handling */ 110d560168bSGuenter Roeck 111d560168bSGuenter Roeck #if IS_REACHABLE(CONFIG_THERMAL) && defined(CONFIG_THERMAL_OF) 112d560168bSGuenter Roeck static int hwmon_thermal_get_temp(void *data, int *temp) 113d560168bSGuenter Roeck { 114d560168bSGuenter Roeck struct hwmon_thermal_data *tdata = data; 115d560168bSGuenter Roeck struct hwmon_device *hwdev = tdata->hwdev; 116d560168bSGuenter Roeck int ret; 117d560168bSGuenter Roeck long t; 118d560168bSGuenter Roeck 119d560168bSGuenter Roeck ret = hwdev->chip->ops->read(&hwdev->dev, hwmon_temp, hwmon_temp_input, 120d560168bSGuenter Roeck tdata->index, &t); 121d560168bSGuenter Roeck if (ret < 0) 122d560168bSGuenter Roeck return ret; 123d560168bSGuenter Roeck 124d560168bSGuenter Roeck *temp = t; 125d560168bSGuenter Roeck 126d560168bSGuenter Roeck return 0; 127d560168bSGuenter Roeck } 128d560168bSGuenter Roeck 129d560168bSGuenter Roeck static struct thermal_zone_of_device_ops hwmon_thermal_ops = { 130d560168bSGuenter Roeck .get_temp = hwmon_thermal_get_temp, 131d560168bSGuenter Roeck }; 132d560168bSGuenter Roeck 133d560168bSGuenter Roeck static int hwmon_thermal_add_sensor(struct device *dev, 134d560168bSGuenter Roeck struct hwmon_device *hwdev, int index) 135d560168bSGuenter Roeck { 136d560168bSGuenter Roeck struct hwmon_thermal_data *tdata; 137d560168bSGuenter Roeck 138d560168bSGuenter Roeck tdata = devm_kzalloc(dev, sizeof(*tdata), GFP_KERNEL); 139d560168bSGuenter Roeck if (!tdata) 140d560168bSGuenter Roeck return -ENOMEM; 141d560168bSGuenter Roeck 142d560168bSGuenter Roeck tdata->hwdev = hwdev; 143d560168bSGuenter Roeck tdata->index = index; 144d560168bSGuenter Roeck 145d560168bSGuenter Roeck devm_thermal_zone_of_sensor_register(&hwdev->dev, index, tdata, 146d560168bSGuenter Roeck &hwmon_thermal_ops); 147d560168bSGuenter Roeck 148d560168bSGuenter Roeck return 0; 149d560168bSGuenter Roeck } 150d560168bSGuenter Roeck #else 151d560168bSGuenter Roeck static int hwmon_thermal_add_sensor(struct device *dev, 152d560168bSGuenter Roeck struct hwmon_device *hwdev, int index) 153d560168bSGuenter Roeck { 154d560168bSGuenter Roeck return 0; 155d560168bSGuenter Roeck } 156d560168bSGuenter Roeck #endif /* IS_REACHABLE(CONFIG_THERMAL) && defined(CONFIG_THERMAL_OF) */ 157d560168bSGuenter Roeck 158d560168bSGuenter Roeck /* sysfs attribute management */ 159d560168bSGuenter Roeck 160d560168bSGuenter Roeck static ssize_t hwmon_attr_show(struct device *dev, 161d560168bSGuenter Roeck struct device_attribute *devattr, char *buf) 162d560168bSGuenter Roeck { 163d560168bSGuenter Roeck struct hwmon_device_attribute *hattr = to_hwmon_attr(devattr); 164d560168bSGuenter Roeck long val; 165d560168bSGuenter Roeck int ret; 166d560168bSGuenter Roeck 167d560168bSGuenter Roeck ret = hattr->ops->read(dev, hattr->type, hattr->attr, hattr->index, 168d560168bSGuenter Roeck &val); 169d560168bSGuenter Roeck if (ret < 0) 170d560168bSGuenter Roeck return ret; 171d560168bSGuenter Roeck 172d560168bSGuenter Roeck return sprintf(buf, "%ld\n", val); 173d560168bSGuenter Roeck } 174d560168bSGuenter Roeck 175d560168bSGuenter Roeck static ssize_t hwmon_attr_store(struct device *dev, 176d560168bSGuenter Roeck struct device_attribute *devattr, 177d560168bSGuenter Roeck const char *buf, size_t count) 178d560168bSGuenter Roeck { 179d560168bSGuenter Roeck struct hwmon_device_attribute *hattr = to_hwmon_attr(devattr); 180d560168bSGuenter Roeck long val; 181d560168bSGuenter Roeck int ret; 182d560168bSGuenter Roeck 183d560168bSGuenter Roeck ret = kstrtol(buf, 10, &val); 184d560168bSGuenter Roeck if (ret < 0) 185d560168bSGuenter Roeck return ret; 186d560168bSGuenter Roeck 187d560168bSGuenter Roeck ret = hattr->ops->write(dev, hattr->type, hattr->attr, hattr->index, 188d560168bSGuenter Roeck val); 189d560168bSGuenter Roeck if (ret < 0) 190d560168bSGuenter Roeck return ret; 191d560168bSGuenter Roeck 192d560168bSGuenter Roeck return count; 193d560168bSGuenter Roeck } 194d560168bSGuenter Roeck 195d560168bSGuenter Roeck static int hwmon_attr_base(enum hwmon_sensor_types type) 196d560168bSGuenter Roeck { 197d560168bSGuenter Roeck if (type == hwmon_in) 198d560168bSGuenter Roeck return 0; 199d560168bSGuenter Roeck return 1; 200d560168bSGuenter Roeck } 201d560168bSGuenter Roeck 202d560168bSGuenter Roeck static struct attribute *hwmon_genattr(struct device *dev, 203d560168bSGuenter Roeck const void *drvdata, 204d560168bSGuenter Roeck enum hwmon_sensor_types type, 205d560168bSGuenter Roeck u32 attr, 206d560168bSGuenter Roeck int index, 207d560168bSGuenter Roeck const char *template, 208d560168bSGuenter Roeck const struct hwmon_ops *ops) 209d560168bSGuenter Roeck { 210d560168bSGuenter Roeck struct hwmon_device_attribute *hattr; 211d560168bSGuenter Roeck struct device_attribute *dattr; 212d560168bSGuenter Roeck struct attribute *a; 213d560168bSGuenter Roeck umode_t mode; 214d560168bSGuenter Roeck char *name; 215d560168bSGuenter Roeck 216d560168bSGuenter Roeck /* The attribute is invisible if there is no template string */ 217d560168bSGuenter Roeck if (!template) 218d560168bSGuenter Roeck return ERR_PTR(-ENOENT); 219d560168bSGuenter Roeck 220d560168bSGuenter Roeck mode = ops->is_visible(drvdata, type, attr, index); 221d560168bSGuenter Roeck if (!mode) 222d560168bSGuenter Roeck return ERR_PTR(-ENOENT); 223d560168bSGuenter Roeck 224d560168bSGuenter Roeck if ((mode & S_IRUGO) && !ops->read) 225d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 226d560168bSGuenter Roeck if ((mode & S_IWUGO) && !ops->write) 227d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 228d560168bSGuenter Roeck 229d560168bSGuenter Roeck if (type == hwmon_chip) { 230d560168bSGuenter Roeck name = (char *)template; 231d560168bSGuenter Roeck } else { 232d560168bSGuenter Roeck name = devm_kzalloc(dev, strlen(template) + 16, GFP_KERNEL); 233d560168bSGuenter Roeck if (!name) 234d560168bSGuenter Roeck return ERR_PTR(-ENOMEM); 235d560168bSGuenter Roeck scnprintf(name, strlen(template) + 16, template, 236d560168bSGuenter Roeck index + hwmon_attr_base(type)); 237d560168bSGuenter Roeck } 238d560168bSGuenter Roeck 239d560168bSGuenter Roeck hattr = devm_kzalloc(dev, sizeof(*hattr), GFP_KERNEL); 240d560168bSGuenter Roeck if (!hattr) 241d560168bSGuenter Roeck return ERR_PTR(-ENOMEM); 242d560168bSGuenter Roeck 243d560168bSGuenter Roeck hattr->type = type; 244d560168bSGuenter Roeck hattr->attr = attr; 245d560168bSGuenter Roeck hattr->index = index; 246d560168bSGuenter Roeck hattr->ops = ops; 247d560168bSGuenter Roeck 248d560168bSGuenter Roeck dattr = &hattr->dev_attr; 249d560168bSGuenter Roeck dattr->show = hwmon_attr_show; 250d560168bSGuenter Roeck dattr->store = hwmon_attr_store; 251d560168bSGuenter Roeck 252d560168bSGuenter Roeck a = &dattr->attr; 253d560168bSGuenter Roeck sysfs_attr_init(a); 254d560168bSGuenter Roeck a->name = name; 255d560168bSGuenter Roeck a->mode = mode; 256d560168bSGuenter Roeck 257d560168bSGuenter Roeck return a; 258d560168bSGuenter Roeck } 259d560168bSGuenter Roeck 260d560168bSGuenter Roeck static const char * const hwmon_chip_attr_templates[] = { 261d560168bSGuenter Roeck [hwmon_chip_temp_reset_history] = "temp_reset_history", 26200d616cfSGuenter Roeck [hwmon_chip_in_reset_history] = "in_reset_history", 2639b26947cSGuenter Roeck [hwmon_chip_curr_reset_history] = "curr_reset_history", 264b308f5c7SGuenter Roeck [hwmon_chip_power_reset_history] = "power_reset_history", 265d560168bSGuenter Roeck [hwmon_chip_update_interval] = "update_interval", 266d560168bSGuenter Roeck [hwmon_chip_alarms] = "alarms", 267d560168bSGuenter Roeck }; 268d560168bSGuenter Roeck 269d560168bSGuenter Roeck static const char * const hwmon_temp_attr_templates[] = { 270d560168bSGuenter Roeck [hwmon_temp_input] = "temp%d_input", 271d560168bSGuenter Roeck [hwmon_temp_type] = "temp%d_type", 272d560168bSGuenter Roeck [hwmon_temp_lcrit] = "temp%d_lcrit", 273d560168bSGuenter Roeck [hwmon_temp_lcrit_hyst] = "temp%d_lcrit_hyst", 274d560168bSGuenter Roeck [hwmon_temp_min] = "temp%d_min", 275d560168bSGuenter Roeck [hwmon_temp_min_hyst] = "temp%d_min_hyst", 276d560168bSGuenter Roeck [hwmon_temp_max] = "temp%d_max", 277d560168bSGuenter Roeck [hwmon_temp_max_hyst] = "temp%d_max_hyst", 278d560168bSGuenter Roeck [hwmon_temp_crit] = "temp%d_crit", 279d560168bSGuenter Roeck [hwmon_temp_crit_hyst] = "temp%d_crit_hyst", 280d560168bSGuenter Roeck [hwmon_temp_emergency] = "temp%d_emergency", 281d560168bSGuenter Roeck [hwmon_temp_emergency_hyst] = "temp%d_emergency_hyst", 282d560168bSGuenter Roeck [hwmon_temp_alarm] = "temp%d_alarm", 283d560168bSGuenter Roeck [hwmon_temp_lcrit_alarm] = "temp%d_lcrit_alarm", 284d560168bSGuenter Roeck [hwmon_temp_min_alarm] = "temp%d_min_alarm", 285d560168bSGuenter Roeck [hwmon_temp_max_alarm] = "temp%d_max_alarm", 286d560168bSGuenter Roeck [hwmon_temp_crit_alarm] = "temp%d_crit_alarm", 287d560168bSGuenter Roeck [hwmon_temp_emergency_alarm] = "temp%d_emergency_alarm", 288d560168bSGuenter Roeck [hwmon_temp_fault] = "temp%d_fault", 289d560168bSGuenter Roeck [hwmon_temp_offset] = "temp%d_offset", 290d560168bSGuenter Roeck [hwmon_temp_label] = "temp%d_label", 291d560168bSGuenter Roeck [hwmon_temp_lowest] = "temp%d_lowest", 292d560168bSGuenter Roeck [hwmon_temp_highest] = "temp%d_highest", 293d560168bSGuenter Roeck [hwmon_temp_reset_history] = "temp%d_reset_history", 294d560168bSGuenter Roeck }; 295d560168bSGuenter Roeck 29600d616cfSGuenter Roeck static const char * const hwmon_in_attr_templates[] = { 29700d616cfSGuenter Roeck [hwmon_in_input] = "in%d_input", 29800d616cfSGuenter Roeck [hwmon_in_min] = "in%d_min", 29900d616cfSGuenter Roeck [hwmon_in_max] = "in%d_max", 30000d616cfSGuenter Roeck [hwmon_in_lcrit] = "in%d_lcrit", 30100d616cfSGuenter Roeck [hwmon_in_crit] = "in%d_crit", 30200d616cfSGuenter Roeck [hwmon_in_average] = "in%d_average", 30300d616cfSGuenter Roeck [hwmon_in_lowest] = "in%d_lowest", 30400d616cfSGuenter Roeck [hwmon_in_highest] = "in%d_highest", 30500d616cfSGuenter Roeck [hwmon_in_reset_history] = "in%d_reset_history", 30600d616cfSGuenter Roeck [hwmon_in_label] = "in%d_label", 30700d616cfSGuenter Roeck [hwmon_in_alarm] = "in%d_alarm", 30800d616cfSGuenter Roeck [hwmon_in_min_alarm] = "in%d_min_alarm", 30900d616cfSGuenter Roeck [hwmon_in_max_alarm] = "in%d_max_alarm", 31000d616cfSGuenter Roeck [hwmon_in_lcrit_alarm] = "in%d_lcrit_alarm", 31100d616cfSGuenter Roeck [hwmon_in_crit_alarm] = "in%d_crit_alarm", 31200d616cfSGuenter Roeck }; 31300d616cfSGuenter Roeck 3149b26947cSGuenter Roeck static const char * const hwmon_curr_attr_templates[] = { 3159b26947cSGuenter Roeck [hwmon_curr_input] = "curr%d_input", 3169b26947cSGuenter Roeck [hwmon_curr_min] = "curr%d_min", 3179b26947cSGuenter Roeck [hwmon_curr_max] = "curr%d_max", 3189b26947cSGuenter Roeck [hwmon_curr_lcrit] = "curr%d_lcrit", 3199b26947cSGuenter Roeck [hwmon_curr_crit] = "curr%d_crit", 3209b26947cSGuenter Roeck [hwmon_curr_average] = "curr%d_average", 3219b26947cSGuenter Roeck [hwmon_curr_lowest] = "curr%d_lowest", 3229b26947cSGuenter Roeck [hwmon_curr_highest] = "curr%d_highest", 3239b26947cSGuenter Roeck [hwmon_curr_reset_history] = "curr%d_reset_history", 3249b26947cSGuenter Roeck [hwmon_curr_label] = "curr%d_label", 3259b26947cSGuenter Roeck [hwmon_curr_alarm] = "curr%d_alarm", 3269b26947cSGuenter Roeck [hwmon_curr_min_alarm] = "curr%d_min_alarm", 3279b26947cSGuenter Roeck [hwmon_curr_max_alarm] = "curr%d_max_alarm", 3289b26947cSGuenter Roeck [hwmon_curr_lcrit_alarm] = "curr%d_lcrit_alarm", 3299b26947cSGuenter Roeck [hwmon_curr_crit_alarm] = "curr%d_crit_alarm", 3309b26947cSGuenter Roeck }; 3319b26947cSGuenter Roeck 332b308f5c7SGuenter Roeck static const char * const hwmon_power_attr_templates[] = { 333b308f5c7SGuenter Roeck [hwmon_power_average] = "power%d_average", 334b308f5c7SGuenter Roeck [hwmon_power_average_interval] = "power%d_average_interval", 335b308f5c7SGuenter Roeck [hwmon_power_average_interval_max] = "power%d_interval_max", 336b308f5c7SGuenter Roeck [hwmon_power_average_interval_min] = "power%d_interval_min", 337b308f5c7SGuenter Roeck [hwmon_power_average_highest] = "power%d_average_highest", 338b308f5c7SGuenter Roeck [hwmon_power_average_lowest] = "power%d_average_lowest", 339b308f5c7SGuenter Roeck [hwmon_power_average_max] = "power%d_average_max", 340b308f5c7SGuenter Roeck [hwmon_power_average_min] = "power%d_average_min", 341b308f5c7SGuenter Roeck [hwmon_power_input] = "power%d_input", 342b308f5c7SGuenter Roeck [hwmon_power_input_highest] = "power%d_input_highest", 343b308f5c7SGuenter Roeck [hwmon_power_input_lowest] = "power%d_input_lowest", 344b308f5c7SGuenter Roeck [hwmon_power_reset_history] = "power%d_reset_history", 345b308f5c7SGuenter Roeck [hwmon_power_accuracy] = "power%d_accuracy", 346b308f5c7SGuenter Roeck [hwmon_power_cap] = "power%d_cap", 347b308f5c7SGuenter Roeck [hwmon_power_cap_hyst] = "power%d_cap_hyst", 348b308f5c7SGuenter Roeck [hwmon_power_cap_max] = "power%d_cap_max", 349b308f5c7SGuenter Roeck [hwmon_power_cap_min] = "power%d_cap_min", 350b308f5c7SGuenter Roeck [hwmon_power_max] = "power%d_max", 351b308f5c7SGuenter Roeck [hwmon_power_crit] = "power%d_crit", 352b308f5c7SGuenter Roeck [hwmon_power_label] = "power%d_label", 353b308f5c7SGuenter Roeck [hwmon_power_alarm] = "power%d_alarm", 354b308f5c7SGuenter Roeck [hwmon_power_cap_alarm] = "power%d_cap_alarm", 355b308f5c7SGuenter Roeck [hwmon_power_max_alarm] = "power%d_max_alarm", 356b308f5c7SGuenter Roeck [hwmon_power_crit_alarm] = "power%d_crit_alarm", 357b308f5c7SGuenter Roeck }; 358b308f5c7SGuenter Roeck 3596bfcca44SGuenter Roeck static const char * const hwmon_energy_attr_templates[] = { 3606bfcca44SGuenter Roeck [hwmon_energy_input] = "energy%d_input", 3616bfcca44SGuenter Roeck [hwmon_energy_label] = "energy%d_label", 3626bfcca44SGuenter Roeck }; 3636bfcca44SGuenter Roeck 3646bfcca44SGuenter Roeck static const char * const hwmon_humidity_attr_templates[] = { 3656bfcca44SGuenter Roeck [hwmon_humidity_input] = "humidity%d_input", 3666bfcca44SGuenter Roeck [hwmon_humidity_label] = "humidity%d_label", 3676bfcca44SGuenter Roeck [hwmon_humidity_min] = "humidity%d_min", 3686bfcca44SGuenter Roeck [hwmon_humidity_min_hyst] = "humidity%d_min_hyst", 3696bfcca44SGuenter Roeck [hwmon_humidity_max] = "humidity%d_max", 3706bfcca44SGuenter Roeck [hwmon_humidity_max_hyst] = "humidity%d_max_hyst", 3716bfcca44SGuenter Roeck [hwmon_humidity_alarm] = "humidity%d_alarm", 3726bfcca44SGuenter Roeck [hwmon_humidity_fault] = "humidity%d_fault", 3736bfcca44SGuenter Roeck }; 3746bfcca44SGuenter Roeck 375*8faee73fSGuenter Roeck static const char * const hwmon_fan_attr_templates[] = { 376*8faee73fSGuenter Roeck [hwmon_fan_input] = "fan%d_input", 377*8faee73fSGuenter Roeck [hwmon_fan_label] = "fan%d_label", 378*8faee73fSGuenter Roeck [hwmon_fan_min] = "fan%d_min", 379*8faee73fSGuenter Roeck [hwmon_fan_max] = "fan%d_max", 380*8faee73fSGuenter Roeck [hwmon_fan_div] = "fan%d_div", 381*8faee73fSGuenter Roeck [hwmon_fan_pulses] = "fan%d_pulses", 382*8faee73fSGuenter Roeck [hwmon_fan_target] = "fan%d_target", 383*8faee73fSGuenter Roeck [hwmon_fan_alarm] = "fan%d_alarm", 384*8faee73fSGuenter Roeck [hwmon_fan_min_alarm] = "fan%d_min_alarm", 385*8faee73fSGuenter Roeck [hwmon_fan_max_alarm] = "fan%d_max_alarm", 386*8faee73fSGuenter Roeck [hwmon_fan_fault] = "fan%d_fault", 387*8faee73fSGuenter Roeck }; 388*8faee73fSGuenter Roeck 389d560168bSGuenter Roeck static const char * const *__templates[] = { 390d560168bSGuenter Roeck [hwmon_chip] = hwmon_chip_attr_templates, 391d560168bSGuenter Roeck [hwmon_temp] = hwmon_temp_attr_templates, 39200d616cfSGuenter Roeck [hwmon_in] = hwmon_in_attr_templates, 3939b26947cSGuenter Roeck [hwmon_curr] = hwmon_curr_attr_templates, 394b308f5c7SGuenter Roeck [hwmon_power] = hwmon_power_attr_templates, 3956bfcca44SGuenter Roeck [hwmon_energy] = hwmon_energy_attr_templates, 3966bfcca44SGuenter Roeck [hwmon_humidity] = hwmon_humidity_attr_templates, 397*8faee73fSGuenter Roeck [hwmon_fan] = hwmon_fan_attr_templates, 398d560168bSGuenter Roeck }; 399d560168bSGuenter Roeck 400d560168bSGuenter Roeck static const int __templates_size[] = { 401d560168bSGuenter Roeck [hwmon_chip] = ARRAY_SIZE(hwmon_chip_attr_templates), 402d560168bSGuenter Roeck [hwmon_temp] = ARRAY_SIZE(hwmon_temp_attr_templates), 40300d616cfSGuenter Roeck [hwmon_in] = ARRAY_SIZE(hwmon_in_attr_templates), 4049b26947cSGuenter Roeck [hwmon_curr] = ARRAY_SIZE(hwmon_curr_attr_templates), 405b308f5c7SGuenter Roeck [hwmon_power] = ARRAY_SIZE(hwmon_power_attr_templates), 4066bfcca44SGuenter Roeck [hwmon_energy] = ARRAY_SIZE(hwmon_energy_attr_templates), 4076bfcca44SGuenter Roeck [hwmon_humidity] = ARRAY_SIZE(hwmon_humidity_attr_templates), 408*8faee73fSGuenter Roeck [hwmon_fan] = ARRAY_SIZE(hwmon_fan_attr_templates), 409d560168bSGuenter Roeck }; 410d560168bSGuenter Roeck 411d560168bSGuenter Roeck static int hwmon_num_channel_attrs(const struct hwmon_channel_info *info) 412d560168bSGuenter Roeck { 413d560168bSGuenter Roeck int i, n; 414d560168bSGuenter Roeck 415d560168bSGuenter Roeck for (i = n = 0; info->config[i]; i++) 416d560168bSGuenter Roeck n += hweight32(info->config[i]); 417d560168bSGuenter Roeck 418d560168bSGuenter Roeck return n; 419d560168bSGuenter Roeck } 420d560168bSGuenter Roeck 421d560168bSGuenter Roeck static int hwmon_genattrs(struct device *dev, 422d560168bSGuenter Roeck const void *drvdata, 423d560168bSGuenter Roeck struct attribute **attrs, 424d560168bSGuenter Roeck const struct hwmon_ops *ops, 425d560168bSGuenter Roeck const struct hwmon_channel_info *info) 426d560168bSGuenter Roeck { 427d560168bSGuenter Roeck const char * const *templates; 428d560168bSGuenter Roeck int template_size; 429d560168bSGuenter Roeck int i, aindex = 0; 430d560168bSGuenter Roeck 431d560168bSGuenter Roeck if (info->type >= ARRAY_SIZE(__templates)) 432d560168bSGuenter Roeck return -EINVAL; 433d560168bSGuenter Roeck 434d560168bSGuenter Roeck templates = __templates[info->type]; 435d560168bSGuenter Roeck template_size = __templates_size[info->type]; 436d560168bSGuenter Roeck 437d560168bSGuenter Roeck for (i = 0; info->config[i]; i++) { 438d560168bSGuenter Roeck u32 attr_mask = info->config[i]; 439d560168bSGuenter Roeck u32 attr; 440d560168bSGuenter Roeck 441d560168bSGuenter Roeck while (attr_mask) { 442d560168bSGuenter Roeck struct attribute *a; 443d560168bSGuenter Roeck 444d560168bSGuenter Roeck attr = __ffs(attr_mask); 445d560168bSGuenter Roeck attr_mask &= ~BIT(attr); 446d560168bSGuenter Roeck if (attr >= template_size) 447d560168bSGuenter Roeck return -EINVAL; 448d560168bSGuenter Roeck a = hwmon_genattr(dev, drvdata, info->type, attr, i, 449d560168bSGuenter Roeck templates[attr], ops); 450d560168bSGuenter Roeck if (IS_ERR(a)) { 451d560168bSGuenter Roeck if (PTR_ERR(a) != -ENOENT) 452d560168bSGuenter Roeck return PTR_ERR(a); 453d560168bSGuenter Roeck continue; 454d560168bSGuenter Roeck } 455d560168bSGuenter Roeck attrs[aindex++] = a; 456d560168bSGuenter Roeck } 457d560168bSGuenter Roeck } 458d560168bSGuenter Roeck return aindex; 459d560168bSGuenter Roeck } 460d560168bSGuenter Roeck 461d560168bSGuenter Roeck static struct attribute ** 462d560168bSGuenter Roeck __hwmon_create_attrs(struct device *dev, const void *drvdata, 463d560168bSGuenter Roeck const struct hwmon_chip_info *chip) 464d560168bSGuenter Roeck { 465d560168bSGuenter Roeck int ret, i, aindex = 0, nattrs = 0; 466d560168bSGuenter Roeck struct attribute **attrs; 467d560168bSGuenter Roeck 468d560168bSGuenter Roeck for (i = 0; chip->info[i]; i++) 469d560168bSGuenter Roeck nattrs += hwmon_num_channel_attrs(chip->info[i]); 470d560168bSGuenter Roeck 471d560168bSGuenter Roeck if (nattrs == 0) 472d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 473d560168bSGuenter Roeck 474d560168bSGuenter Roeck attrs = devm_kcalloc(dev, nattrs + 1, sizeof(*attrs), GFP_KERNEL); 475d560168bSGuenter Roeck if (!attrs) 476d560168bSGuenter Roeck return ERR_PTR(-ENOMEM); 477d560168bSGuenter Roeck 478d560168bSGuenter Roeck for (i = 0; chip->info[i]; i++) { 479d560168bSGuenter Roeck ret = hwmon_genattrs(dev, drvdata, &attrs[aindex], chip->ops, 480d560168bSGuenter Roeck chip->info[i]); 481d560168bSGuenter Roeck if (ret < 0) 482d560168bSGuenter Roeck return ERR_PTR(ret); 483d560168bSGuenter Roeck aindex += ret; 484d560168bSGuenter Roeck } 485d560168bSGuenter Roeck 486d560168bSGuenter Roeck return attrs; 487d560168bSGuenter Roeck } 488d560168bSGuenter Roeck 489d560168bSGuenter Roeck static struct device * 490d560168bSGuenter Roeck __hwmon_device_register(struct device *dev, const char *name, void *drvdata, 491d560168bSGuenter Roeck const struct hwmon_chip_info *chip, 492d560168bSGuenter Roeck const struct attribute_group **groups) 493d560168bSGuenter Roeck { 494d560168bSGuenter Roeck struct hwmon_device *hwdev; 495d560168bSGuenter Roeck struct device *hdev; 496d560168bSGuenter Roeck int i, j, err, id; 497d560168bSGuenter Roeck 498d560168bSGuenter Roeck /* Do not accept invalid characters in hwmon name attribute */ 499d560168bSGuenter Roeck if (name && (!strlen(name) || strpbrk(name, "-* \t\n"))) 500d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 501d560168bSGuenter Roeck 502d560168bSGuenter Roeck id = ida_simple_get(&hwmon_ida, 0, 0, GFP_KERNEL); 503d560168bSGuenter Roeck if (id < 0) 504d560168bSGuenter Roeck return ERR_PTR(id); 505d560168bSGuenter Roeck 506d560168bSGuenter Roeck hwdev = kzalloc(sizeof(*hwdev), GFP_KERNEL); 507d560168bSGuenter Roeck if (hwdev == NULL) { 508d560168bSGuenter Roeck err = -ENOMEM; 509d560168bSGuenter Roeck goto ida_remove; 510d560168bSGuenter Roeck } 511d560168bSGuenter Roeck 512d560168bSGuenter Roeck hdev = &hwdev->dev; 513d560168bSGuenter Roeck 514d560168bSGuenter Roeck if (chip && chip->ops->is_visible) { 515d560168bSGuenter Roeck struct attribute **attrs; 516d560168bSGuenter Roeck int ngroups = 2; 517d560168bSGuenter Roeck 518d560168bSGuenter Roeck if (groups) 519d560168bSGuenter Roeck for (i = 0; groups[i]; i++) 520d560168bSGuenter Roeck ngroups++; 521d560168bSGuenter Roeck 522d560168bSGuenter Roeck hwdev->groups = devm_kcalloc(dev, ngroups, sizeof(*groups), 523d560168bSGuenter Roeck GFP_KERNEL); 524d560168bSGuenter Roeck if (!hwdev->groups) 525d560168bSGuenter Roeck return ERR_PTR(-ENOMEM); 526d560168bSGuenter Roeck 527d560168bSGuenter Roeck attrs = __hwmon_create_attrs(dev, drvdata, chip); 528d560168bSGuenter Roeck if (IS_ERR(attrs)) { 529d560168bSGuenter Roeck err = PTR_ERR(attrs); 530d560168bSGuenter Roeck goto free_hwmon; 531d560168bSGuenter Roeck } 532d560168bSGuenter Roeck 533d560168bSGuenter Roeck hwdev->group.attrs = attrs; 534d560168bSGuenter Roeck ngroups = 0; 535d560168bSGuenter Roeck hwdev->groups[ngroups++] = &hwdev->group; 536d560168bSGuenter Roeck 537d560168bSGuenter Roeck if (groups) { 538d560168bSGuenter Roeck for (i = 0; groups[i]; i++) 539d560168bSGuenter Roeck hwdev->groups[ngroups++] = groups[i]; 540d560168bSGuenter Roeck } 541d560168bSGuenter Roeck 542d560168bSGuenter Roeck hdev->groups = hwdev->groups; 543d560168bSGuenter Roeck } else { 544d560168bSGuenter Roeck hdev->groups = groups; 545d560168bSGuenter Roeck } 546d560168bSGuenter Roeck 547d560168bSGuenter Roeck hwdev->name = name; 548d560168bSGuenter Roeck hdev->class = &hwmon_class; 549d560168bSGuenter Roeck hdev->parent = dev; 550d560168bSGuenter Roeck hdev->of_node = dev ? dev->of_node : NULL; 551d560168bSGuenter Roeck hwdev->chip = chip; 552d560168bSGuenter Roeck dev_set_drvdata(hdev, drvdata); 553d560168bSGuenter Roeck dev_set_name(hdev, HWMON_ID_FORMAT, id); 554d560168bSGuenter Roeck err = device_register(hdev); 555d560168bSGuenter Roeck if (err) 556d560168bSGuenter Roeck goto free_hwmon; 557d560168bSGuenter Roeck 558d560168bSGuenter Roeck if (chip && chip->ops->is_visible && chip->ops->read && 559d560168bSGuenter Roeck chip->info[0]->type == hwmon_chip && 560d560168bSGuenter Roeck (chip->info[0]->config[0] & HWMON_C_REGISTER_TZ)) { 561d560168bSGuenter Roeck const struct hwmon_channel_info **info = chip->info; 562d560168bSGuenter Roeck 563d560168bSGuenter Roeck for (i = 1; info[i]; i++) { 564d560168bSGuenter Roeck if (info[i]->type != hwmon_temp) 565d560168bSGuenter Roeck continue; 566d560168bSGuenter Roeck 567d560168bSGuenter Roeck for (j = 0; info[i]->config[j]; j++) { 568d560168bSGuenter Roeck if (!chip->ops->is_visible(drvdata, hwmon_temp, 569d560168bSGuenter Roeck hwmon_temp_input, j)) 570d560168bSGuenter Roeck continue; 571d560168bSGuenter Roeck if (info[i]->config[j] & HWMON_T_INPUT) 572d560168bSGuenter Roeck hwmon_thermal_add_sensor(dev, hwdev, j); 573d560168bSGuenter Roeck } 574d560168bSGuenter Roeck } 575d560168bSGuenter Roeck } 576d560168bSGuenter Roeck 577d560168bSGuenter Roeck return hdev; 578d560168bSGuenter Roeck 579d560168bSGuenter Roeck free_hwmon: 580d560168bSGuenter Roeck kfree(hwdev); 581d560168bSGuenter Roeck ida_remove: 582d560168bSGuenter Roeck ida_simple_remove(&hwmon_ida, id); 583d560168bSGuenter Roeck return ERR_PTR(err); 584d560168bSGuenter Roeck } 585d560168bSGuenter Roeck 5861236441fSMark M. Hoffman /** 587bab2243cSGuenter Roeck * hwmon_device_register_with_groups - register w/ hwmon 588bab2243cSGuenter Roeck * @dev: the parent device 589bab2243cSGuenter Roeck * @name: hwmon name attribute 590bab2243cSGuenter Roeck * @drvdata: driver data to attach to created device 591bab2243cSGuenter Roeck * @groups: List of attribute groups to create 592bab2243cSGuenter Roeck * 593bab2243cSGuenter Roeck * hwmon_device_unregister() must be called when the device is no 594bab2243cSGuenter Roeck * longer needed. 595bab2243cSGuenter Roeck * 596bab2243cSGuenter Roeck * Returns the pointer to the new device. 597bab2243cSGuenter Roeck */ 598bab2243cSGuenter Roeck struct device * 599bab2243cSGuenter Roeck hwmon_device_register_with_groups(struct device *dev, const char *name, 600bab2243cSGuenter Roeck void *drvdata, 601bab2243cSGuenter Roeck const struct attribute_group **groups) 602bab2243cSGuenter Roeck { 603d560168bSGuenter Roeck return __hwmon_device_register(dev, name, drvdata, NULL, groups); 604bab2243cSGuenter Roeck } 605bab2243cSGuenter Roeck EXPORT_SYMBOL_GPL(hwmon_device_register_with_groups); 606bab2243cSGuenter Roeck 607bab2243cSGuenter Roeck /** 608d560168bSGuenter Roeck * hwmon_device_register_with_info - register w/ hwmon 609d560168bSGuenter Roeck * @dev: the parent device 610d560168bSGuenter Roeck * @name: hwmon name attribute 611d560168bSGuenter Roeck * @drvdata: driver data to attach to created device 612d560168bSGuenter Roeck * @info: Pointer to hwmon chip information 613d560168bSGuenter Roeck * @groups - pointer to list of driver specific attribute groups 614d560168bSGuenter Roeck * 615d560168bSGuenter Roeck * hwmon_device_unregister() must be called when the device is no 616d560168bSGuenter Roeck * longer needed. 617d560168bSGuenter Roeck * 618d560168bSGuenter Roeck * Returns the pointer to the new device. 619d560168bSGuenter Roeck */ 620d560168bSGuenter Roeck struct device * 621d560168bSGuenter Roeck hwmon_device_register_with_info(struct device *dev, const char *name, 622d560168bSGuenter Roeck void *drvdata, 623d560168bSGuenter Roeck const struct hwmon_chip_info *chip, 624d560168bSGuenter Roeck const struct attribute_group **groups) 625d560168bSGuenter Roeck { 626d560168bSGuenter Roeck if (chip && (!chip->ops || !chip->info)) 627d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 628d560168bSGuenter Roeck 629d560168bSGuenter Roeck return __hwmon_device_register(dev, name, drvdata, chip, groups); 630d560168bSGuenter Roeck } 631d560168bSGuenter Roeck EXPORT_SYMBOL_GPL(hwmon_device_register_with_info); 632d560168bSGuenter Roeck 633d560168bSGuenter Roeck /** 6341beeffe4STony Jones * hwmon_device_register - register w/ hwmon 6351236441fSMark M. Hoffman * @dev: the device to register 6361236441fSMark M. Hoffman * 6371beeffe4STony Jones * hwmon_device_unregister() must be called when the device is no 6381236441fSMark M. Hoffman * longer needed. 6391236441fSMark M. Hoffman * 6401beeffe4STony Jones * Returns the pointer to the new device. 6411236441fSMark M. Hoffman */ 6421beeffe4STony Jones struct device *hwmon_device_register(struct device *dev) 6431236441fSMark M. Hoffman { 644bab2243cSGuenter Roeck return hwmon_device_register_with_groups(dev, NULL, NULL, NULL); 6451236441fSMark M. Hoffman } 646839a9eefSFrans Meulenbroeks EXPORT_SYMBOL_GPL(hwmon_device_register); 6471236441fSMark M. Hoffman 6481236441fSMark M. Hoffman /** 6491236441fSMark M. Hoffman * hwmon_device_unregister - removes the previously registered class device 6501236441fSMark M. Hoffman * 6511beeffe4STony Jones * @dev: the class device to destroy 6521236441fSMark M. Hoffman */ 6531beeffe4STony Jones void hwmon_device_unregister(struct device *dev) 6541236441fSMark M. Hoffman { 6551236441fSMark M. Hoffman int id; 6561236441fSMark M. Hoffman 657739cf3a2SKay Sievers if (likely(sscanf(dev_name(dev), HWMON_ID_FORMAT, &id) == 1)) { 6581beeffe4STony Jones device_unregister(dev); 6594ca5f468SJonathan Cameron ida_simple_remove(&hwmon_ida, id); 6601236441fSMark M. Hoffman } else 6611beeffe4STony Jones dev_dbg(dev->parent, 6621236441fSMark M. Hoffman "hwmon_device_unregister() failed: bad class ID!\n"); 6631236441fSMark M. Hoffman } 664839a9eefSFrans Meulenbroeks EXPORT_SYMBOL_GPL(hwmon_device_unregister); 6651236441fSMark M. Hoffman 66674188cbaSGuenter Roeck static void devm_hwmon_release(struct device *dev, void *res) 66774188cbaSGuenter Roeck { 66874188cbaSGuenter Roeck struct device *hwdev = *(struct device **)res; 66974188cbaSGuenter Roeck 67074188cbaSGuenter Roeck hwmon_device_unregister(hwdev); 67174188cbaSGuenter Roeck } 67274188cbaSGuenter Roeck 67374188cbaSGuenter Roeck /** 67474188cbaSGuenter Roeck * devm_hwmon_device_register_with_groups - register w/ hwmon 67574188cbaSGuenter Roeck * @dev: the parent device 67674188cbaSGuenter Roeck * @name: hwmon name attribute 67774188cbaSGuenter Roeck * @drvdata: driver data to attach to created device 67874188cbaSGuenter Roeck * @groups: List of attribute groups to create 67974188cbaSGuenter Roeck * 68074188cbaSGuenter Roeck * Returns the pointer to the new device. The new device is automatically 68174188cbaSGuenter Roeck * unregistered with the parent device. 68274188cbaSGuenter Roeck */ 68374188cbaSGuenter Roeck struct device * 68474188cbaSGuenter Roeck devm_hwmon_device_register_with_groups(struct device *dev, const char *name, 68574188cbaSGuenter Roeck void *drvdata, 68674188cbaSGuenter Roeck const struct attribute_group **groups) 68774188cbaSGuenter Roeck { 68874188cbaSGuenter Roeck struct device **ptr, *hwdev; 68974188cbaSGuenter Roeck 69074188cbaSGuenter Roeck if (!dev) 69174188cbaSGuenter Roeck return ERR_PTR(-EINVAL); 69274188cbaSGuenter Roeck 69374188cbaSGuenter Roeck ptr = devres_alloc(devm_hwmon_release, sizeof(*ptr), GFP_KERNEL); 69474188cbaSGuenter Roeck if (!ptr) 69574188cbaSGuenter Roeck return ERR_PTR(-ENOMEM); 69674188cbaSGuenter Roeck 69774188cbaSGuenter Roeck hwdev = hwmon_device_register_with_groups(dev, name, drvdata, groups); 69874188cbaSGuenter Roeck if (IS_ERR(hwdev)) 69974188cbaSGuenter Roeck goto error; 70074188cbaSGuenter Roeck 70174188cbaSGuenter Roeck *ptr = hwdev; 70274188cbaSGuenter Roeck devres_add(dev, ptr); 70374188cbaSGuenter Roeck return hwdev; 70474188cbaSGuenter Roeck 70574188cbaSGuenter Roeck error: 70674188cbaSGuenter Roeck devres_free(ptr); 70774188cbaSGuenter Roeck return hwdev; 70874188cbaSGuenter Roeck } 70974188cbaSGuenter Roeck EXPORT_SYMBOL_GPL(devm_hwmon_device_register_with_groups); 71074188cbaSGuenter Roeck 711d560168bSGuenter Roeck /** 712d560168bSGuenter Roeck * devm_hwmon_device_register_with_info - register w/ hwmon 713d560168bSGuenter Roeck * @dev: the parent device 714d560168bSGuenter Roeck * @name: hwmon name attribute 715d560168bSGuenter Roeck * @drvdata: driver data to attach to created device 716d560168bSGuenter Roeck * @info: Pointer to hwmon chip information 717d560168bSGuenter Roeck * @groups - pointer to list of driver specific attribute groups 718d560168bSGuenter Roeck * 719d560168bSGuenter Roeck * Returns the pointer to the new device. The new device is automatically 720d560168bSGuenter Roeck * unregistered with the parent device. 721d560168bSGuenter Roeck */ 722d560168bSGuenter Roeck struct device * 723d560168bSGuenter Roeck devm_hwmon_device_register_with_info(struct device *dev, const char *name, 724d560168bSGuenter Roeck void *drvdata, 725d560168bSGuenter Roeck const struct hwmon_chip_info *chip, 726d560168bSGuenter Roeck const struct attribute_group **groups) 727d560168bSGuenter Roeck { 728d560168bSGuenter Roeck struct device **ptr, *hwdev; 729d560168bSGuenter Roeck 730d560168bSGuenter Roeck if (!dev) 731d560168bSGuenter Roeck return ERR_PTR(-EINVAL); 732d560168bSGuenter Roeck 733d560168bSGuenter Roeck ptr = devres_alloc(devm_hwmon_release, sizeof(*ptr), GFP_KERNEL); 734d560168bSGuenter Roeck if (!ptr) 735d560168bSGuenter Roeck return ERR_PTR(-ENOMEM); 736d560168bSGuenter Roeck 737d560168bSGuenter Roeck hwdev = hwmon_device_register_with_info(dev, name, drvdata, chip, 738d560168bSGuenter Roeck groups); 739d560168bSGuenter Roeck if (IS_ERR(hwdev)) 740d560168bSGuenter Roeck goto error; 741d560168bSGuenter Roeck 742d560168bSGuenter Roeck *ptr = hwdev; 743d560168bSGuenter Roeck devres_add(dev, ptr); 744d560168bSGuenter Roeck 745d560168bSGuenter Roeck return hwdev; 746d560168bSGuenter Roeck 747d560168bSGuenter Roeck error: 748d560168bSGuenter Roeck devres_free(ptr); 749d560168bSGuenter Roeck return hwdev; 750d560168bSGuenter Roeck } 751d560168bSGuenter Roeck EXPORT_SYMBOL_GPL(devm_hwmon_device_register_with_info); 752d560168bSGuenter Roeck 75374188cbaSGuenter Roeck static int devm_hwmon_match(struct device *dev, void *res, void *data) 75474188cbaSGuenter Roeck { 75574188cbaSGuenter Roeck struct device **hwdev = res; 75674188cbaSGuenter Roeck 75774188cbaSGuenter Roeck return *hwdev == data; 75874188cbaSGuenter Roeck } 75974188cbaSGuenter Roeck 76074188cbaSGuenter Roeck /** 76174188cbaSGuenter Roeck * devm_hwmon_device_unregister - removes a previously registered hwmon device 76274188cbaSGuenter Roeck * 76374188cbaSGuenter Roeck * @dev: the parent device of the device to unregister 76474188cbaSGuenter Roeck */ 76574188cbaSGuenter Roeck void devm_hwmon_device_unregister(struct device *dev) 76674188cbaSGuenter Roeck { 76774188cbaSGuenter Roeck WARN_ON(devres_release(dev, devm_hwmon_release, devm_hwmon_match, dev)); 76874188cbaSGuenter Roeck } 76974188cbaSGuenter Roeck EXPORT_SYMBOL_GPL(devm_hwmon_device_unregister); 77074188cbaSGuenter Roeck 7712958b1ecSJean Delvare static void __init hwmon_pci_quirks(void) 7722958b1ecSJean Delvare { 7732958b1ecSJean Delvare #if defined CONFIG_X86 && defined CONFIG_PCI 7742958b1ecSJean Delvare struct pci_dev *sb; 7752958b1ecSJean Delvare u16 base; 7762958b1ecSJean Delvare u8 enable; 7772958b1ecSJean Delvare 7782958b1ecSJean Delvare /* Open access to 0x295-0x296 on MSI MS-7031 */ 7792958b1ecSJean Delvare sb = pci_get_device(PCI_VENDOR_ID_ATI, 0x436c, NULL); 780d6dab7ddSJean Delvare if (sb) { 781d6dab7ddSJean Delvare if (sb->subsystem_vendor == 0x1462 && /* MSI */ 782d6dab7ddSJean Delvare sb->subsystem_device == 0x0031) { /* MS-7031 */ 7832958b1ecSJean Delvare pci_read_config_byte(sb, 0x48, &enable); 7842958b1ecSJean Delvare pci_read_config_word(sb, 0x64, &base); 7852958b1ecSJean Delvare 7862958b1ecSJean Delvare if (base == 0 && !(enable & BIT(2))) { 7872958b1ecSJean Delvare dev_info(&sb->dev, 7882958b1ecSJean Delvare "Opening wide generic port at 0x295\n"); 7892958b1ecSJean Delvare pci_write_config_word(sb, 0x64, 0x295); 790d6dab7ddSJean Delvare pci_write_config_byte(sb, 0x48, 791d6dab7ddSJean Delvare enable | BIT(2)); 7922958b1ecSJean Delvare } 7932958b1ecSJean Delvare } 794d6dab7ddSJean Delvare pci_dev_put(sb); 795d6dab7ddSJean Delvare } 7962958b1ecSJean Delvare #endif 7972958b1ecSJean Delvare } 7982958b1ecSJean Delvare 7991236441fSMark M. Hoffman static int __init hwmon_init(void) 8001236441fSMark M. Hoffman { 801bab2243cSGuenter Roeck int err; 802bab2243cSGuenter Roeck 8032958b1ecSJean Delvare hwmon_pci_quirks(); 8042958b1ecSJean Delvare 805bab2243cSGuenter Roeck err = class_register(&hwmon_class); 806bab2243cSGuenter Roeck if (err) { 807bab2243cSGuenter Roeck pr_err("couldn't register hwmon sysfs class\n"); 808bab2243cSGuenter Roeck return err; 8091236441fSMark M. Hoffman } 8101236441fSMark M. Hoffman return 0; 8111236441fSMark M. Hoffman } 8121236441fSMark M. Hoffman 8131236441fSMark M. Hoffman static void __exit hwmon_exit(void) 8141236441fSMark M. Hoffman { 815bab2243cSGuenter Roeck class_unregister(&hwmon_class); 8161236441fSMark M. Hoffman } 8171236441fSMark M. Hoffman 81837f54ee5SDavid Brownell subsys_initcall(hwmon_init); 8191236441fSMark M. Hoffman module_exit(hwmon_exit); 8201236441fSMark M. Hoffman 8211236441fSMark M. Hoffman MODULE_AUTHOR("Mark M. Hoffman <mhoffman@lightlink.com>"); 8221236441fSMark M. Hoffman MODULE_DESCRIPTION("hardware monitoring sysfs/class support"); 8231236441fSMark M. Hoffman MODULE_LICENSE("GPL"); 8241236441fSMark M. Hoffman 825