mirror of
https://github.com/lm-sensors/lm-sensors.git
synced 2026-10-21 11:39:31 +00:00
add smsc47m1 fan driver
git-svn-id: http://lm-sensors.org/svn/lm-sensors/trunk@1397 7894878c-1315-0410-8ee3-d5d059ff63e0
This commit is contained in:
1 parent
c382a5ca7a
commit
37cbcbe5ad
7 files changed
+659
-5
No files matched your search
@@ -21,10 +21,11 @@ ask CVS about it:
|
||||
NOTE: Requires i2c-2.6.1 or newer, or kernel 2.4.13 or newer.
|
||||
File doc/vid: New
|
||||
File include/sensors_vid.h: New
|
||||
Library: Add multiple VRM version support for adm1025, w83781d
|
||||
Library: Add multiple VRM version support for adm1025, w83781d;
|
||||
fix 'flex scanner jammed' on some systems
|
||||
Makefiles: For 2.4+ kernels, modules now install in
|
||||
kernel/drivers/[i2c,sensors] , not misc/ , and
|
||||
removes old versions in misc/ .
|
||||
'make install' removes old versions in misc/ .
|
||||
Use $CFLAGS and $CPPFLAGS if defined.
|
||||
Module adm1025: Add multiple VID version support
|
||||
Module i2c-amd756: Add nVidia nForce support; fix block read length;
|
||||
@@ -32,9 +33,12 @@ ask CVS about it:
|
||||
Module i2c-i801: Add support for 82801DB (ICH4)
|
||||
Module i2c-savage4: new
|
||||
Module i2c-viapro: Add support for VT8231 (0x8235), VT8233A (0x3147)
|
||||
Module smbus-arp: new
|
||||
Module smsc47m1: new
|
||||
Module via686a: Add support for VT8231 sensors
|
||||
Module w83781d: Add multiple VID version support
|
||||
Program eeprom: new
|
||||
Program i2cdump: Add smbus block command specification
|
||||
Program mkpatch: Install new sensors_vid.h
|
||||
Program rrd: Fix swapped CPU and MB temps in summ_week.cgi
|
||||
Program sensord: Major update, now requires rrd source;
|
||||
|
||||
@@ -47,9 +47,10 @@ At least the following I2C/SMBus adapters are supported:
|
||||
NVidia nForce
|
||||
ServerWorks OSB4, CSB5
|
||||
SiS 5595
|
||||
SMSC Victory66
|
||||
SMSC Victory66, 74M1xx
|
||||
3Dfx Voodoo 3 and Banshee
|
||||
VIA Technologies VT82C586B, VT82C596A/B, VT82C686A/B, and VT8233
|
||||
VIA Technologies VT82C586B, VT82C596A/B, VT82C686A/B, VT8231,
|
||||
VT8233, and VT8233A.
|
||||
|
||||
|
||||
At least the following hardware sensor chips are supported:
|
||||
|
||||
+7
-1
@@ -1,7 +1,7 @@
|
||||
SUMMARY OF SUPPORTED CHIPS
|
||||
==========================
|
||||
This is a summary of the sensor and non-sensor chips supported
|
||||
by this package. It summarizes the features of each supported chip.
|
||||
by this package. It lists the features of each supported chip.
|
||||
|
||||
For further information on a particular chip, see the documentation
|
||||
in this directory. Data sheets are generally available on the
|
||||
@@ -119,6 +119,9 @@ mtp008
|
||||
sis5595
|
||||
sis5595 0-1 4-5 2 - no yes
|
||||
|
||||
smsc74m1
|
||||
smsc74m1 - - 2 2 no yes (LPC)
|
||||
|
||||
thmc50
|
||||
adm1022 3 2 - 1 dac yes no
|
||||
thmc50 3 2 - 1 dac yes no
|
||||
@@ -168,6 +171,9 @@ pcf8574 & pcf8574a
|
||||
pcf8591
|
||||
Quad A/D + one D/A
|
||||
|
||||
smbus-arp
|
||||
An SMBus 2.0 ARP client
|
||||
|
||||
|
||||
-----------------------------------------------------------------------------
|
||||
-----------------------------------------------------------------------------
|
||||
|
||||
@@ -0,0 +1,52 @@
|
||||
Kernel driver `smsc74m1.o'
|
||||
=========================
|
||||
|
||||
Status: Beta.
|
||||
|
||||
Supported chips:
|
||||
* SMSC 74M1xx Super I/O Controllers
|
||||
Addresses scanned: none, address read from Super I/O config space
|
||||
Datasheets:
|
||||
http://www.smsc.com/main/datasheets/47m10x.pdf
|
||||
http://www.smsc.com/main/datasheets/47m120.pdf
|
||||
http://www.smsc.com/main/datasheets/47m13x.pdf
|
||||
http://www.smsc.com/main/datasheets/47m14x.pdf
|
||||
|
||||
Authors: Mark D. Studebaker <mdsxyz123@yahoo.com>
|
||||
With assistance from Bruce Allen <ballen@uwm.edu> and his
|
||||
fan.c program: http://www.lsc-group.phys.uwm.edu/%7Eballen/driver/
|
||||
|
||||
Module Parameters
|
||||
-----------------
|
||||
|
||||
force_addr=0xaddr Set the I/O base address. Useful for boards
|
||||
that don't set the address in the BIOS.
|
||||
Don't use this unless the driver complains that the
|
||||
base address is not set.
|
||||
Example: 'modprobe smsc47m1 force_addr=0x680'
|
||||
|
||||
|
||||
Description
|
||||
-----------
|
||||
|
||||
The Standard Microsystems Corporation (SMSC) 47M1xx Super I/O chips
|
||||
contain monitoring and PWM control circuitry for two fans.
|
||||
|
||||
FAN rotation speeds are reported in RPM (rotations per minute). An alarm is
|
||||
triggered if the rotation speed has dropped below a programmable limit. FAN
|
||||
readings can be divided by a programmable divider (1, 2, 4 or 8) to give
|
||||
the readings more range or accuracy. This is important because some FANs
|
||||
report only one 'tick' each rotation, while others report two - making
|
||||
all readings twice as high. Not all RPM values can accurately be represented,
|
||||
so some rounding is done. With a divider of 2, the lowest representable
|
||||
value is around 2600 RPM.
|
||||
|
||||
PWM values are from 0 to 100%. The first value in the /proc entry is
|
||||
the percentage; the second is the enable (0 or 1).
|
||||
|
||||
If an alarm triggers, it will remain triggered until the hardware register
|
||||
is read at least once. This means that the cause for the alarm may
|
||||
already have disappeared! Note that in the current implementation, all
|
||||
hardware registers are read whenever any data is read (unless it is less
|
||||
than 1.5 seconds since the last update). This means that you can easily
|
||||
miss once-only alarms.
|
||||
@@ -26,6 +26,7 @@ KERNELCHIPSDIR := $(MODULE_DIR)
|
||||
# These targets are NOT included in 'mkpatch' ...
|
||||
KERNELCHIPSTARGETS := $(MODULE_DIR)/pcf8591.o
|
||||
KERNELCHIPSTARGETS += $(MODULE_DIR)/smbus-arp.o
|
||||
KERNELCHIPSTARGETS += $(MODULE_DIR)/smsc47m1.o
|
||||
|
||||
# These targets ARE included in 'mkpatch', except for LTC1710, which we
|
||||
# leave here because it used to be in 'mkpatch' ...
|
||||
|
||||
@@ -0,0 +1,580 @@
|
||||
/*
|
||||
smsc47m1.c - Part of lm_sensors, Linux kernel modules
|
||||
for hardware monitoring
|
||||
|
||||
Copyright (c) 2002 Mark D. Studebaker <mdsxyz123@yahoo.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.
|
||||
*/
|
||||
|
||||
#include <linux/version.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/ioport.h>
|
||||
#include <linux/sysctl.h>
|
||||
#include <asm/errno.h>
|
||||
#include <asm/io.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/i2c.h>
|
||||
#include "version.h"
|
||||
#include "sensors.h"
|
||||
#include <linux/init.h>
|
||||
|
||||
#if (LINUX_VERSION_CODE < KERNEL_VERSION(2,2,18)) || \
|
||||
(LINUX_VERSION_CODE == KERNEL_VERSION(2,3,0))
|
||||
#define init_MUTEX(s) do { *(s) = MUTEX; } while(0)
|
||||
#endif
|
||||
|
||||
#ifndef I2C_DRIVERID_SMSC47M1
|
||||
#define I2C_DRIVERID_SMSC47M1 1031
|
||||
#endif
|
||||
|
||||
#ifndef THIS_MODULE
|
||||
#define THIS_MODULE NULL
|
||||
#endif
|
||||
|
||||
static int force_addr = 0;
|
||||
MODULE_PARM(force_addr, "i");
|
||||
MODULE_PARM_DESC(force_addr,
|
||||
"Initialize the base address of the sensors");
|
||||
|
||||
static unsigned short normal_i2c[] = { SENSORS_I2C_END };
|
||||
static unsigned short normal_i2c_range[] = { SENSORS_I2C_END };
|
||||
static unsigned int normal_isa[] = { 0x0000, SENSORS_ISA_END };
|
||||
static unsigned int normal_isa_range[] = { SENSORS_ISA_END };
|
||||
|
||||
SENSORS_INSMOD_1(smsc47m1);
|
||||
|
||||
/* modified from kernel/include/traps.c */
|
||||
#define REG 0x2e /* The register to read/write */
|
||||
#define DEV 0x07 /* Register: Logical device select */
|
||||
#define VAL 0x2f /* The value to read/write */
|
||||
#define PME 0x0a /* The device with the fan registers in it */
|
||||
#define DEVID 0x20 /* Register: Device ID */
|
||||
|
||||
static inline void
|
||||
superio_outb(int reg, int val)
|
||||
{
|
||||
outb(reg, REG);
|
||||
outb(val, VAL);
|
||||
}
|
||||
|
||||
static inline int
|
||||
superio_inb(int reg)
|
||||
{
|
||||
outb(reg, REG);
|
||||
return inb(VAL);
|
||||
}
|
||||
|
||||
static inline void
|
||||
superio_select()
|
||||
{
|
||||
outb(DEV, REG);
|
||||
outb(PME, VAL);
|
||||
}
|
||||
|
||||
static inline void
|
||||
superio_enter()
|
||||
{
|
||||
outb(0x55, REG);
|
||||
}
|
||||
|
||||
static inline void
|
||||
superio_exit()
|
||||
{
|
||||
outb(0xAA, REG);
|
||||
}
|
||||
|
||||
#define SMSC_DEVID 0x59
|
||||
#define SMSC_ACT_REG 0x20
|
||||
#define SMSC_BASE_REG 0x60
|
||||
|
||||
#define SMSC_EXTENT 0x80
|
||||
|
||||
#define SMSC47M1_REG_ALARM1 0x04
|
||||
#define SMSC47M1_REG_TPIN2 0x33
|
||||
#define SMSC47M1_REG_TPIN1 0x34
|
||||
#define SMSC47M1_REG_PPIN(nr) (0x37 - (nr))
|
||||
#define SMSC47M1_REG_PWM(nr) (0x55 + (nr))
|
||||
#define SMSC47M1_REG_FANDIV 0x58
|
||||
#define SMSC47M1_REG_FAN(nr) (0x58 + (nr))
|
||||
#define SMSC47M1_REG_FAN_MIN(nr) (0x5a + (nr))
|
||||
|
||||
extern inline u8 MIN_TO_REG(long rpm, int div)
|
||||
{
|
||||
if (rpm == 0)
|
||||
return 0;
|
||||
rpm = SENSORS_LIMIT(rpm, 1, 1000000);
|
||||
return SENSORS_LIMIT(192 - ((983040 + rpm * div / 2) / (rpm * div)),
|
||||
0, 191);
|
||||
}
|
||||
|
||||
#define MIN_FROM_REG(val,div) ((val)>=192?0: \
|
||||
983040/((192-(val))*(div)))
|
||||
#define FAN_FROM_REG(val,div,preload) ((val)==0?-1:(val)==255?0: \
|
||||
983040/(((val)-preload)*(div)))
|
||||
#define DIV_FROM_REG(val) (1 << (val))
|
||||
#define DIV_TO_REG(val) ((val)==8?3:(val)==4?2:(val)==1?0:1)
|
||||
#define PWM_FROM_REG(val) ((((val) & 0x7f) * 1005) / 640)
|
||||
#define PWM_TO_REG(val) SENSORS_LIMIT((((val) * 645) / 1000), 0, 63)
|
||||
|
||||
#define SMSC47M1_INIT_FAN_MIN_1 3000
|
||||
#define SMSC47M1_INIT_FAN_MIN_2 3000
|
||||
|
||||
#ifdef MODULE
|
||||
extern int init_module(void);
|
||||
extern int cleanup_module(void);
|
||||
#endif /* MODULE */
|
||||
|
||||
struct smsc47m1_data {
|
||||
struct semaphore lock;
|
||||
int sysctl_id;
|
||||
|
||||
struct semaphore update_lock;
|
||||
char valid; /* !=0 if following fields are valid */
|
||||
unsigned long last_updated; /* In jiffies */
|
||||
|
||||
u8 fan[2]; /* Register value */
|
||||
u8 fan_min[2]; /* Register value */
|
||||
u8 fan_div[2]; /* Register encoding, shifted right */
|
||||
u8 alarms; /* Register encoding */
|
||||
u8 pwm[2]; /* Register value */
|
||||
};
|
||||
|
||||
#ifdef MODULE
|
||||
static
|
||||
#else
|
||||
extern
|
||||
#endif
|
||||
int __init sensors_smsc47m1_init(void);
|
||||
static int __init smsc47m1_cleanup(void);
|
||||
|
||||
static int smsc47m1_attach_adapter(struct i2c_adapter *adapter);
|
||||
static int smsc47m1_detect(struct i2c_adapter *adapter, int address,
|
||||
unsigned short flags, int kind);
|
||||
static int smsc47m1_detach_client(struct i2c_client *client);
|
||||
static int smsc47m1_command(struct i2c_client *client, unsigned int cmd,
|
||||
void *arg);
|
||||
static void smsc47m1_inc_use(struct i2c_client *client);
|
||||
static void smsc47m1_dec_use(struct i2c_client *client);
|
||||
|
||||
static int smsc47m1_read_value(struct i2c_client *client, u8 register);
|
||||
static int smsc47m1_write_value(struct i2c_client *client, u8 register,
|
||||
u8 value);
|
||||
static void smsc47m1_update_client(struct i2c_client *client);
|
||||
static void smsc47m1_init_client(struct i2c_client *client);
|
||||
static int smsc47m1_find(int *address);
|
||||
|
||||
|
||||
static void smsc47m1_fan(struct i2c_client *client, int operation,
|
||||
int ctl_name, int *nrels_mag, long *results);
|
||||
static void smsc47m1_alarms(struct i2c_client *client, int operation,
|
||||
int ctl_name, int *nrels_mag, long *results);
|
||||
static void smsc47m1_fan_div(struct i2c_client *client, int operation,
|
||||
int ctl_name, int *nrels_mag, long *results);
|
||||
static void smsc47m1_pwm(struct i2c_client *client, int operation,
|
||||
int ctl_name, int *nrels_mag, long *results);
|
||||
|
||||
static int smsc47m1_id = 0;
|
||||
|
||||
static struct i2c_driver smsc47m1_driver = {
|
||||
/* name */ "SiS 5595",
|
||||
/* id */ I2C_DRIVERID_SMSC47M1,
|
||||
/* flags */ I2C_DF_NOTIFY,
|
||||
/* attach_adapter */ &smsc47m1_attach_adapter,
|
||||
/* detach_client */ &smsc47m1_detach_client,
|
||||
/* command */ &smsc47m1_command,
|
||||
/* inc_use */ &smsc47m1_inc_use,
|
||||
/* dec_use */ &smsc47m1_dec_use
|
||||
};
|
||||
|
||||
static int __initdata smsc47m1_initialized = 0;
|
||||
|
||||
static ctl_table smsc47m1_dir_table_template[] = {
|
||||
{SMSC47M1_SYSCTL_FAN1, "fan1", NULL, 0, 0644, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_fan},
|
||||
{SMSC47M1_SYSCTL_FAN2, "fan2", NULL, 0, 0644, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_fan},
|
||||
{SMSC47M1_SYSCTL_FAN_DIV, "fan_div", NULL, 0, 0644, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_fan_div},
|
||||
{SMSC47M1_SYSCTL_ALARMS, "alarms", NULL, 0, 0444, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_alarms},
|
||||
{SMSC47M1_SYSCTL_PWM1, "pwm1", NULL, 0, 0644, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_pwm},
|
||||
{SMSC47M1_SYSCTL_PWM2, "pwm2", NULL, 0, 0644, NULL, &i2c_proc_real,
|
||||
&i2c_sysctl_real, NULL, &smsc47m1_pwm},
|
||||
{0}
|
||||
};
|
||||
|
||||
int smsc47m1_attach_adapter(struct i2c_adapter *adapter)
|
||||
{
|
||||
return i2c_detect(adapter, &addr_data, smsc47m1_detect);
|
||||
}
|
||||
|
||||
int smsc47m1_find(int *address)
|
||||
{
|
||||
u16 val;
|
||||
|
||||
superio_enter();
|
||||
val= superio_inb(DEVID);
|
||||
if(SMSC_DEVID != val) {
|
||||
superio_exit();
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
superio_select();
|
||||
val = (superio_inb(SMSC_BASE_REG) << 8) |
|
||||
superio_inb(SMSC_BASE_REG + 1);
|
||||
*address = val & ~(SMSC_EXTENT - 1);
|
||||
if (*address == 0 && force_addr == 0) {
|
||||
printk("smsc47m1.o: base address not set - use force_addr=0xaddr\n");
|
||||
superio_exit();
|
||||
return -ENODEV;
|
||||
}
|
||||
if (force_addr)
|
||||
*address = force_addr; /* so detect will get called */
|
||||
|
||||
superio_exit();
|
||||
return 0;
|
||||
}
|
||||
|
||||
int smsc47m1_detect(struct i2c_adapter *adapter, int address,
|
||||
unsigned short flags, int kind)
|
||||
{
|
||||
int i;
|
||||
struct i2c_client *new_client;
|
||||
struct smsc47m1_data *data;
|
||||
int err = 0;
|
||||
const char *type_name = "smsc47m1";
|
||||
const char *client_name = "SMSC47M11xx chip";
|
||||
|
||||
if (!i2c_is_isa_adapter(adapter)) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
if(force_addr)
|
||||
address = force_addr & ~(SMSC_EXTENT - 1);
|
||||
if (check_region(address, SMSC_EXTENT)) {
|
||||
printk("smsc47m1.o: region 0x%x already in use!\n", address);
|
||||
return -ENODEV;
|
||||
}
|
||||
if(force_addr) {
|
||||
printk("smsc47m1.o: forcing ISA address 0x%04X\n", address);
|
||||
superio_enter();
|
||||
superio_select();
|
||||
superio_outb(SMSC_BASE_REG, address >> 8);
|
||||
superio_outb(SMSC_BASE_REG, address & 0xff);
|
||||
}
|
||||
|
||||
if (!(new_client = kmalloc(sizeof(struct i2c_client) +
|
||||
sizeof(struct smsc47m1_data),
|
||||
GFP_KERNEL))) {
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
data = (struct smsc47m1_data *) (new_client + 1);
|
||||
new_client->addr = address;
|
||||
init_MUTEX(&data->lock);
|
||||
new_client->data = data;
|
||||
new_client->adapter = adapter;
|
||||
new_client->driver = &smsc47m1_driver;
|
||||
new_client->flags = 0;
|
||||
|
||||
request_region(address, SMSC_EXTENT, "smsc47m1x-fans");
|
||||
strcpy(new_client->name, client_name);
|
||||
|
||||
new_client->id = smsc47m1_id++;
|
||||
data->valid = 0;
|
||||
init_MUTEX(&data->update_lock);
|
||||
|
||||
if ((err = i2c_attach_client(new_client)))
|
||||
goto ERROR3;
|
||||
|
||||
if ((i = i2c_register_entry((struct i2c_client *) new_client,
|
||||
type_name,
|
||||
smsc47m1_dir_table_template,
|
||||
THIS_MODULE)) < 0) {
|
||||
err = i;
|
||||
goto ERROR4;
|
||||
}
|
||||
data->sysctl_id = i;
|
||||
|
||||
smsc47m1_init_client(new_client);
|
||||
return 0;
|
||||
|
||||
ERROR4:
|
||||
i2c_detach_client(new_client);
|
||||
ERROR3:
|
||||
release_region(address, SMSC_EXTENT);
|
||||
kfree(new_client);
|
||||
return err;
|
||||
}
|
||||
|
||||
int smsc47m1_detach_client(struct i2c_client *client)
|
||||
{
|
||||
int err;
|
||||
|
||||
i2c_deregister_entry(((struct smsc47m1_data *) (client->data))->
|
||||
sysctl_id);
|
||||
|
||||
if ((err = i2c_detach_client(client))) {
|
||||
printk
|
||||
("smsc47m1.o: Client deregistration failed, client not detached.\n");
|
||||
return err;
|
||||
}
|
||||
|
||||
release_region(client->addr, SMSC_EXTENT);
|
||||
kfree(client);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int smsc47m1_command(struct i2c_client *client, unsigned int cmd, void *arg)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
void smsc47m1_inc_use(struct i2c_client *client)
|
||||
{
|
||||
#ifdef MODULE
|
||||
MOD_INC_USE_COUNT;
|
||||
#endif
|
||||
}
|
||||
|
||||
void smsc47m1_dec_use(struct i2c_client *client)
|
||||
{
|
||||
#ifdef MODULE
|
||||
MOD_DEC_USE_COUNT;
|
||||
#endif
|
||||
}
|
||||
|
||||
int smsc47m1_read_value(struct i2c_client *client, u8 reg)
|
||||
{
|
||||
int res;
|
||||
|
||||
res = inb_p(client->addr + reg);
|
||||
return res;
|
||||
}
|
||||
|
||||
int smsc47m1_write_value(struct i2c_client *client, u8 reg, u8 value)
|
||||
{
|
||||
outb_p(value, client->addr + reg);
|
||||
return 0;
|
||||
}
|
||||
|
||||
void smsc47m1_init_client(struct i2c_client *client)
|
||||
{
|
||||
/* configure pins for tach function */
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_TPIN1, 0x05);
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_TPIN2, 0x05);
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_FAN_MIN(1),
|
||||
MIN_TO_REG(SMSC47M1_INIT_FAN_MIN_1, 2));
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_FAN_MIN(2),
|
||||
MIN_TO_REG(SMSC47M1_INIT_FAN_MIN_2, 2));
|
||||
}
|
||||
|
||||
void smsc47m1_update_client(struct i2c_client *client)
|
||||
{
|
||||
struct smsc47m1_data *data = client->data;
|
||||
int i;
|
||||
|
||||
down(&data->update_lock);
|
||||
|
||||
if ((jiffies - data->last_updated > HZ + HZ / 2) ||
|
||||
(jiffies < data->last_updated) || !data->valid) {
|
||||
for (i = 1; i <= 2; i++) {
|
||||
data->fan[i - 1] =
|
||||
smsc47m1_read_value(client, SMSC47M1_REG_FAN(i));
|
||||
data->fan_min[i - 1] =
|
||||
smsc47m1_read_value(client, SMSC47M1_REG_FAN_MIN(i));
|
||||
data->pwm[i - 1] =
|
||||
smsc47m1_read_value(client, SMSC47M1_REG_PWM(i));
|
||||
}
|
||||
|
||||
i = smsc47m1_read_value(client, SMSC47M1_REG_FANDIV);
|
||||
data->fan_div[0] = (i >> 4) & 0x03;
|
||||
data->fan_div[1] = i >> 6;
|
||||
data->alarms =
|
||||
smsc47m1_read_value(client, SMSC47M1_REG_ALARM1) >> 6;
|
||||
if(data->alarms)
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_ALARM1, 0xc0);
|
||||
data->last_updated = jiffies;
|
||||
data->valid = 1;
|
||||
}
|
||||
|
||||
up(&data->update_lock);
|
||||
}
|
||||
|
||||
|
||||
void smsc47m1_fan(struct i2c_client *client, int operation, int ctl_name,
|
||||
int *nrels_mag, long *results)
|
||||
{
|
||||
struct smsc47m1_data *data = client->data;
|
||||
int nr = ctl_name - SMSC47M1_SYSCTL_FAN1 + 1;
|
||||
|
||||
if (operation == SENSORS_PROC_REAL_INFO)
|
||||
*nrels_mag = 0;
|
||||
else if (operation == SENSORS_PROC_REAL_READ) {
|
||||
smsc47m1_update_client(client);
|
||||
results[0] = MIN_FROM_REG(data->fan_min[nr - 1],
|
||||
DIV_FROM_REG(data->fan_div[nr - 1]));
|
||||
results[1] = FAN_FROM_REG(data->fan[nr - 1],
|
||||
DIV_FROM_REG(data->fan_div[nr - 1]),
|
||||
data->fan_min[nr - 1]);
|
||||
*nrels_mag = 2;
|
||||
} else if (operation == SENSORS_PROC_REAL_WRITE) {
|
||||
if (*nrels_mag >= 1) {
|
||||
data->fan_min[nr - 1] = MIN_TO_REG(results[0],
|
||||
DIV_FROM_REG
|
||||
(data->
|
||||
fan_div[nr-1]));
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_FAN_MIN(nr),
|
||||
data->fan_min[nr - 1]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void smsc47m1_alarms(struct i2c_client *client, int operation, int ctl_name,
|
||||
int *nrels_mag, long *results)
|
||||
{
|
||||
struct smsc47m1_data *data = client->data;
|
||||
if (operation == SENSORS_PROC_REAL_INFO)
|
||||
*nrels_mag = 0;
|
||||
else if (operation == SENSORS_PROC_REAL_READ) {
|
||||
smsc47m1_update_client(client);
|
||||
results[0] = data->alarms;
|
||||
*nrels_mag = 1;
|
||||
}
|
||||
}
|
||||
|
||||
void smsc47m1_fan_div(struct i2c_client *client, int operation,
|
||||
int ctl_name, int *nrels_mag, long *results)
|
||||
{
|
||||
struct smsc47m1_data *data = client->data;
|
||||
int old;
|
||||
|
||||
if (operation == SENSORS_PROC_REAL_INFO)
|
||||
*nrels_mag = 0;
|
||||
else if (operation == SENSORS_PROC_REAL_READ) {
|
||||
smsc47m1_update_client(client);
|
||||
results[0] = DIV_FROM_REG(data->fan_div[0]);
|
||||
results[1] = DIV_FROM_REG(data->fan_div[1]);
|
||||
*nrels_mag = 2;
|
||||
} else if (operation == SENSORS_PROC_REAL_WRITE) {
|
||||
old = smsc47m1_read_value(client, SMSC47M1_REG_FANDIV);
|
||||
if (*nrels_mag >= 2) {
|
||||
data->fan_div[1] = DIV_TO_REG(results[1]);
|
||||
old = (old & 0x3f) | (data->fan_div[1] << 6);
|
||||
}
|
||||
if (*nrels_mag >= 1) {
|
||||
data->fan_div[0] = DIV_TO_REG(results[0]);
|
||||
old = (old & 0xcf) | (data->fan_div[0] << 4);
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_FANDIV, old);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void smsc47m1_pwm(struct i2c_client *client, int operation, int ctl_name,
|
||||
int *nrels_mag, long *results)
|
||||
{
|
||||
struct smsc47m1_data *data = client->data;
|
||||
int nr = 1 + ctl_name - SMSC47M1_SYSCTL_PWM1;
|
||||
|
||||
if (operation == SENSORS_PROC_REAL_INFO)
|
||||
*nrels_mag = 0;
|
||||
else if (operation == SENSORS_PROC_REAL_READ) {
|
||||
smsc47m1_update_client(client);
|
||||
results[0] = PWM_FROM_REG(data->pwm[nr - 1]);
|
||||
results[1] = data->pwm[nr - 1] >> 7;
|
||||
*nrels_mag = 2;
|
||||
} else if (operation == SENSORS_PROC_REAL_WRITE) {
|
||||
if (*nrels_mag >= 1) {
|
||||
data->pwm[nr - 1] &= 0x80;
|
||||
data->pwm[nr - 1] |= PWM_TO_REG(results[0]);
|
||||
if (*nrels_mag >= 2) {
|
||||
if(results[1] && (!(data->pwm[nr-1] & 0x80))) {
|
||||
/* output PWM */
|
||||
smsc47m1_write_value(client,
|
||||
SMSC47M1_REG_PPIN(nr), 0x04);
|
||||
data->pwm[nr - 1] |= 0x80;
|
||||
}
|
||||
}
|
||||
smsc47m1_write_value(client, SMSC47M1_REG_PWM(nr),
|
||||
data->pwm[nr - 1]);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int __init sensors_smsc47m1_init(void)
|
||||
{
|
||||
int res, addr;
|
||||
|
||||
printk("smsc47m1.o version %s (%s)\n", LM_VERSION, LM_DATE);
|
||||
smsc47m1_initialized = 0;
|
||||
|
||||
if (smsc47m1_find(&addr)) {
|
||||
printk("smsc47m1.o: SMSC47M1 not detected, module not inserted.\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
normal_isa[0] = addr;
|
||||
|
||||
if ((res = i2c_add_driver(&smsc47m1_driver))) {
|
||||
printk
|
||||
("smsc47m1.o: Driver registration failed, module not inserted.\n");
|
||||
smsc47m1_cleanup();
|
||||
return res;
|
||||
}
|
||||
smsc47m1_initialized++;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int __init smsc47m1_cleanup(void)
|
||||
{
|
||||
int res;
|
||||
|
||||
if (smsc47m1_initialized >= 1) {
|
||||
if ((res = i2c_del_driver(&smsc47m1_driver))) {
|
||||
printk
|
||||
("smsc47m1.o: Driver deregistration failed, module not removed.\n");
|
||||
return res;
|
||||
}
|
||||
smsc47m1_initialized--;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
EXPORT_NO_SYMBOLS;
|
||||
|
||||
#ifdef MODULE
|
||||
|
||||
MODULE_AUTHOR("Mark D. Studebaker <mdsxyz123@yahoo.com>");
|
||||
MODULE_DESCRIPTION("SMSC47M110x Fan sensors");
|
||||
#ifdef MODULE_LICENSE
|
||||
MODULE_LICENSE("GPL");
|
||||
#endif
|
||||
|
||||
int init_module(void)
|
||||
{
|
||||
return sensors_smsc47m1_init();
|
||||
}
|
||||
|
||||
int cleanup_module(void)
|
||||
{
|
||||
return smsc47m1_cleanup();
|
||||
}
|
||||
|
||||
#endif /* MODULE */
|
||||
@@ -567,4 +567,14 @@
|
||||
#define ARP_SYSCTL7 1006
|
||||
#define ARP_SYSCTL8 1007
|
||||
|
||||
#define SMSC47M1_SYSCTL_FAN1 1101 /* Rotations/min */
|
||||
#define SMSC47M1_SYSCTL_FAN2 1102
|
||||
#define SMSC47M1_SYSCTL_PWM1 1401
|
||||
#define SMSC47M1_SYSCTL_PWM2 1402
|
||||
#define SMSC47M1_SYSCTL_FAN_DIV 2000 /* 1, 2, 4 or 8 */
|
||||
#define SMSC47M1_SYSCTL_ALARMS 2004 /* bitvector */
|
||||
|
||||
#define SMSC47M1_ALARM_FAN1 0x0001
|
||||
#define SMSC47M1_ALARM_FAN2 0x0002
|
||||
|
||||
#endif /* def SENSORS_SENSORS_H */
|
||||
Reference in new issue
Block a user