mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-25 19:40:56 +07:00
2f2408a88c
* 'hwmon-for-linus' of git://jdelvare.pck.nerim.net/jdelvare-2.6: (29 commits) hwmon: Fix various typos hwmon: Check for ACPI resource conflicts hwmon: (lm70) Add TI TMP121 support hwmon: (lm70) Code streamlining and cleanup hwmon: Deprecate the fscher and fscpos drivers hwmon: (fschmd) Add watchdog support hwmon: (fschmd) Cleanups for watchdog support hwmon: (i5k_amb) Load automatically on all 5000/5400 chipsets hwmon: (it87) Add support for the ITE IT8720F hwmon: Don't overuse I2C_CLIENT_MODULE_PARM hwmon: Add LTC4245 driver hwmon: (f71882fg) Fix fan_to/from_reg prototypes hwmon: (f71882fg) Printout fan modes hwmon: (f71882fg) Add documentation hwmon: (f71882fg) Fix auto_channels_temp temp numbering with f8000 hwmon: (f71882fg) Add missing pwm3 attr for f71862fg hwmon: (f71882fg) Add F8000 support hwmon: (f71882fg) Remove the fan_mode module option hwmon: (f71882fg) Separate max and crit alarm and beep hwmon: (f71882fg) Check for hwmon powerdown state ...
1229 lines
36 KiB
C
1229 lines
36 KiB
C
/* fschmd.c
|
|
*
|
|
* Copyright (C) 2007,2008 Hans de Goede <hdegoede@redhat.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
|
*/
|
|
|
|
/*
|
|
* Merged Fujitsu Siemens hwmon driver, supporting the Poseidon, Hermes,
|
|
* Scylla, Heracles and Heimdall chips
|
|
*
|
|
* Based on the original 2.4 fscscy, 2.6 fscpos, 2.6 fscher and 2.6
|
|
* (candidate) fschmd drivers:
|
|
* Copyright (C) 2006 Thilo Cestonaro
|
|
* <thilo.cestonaro.external@fujitsu-siemens.com>
|
|
* Copyright (C) 2004, 2005 Stefan Ott <stefan@desire.ch>
|
|
* Copyright (C) 2003, 2004 Reinhard Nissl <rnissl@gmx.de>
|
|
* Copyright (c) 2001 Martin Knoblauch <mkn@teraport.de, knobi@knobisoft.de>
|
|
* Copyright (C) 2000 Hermann Jung <hej@odn.de>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/hwmon.h>
|
|
#include <linux/hwmon-sysfs.h>
|
|
#include <linux/err.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/sysfs.h>
|
|
#include <linux/dmi.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/watchdog.h>
|
|
#include <linux/miscdevice.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/kref.h>
|
|
|
|
/* Addresses to scan */
|
|
static const unsigned short normal_i2c[] = { 0x73, I2C_CLIENT_END };
|
|
|
|
/* Insmod parameters */
|
|
static int nowayout = WATCHDOG_NOWAYOUT;
|
|
module_param(nowayout, int, 0);
|
|
MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started (default="
|
|
__MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
|
|
I2C_CLIENT_INSMOD_5(fscpos, fscher, fscscy, fschrc, fschmd);
|
|
|
|
/*
|
|
* The FSCHMD registers and other defines
|
|
*/
|
|
|
|
/* chip identification */
|
|
#define FSCHMD_REG_IDENT_0 0x00
|
|
#define FSCHMD_REG_IDENT_1 0x01
|
|
#define FSCHMD_REG_IDENT_2 0x02
|
|
#define FSCHMD_REG_REVISION 0x03
|
|
|
|
/* global control and status */
|
|
#define FSCHMD_REG_EVENT_STATE 0x04
|
|
#define FSCHMD_REG_CONTROL 0x05
|
|
|
|
#define FSCHMD_CONTROL_ALERT_LED 0x01
|
|
|
|
/* watchdog */
|
|
#define FSCHMD_REG_WDOG_PRESET 0x28
|
|
#define FSCHMD_REG_WDOG_STATE 0x23
|
|
#define FSCHMD_REG_WDOG_CONTROL 0x21
|
|
|
|
#define FSCHMD_WDOG_CONTROL_TRIGGER 0x10
|
|
#define FSCHMD_WDOG_CONTROL_STARTED 0x10 /* the same as trigger */
|
|
#define FSCHMD_WDOG_CONTROL_STOP 0x20
|
|
#define FSCHMD_WDOG_CONTROL_RESOLUTION 0x40
|
|
|
|
#define FSCHMD_WDOG_STATE_CARDRESET 0x02
|
|
|
|
/* voltages, weird order is to keep the same order as the old drivers */
|
|
static const u8 FSCHMD_REG_VOLT[3] = { 0x45, 0x42, 0x48 };
|
|
|
|
/* minimum pwm at which the fan is driven (pwm can by increased depending on
|
|
the temp. Notice that for the scy some fans share there minimum speed.
|
|
Also notice that with the scy the sensor order is different than with the
|
|
other chips, this order was in the 2.4 driver and kept for consistency. */
|
|
static const u8 FSCHMD_REG_FAN_MIN[5][6] = {
|
|
{ 0x55, 0x65 }, /* pos */
|
|
{ 0x55, 0x65, 0xb5 }, /* her */
|
|
{ 0x65, 0x65, 0x55, 0xa5, 0x55, 0xa5 }, /* scy */
|
|
{ 0x55, 0x65, 0xa5, 0xb5 }, /* hrc */
|
|
{ 0x55, 0x65, 0xa5, 0xb5, 0xc5 }, /* hmd */
|
|
};
|
|
|
|
/* actual fan speed */
|
|
static const u8 FSCHMD_REG_FAN_ACT[5][6] = {
|
|
{ 0x0e, 0x6b, 0xab }, /* pos */
|
|
{ 0x0e, 0x6b, 0xbb }, /* her */
|
|
{ 0x6b, 0x6c, 0x0e, 0xab, 0x5c, 0xbb }, /* scy */
|
|
{ 0x0e, 0x6b, 0xab, 0xbb }, /* hrc */
|
|
{ 0x5b, 0x6b, 0xab, 0xbb, 0xcb }, /* hmd */
|
|
};
|
|
|
|
/* fan status registers */
|
|
static const u8 FSCHMD_REG_FAN_STATE[5][6] = {
|
|
{ 0x0d, 0x62, 0xa2 }, /* pos */
|
|
{ 0x0d, 0x62, 0xb2 }, /* her */
|
|
{ 0x62, 0x61, 0x0d, 0xa2, 0x52, 0xb2 }, /* scy */
|
|
{ 0x0d, 0x62, 0xa2, 0xb2 }, /* hrc */
|
|
{ 0x52, 0x62, 0xa2, 0xb2, 0xc2 }, /* hmd */
|
|
};
|
|
|
|
/* fan ripple / divider registers */
|
|
static const u8 FSCHMD_REG_FAN_RIPPLE[5][6] = {
|
|
{ 0x0f, 0x6f, 0xaf }, /* pos */
|
|
{ 0x0f, 0x6f, 0xbf }, /* her */
|
|
{ 0x6f, 0x6f, 0x0f, 0xaf, 0x0f, 0xbf }, /* scy */
|
|
{ 0x0f, 0x6f, 0xaf, 0xbf }, /* hrc */
|
|
{ 0x5f, 0x6f, 0xaf, 0xbf, 0xcf }, /* hmd */
|
|
};
|
|
|
|
static const int FSCHMD_NO_FAN_SENSORS[5] = { 3, 3, 6, 4, 5 };
|
|
|
|
/* Fan status register bitmasks */
|
|
#define FSCHMD_FAN_ALARM 0x04 /* called fault by FSC! */
|
|
#define FSCHMD_FAN_NOT_PRESENT 0x08 /* not documented */
|
|
|
|
|
|
/* actual temperature registers */
|
|
static const u8 FSCHMD_REG_TEMP_ACT[5][5] = {
|
|
{ 0x64, 0x32, 0x35 }, /* pos */
|
|
{ 0x64, 0x32, 0x35 }, /* her */
|
|
{ 0x64, 0xD0, 0x32, 0x35 }, /* scy */
|
|
{ 0x64, 0x32, 0x35 }, /* hrc */
|
|
{ 0x70, 0x80, 0x90, 0xd0, 0xe0 }, /* hmd */
|
|
};
|
|
|
|
/* temperature state registers */
|
|
static const u8 FSCHMD_REG_TEMP_STATE[5][5] = {
|
|
{ 0x71, 0x81, 0x91 }, /* pos */
|
|
{ 0x71, 0x81, 0x91 }, /* her */
|
|
{ 0x71, 0xd1, 0x81, 0x91 }, /* scy */
|
|
{ 0x71, 0x81, 0x91 }, /* hrc */
|
|
{ 0x71, 0x81, 0x91, 0xd1, 0xe1 }, /* hmd */
|
|
};
|
|
|
|
/* temperature high limit registers, FSC does not document these. Proven to be
|
|
there with field testing on the fscher and fschrc, already supported / used
|
|
in the fscscy 2.4 driver. FSC has confirmed that the fschmd has registers
|
|
at these addresses, but doesn't want to confirm they are the same as with
|
|
the fscher?? */
|
|
static const u8 FSCHMD_REG_TEMP_LIMIT[5][5] = {
|
|
{ 0, 0, 0 }, /* pos */
|
|
{ 0x76, 0x86, 0x96 }, /* her */
|
|
{ 0x76, 0xd6, 0x86, 0x96 }, /* scy */
|
|
{ 0x76, 0x86, 0x96 }, /* hrc */
|
|
{ 0x76, 0x86, 0x96, 0xd6, 0xe6 }, /* hmd */
|
|
};
|
|
|
|
/* These were found through experimenting with an fscher, currently they are
|
|
not used, but we keep them around for future reference.
|
|
static const u8 FSCHER_REG_TEMP_AUTOP1[] = { 0x73, 0x83, 0x93 };
|
|
static const u8 FSCHER_REG_TEMP_AUTOP2[] = { 0x75, 0x85, 0x95 }; */
|
|
|
|
static const int FSCHMD_NO_TEMP_SENSORS[5] = { 3, 3, 4, 3, 5 };
|
|
|
|
/* temp status register bitmasks */
|
|
#define FSCHMD_TEMP_WORKING 0x01
|
|
#define FSCHMD_TEMP_ALERT 0x02
|
|
/* there only really is an alarm if the sensor is working and alert == 1 */
|
|
#define FSCHMD_TEMP_ALARM_MASK \
|
|
(FSCHMD_TEMP_WORKING | FSCHMD_TEMP_ALERT)
|
|
|
|
/*
|
|
* Functions declarations
|
|
*/
|
|
|
|
static int fschmd_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id);
|
|
static int fschmd_detect(struct i2c_client *client, int kind,
|
|
struct i2c_board_info *info);
|
|
static int fschmd_remove(struct i2c_client *client);
|
|
static struct fschmd_data *fschmd_update_device(struct device *dev);
|
|
|
|
/*
|
|
* Driver data (common to all clients)
|
|
*/
|
|
|
|
static const struct i2c_device_id fschmd_id[] = {
|
|
{ "fscpos", fscpos },
|
|
{ "fscher", fscher },
|
|
{ "fscscy", fscscy },
|
|
{ "fschrc", fschrc },
|
|
{ "fschmd", fschmd },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, fschmd_id);
|
|
|
|
static struct i2c_driver fschmd_driver = {
|
|
.class = I2C_CLASS_HWMON,
|
|
.driver = {
|
|
.name = "fschmd",
|
|
},
|
|
.probe = fschmd_probe,
|
|
.remove = fschmd_remove,
|
|
.id_table = fschmd_id,
|
|
.detect = fschmd_detect,
|
|
.address_data = &addr_data,
|
|
};
|
|
|
|
/*
|
|
* Client data (each client gets its own)
|
|
*/
|
|
|
|
struct fschmd_data {
|
|
struct i2c_client *client;
|
|
struct device *hwmon_dev;
|
|
struct mutex update_lock;
|
|
struct mutex watchdog_lock;
|
|
struct list_head list; /* member of the watchdog_data_list */
|
|
struct kref kref;
|
|
struct miscdevice watchdog_miscdev;
|
|
int kind;
|
|
unsigned long watchdog_is_open;
|
|
char watchdog_expect_close;
|
|
char watchdog_name[10]; /* must be unique to avoid sysfs conflict */
|
|
char valid; /* zero until following fields are valid */
|
|
unsigned long last_updated; /* in jiffies */
|
|
|
|
/* register values */
|
|
u8 revision; /* chip revision */
|
|
u8 global_control; /* global control register */
|
|
u8 watchdog_control; /* watchdog control register */
|
|
u8 watchdog_state; /* watchdog status register */
|
|
u8 watchdog_preset; /* watchdog counter preset on trigger val */
|
|
u8 volt[3]; /* 12, 5, battery voltage */
|
|
u8 temp_act[5]; /* temperature */
|
|
u8 temp_status[5]; /* status of sensor */
|
|
u8 temp_max[5]; /* high temp limit, notice: undocumented! */
|
|
u8 fan_act[6]; /* fans revolutions per second */
|
|
u8 fan_status[6]; /* fan status */
|
|
u8 fan_min[6]; /* fan min value for rps */
|
|
u8 fan_ripple[6]; /* divider for rps */
|
|
};
|
|
|
|
/* Global variables to hold information read from special DMI tables, which are
|
|
available on FSC machines with an fscher or later chip. There is no need to
|
|
protect these with a lock as they are only modified from our attach function
|
|
which always gets called with the i2c-core lock held and never accessed
|
|
before the attach function is done with them. */
|
|
static int dmi_mult[3] = { 490, 200, 100 };
|
|
static int dmi_offset[3] = { 0, 0, 0 };
|
|
static int dmi_vref = -1;
|
|
|
|
/* Somewhat ugly :( global data pointer list with all fschmd devices, so that
|
|
we can find our device data as when using misc_register there is no other
|
|
method to get to ones device data from the open fop. */
|
|
static LIST_HEAD(watchdog_data_list);
|
|
/* Note this lock not only protect list access, but also data.kref access */
|
|
static DEFINE_MUTEX(watchdog_data_mutex);
|
|
|
|
/* Release our data struct when we're detached from the i2c client *and* all
|
|
references to our watchdog device are released */
|
|
static void fschmd_release_resources(struct kref *ref)
|
|
{
|
|
struct fschmd_data *data = container_of(ref, struct fschmd_data, kref);
|
|
kfree(data);
|
|
}
|
|
|
|
/*
|
|
* Sysfs attr show / store functions
|
|
*/
|
|
|
|
static ssize_t show_in_value(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
const int max_reading[3] = { 14200, 6600, 3300 };
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
/* fscher / fschrc - 1 as data->kind is an array index, not a chips */
|
|
if (data->kind == (fscher - 1) || data->kind >= (fschrc - 1))
|
|
return sprintf(buf, "%d\n", (data->volt[index] * dmi_vref *
|
|
dmi_mult[index]) / 255 + dmi_offset[index]);
|
|
else
|
|
return sprintf(buf, "%d\n", (data->volt[index] *
|
|
max_reading[index] + 128) / 255);
|
|
}
|
|
|
|
|
|
#define TEMP_FROM_REG(val) (((val) - 128) * 1000)
|
|
|
|
static ssize_t show_temp_value(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_act[index]));
|
|
}
|
|
|
|
static ssize_t show_temp_max(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
return sprintf(buf, "%d\n", TEMP_FROM_REG(data->temp_max[index]));
|
|
}
|
|
|
|
static ssize_t store_temp_max(struct device *dev, struct device_attribute
|
|
*devattr, const char *buf, size_t count)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = dev_get_drvdata(dev);
|
|
long v = simple_strtol(buf, NULL, 10) / 1000;
|
|
|
|
v = SENSORS_LIMIT(v, -128, 127) + 128;
|
|
|
|
mutex_lock(&data->update_lock);
|
|
i2c_smbus_write_byte_data(to_i2c_client(dev),
|
|
FSCHMD_REG_TEMP_LIMIT[data->kind][index], v);
|
|
data->temp_max[index] = v;
|
|
mutex_unlock(&data->update_lock);
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t show_temp_fault(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
/* bit 0 set means sensor working ok, so no fault! */
|
|
if (data->temp_status[index] & FSCHMD_TEMP_WORKING)
|
|
return sprintf(buf, "0\n");
|
|
else
|
|
return sprintf(buf, "1\n");
|
|
}
|
|
|
|
static ssize_t show_temp_alarm(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
if ((data->temp_status[index] & FSCHMD_TEMP_ALARM_MASK) ==
|
|
FSCHMD_TEMP_ALARM_MASK)
|
|
return sprintf(buf, "1\n");
|
|
else
|
|
return sprintf(buf, "0\n");
|
|
}
|
|
|
|
|
|
#define RPM_FROM_REG(val) ((val) * 60)
|
|
|
|
static ssize_t show_fan_value(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
return sprintf(buf, "%u\n", RPM_FROM_REG(data->fan_act[index]));
|
|
}
|
|
|
|
static ssize_t show_fan_div(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
/* bits 2..7 reserved => mask with 3 */
|
|
return sprintf(buf, "%d\n", 1 << (data->fan_ripple[index] & 3));
|
|
}
|
|
|
|
static ssize_t store_fan_div(struct device *dev, struct device_attribute
|
|
*devattr, const char *buf, size_t count)
|
|
{
|
|
u8 reg;
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = dev_get_drvdata(dev);
|
|
/* supported values: 2, 4, 8 */
|
|
unsigned long v = simple_strtoul(buf, NULL, 10);
|
|
|
|
switch (v) {
|
|
case 2: v = 1; break;
|
|
case 4: v = 2; break;
|
|
case 8: v = 3; break;
|
|
default:
|
|
dev_err(dev, "fan_div value %lu not supported. "
|
|
"Choose one of 2, 4 or 8!\n", v);
|
|
return -EINVAL;
|
|
}
|
|
|
|
mutex_lock(&data->update_lock);
|
|
|
|
reg = i2c_smbus_read_byte_data(to_i2c_client(dev),
|
|
FSCHMD_REG_FAN_RIPPLE[data->kind][index]);
|
|
|
|
/* bits 2..7 reserved => mask with 0x03 */
|
|
reg &= ~0x03;
|
|
reg |= v;
|
|
|
|
i2c_smbus_write_byte_data(to_i2c_client(dev),
|
|
FSCHMD_REG_FAN_RIPPLE[data->kind][index], reg);
|
|
|
|
data->fan_ripple[index] = reg;
|
|
|
|
mutex_unlock(&data->update_lock);
|
|
|
|
return count;
|
|
}
|
|
|
|
static ssize_t show_fan_alarm(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
if (data->fan_status[index] & FSCHMD_FAN_ALARM)
|
|
return sprintf(buf, "1\n");
|
|
else
|
|
return sprintf(buf, "0\n");
|
|
}
|
|
|
|
static ssize_t show_fan_fault(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
if (data->fan_status[index] & FSCHMD_FAN_NOT_PRESENT)
|
|
return sprintf(buf, "1\n");
|
|
else
|
|
return sprintf(buf, "0\n");
|
|
}
|
|
|
|
|
|
static ssize_t show_pwm_auto_point1_pwm(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
int val = fschmd_update_device(dev)->fan_min[index];
|
|
|
|
/* 0 = allow turning off, 1-255 = 50-100% */
|
|
if (val)
|
|
val = val / 2 + 128;
|
|
|
|
return sprintf(buf, "%d\n", val);
|
|
}
|
|
|
|
static ssize_t store_pwm_auto_point1_pwm(struct device *dev,
|
|
struct device_attribute *devattr, const char *buf, size_t count)
|
|
{
|
|
int index = to_sensor_dev_attr(devattr)->index;
|
|
struct fschmd_data *data = dev_get_drvdata(dev);
|
|
unsigned long v = simple_strtoul(buf, NULL, 10);
|
|
|
|
/* register: 0 = allow turning off, 1-255 = 50-100% */
|
|
if (v) {
|
|
v = SENSORS_LIMIT(v, 128, 255);
|
|
v = (v - 128) * 2 + 1;
|
|
}
|
|
|
|
mutex_lock(&data->update_lock);
|
|
|
|
i2c_smbus_write_byte_data(to_i2c_client(dev),
|
|
FSCHMD_REG_FAN_MIN[data->kind][index], v);
|
|
data->fan_min[index] = v;
|
|
|
|
mutex_unlock(&data->update_lock);
|
|
|
|
return count;
|
|
}
|
|
|
|
|
|
/* The FSC hwmon family has the ability to force an attached alert led to flash
|
|
from software, we export this as an alert_led sysfs attr */
|
|
static ssize_t show_alert_led(struct device *dev,
|
|
struct device_attribute *devattr, char *buf)
|
|
{
|
|
struct fschmd_data *data = fschmd_update_device(dev);
|
|
|
|
if (data->global_control & FSCHMD_CONTROL_ALERT_LED)
|
|
return sprintf(buf, "1\n");
|
|
else
|
|
return sprintf(buf, "0\n");
|
|
}
|
|
|
|
static ssize_t store_alert_led(struct device *dev,
|
|
struct device_attribute *devattr, const char *buf, size_t count)
|
|
{
|
|
u8 reg;
|
|
struct fschmd_data *data = dev_get_drvdata(dev);
|
|
unsigned long v = simple_strtoul(buf, NULL, 10);
|
|
|
|
mutex_lock(&data->update_lock);
|
|
|
|
reg = i2c_smbus_read_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL);
|
|
|
|
if (v)
|
|
reg |= FSCHMD_CONTROL_ALERT_LED;
|
|
else
|
|
reg &= ~FSCHMD_CONTROL_ALERT_LED;
|
|
|
|
i2c_smbus_write_byte_data(to_i2c_client(dev), FSCHMD_REG_CONTROL, reg);
|
|
|
|
data->global_control = reg;
|
|
|
|
mutex_unlock(&data->update_lock);
|
|
|
|
return count;
|
|
}
|
|
|
|
static struct sensor_device_attribute fschmd_attr[] = {
|
|
SENSOR_ATTR(in0_input, 0444, show_in_value, NULL, 0),
|
|
SENSOR_ATTR(in1_input, 0444, show_in_value, NULL, 1),
|
|
SENSOR_ATTR(in2_input, 0444, show_in_value, NULL, 2),
|
|
SENSOR_ATTR(alert_led, 0644, show_alert_led, store_alert_led, 0),
|
|
};
|
|
|
|
static struct sensor_device_attribute fschmd_temp_attr[] = {
|
|
SENSOR_ATTR(temp1_input, 0444, show_temp_value, NULL, 0),
|
|
SENSOR_ATTR(temp1_max, 0644, show_temp_max, store_temp_max, 0),
|
|
SENSOR_ATTR(temp1_fault, 0444, show_temp_fault, NULL, 0),
|
|
SENSOR_ATTR(temp1_alarm, 0444, show_temp_alarm, NULL, 0),
|
|
SENSOR_ATTR(temp2_input, 0444, show_temp_value, NULL, 1),
|
|
SENSOR_ATTR(temp2_max, 0644, show_temp_max, store_temp_max, 1),
|
|
SENSOR_ATTR(temp2_fault, 0444, show_temp_fault, NULL, 1),
|
|
SENSOR_ATTR(temp2_alarm, 0444, show_temp_alarm, NULL, 1),
|
|
SENSOR_ATTR(temp3_input, 0444, show_temp_value, NULL, 2),
|
|
SENSOR_ATTR(temp3_max, 0644, show_temp_max, store_temp_max, 2),
|
|
SENSOR_ATTR(temp3_fault, 0444, show_temp_fault, NULL, 2),
|
|
SENSOR_ATTR(temp3_alarm, 0444, show_temp_alarm, NULL, 2),
|
|
SENSOR_ATTR(temp4_input, 0444, show_temp_value, NULL, 3),
|
|
SENSOR_ATTR(temp4_max, 0644, show_temp_max, store_temp_max, 3),
|
|
SENSOR_ATTR(temp4_fault, 0444, show_temp_fault, NULL, 3),
|
|
SENSOR_ATTR(temp4_alarm, 0444, show_temp_alarm, NULL, 3),
|
|
SENSOR_ATTR(temp5_input, 0444, show_temp_value, NULL, 4),
|
|
SENSOR_ATTR(temp5_max, 0644, show_temp_max, store_temp_max, 4),
|
|
SENSOR_ATTR(temp5_fault, 0444, show_temp_fault, NULL, 4),
|
|
SENSOR_ATTR(temp5_alarm, 0444, show_temp_alarm, NULL, 4),
|
|
};
|
|
|
|
static struct sensor_device_attribute fschmd_fan_attr[] = {
|
|
SENSOR_ATTR(fan1_input, 0444, show_fan_value, NULL, 0),
|
|
SENSOR_ATTR(fan1_div, 0644, show_fan_div, store_fan_div, 0),
|
|
SENSOR_ATTR(fan1_alarm, 0444, show_fan_alarm, NULL, 0),
|
|
SENSOR_ATTR(fan1_fault, 0444, show_fan_fault, NULL, 0),
|
|
SENSOR_ATTR(pwm1_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 0),
|
|
SENSOR_ATTR(fan2_input, 0444, show_fan_value, NULL, 1),
|
|
SENSOR_ATTR(fan2_div, 0644, show_fan_div, store_fan_div, 1),
|
|
SENSOR_ATTR(fan2_alarm, 0444, show_fan_alarm, NULL, 1),
|
|
SENSOR_ATTR(fan2_fault, 0444, show_fan_fault, NULL, 1),
|
|
SENSOR_ATTR(pwm2_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 1),
|
|
SENSOR_ATTR(fan3_input, 0444, show_fan_value, NULL, 2),
|
|
SENSOR_ATTR(fan3_div, 0644, show_fan_div, store_fan_div, 2),
|
|
SENSOR_ATTR(fan3_alarm, 0444, show_fan_alarm, NULL, 2),
|
|
SENSOR_ATTR(fan3_fault, 0444, show_fan_fault, NULL, 2),
|
|
SENSOR_ATTR(pwm3_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 2),
|
|
SENSOR_ATTR(fan4_input, 0444, show_fan_value, NULL, 3),
|
|
SENSOR_ATTR(fan4_div, 0644, show_fan_div, store_fan_div, 3),
|
|
SENSOR_ATTR(fan4_alarm, 0444, show_fan_alarm, NULL, 3),
|
|
SENSOR_ATTR(fan4_fault, 0444, show_fan_fault, NULL, 3),
|
|
SENSOR_ATTR(pwm4_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 3),
|
|
SENSOR_ATTR(fan5_input, 0444, show_fan_value, NULL, 4),
|
|
SENSOR_ATTR(fan5_div, 0644, show_fan_div, store_fan_div, 4),
|
|
SENSOR_ATTR(fan5_alarm, 0444, show_fan_alarm, NULL, 4),
|
|
SENSOR_ATTR(fan5_fault, 0444, show_fan_fault, NULL, 4),
|
|
SENSOR_ATTR(pwm5_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 4),
|
|
SENSOR_ATTR(fan6_input, 0444, show_fan_value, NULL, 5),
|
|
SENSOR_ATTR(fan6_div, 0644, show_fan_div, store_fan_div, 5),
|
|
SENSOR_ATTR(fan6_alarm, 0444, show_fan_alarm, NULL, 5),
|
|
SENSOR_ATTR(fan6_fault, 0444, show_fan_fault, NULL, 5),
|
|
SENSOR_ATTR(pwm6_auto_point1_pwm, 0644, show_pwm_auto_point1_pwm,
|
|
store_pwm_auto_point1_pwm, 5),
|
|
};
|
|
|
|
|
|
/*
|
|
* Watchdog routines
|
|
*/
|
|
|
|
static int watchdog_set_timeout(struct fschmd_data *data, int timeout)
|
|
{
|
|
int ret, resolution;
|
|
int kind = data->kind + 1; /* 0-x array index -> 1-x module param */
|
|
|
|
/* 2 second or 60 second resolution? */
|
|
if (timeout <= 510 || kind == fscpos || kind == fscscy)
|
|
resolution = 2;
|
|
else
|
|
resolution = 60;
|
|
|
|
if (timeout < resolution || timeout > (resolution * 255))
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&data->watchdog_lock);
|
|
if (!data->client) {
|
|
ret = -ENODEV;
|
|
goto leave;
|
|
}
|
|
|
|
if (resolution == 2)
|
|
data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_RESOLUTION;
|
|
else
|
|
data->watchdog_control |= FSCHMD_WDOG_CONTROL_RESOLUTION;
|
|
|
|
data->watchdog_preset = DIV_ROUND_UP(timeout, resolution);
|
|
|
|
/* Write new timeout value */
|
|
i2c_smbus_write_byte_data(data->client, FSCHMD_REG_WDOG_PRESET,
|
|
data->watchdog_preset);
|
|
/* Write new control register, do not trigger! */
|
|
i2c_smbus_write_byte_data(data->client, FSCHMD_REG_WDOG_CONTROL,
|
|
data->watchdog_control & ~FSCHMD_WDOG_CONTROL_TRIGGER);
|
|
|
|
ret = data->watchdog_preset * resolution;
|
|
|
|
leave:
|
|
mutex_unlock(&data->watchdog_lock);
|
|
return ret;
|
|
}
|
|
|
|
static int watchdog_get_timeout(struct fschmd_data *data)
|
|
{
|
|
int timeout;
|
|
|
|
mutex_lock(&data->watchdog_lock);
|
|
if (data->watchdog_control & FSCHMD_WDOG_CONTROL_RESOLUTION)
|
|
timeout = data->watchdog_preset * 60;
|
|
else
|
|
timeout = data->watchdog_preset * 2;
|
|
mutex_unlock(&data->watchdog_lock);
|
|
|
|
return timeout;
|
|
}
|
|
|
|
static int watchdog_trigger(struct fschmd_data *data)
|
|
{
|
|
int ret = 0;
|
|
|
|
mutex_lock(&data->watchdog_lock);
|
|
if (!data->client) {
|
|
ret = -ENODEV;
|
|
goto leave;
|
|
}
|
|
|
|
data->watchdog_control |= FSCHMD_WDOG_CONTROL_TRIGGER;
|
|
i2c_smbus_write_byte_data(data->client, FSCHMD_REG_WDOG_CONTROL,
|
|
data->watchdog_control);
|
|
leave:
|
|
mutex_unlock(&data->watchdog_lock);
|
|
return ret;
|
|
}
|
|
|
|
static int watchdog_stop(struct fschmd_data *data)
|
|
{
|
|
int ret = 0;
|
|
|
|
mutex_lock(&data->watchdog_lock);
|
|
if (!data->client) {
|
|
ret = -ENODEV;
|
|
goto leave;
|
|
}
|
|
|
|
data->watchdog_control &= ~FSCHMD_WDOG_CONTROL_STARTED;
|
|
/* Don't store the stop flag in our watchdog control register copy, as
|
|
its a write only bit (read always returns 0) */
|
|
i2c_smbus_write_byte_data(data->client, FSCHMD_REG_WDOG_CONTROL,
|
|
data->watchdog_control | FSCHMD_WDOG_CONTROL_STOP);
|
|
leave:
|
|
mutex_unlock(&data->watchdog_lock);
|
|
return ret;
|
|
}
|
|
|
|
static int watchdog_open(struct inode *inode, struct file *filp)
|
|
{
|
|
struct fschmd_data *pos, *data = NULL;
|
|
|
|
/* We get called from drivers/char/misc.c with misc_mtx hold, and we
|
|
call misc_register() from fschmd_probe() with watchdog_data_mutex
|
|
hold, as misc_register() takes the misc_mtx lock, this is a possible
|
|
deadlock, so we use mutex_trylock here. */
|
|
if (!mutex_trylock(&watchdog_data_mutex))
|
|
return -ERESTARTSYS;
|
|
list_for_each_entry(pos, &watchdog_data_list, list) {
|
|
if (pos->watchdog_miscdev.minor == iminor(inode)) {
|
|
data = pos;
|
|
break;
|
|
}
|
|
}
|
|
/* Note we can never not have found data, so we don't check for this */
|
|
kref_get(&data->kref);
|
|
mutex_unlock(&watchdog_data_mutex);
|
|
|
|
if (test_and_set_bit(0, &data->watchdog_is_open))
|
|
return -EBUSY;
|
|
|
|
/* Start the watchdog */
|
|
watchdog_trigger(data);
|
|
filp->private_data = data;
|
|
|
|
return nonseekable_open(inode, filp);
|
|
}
|
|
|
|
static int watchdog_release(struct inode *inode, struct file *filp)
|
|
{
|
|
struct fschmd_data *data = filp->private_data;
|
|
|
|
if (data->watchdog_expect_close) {
|
|
watchdog_stop(data);
|
|
data->watchdog_expect_close = 0;
|
|
} else {
|
|
watchdog_trigger(data);
|
|
dev_crit(&data->client->dev,
|
|
"unexpected close, not stopping watchdog!\n");
|
|
}
|
|
|
|
clear_bit(0, &data->watchdog_is_open);
|
|
|
|
mutex_lock(&watchdog_data_mutex);
|
|
kref_put(&data->kref, fschmd_release_resources);
|
|
mutex_unlock(&watchdog_data_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t watchdog_write(struct file *filp, const char __user *buf,
|
|
size_t count, loff_t *offset)
|
|
{
|
|
size_t ret;
|
|
struct fschmd_data *data = filp->private_data;
|
|
|
|
if (count) {
|
|
if (!nowayout) {
|
|
size_t i;
|
|
|
|
/* Clear it in case it was set with a previous write */
|
|
data->watchdog_expect_close = 0;
|
|
|
|
for (i = 0; i != count; i++) {
|
|
char c;
|
|
if (get_user(c, buf + i))
|
|
return -EFAULT;
|
|
if (c == 'V')
|
|
data->watchdog_expect_close = 1;
|
|
}
|
|
}
|
|
ret = watchdog_trigger(data);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
return count;
|
|
}
|
|
|
|
static int watchdog_ioctl(struct inode *inode, struct file *filp,
|
|
unsigned int cmd, unsigned long arg)
|
|
{
|
|
static struct watchdog_info ident = {
|
|
.options = WDIOF_KEEPALIVEPING | WDIOF_SETTIMEOUT |
|
|
WDIOF_CARDRESET,
|
|
.identity = "FSC watchdog"
|
|
};
|
|
int i, ret = 0;
|
|
struct fschmd_data *data = filp->private_data;
|
|
|
|
switch (cmd) {
|
|
case WDIOC_GETSUPPORT:
|
|
ident.firmware_version = data->revision;
|
|
if (!nowayout)
|
|
ident.options |= WDIOF_MAGICCLOSE;
|
|
if (copy_to_user((void __user *)arg, &ident, sizeof(ident)))
|
|
ret = -EFAULT;
|
|
break;
|
|
|
|
case WDIOC_GETSTATUS:
|
|
ret = put_user(0, (int __user *)arg);
|
|
break;
|
|
|
|
case WDIOC_GETBOOTSTATUS:
|
|
if (data->watchdog_state & FSCHMD_WDOG_STATE_CARDRESET)
|
|
ret = put_user(WDIOF_CARDRESET, (int __user *)arg);
|
|
else
|
|
ret = put_user(0, (int __user *)arg);
|
|
break;
|
|
|
|
case WDIOC_KEEPALIVE:
|
|
ret = watchdog_trigger(data);
|
|
break;
|
|
|
|
case WDIOC_GETTIMEOUT:
|
|
i = watchdog_get_timeout(data);
|
|
ret = put_user(i, (int __user *)arg);
|
|
break;
|
|
|
|
case WDIOC_SETTIMEOUT:
|
|
if (get_user(i, (int __user *)arg)) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
ret = watchdog_set_timeout(data, i);
|
|
if (ret > 0)
|
|
ret = put_user(ret, (int __user *)arg);
|
|
break;
|
|
|
|
case WDIOC_SETOPTIONS:
|
|
if (get_user(i, (int __user *)arg)) {
|
|
ret = -EFAULT;
|
|
break;
|
|
}
|
|
|
|
if (i & WDIOS_DISABLECARD)
|
|
ret = watchdog_stop(data);
|
|
else if (i & WDIOS_ENABLECARD)
|
|
ret = watchdog_trigger(data);
|
|
else
|
|
ret = -EINVAL;
|
|
|
|
break;
|
|
default:
|
|
ret = -ENOTTY;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static struct file_operations watchdog_fops = {
|
|
.owner = THIS_MODULE,
|
|
.llseek = no_llseek,
|
|
.open = watchdog_open,
|
|
.release = watchdog_release,
|
|
.write = watchdog_write,
|
|
.ioctl = watchdog_ioctl,
|
|
};
|
|
|
|
|
|
/*
|
|
* Detect, register, unregister and update device functions
|
|
*/
|
|
|
|
/* DMI decode routine to read voltage scaling factors from special DMI tables,
|
|
which are available on FSC machines with an fscher or later chip. */
|
|
static void fschmd_dmi_decode(const struct dmi_header *header)
|
|
{
|
|
int i, mult[3] = { 0 }, offset[3] = { 0 }, vref = 0, found = 0;
|
|
|
|
/* dmi code ugliness, we get passed the address of the contents of
|
|
a complete DMI record, but in the form of a dmi_header pointer, in
|
|
reality this address holds header->length bytes of which the header
|
|
are the first 4 bytes */
|
|
u8 *dmi_data = (u8 *)header;
|
|
|
|
/* We are looking for OEM-specific type 185 */
|
|
if (header->type != 185)
|
|
return;
|
|
|
|
/* we are looking for what Siemens calls "subtype" 19, the subtype
|
|
is stored in byte 5 of the dmi block */
|
|
if (header->length < 5 || dmi_data[4] != 19)
|
|
return;
|
|
|
|
/* After the subtype comes 1 unknown byte and then blocks of 5 bytes,
|
|
consisting of what Siemens calls an "Entity" number, followed by
|
|
2 16-bit words in LSB first order */
|
|
for (i = 6; (i + 4) < header->length; i += 5) {
|
|
/* entity 1 - 3: voltage multiplier and offset */
|
|
if (dmi_data[i] >= 1 && dmi_data[i] <= 3) {
|
|
/* Our in sensors order and the DMI order differ */
|
|
const int shuffle[3] = { 1, 0, 2 };
|
|
int in = shuffle[dmi_data[i] - 1];
|
|
|
|
/* Check for twice the same entity */
|
|
if (found & (1 << in))
|
|
return;
|
|
|
|
mult[in] = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
|
|
offset[in] = dmi_data[i + 3] | (dmi_data[i + 4] << 8);
|
|
|
|
found |= 1 << in;
|
|
}
|
|
|
|
/* entity 7: reference voltage */
|
|
if (dmi_data[i] == 7) {
|
|
/* Check for twice the same entity */
|
|
if (found & 0x08)
|
|
return;
|
|
|
|
vref = dmi_data[i + 1] | (dmi_data[i + 2] << 8);
|
|
|
|
found |= 0x08;
|
|
}
|
|
}
|
|
|
|
if (found == 0x0F) {
|
|
for (i = 0; i < 3; i++) {
|
|
dmi_mult[i] = mult[i] * 10;
|
|
dmi_offset[i] = offset[i] * 10;
|
|
}
|
|
dmi_vref = vref;
|
|
}
|
|
}
|
|
|
|
static int fschmd_detect(struct i2c_client *client, int kind,
|
|
struct i2c_board_info *info)
|
|
{
|
|
struct i2c_adapter *adapter = client->adapter;
|
|
const char * const client_names[5] = { "fscpos", "fscher", "fscscy",
|
|
"fschrc", "fschmd" };
|
|
|
|
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
|
return -ENODEV;
|
|
|
|
/* Detect & Identify the chip */
|
|
if (kind <= 0) {
|
|
char id[4];
|
|
|
|
id[0] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_IDENT_0);
|
|
id[1] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_IDENT_1);
|
|
id[2] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_IDENT_2);
|
|
id[3] = '\0';
|
|
|
|
if (!strcmp(id, "PEG"))
|
|
kind = fscpos;
|
|
else if (!strcmp(id, "HER"))
|
|
kind = fscher;
|
|
else if (!strcmp(id, "SCY"))
|
|
kind = fscscy;
|
|
else if (!strcmp(id, "HRC"))
|
|
kind = fschrc;
|
|
else if (!strcmp(id, "HMD"))
|
|
kind = fschmd;
|
|
else
|
|
return -ENODEV;
|
|
}
|
|
|
|
strlcpy(info->type, client_names[kind - 1], I2C_NAME_SIZE);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int fschmd_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
struct fschmd_data *data;
|
|
const char * const names[5] = { "Poseidon", "Hermes", "Scylla",
|
|
"Heracles", "Heimdall" };
|
|
const int watchdog_minors[] = { WATCHDOG_MINOR, 212, 213, 214, 215 };
|
|
int i, err;
|
|
enum chips kind = id->driver_data;
|
|
|
|
data = kzalloc(sizeof(struct fschmd_data), GFP_KERNEL);
|
|
if (!data)
|
|
return -ENOMEM;
|
|
|
|
i2c_set_clientdata(client, data);
|
|
mutex_init(&data->update_lock);
|
|
mutex_init(&data->watchdog_lock);
|
|
INIT_LIST_HEAD(&data->list);
|
|
kref_init(&data->kref);
|
|
/* Store client pointer in our data struct for watchdog usage
|
|
(where the client is found through a data ptr instead of the
|
|
otherway around) */
|
|
data->client = client;
|
|
|
|
if (kind == fscpos) {
|
|
/* The Poseidon has hardwired temp limits, fill these
|
|
in for the alarm resetting code */
|
|
data->temp_max[0] = 70 + 128;
|
|
data->temp_max[1] = 50 + 128;
|
|
data->temp_max[2] = 50 + 128;
|
|
}
|
|
|
|
/* Read the special DMI table for fscher and newer chips */
|
|
if ((kind == fscher || kind >= fschrc) && dmi_vref == -1) {
|
|
dmi_walk(fschmd_dmi_decode);
|
|
if (dmi_vref == -1) {
|
|
dev_warn(&client->dev,
|
|
"Couldn't get voltage scaling factors from "
|
|
"BIOS DMI table, using builtin defaults\n");
|
|
dmi_vref = 33;
|
|
}
|
|
}
|
|
|
|
/* Read in some never changing registers */
|
|
data->revision = i2c_smbus_read_byte_data(client, FSCHMD_REG_REVISION);
|
|
data->global_control = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_CONTROL);
|
|
data->watchdog_control = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_WDOG_CONTROL);
|
|
data->watchdog_state = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_WDOG_STATE);
|
|
data->watchdog_preset = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_WDOG_PRESET);
|
|
|
|
/* i2c kind goes from 1-5, we want from 0-4 to address arrays */
|
|
data->kind = kind - 1;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fschmd_attr); i++) {
|
|
err = device_create_file(&client->dev,
|
|
&fschmd_attr[i].dev_attr);
|
|
if (err)
|
|
goto exit_detach;
|
|
}
|
|
|
|
for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++) {
|
|
/* Poseidon doesn't have TEMP_LIMIT registers */
|
|
if (kind == fscpos && fschmd_temp_attr[i].dev_attr.show ==
|
|
show_temp_max)
|
|
continue;
|
|
|
|
err = device_create_file(&client->dev,
|
|
&fschmd_temp_attr[i].dev_attr);
|
|
if (err)
|
|
goto exit_detach;
|
|
}
|
|
|
|
for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++) {
|
|
/* Poseidon doesn't have a FAN_MIN register for its 3rd fan */
|
|
if (kind == fscpos &&
|
|
!strcmp(fschmd_fan_attr[i].dev_attr.attr.name,
|
|
"pwm3_auto_point1_pwm"))
|
|
continue;
|
|
|
|
err = device_create_file(&client->dev,
|
|
&fschmd_fan_attr[i].dev_attr);
|
|
if (err)
|
|
goto exit_detach;
|
|
}
|
|
|
|
data->hwmon_dev = hwmon_device_register(&client->dev);
|
|
if (IS_ERR(data->hwmon_dev)) {
|
|
err = PTR_ERR(data->hwmon_dev);
|
|
data->hwmon_dev = NULL;
|
|
goto exit_detach;
|
|
}
|
|
|
|
/* We take the data_mutex lock early so that watchdog_open() cannot
|
|
run when misc_register() has completed, but we've not yet added
|
|
our data to the watchdog_data_list (and set the default timeout) */
|
|
mutex_lock(&watchdog_data_mutex);
|
|
for (i = 0; i < ARRAY_SIZE(watchdog_minors); i++) {
|
|
/* Register our watchdog part */
|
|
snprintf(data->watchdog_name, sizeof(data->watchdog_name),
|
|
"watchdog%c", (i == 0) ? '\0' : ('0' + i));
|
|
data->watchdog_miscdev.name = data->watchdog_name;
|
|
data->watchdog_miscdev.fops = &watchdog_fops;
|
|
data->watchdog_miscdev.minor = watchdog_minors[i];
|
|
err = misc_register(&data->watchdog_miscdev);
|
|
if (err == -EBUSY)
|
|
continue;
|
|
if (err) {
|
|
data->watchdog_miscdev.minor = 0;
|
|
dev_err(&client->dev,
|
|
"Registering watchdog chardev: %d\n", err);
|
|
break;
|
|
}
|
|
|
|
list_add(&data->list, &watchdog_data_list);
|
|
watchdog_set_timeout(data, 60);
|
|
dev_info(&client->dev,
|
|
"Registered watchdog chardev major 10, minor: %d\n",
|
|
watchdog_minors[i]);
|
|
break;
|
|
}
|
|
if (i == ARRAY_SIZE(watchdog_minors)) {
|
|
data->watchdog_miscdev.minor = 0;
|
|
dev_warn(&client->dev, "Couldn't register watchdog chardev "
|
|
"(due to no free minor)\n");
|
|
}
|
|
mutex_unlock(&watchdog_data_mutex);
|
|
|
|
dev_info(&client->dev, "Detected FSC %s chip, revision: %d\n",
|
|
names[data->kind], (int) data->revision);
|
|
|
|
return 0;
|
|
|
|
exit_detach:
|
|
fschmd_remove(client); /* will also free data for us */
|
|
return err;
|
|
}
|
|
|
|
static int fschmd_remove(struct i2c_client *client)
|
|
{
|
|
struct fschmd_data *data = i2c_get_clientdata(client);
|
|
int i;
|
|
|
|
/* Unregister the watchdog (if registered) */
|
|
if (data->watchdog_miscdev.minor) {
|
|
misc_deregister(&data->watchdog_miscdev);
|
|
if (data->watchdog_is_open) {
|
|
dev_warn(&client->dev,
|
|
"i2c client detached with watchdog open! "
|
|
"Stopping watchdog.\n");
|
|
watchdog_stop(data);
|
|
}
|
|
mutex_lock(&watchdog_data_mutex);
|
|
list_del(&data->list);
|
|
mutex_unlock(&watchdog_data_mutex);
|
|
/* Tell the watchdog code the client is gone */
|
|
mutex_lock(&data->watchdog_lock);
|
|
data->client = NULL;
|
|
mutex_unlock(&data->watchdog_lock);
|
|
}
|
|
|
|
/* Check if registered in case we're called from fschmd_detect
|
|
to cleanup after an error */
|
|
if (data->hwmon_dev)
|
|
hwmon_device_unregister(data->hwmon_dev);
|
|
|
|
for (i = 0; i < ARRAY_SIZE(fschmd_attr); i++)
|
|
device_remove_file(&client->dev, &fschmd_attr[i].dev_attr);
|
|
for (i = 0; i < (FSCHMD_NO_TEMP_SENSORS[data->kind] * 4); i++)
|
|
device_remove_file(&client->dev,
|
|
&fschmd_temp_attr[i].dev_attr);
|
|
for (i = 0; i < (FSCHMD_NO_FAN_SENSORS[data->kind] * 5); i++)
|
|
device_remove_file(&client->dev,
|
|
&fschmd_fan_attr[i].dev_attr);
|
|
|
|
mutex_lock(&watchdog_data_mutex);
|
|
kref_put(&data->kref, fschmd_release_resources);
|
|
mutex_unlock(&watchdog_data_mutex);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct fschmd_data *fschmd_update_device(struct device *dev)
|
|
{
|
|
struct i2c_client *client = to_i2c_client(dev);
|
|
struct fschmd_data *data = i2c_get_clientdata(client);
|
|
int i;
|
|
|
|
mutex_lock(&data->update_lock);
|
|
|
|
if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
|
|
|
|
for (i = 0; i < FSCHMD_NO_TEMP_SENSORS[data->kind]; i++) {
|
|
data->temp_act[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_TEMP_ACT[data->kind][i]);
|
|
data->temp_status[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_TEMP_STATE[data->kind][i]);
|
|
|
|
/* The fscpos doesn't have TEMP_LIMIT registers */
|
|
if (FSCHMD_REG_TEMP_LIMIT[data->kind][i])
|
|
data->temp_max[i] = i2c_smbus_read_byte_data(
|
|
client,
|
|
FSCHMD_REG_TEMP_LIMIT[data->kind][i]);
|
|
|
|
/* reset alarm if the alarm condition is gone,
|
|
the chip doesn't do this itself */
|
|
if ((data->temp_status[i] & FSCHMD_TEMP_ALARM_MASK) ==
|
|
FSCHMD_TEMP_ALARM_MASK &&
|
|
data->temp_act[i] < data->temp_max[i])
|
|
i2c_smbus_write_byte_data(client,
|
|
FSCHMD_REG_TEMP_STATE[data->kind][i],
|
|
FSCHMD_TEMP_ALERT);
|
|
}
|
|
|
|
for (i = 0; i < FSCHMD_NO_FAN_SENSORS[data->kind]; i++) {
|
|
data->fan_act[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_FAN_ACT[data->kind][i]);
|
|
data->fan_status[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_FAN_STATE[data->kind][i]);
|
|
data->fan_ripple[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_FAN_RIPPLE[data->kind][i]);
|
|
|
|
/* The fscpos third fan doesn't have a fan_min */
|
|
if (FSCHMD_REG_FAN_MIN[data->kind][i])
|
|
data->fan_min[i] = i2c_smbus_read_byte_data(
|
|
client,
|
|
FSCHMD_REG_FAN_MIN[data->kind][i]);
|
|
|
|
/* reset fan status if speed is back to > 0 */
|
|
if ((data->fan_status[i] & FSCHMD_FAN_ALARM) &&
|
|
data->fan_act[i])
|
|
i2c_smbus_write_byte_data(client,
|
|
FSCHMD_REG_FAN_STATE[data->kind][i],
|
|
FSCHMD_FAN_ALARM);
|
|
}
|
|
|
|
for (i = 0; i < 3; i++)
|
|
data->volt[i] = i2c_smbus_read_byte_data(client,
|
|
FSCHMD_REG_VOLT[i]);
|
|
|
|
data->last_updated = jiffies;
|
|
data->valid = 1;
|
|
}
|
|
|
|
mutex_unlock(&data->update_lock);
|
|
|
|
return data;
|
|
}
|
|
|
|
static int __init fschmd_init(void)
|
|
{
|
|
return i2c_add_driver(&fschmd_driver);
|
|
}
|
|
|
|
static void __exit fschmd_exit(void)
|
|
{
|
|
i2c_del_driver(&fschmd_driver);
|
|
}
|
|
|
|
MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
|
|
MODULE_DESCRIPTION("FSC Poseidon, Hermes, Scylla, Heracles and "
|
|
"Heimdall driver");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
module_init(fschmd_init);
|
|
module_exit(fschmd_exit);
|