wt/lm-sensors
1
0
Fork 0
mirror of https://github.com/lm-sensors/lm-sensors.git synced 2026-10-13 10:24:42 +00:00
Code Issues Packages Projects Releases Wiki Activity
Files
a03c2edf3db7e528ae1c193702304d2cf87dc34d
lm-sensors/kernel/chips/fscpos.c
T

772 lines
23 KiB
C
Raw Blame History

/*
fscpos.c - Part of lm_sensors, Linux kernel modules for hardware
monitoring
Copyright (c) 2001 Hermann Jung <hej@odn.de>
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.
*/
/*
fujitsu siemens poseidon chip,
module based on lm80.c
Copyright (c) 1998, 1999 Frodo Looijaard <frodol@dds.nl>
and Philip Edelbrock <phil@netroedge.com>
*/
#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 THIS_MODULE
#define THIS_MODULE NULL
#endif
/* Addresses to scan */
static unsigned short normal_i2c[] = { 0x73, SENSORS_I2C_END };
static unsigned short normal_i2c_range[] = { SENSORS_I2C_END };
static unsigned int normal_isa[] = { SENSORS_ISA_END };
static unsigned int normal_isa_range[] = { SENSORS_ISA_END };
/* Insmod parameters */
SENSORS_INSMOD_1(fscpos);
/* The FSCPOS registers */
/* chip identification */
#define FSCPOS_REG_IDENT_0 0x00
#define FSCPOS_REG_IDENT_1 0x01
#define FSCPOS_REG_IDENT_2 0x02
#define FSCPOS_REG_REVISION 0x03
/* global control and status */
#define FSCPOS_REG_EVENT_STATE 0x04
#define FSCPOS_REG_CONTROL 0x05
/* watchdog */
#define FSCPOS_REG_WDOG_PRESET 0x28
#define FSCPOS_REG_WDOG_STATE 0x23
#define FSCPOS_REG_WDOG_CONTROL 0x21
/* fan 0 */
#define FSCPOS_REG_FAN0_MIN 0x55
#define FSCPOS_REG_FAN0_ACT 0x0e
#define FSCPOS_REG_FAN0_STATE 0x0d
#define FSCPOS_REG_FAN0_RIPPLE 0x0f
/* fan 1 */
#define FSCPOS_REG_FAN1_MIN 0x65
#define FSCPOS_REG_FAN1_ACT 0x6b
#define FSCPOS_REG_FAN1_STATE 0x62
#define FSCPOS_REG_FAN1_RIPPLE 0x6f
/* fan 2 */
/* min speed fan2 not supported */
#define FSCPOS_REG_FAN2_ACT 0xab
#define FSCPOS_REG_FAN2_STATE 0xa2
#define FSCPOS_REG_FAN2_RIPPLE 0x0af
/* voltage supervision */
#define FSCPOS_REG_VOLT_12 0x45
#define FSCPOS_REG_VOLT_5 0x42
#define FSCPOS_REG_VOLT_BATT 0x48
/* temperatures */
/* sensor 0 */
#define FSCPOS_REG_TEMP0_ACT 0x64
#define FSCPOS_REG_TEMP0_STATE 0x71
/* sensor 1 */
#define FSCPOS_REG_TEMP1_ACT 0x32
#define FSCPOS_REG_TEMP1_STATE 0x81
/* sensor 2 */
#define FSCPOS_REG_TEMP2_ACT 0x35
#define FSCPOS_REG_TEMP2_STATE 0x91
/* Conversions. Rounding and limit checking is only done on the TO_REG
variants. Note that you should be a bit careful with which arguments
these macros are called: arguments may be evaluated more than once.
Fixing this is just not worth it. */
#define IN_TO_REG(val,nr) (SENSORS_LIMIT((val),0,255))
#define IN_FROM_REG(val,nr) (val)
/* Initial limits */
#ifdef MODULE
extern int init_module(void);
extern int cleanup_module(void);
#endif /* MODULE */
/* For each registered FSCPOS, we need to keep some data in memory. That
data is pointed to by fscpos_list[NR]->data. The structure itself is
dynamically allocated, at the same time when a new fscpos client is
allocated. */
struct fscpos_data {
int sysctl_id;
struct semaphore update_lock;
char valid; /* !=0 if following fields are valid */
unsigned long last_updated; /* In jiffies */
u8 revision; /* revision of chip */
u8 global_event; /* global event status */
u8 global_control; /* global control register */
u8 watchdog[3]; /* watchdog */
u8 volt[3]; /* 12, 5, battery current */
u8 temp_act[3]; /* temperature */
u8 temp_status[3]; /* status of sensor */
u8 fan_act[3]; /* fans revolutions per second */
u8 fan_status[3]; /* fan status */
u8 fan_min[3]; /* fan min value for rps */
u8 fan_ripple[3]; /* divider for rps */
};
#ifdef MODULE
static
#else
extern
#endif
int __init sensors_fscpos_init(void);
static int __init fscpos_cleanup(void);
static int fscpos_attach_adapter(struct i2c_adapter *adapter);
static int fscpos_detect(struct i2c_adapter *adapter, int address,
unsigned short flags, int kind);
static int fscpos_detach_client(struct i2c_client *client);
static int fscpos_command(struct i2c_client *client, unsigned int cmd,
void *arg);
static void fscpos_inc_use(struct i2c_client *client);
static void fscpos_dec_use(struct i2c_client *client);
static int fscpos_read_value(struct i2c_client *client, u8 register);
static int fscpos_write_value(struct i2c_client *client, u8 register,
u8 value);
static void fscpos_update_client(struct i2c_client *client);
static void fscpos_init_client(struct i2c_client *client);
static void fscpos_in(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results);
static void fscpos_fan(struct i2c_client *client, int operation,
int ctl_name, int *nrels_mag, long *results);
static void fscpos_fan_internal(struct i2c_client *client, int operation,
int ctl_name, int *nrels_mag, long *results,
int nr, int reg_state, int reg_min, int res_ripple);
static void fscpos_temp(struct i2c_client *client, int operation,
int ctl_name, int *nrels_mag, long *results);
static void fscpos_volt(struct i2c_client *client, int operation,
int ctl_name, int *nrels_mag, long *results);
static void fscpos_wdog(struct i2c_client *client, int operation,
int ctl_name, int *nrels_mag, long *results);
static int fscpos_id = 0;
static struct i2c_driver fscpos_driver = {
/* name */ "FSCPOS sensor driver",
/* id */ I2C_DRIVERID_FSCPOS,
/* flags */ I2C_DF_NOTIFY,
/* attach_adapter */ &fscpos_attach_adapter,
/* detach_client */ &fscpos_detach_client,
/* command */ &fscpos_command,
/* inc_use */ &fscpos_inc_use,
/* dec_use */ &fscpos_dec_use
};
/* Used by fscpos_init/cleanup */
static int __initdata fscpos_initialized = 0;
/* The /proc/sys entries */
/* These files are created for each detected FSCPOS. This is just a template;
though at first sight, you might think we could use a statically
allocated list, we need some way to get back to the parent - which
is done through one of the 'extra' fields which are initialized
when a new copy is allocated. */
static ctl_table fscpos_dir_table_template[] = {
{FSCPOS_SYSCTL_REV, "rev", NULL, 0, 0444, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_in},
{FSCPOS_SYSCTL_EVENT, "alarms", NULL, 0, 0444, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_in},
{FSCPOS_SYSCTL_CONTROL, "control", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_in},
{FSCPOS_SYSCTL_TEMP0, "temp1", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_temp},
{FSCPOS_SYSCTL_TEMP1, "temp2", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_temp},
{FSCPOS_SYSCTL_TEMP2, "temp3", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_temp},
{FSCPOS_SYSCTL_VOLT0, "in0", NULL, 0, 0444, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_volt},
{FSCPOS_SYSCTL_VOLT1, "in1", NULL, 0, 0444, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_volt},
{FSCPOS_SYSCTL_VOLT2, "in2", NULL, 0, 0444, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_volt},
{FSCPOS_SYSCTL_FAN0, "fan1", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_fan},
{FSCPOS_SYSCTL_FAN1, "fan2", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_fan},
{FSCPOS_SYSCTL_FAN2, "fan3", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_fan},
{FSCPOS_SYSCTL_WDOG, "wdog", NULL, 0, 0644, NULL, &i2c_proc_real,
&i2c_sysctl_real, NULL, &fscpos_wdog},
{0}
};
int fscpos_attach_adapter(struct i2c_adapter *adapter)
{
return i2c_detect(adapter, &addr_data, fscpos_detect);
}
int fscpos_detect(struct i2c_adapter *adapter, int address,
unsigned short flags, int kind)
{
int i;
struct i2c_client *new_client;
struct fscpos_data *data;
int err = 0;
const char *type_name, *client_name;
/* Make sure we aren't probing the ISA bus!! This is just a safety check
at this moment; i2c_detect really won't call us. */
#ifdef DEBUG
if (i2c_is_isa_adapter(adapter)) {
printk
("fscpos.o: fscpos_detect called for an ISA bus adapter?!?\n");
return 0;
}
#endif
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
goto ERROR0;
/* OK. For now, we presume we have a valid client. We now create the
client structure, even though we cannot fill it completely yet.
But it allows us to access fscpos_{read,write}_value. */
if (!(new_client = kmalloc(sizeof(struct i2c_client) +
sizeof(struct fscpos_data),
GFP_KERNEL))) {
err = -ENOMEM;
goto ERROR0;
}
data = (struct fscpos_data *) (new_client + 1);
new_client->addr = address;
new_client->data = data;
new_client->adapter = adapter;
new_client->driver = &fscpos_driver;
new_client->flags = 0;
/* Do the remaining detection unless force or force_fscpos parameter */
if (kind < 0) {
if (fscpos_read_value(new_client, FSCPOS_REG_IDENT_0) != 0x50)
goto ERROR1;
if (fscpos_read_value(new_client, FSCPOS_REG_IDENT_1) != 0x45)
goto ERROR1;
if (fscpos_read_value(new_client, FSCPOS_REG_IDENT_2) != 0x47)
goto ERROR1;
}
kind = fscpos;
type_name = "fscpos";
client_name = "fsc poseidon chip";
/* Fill in the remaining client fields and put it into the global list */
strcpy(new_client->name, client_name);
new_client->id = fscpos_id++;
data->valid = 0;
init_MUTEX(&data->update_lock);
/* Tell the I2C layer a new client has arrived */
if ((err = i2c_attach_client(new_client)))
goto ERROR3;
/* Register a new directory entry with module sensors */
if ((i = i2c_register_entry(new_client, type_name,
fscpos_dir_table_template,
THIS_MODULE)) < 0) {
err = i;
goto ERROR4;
}
data->sysctl_id = i;
fscpos_init_client(new_client);
return 0;
/* OK, this is not exactly good programming practice, usually. But it is
very code-efficient in this case. */
ERROR4:
i2c_detach_client(new_client);
ERROR3:
ERROR1:
kfree(new_client);
ERROR0:
return err;
}
int fscpos_detach_client(struct i2c_client *client)
{
int err;
i2c_deregister_entry(((struct fscpos_data *) (client->data))->
sysctl_id);
if ((err = i2c_detach_client(client))) {
printk
("fscpos.o: Client deregistration failed, client not detached.\n");
return err;
}
kfree(client);
return 0;
}
/* No commands defined yet */
int fscpos_command(struct i2c_client *client, unsigned int cmd, void *arg)
{
return 0;
}
void fscpos_inc_use(struct i2c_client *client)
{
#ifdef MODULE
MOD_INC_USE_COUNT;
#endif
}
void fscpos_dec_use(struct i2c_client *client)
{
#ifdef MODULE
MOD_DEC_USE_COUNT;
#endif
}
int fscpos_read_value(struct i2c_client *client, u8 reg)
{
#ifdef DEBUG
printk("fscpos: read reg 0x%02x\n",reg);
#endif
return i2c_smbus_read_byte_data(client, reg);
}
int fscpos_write_value(struct i2c_client *client, u8 reg, u8 value)
{
#ifdef DEBUG
printk("fscpos: write reg 0x%02x, val 0x%02x\n",reg, value);
#endif
return i2c_smbus_write_byte_data(client, reg, value);
}
/* Called when we have found a new FSCPOS. It should set limits, etc. */
void fscpos_init_client(struct i2c_client *client)
{
struct fscpos_data *data = client->data;
/* read revision from chip */
data->revision = fscpos_read_value(client,FSCPOS_REG_REVISION);
/* setup missing fan2_min value */
data->fan_min[2] = 0xff;
}
void fscpos_update_client(struct i2c_client *client)
{
struct fscpos_data *data = client->data;
down(&data->update_lock);
if ((jiffies - data->last_updated > 2 * HZ) ||
(jiffies < data->last_updated) || !data->valid) {
#ifdef DEBUG
printk("Starting fscpos update\n");
#endif
data->temp_act[0] = fscpos_read_value(client, FSCPOS_REG_TEMP0_ACT);
data->temp_act[1] = fscpos_read_value(client, FSCPOS_REG_TEMP1_ACT);
data->temp_act[2] = fscpos_read_value(client, FSCPOS_REG_TEMP2_ACT);
data->temp_status[0] = fscpos_read_value(client, FSCPOS_REG_TEMP0_STATE);
data->temp_status[1] = fscpos_read_value(client, FSCPOS_REG_TEMP1_STATE);
data->temp_status[2] = fscpos_read_value(client, FSCPOS_REG_TEMP2_STATE);
data->volt[0] = fscpos_read_value(client, FSCPOS_REG_VOLT_12);
data->volt[1] = fscpos_read_value(client, FSCPOS_REG_VOLT_5);
data->volt[2] = fscpos_read_value(client, FSCPOS_REG_VOLT_BATT);
data->fan_act[0] = fscpos_read_value(client, FSCPOS_REG_FAN0_ACT);
data->fan_act[1] = fscpos_read_value(client, FSCPOS_REG_FAN1_ACT);
data->fan_act[2] = fscpos_read_value(client, FSCPOS_REG_FAN2_ACT);
data->fan_status[0] = fscpos_read_value(client, FSCPOS_REG_FAN0_STATE);
data->fan_status[1] = fscpos_read_value(client, FSCPOS_REG_FAN1_STATE);
data->fan_status[2] = fscpos_read_value(client, FSCPOS_REG_FAN2_STATE);
data->fan_min[0] = fscpos_read_value(client, FSCPOS_REG_FAN0_MIN);
data->fan_min[1] = fscpos_read_value(client, FSCPOS_REG_FAN1_MIN);
/* fan2_min is not supported */
data->fan_ripple[0] = fscpos_read_value(client, FSCPOS_REG_FAN0_RIPPLE);
data->fan_ripple[1] = fscpos_read_value(client, FSCPOS_REG_FAN1_RIPPLE);
data->fan_ripple[2] = fscpos_read_value(client, FSCPOS_REG_FAN2_RIPPLE);
data->watchdog[0] = fscpos_read_value(client, FSCPOS_REG_WDOG_PRESET);
data->watchdog[1] = fscpos_read_value(client, FSCPOS_REG_WDOG_STATE);
data->watchdog[2] = fscpos_read_value(client, FSCPOS_REG_WDOG_CONTROL);
data->global_event = fscpos_read_value(client, FSCPOS_REG_EVENT_STATE);
data->last_updated = jiffies;
data->valid = 1;
}
up(&data->update_lock);
}
/* The next few functions are the call-back functions of the /proc/sys and
sysctl files. Which function is used is defined in the ctl_table in
the extra1 field.
Each function must return the magnitude (power of 10 to divide the date
with) if it is called with operation==SENSORS_PROC_REAL_INFO. It must
put a maximum of *nrels elements in results reflecting the data of this
file, and set *nrels to the number it actually put in it, if operation==
SENSORS_PROC_REAL_READ. Finally, it must get upto *nrels elements from
results and write them to the chip, if operations==SENSORS_PROC_REAL_WRITE.
Note that on SENSORS_PROC_REAL_READ, I do not check whether results is
large enough (by checking the incoming value of *nrels). This is not very
good practice, but as long as you put less than about 5 values in results,
you can assume it is large enough. */
void fscpos_in(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results)
{
struct fscpos_data *data = client->data;
if (operation == SENSORS_PROC_REAL_INFO)
*nrels_mag = 0;
else if (operation == SENSORS_PROC_REAL_READ) {
fscpos_update_client(client);
switch(ctl_name) {
case FSCPOS_SYSCTL_REV:
results[0] = data->revision ;
break;
case FSCPOS_SYSCTL_EVENT:
results[0] = data->global_event & 0x1f;
break;
case FSCPOS_SYSCTL_CONTROL:
results[0] = data->global_control & 0x01;
break;
default:
printk("fscpos: ctl_name %d not supported\n",
ctl_name);
*nrels_mag = 0;
return;
}
*nrels_mag = 1;
} else if (operation == SENSORS_PROC_REAL_WRITE) {
if((ctl_name == FSCPOS_SYSCTL_CONTROL) && (*nrels_mag >= 1)) {
data->global_control = (results[0] & 0x01);
printk("fscpos: writing 0x%02x to global_control\n",
data->global_control);
fscpos_write_value(client,FSCPOS_REG_CONTROL,
data->global_control);
}
else
printk("fscpos: writing to chip not supported\n");
}
}
#define TEMP_FROM_REG(val) (val-128)
void fscpos_temp(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results)
{
struct fscpos_data *data = client->data;
if (operation == SENSORS_PROC_REAL_INFO)
*nrels_mag = 0;
else if (operation == SENSORS_PROC_REAL_READ) {
fscpos_update_client(client);
switch(ctl_name) {
case FSCPOS_SYSCTL_TEMP0:
results[0] = data->temp_status[0] & 0x03;
results[1] = TEMP_FROM_REG(data->temp_act[0]);
break;
case FSCPOS_SYSCTL_TEMP1:
results[0] = data->temp_status[1] & 0x03;
results[1] = TEMP_FROM_REG(data->temp_act[1]);
break;
case FSCPOS_SYSCTL_TEMP2:
results[0] = data->temp_status[2] & 0x03;
results[1] = TEMP_FROM_REG(data->temp_act[2]);
break;
default:
printk("fscpos: ctl_name %d not supported\n",
ctl_name);
*nrels_mag = 0;
return;
}
*nrels_mag = 2;
} else if (operation == SENSORS_PROC_REAL_WRITE) {
if(*nrels_mag >= 1) {
switch(ctl_name) {
case FSCPOS_SYSCTL_TEMP0:
data->temp_status[0] =
(data->temp_status[0] & ~0x02)
| (results[0] & 0x02);
printk("fscpos: writing value 0x%02x "
"to temp0_status\n",
data->temp_status[0]);
fscpos_write_value(client,
FSCPOS_REG_TEMP0_STATE,
data->temp_status[0] & 0x02);
break;
case FSCPOS_SYSCTL_TEMP1:
data->temp_status[1] = (data->temp_status[1] & ~0x02) | (results[0] & 0x02);
printk("fscpos: writing value 0x%02x to temp1_status\n", data->temp_status[1]);
fscpos_write_value(client,FSCPOS_REG_TEMP1_STATE,
data->temp_status[1] & 0x02);
break;
case FSCPOS_SYSCTL_TEMP2:
data->temp_status[2] = (data->temp_status[2] & ~0x02) | (results[0] & 0x02);
printk("fscpos: writing value 0x%02x to temp2_status\n", data->temp_status[2]);
fscpos_write_value(client,FSCPOS_REG_TEMP2_STATE,
data->temp_status[2] & 0x02);
break;
default:
printk("fscpos: ctl_name %d not supported\n",ctl_name);
}
}
else
printk("fscpos: writing to chip not supported\n");
}
}
#define VOLT_FROM_REG(val,mult) (val*mult/255)
void fscpos_volt(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results)
{
struct fscpos_data *data = client->data;
if (operation == SENSORS_PROC_REAL_INFO)
*nrels_mag = 2;
else if (operation == SENSORS_PROC_REAL_READ) {
fscpos_update_client(client);
switch(ctl_name) {
case FSCPOS_SYSCTL_VOLT0:
results[0] = VOLT_FROM_REG(data->volt[0],1420);
break;
case FSCPOS_SYSCTL_VOLT1:
results[0] = VOLT_FROM_REG(data->volt[1],660);
break;
case FSCPOS_SYSCTL_VOLT2:
results[0] = VOLT_FROM_REG(data->volt[2],330);
break;
default:
printk("fscpos: ctl_name %d not supported\n",
ctl_name);
*nrels_mag = 0;
return;
}
*nrels_mag = 1;
} else if (operation == SENSORS_PROC_REAL_WRITE) {
printk("fscpos: writing to chip not supported\n");
}
}
void fscpos_fan(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results)
{
switch(ctl_name) {
case FSCPOS_SYSCTL_FAN0:
fscpos_fan_internal(client,operation,ctl_name,nrels_mag,results,
0,FSCPOS_REG_FAN0_STATE,FSCPOS_REG_FAN0_MIN,
FSCPOS_REG_FAN0_RIPPLE);
break;
case FSCPOS_SYSCTL_FAN1:
fscpos_fan_internal(client,operation,ctl_name,nrels_mag,results,
1,FSCPOS_REG_FAN1_STATE,FSCPOS_REG_FAN1_MIN,
FSCPOS_REG_FAN1_RIPPLE);
break;
case FSCPOS_SYSCTL_FAN2:
fscpos_fan_internal(client,operation,ctl_name,nrels_mag,results,
2,FSCPOS_REG_FAN2_STATE,0xff,
FSCPOS_REG_FAN2_RIPPLE);
break;
default:
printk("fscpos: illegal fan nr %d\n",ctl_name);
}
}
#define RPM_FROM_REG(val) (val*60)
void fscpos_fan_internal(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results, int nr,
int reg_state, int reg_min, int reg_ripple )
{
struct fscpos_data *data = client->data;
if (operation == SENSORS_PROC_REAL_INFO)
*nrels_mag = 0;
else if (operation == SENSORS_PROC_REAL_READ) {
fscpos_update_client(client);
results[0] = data->fan_status[nr] & 0x04;
results[1] = data->fan_min[nr];
results[2] = data->fan_ripple[nr] & 0x03;
results[3] = RPM_FROM_REG(data->fan_act[nr]);
*nrels_mag = 4;
} else if (operation == SENSORS_PROC_REAL_WRITE) {
if(*nrels_mag >= 1) {
data->fan_status[nr] = results[0] & 0x04;
printk("fscpos: writing value 0x%02x to fan%d_status\n",
data->fan_status[nr],nr);
fscpos_write_value(client,reg_state,
data->fan_status[nr]);
}
if((*nrels_mag >= 2) && (nr < 2)) {
/* minimal speed for fan2 not supported */
data->fan_min[nr] = results[1];
printk("fscpos: writing value 0x%02x to fan%d_min\n",
data->fan_min[nr],nr);
fscpos_write_value(client,reg_min,
data->fan_min[nr]);
}
if(*nrels_mag >= 3) {
if((results[2] & 0x03) == 0) {
printk("fscpos: fan%d ripple 0 not allowed\n",nr);
return;
}
data->fan_ripple[nr] = results[2] & 0x03;
printk("fscpos: writing value 0x%02x to fan%d_ripple\n",
data->fan_ripple[nr],nr);
fscpos_write_value(client,reg_ripple,
data->fan_ripple[nr]);
}
}
}
void fscpos_wdog(struct i2c_client *client, int operation, int ctl_name,
int *nrels_mag, long *results)
{
struct fscpos_data *data = client->data;
if (operation == SENSORS_PROC_REAL_INFO)
*nrels_mag = 0;
else if (operation == SENSORS_PROC_REAL_READ) {
fscpos_update_client(client);
results[0] = data->watchdog[0] ;
results[1] = data->watchdog[1] & 0x02;
results[2] = data->watchdog[2] & 0xb0;
*nrels_mag = 3;
} else if (operation == SENSORS_PROC_REAL_WRITE) {
if (*nrels_mag >= 1) {
data->watchdog[0] = results[0] & 0xff;
printk("fscpos: writing value 0x%02x to wdog_preset\n",
data->watchdog[0]);
fscpos_write_value(client,FSCPOS_REG_WDOG_PRESET,
data->watchdog[0]);
}
if (*nrels_mag >= 2) {
data->watchdog[1] = results[1] & 0x02;
printk("fscpos: writing value 0x%02x to wdog_state\n",
data->watchdog[1]);
fscpos_write_value(client,FSCPOS_REG_WDOG_STATE,
data->watchdog[1]);
}
if (*nrels_mag >= 3) {
data->watchdog[2] = results[2] & 0xb0;
printk("fscpos: writing value 0x%02x to wdog_control\n",
data->watchdog[2]);
fscpos_write_value(client,FSCPOS_REG_WDOG_CONTROL,
data->watchdog[2]);
}
}
}
int __init sensors_fscpos_init(void)
{
int res;
printk("fscpos.o version %s (%s)\n", LM_VERSION, LM_DATE);
fscpos_initialized = 0;
if ((res = i2c_add_driver(&fscpos_driver))) {
printk
("fscpos.o: Driver registration failed, module not inserted.\n");
fscpos_cleanup();
return res;
}
fscpos_initialized++;
return 0;
}
int __init fscpos_cleanup(void)
{
int res;
if (fscpos_initialized >= 1) {
if ((res = i2c_del_driver(&fscpos_driver))) {
printk
("fscpos.o: Driver deregistration failed, module not removed.\n");
return res;
}
fscpos_initialized--;
}
return 0;
}
EXPORT_NO_SYMBOLS;
#ifdef MODULE
MODULE_AUTHOR
("Hermann Jung <hej@odn.de> based on work from Frodo Looijaard <frodol@dds.nl> and Philip Edelbrock <phil@netroedge.com>");
MODULE_DESCRIPTION("fujitsu siemens poseidon chip driver");
#ifdef MODULE_LICENSE
MODULE_LICENSE("GPL");
#endif
int init_module(void)
{
return sensors_fscpos_init();
}
int cleanup_module(void)
{
return fscpos_cleanup();
}
#endif /* MODULE */
Reference in New Issue View Git Blame Copy Permalink