mirror of
https://github.com/lm-sensors/lm-sensors.git
synced 2026-11-08 16:11:26 +00:00
Many things, most notable the lm78 module
* Some Makefile changes. doc/makefiles documents most of them. * The lm78 module now compiles, but it will still crash. * New module sensors, with general code usable by chip driver modules * i2c-core: added function i2c_adapter_id(), which returns a (low) unique i2c-bus ID. * lm78.h stuff moved into lm78.c or sensors.h git-svn-id: http://lm-sensors.org/svn/lm-sensors/trunk@19 7894878c-1315-0410-8ee3-d5d059ff63e0
This commit is contained in:
Frodo Looijaard committed
1 parent
dcf30092e1
commit
6ea68ba7a2
21 files changed
+2169
-224
No files matched your search
+619
-87
@@ -1,3 +1,4 @@
|
||||
|
||||
/*
|
||||
lm78.c - A Linux module for reading sensor data.
|
||||
Copyright (c) 1998 Frodo Looijaard <frodol@dds.nl>
|
||||
@@ -21,15 +22,112 @@
|
||||
#include <linux/malloc.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 "lm78.h"
|
||||
#include "smbus.h"
|
||||
#include "version.h"
|
||||
#include "isa.h"
|
||||
#include "sensors.h"
|
||||
#include "i2c.h"
|
||||
#include "compat.h"
|
||||
|
||||
/* Many LM78 constants needed below */
|
||||
|
||||
/* Length of ISA address segment */
|
||||
#define LM78_EXTENT 8
|
||||
|
||||
/* Where are the ISA address/data registers relative to the base address */
|
||||
#define LM78_ADDR_REG_OFFSET 5
|
||||
#define LM78_DATA_REG_OFFSET 6
|
||||
|
||||
/* The LM78 registers */
|
||||
#define LM78_REG_IN_MAX(nr) (0x2b + (nr) * 2)
|
||||
#define LM78_REG_IN_MIN(nr) (0x2c + (nr) * 2)
|
||||
#define LM78_REG_IN(nr) (0x20 + (nr))
|
||||
|
||||
#define LM78_REG_FAN_MIN(nr) (0x3a + (nr))
|
||||
#define LM78_REG_FAN(nr) (0x27 + (nr))
|
||||
|
||||
#define LM78_REG_TEMP 0x27
|
||||
#define LM78_REG_TEMP_OVER 0x39
|
||||
#define LM78_REG_TEMP_HYST 0x3a
|
||||
|
||||
#define LM78_REG_ALARM1 0x41
|
||||
#define LM78_REG_ALARM2 0x42
|
||||
|
||||
#define LM78_REG_VID_FANDIV 0x47
|
||||
|
||||
#define LM78_REG_CONFIG 0x40
|
||||
|
||||
|
||||
/* Conversions */
|
||||
static int lm78_in_conv[7] = {10000, 10000, 10000, 16892, 38000,
|
||||
-34768, -15050 };
|
||||
#define IN_TO_REG(val,nr) ((((val) * 100000 / lm78_in_conv[nr]) + 8) / 16)
|
||||
#define IN_FROM_REG(val,nr) (((val) * 16 * lm78_in_conv[nr]) / 100000)
|
||||
|
||||
#define FAN_TO_REG(val) (((val)==0)?255:((1350000+(val))/((val)*2)))
|
||||
#define FAN_FROM_REG(val) (((val)==0)?-1:\
|
||||
((val)==255)?0:(1350000 + (val))/((val)*2))
|
||||
|
||||
#define TEMP_TO_REG(val) ((val)<0?(val)&0xff:(val))
|
||||
#define TEMP_FROM_REG(val) ((val)>0x80?(val)-0x100:(val));
|
||||
|
||||
#define VID_FROM_REG(val) ((val) == 0x0f?0:350-(val)*10)
|
||||
|
||||
#define ALARMS_FROM_REG(val) (val)
|
||||
|
||||
#define DIV_FROM_REG(val) (1 >> (val))
|
||||
#define DIV_TO_REG(val) ((val)==8?3:(val)==4?2:(val)==1?1:2)
|
||||
|
||||
/* Initial limits */
|
||||
#define LM78_INIT_IN_0 280
|
||||
#define LM78_INIT_IN_1 280
|
||||
#define LM78_INIT_IN_2 330
|
||||
#define LM78_INIT_IN_3 500
|
||||
#define LM78_INIT_IN_4 1200
|
||||
#define LM78_INIT_IN_5 -1200
|
||||
#define LM78_INIT_IN_6 -500
|
||||
|
||||
#define LM78_INIT_IN_PERCENTAGE 100
|
||||
|
||||
#define LM78_INIT_IN_MIN_0 \
|
||||
(LM78_INIT_IN_0 - LM78_INIT_IN_0 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_0 \
|
||||
(LM78_INIT_IN_0 + LM78_INIT_IN_0 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_1 \
|
||||
(LM78_INIT_IN_1 - LM78_INIT_IN_1 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_1 \
|
||||
(LM78_INIT_IN_1 + LM78_INIT_IN_1 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_2 \
|
||||
(LM78_INIT_IN_2 - LM78_INIT_IN_2 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_2 \
|
||||
(LM78_INIT_IN_2 + LM78_INIT_IN_2 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_3 \
|
||||
(LM78_INIT_IN_3 - LM78_INIT_IN_3 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_3 \
|
||||
(LM78_INIT_IN_3 + LM78_INIT_IN_3 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_4 \
|
||||
(LM78_INIT_IN_4 - LM78_INIT_IN_4 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_4 \
|
||||
(LM78_INIT_IN_4 + LM78_INIT_IN_4 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_5 \
|
||||
(LM78_INIT_IN_5 - LM78_INIT_IN_5 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_5 \
|
||||
(LM78_INIT_IN_5 + LM78_INIT_IN_5 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MIN_6 \
|
||||
(LM78_INIT_IN_6 - LM78_INIT_IN_6 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
#define LM78_INIT_IN_MAX_6 \
|
||||
(LM78_INIT_IN_6 + LM78_INIT_IN_6 * LM78_INIT_IN_PERCENTAGE / 100)
|
||||
|
||||
#define LM78_INIT_FAN_MIN_1 3000
|
||||
#define LM78_INIT_FAN_MIN_2 3000
|
||||
#define LM78_INIT_FAN_MIN_3 3000
|
||||
|
||||
#define LM78_INIT_TEMP_OVER 60
|
||||
#define LM78_INIT_TEMP_HYST 50
|
||||
|
||||
#ifdef MODULE
|
||||
extern int init_module(void);
|
||||
@@ -51,6 +149,32 @@ extern int cleanup_module(void);
|
||||
bad. Quite a lot of bookkeeping is done. A real driver can often cut
|
||||
some corners. */
|
||||
|
||||
/* For each registered LM78, we need to keep some data in memory. That
|
||||
data is pointed to by lm78_list[NR]->data. The structure itself is
|
||||
dynamically allocated, at the same time when a new lm78 client is
|
||||
allocated. */
|
||||
struct lm78_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 in[7]; /* Register value */
|
||||
u8 in_max[7]; /* Register value */
|
||||
u8 in_min[7]; /* Register value */
|
||||
u8 fan[3]; /* Register value */
|
||||
u8 fan_min[3]; /* Register value */
|
||||
u8 temp; /* Register value */
|
||||
u8 temp_over; /* Register value */
|
||||
u8 temp_hyst; /* Register value */
|
||||
u8 fan_div[2]; /* Register encoding, shifted right */
|
||||
u8 vid; /* Register encoding, combined */
|
||||
u16 alarms; /* Register encoding, combined */
|
||||
};
|
||||
|
||||
|
||||
static int lm78_init(void);
|
||||
static int lm78_cleanup(void);
|
||||
|
||||
@@ -62,21 +186,44 @@ static int lm78_detach_isa(struct isa_client *client);
|
||||
static int lm78_detach_smbus(struct i2c_client *client);
|
||||
static int lm78_new_client(struct i2c_adapter *adapter,
|
||||
struct i2c_client *new_client);
|
||||
static void lm78_init_client(struct i2c_client *client);
|
||||
static void lm78_remove_client(struct i2c_client *client);
|
||||
static int lm78_command(struct i2c_client *client, unsigned int cmd,
|
||||
void *arg);
|
||||
static void lm78_inc_use (struct i2c_client *client);
|
||||
static void lm78_dec_use (struct i2c_client *client);
|
||||
|
||||
static int lm78_read_value(struct i2c_client *client, u8 register);
|
||||
static int lm78_write_value(struct i2c_client *client, u8 register, u8 value);
|
||||
static void lm78_update_client(struct i2c_client *client);
|
||||
static void lm78_init_client(struct i2c_client *client);
|
||||
|
||||
static int lm78_sysctl (ctl_table *table, int *name, int nlen, void *oldval,
|
||||
size_t *oldlenp, void *newval, size_t newlen,
|
||||
void **context);
|
||||
static int lm78_proc (ctl_table *ctl, int write, struct file * filp,
|
||||
void *buffer, size_t *lenp);
|
||||
|
||||
|
||||
static void write_in(struct i2c_client *client, int nr, int nrels,
|
||||
long *results);
|
||||
static void read_in(struct i2c_client *client, int nr, long *results);
|
||||
static void write_fan(struct i2c_client *client, int nr, int nrels,
|
||||
long *results);
|
||||
static void read_fan(struct i2c_client *client, int nr, long *results);
|
||||
static void write_temp(struct i2c_client *client, int nrels, long *results);
|
||||
static void read_temp(struct i2c_client *client, long *results);
|
||||
static void read_vid(struct i2c_client *client, long *results);
|
||||
static void read_alarms(struct i2c_client *client, long *results);
|
||||
static void write_fan_div(struct i2c_client *client, int nrels, long *results);
|
||||
static void read_fan_div(struct i2c_client *client, long *results);
|
||||
|
||||
|
||||
|
||||
/* I choose here for semi-static LM78 allocation. Complete dynamic
|
||||
allocation could also be used; the code needed for this would probably
|
||||
take more memory than the datastructures take now */
|
||||
take more memory than the datastructure takes now. */
|
||||
#define MAX_LM78_NR 4
|
||||
static struct i2c_client *lm78_list[MAX_LM78_NR];
|
||||
static struct semaphore lm78_semaphores[MAX_LM78_NR];
|
||||
|
||||
/* The driver. I choose to use type i2c_driver, as at is identical to both
|
||||
smbus_driver and isa_driver, and clients could be of either kind */
|
||||
@@ -94,8 +241,34 @@ static struct i2c_driver lm78_driver = {
|
||||
/* Used by lm78_init/cleanup */
|
||||
static int lm78_initialized = 0;
|
||||
|
||||
/* The /proc/sys entries */
|
||||
/* These files are created for each detected LM78. 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 lm78_dir_table_template[] = {
|
||||
{ LM78_SYSCTL_IN0, "in0", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN1, "in1", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN2, "in2", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN3, "in3", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN4, "in4", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN5, "in5", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_IN6, "in6", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_FAN1, "fan1", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_FAN2, "fan1", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_FAN3, "fan1", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_TEMP, "temp", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_VID, "vid", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
{ LM78_SYSCTL_FAN_DIV, "fan_div", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl },
|
||||
|
||||
{ LM78_SYSCTL_ALARMS, "alarms", NULL, 0, 0644, NULL, &lm78_proc, &lm78_sysctl }
|
||||
};
|
||||
|
||||
|
||||
/* This function is called when:
|
||||
* lm78_driver is inserted, for each available adapter
|
||||
* lm78_driver is inserted (when this module is loaded), for each
|
||||
available adapter
|
||||
* when a new adapter is inserted (and lm78_driver is still present) */
|
||||
int lm78_attach_adapter(struct i2c_adapter *adapter)
|
||||
{
|
||||
@@ -105,7 +278,10 @@ int lm78_attach_adapter(struct i2c_adapter *adapter)
|
||||
return lm78_detect_smbus(adapter);
|
||||
}
|
||||
|
||||
/* This function is called whenever a client should be removed */
|
||||
/* This function is called whenever a client should be removed:
|
||||
* lm78_driver is removed (when this module is unloaded)
|
||||
* when an adapter is removed which has a lm78 client (and lm78_driver
|
||||
is still present). */
|
||||
int lm78_detach_client(struct i2c_client *client)
|
||||
{
|
||||
if (i2c_is_isa_client(client))
|
||||
@@ -138,42 +314,74 @@ int lm78_detect_isa(struct isa_adapter *adapter)
|
||||
|
||||
request_region(address, LM78_EXTENT, "lm78");
|
||||
|
||||
if (! (new_client = kmalloc(sizeof(struct isa_client), GFP_KERNEL)))
|
||||
/* Allocate space for a new client structure */
|
||||
if (! (new_client = kmalloc(sizeof(struct isa_client) +
|
||||
sizeof(struct lm78_data),
|
||||
GFP_KERNEL)))
|
||||
{
|
||||
release_region(address,LM78_EXTENT);
|
||||
err=-ENOMEM;
|
||||
continue;
|
||||
}
|
||||
goto ERROR1;
|
||||
}
|
||||
|
||||
/* Fill the new client structure with data */
|
||||
new_client->data = (struct lm78_data *) (new_client + 1);
|
||||
new_client->addr = 0;
|
||||
new_client->isa_addr = address;
|
||||
if ((err = lm78_new_client((struct i2c_adapter *) adapter,
|
||||
(struct i2c_client *) new_client))) {
|
||||
release_region(address, LM78_EXTENT);
|
||||
kfree(new_client);
|
||||
continue;
|
||||
}
|
||||
if ((err = isa_attach_client(new_client))) {
|
||||
release_region(address, LM78_EXTENT);
|
||||
lm78_remove_client((struct i2c_client *) new_client);
|
||||
kfree(new_client);
|
||||
continue;
|
||||
}
|
||||
(struct i2c_client *) new_client)))
|
||||
goto ERROR2;
|
||||
|
||||
/* Tell i2c-core a new client has arrived */
|
||||
if ((err = isa_attach_client(new_client)))
|
||||
goto ERROR3;
|
||||
|
||||
/* Register a new directory entry with module sensors */
|
||||
if ((err = sensors_register_entry((struct i2c_client *) new_client,"lm78",
|
||||
lm78_dir_table_template) < 0))
|
||||
goto ERROR4;
|
||||
((struct lm78_data *) (new_client->data)) -> sysctl_id = err;
|
||||
|
||||
/* Initialize the LM78 chip */
|
||||
lm78_init_client((struct i2c_client *) new_client);
|
||||
continue;
|
||||
|
||||
/* OK, this is not exactly good programming practice, usually. But it is
|
||||
very code-efficient in this case. */
|
||||
|
||||
ERROR4:
|
||||
isa_detach_client(new_client);
|
||||
ERROR3:
|
||||
lm78_remove_client((struct i2c_client *) new_client);
|
||||
ERROR2:
|
||||
kfree(new_client);
|
||||
ERROR1:
|
||||
release_region(address, LM78_EXTENT);
|
||||
}
|
||||
return err;
|
||||
|
||||
}
|
||||
|
||||
/* Deregister and remove a LM78 client */
|
||||
int lm78_detach_isa(struct isa_client *client)
|
||||
{
|
||||
int err;
|
||||
int err,i;
|
||||
for (i = 0; i < MAX_LM78_NR; i++)
|
||||
if ((client == (struct isa_client *) (lm78_list[i])))
|
||||
break;
|
||||
if (i == MAX_LM78_NR) {
|
||||
printk("lm78.o: Client to detach not found.\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
sensors_deregister_entry(((struct lm78_data *)(client->data))->sysctl_id);
|
||||
|
||||
if ((err = isa_detach_client(client))) {
|
||||
printk("lm78.o: Client deregistration failed, client not detached.\n");
|
||||
return err;
|
||||
}
|
||||
release_region(client->isa_addr,LM78_EXTENT);
|
||||
lm78_remove_client((struct i2c_client *) client);
|
||||
kfree(client);
|
||||
release_region(client->isa_addr,LM78_EXTENT);
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -194,25 +402,59 @@ int lm78_detect_smbus(struct i2c_adapter *adapter)
|
||||
|
||||
/* Real detection code goes here */
|
||||
|
||||
new_client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
|
||||
/* Allocate space for a new client structure */
|
||||
if (! (new_client = kmalloc(sizeof(struct i2c_client) +
|
||||
sizeof(struct lm78_data),
|
||||
GFP_KERNEL))) {
|
||||
err = -ENOMEM;
|
||||
continue;
|
||||
}
|
||||
|
||||
/* Fill the new client structure with data */
|
||||
new_client->data = (struct lm78_data *) (new_client + 1);
|
||||
new_client->addr = address;
|
||||
if ((err = lm78_new_client(adapter,new_client))) {
|
||||
kfree(new_client);
|
||||
continue;
|
||||
}
|
||||
if ((err = i2c_attach_client(new_client))) {
|
||||
lm78_remove_client(new_client);
|
||||
kfree(new_client);
|
||||
continue;
|
||||
}
|
||||
if ((err = lm78_new_client(adapter,new_client)))
|
||||
goto ERROR2;
|
||||
|
||||
/* Tell i2c-core a new client has arrived */
|
||||
if ((err = i2c_attach_client(new_client)))
|
||||
goto ERROR3;
|
||||
|
||||
/* Register a new directory entry with module sensors */
|
||||
if ((err = sensors_register_entry(new_client,"lm78",
|
||||
lm78_dir_table_template) < 0))
|
||||
goto ERROR4;
|
||||
((struct lm78_data *) (new_client->data))->sysctl_id = err;
|
||||
|
||||
/* Initialize the LM78 chip */
|
||||
lm78_init_client(new_client);
|
||||
continue;
|
||||
|
||||
/* 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:
|
||||
lm78_remove_client((struct i2c_client *) new_client);
|
||||
ERROR2:
|
||||
kfree(new_client);
|
||||
}
|
||||
return err;
|
||||
}
|
||||
|
||||
int lm78_detach_smbus(struct i2c_client *client)
|
||||
{
|
||||
int err;
|
||||
int err,i;
|
||||
for (i = 0; i < MAX_LM78_NR; i++)
|
||||
if (client == lm78_list[i])
|
||||
break;
|
||||
if ((i == MAX_LM78_NR)) {
|
||||
printk("lm78.o: Client to detach not found.\n");
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
sensors_deregister_entry(((struct lm78_data *)(client->data))->sysctl_id);
|
||||
|
||||
if ((err = i2c_detach_client(client))) {
|
||||
printk("lm78.o: Client deregistration failed, client not detached.\n");
|
||||
return err;
|
||||
@@ -228,6 +470,7 @@ int lm78_new_client(struct i2c_adapter *adapter,
|
||||
struct i2c_client *new_client)
|
||||
{
|
||||
int i;
|
||||
struct lm78_data *data;
|
||||
|
||||
/* First, seek out an empty slot */
|
||||
for(i = 0; i < MAX_LM78_NR; i++)
|
||||
@@ -240,28 +483,26 @@ int lm78_new_client(struct i2c_adapter *adapter,
|
||||
}
|
||||
|
||||
lm78_list[i] = new_client;
|
||||
lm78_semaphores[i] = MUTEX;
|
||||
new_client->data = &lm78_semaphores[i];
|
||||
strcpy(new_client->name,"LM78 chip");
|
||||
new_client->id = i;
|
||||
new_client->adapter = adapter;
|
||||
new_client->driver = &lm78_driver;
|
||||
data = new_client->data;
|
||||
data->valid = 0;
|
||||
data->lock = MUTEX;
|
||||
data->update_lock = MUTEX;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Inverse of lm78_new_client */
|
||||
void lm78_remove_client(struct i2c_client *client)
|
||||
{
|
||||
int i;
|
||||
for (i = 0; i < MAX_LM78_NR; i++)
|
||||
if (client == lm78_list[i])
|
||||
if (client == lm78_list[i])
|
||||
lm78_list[i] = NULL;
|
||||
}
|
||||
|
||||
/* Called when we have found a new LM78. It should set limits, etc. */
|
||||
void lm78_init_client(struct i2c_client *client)
|
||||
{
|
||||
}
|
||||
|
||||
/* No commands defined yet */
|
||||
int lm78_command(struct i2c_client *client, unsigned int cmd, void *arg)
|
||||
{
|
||||
@@ -316,37 +557,346 @@ int lm78_write_value(struct i2c_client *client, u8 reg, u8 value)
|
||||
return smbus_write_byte_data(client->adapter, client->addr, reg,value);
|
||||
}
|
||||
|
||||
/* ANYTHING BELOW IS JUST AN EXAMPLE. IGNORE IF YOU WANT TO BASE A DRIVER
|
||||
ON THE CODE IN THIS FILE */
|
||||
|
||||
/* Stupid entry in /proc */
|
||||
static int proc_function(char *buf, char **start, off_t offset, int len,
|
||||
int unused)
|
||||
/* Called when we have found a new LM78. It should set limits, etc. */
|
||||
void lm78_init_client(struct i2c_client *client)
|
||||
{
|
||||
int i;
|
||||
len = 0;
|
||||
for (i = 0; i < MAX_LM78_NR; i++)
|
||||
if(lm78_list[i]) {
|
||||
if(i2c_is_isa_client(lm78_list[i]))
|
||||
len += sprintf(buf+len,"(isa) %d: address=%x\n",i,
|
||||
((struct isa_client *) (lm78_list[i]))->isa_addr);
|
||||
else
|
||||
len += sprintf(buf+len,"(i2c) %d: address=%x\n",i,
|
||||
lm78_list[i]->addr);
|
||||
}
|
||||
return len;
|
||||
/* Reset all except Watchdog values and last conversion values
|
||||
This sets fan-divs to 2, among others */
|
||||
lm78_write_value(client,LM78_REG_CONFIG,0x80);
|
||||
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(0),IN_TO_REG(LM78_INIT_IN_MIN_0,0));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(0),IN_TO_REG(LM78_INIT_IN_MAX_0,0));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(1),IN_TO_REG(LM78_INIT_IN_MIN_1,1));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(1),IN_TO_REG(LM78_INIT_IN_MAX_1,1));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(2),IN_TO_REG(LM78_INIT_IN_MIN_2,2));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(2),IN_TO_REG(LM78_INIT_IN_MAX_2,2));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(3),IN_TO_REG(LM78_INIT_IN_MIN_3,3));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(3),IN_TO_REG(LM78_INIT_IN_MAX_3,3));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(4),IN_TO_REG(LM78_INIT_IN_MIN_4,4));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(4),IN_TO_REG(LM78_INIT_IN_MAX_4,4));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(5),IN_TO_REG(LM78_INIT_IN_MIN_5,5));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(5),IN_TO_REG(LM78_INIT_IN_MAX_5,5));
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(6),IN_TO_REG(LM78_INIT_IN_MIN_6,6));
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(6),IN_TO_REG(LM78_INIT_IN_MAX_6,6));
|
||||
lm78_write_value(client,LM78_REG_FAN_MIN(1),FAN_TO_REG(LM78_INIT_FAN_MIN_1));
|
||||
lm78_write_value(client,LM78_REG_FAN_MIN(2),FAN_TO_REG(LM78_INIT_FAN_MIN_2));
|
||||
lm78_write_value(client,LM78_REG_FAN_MIN(3),FAN_TO_REG(LM78_INIT_FAN_MIN_3));
|
||||
lm78_write_value(client,LM78_REG_TEMP_OVER,TEMP_TO_REG(LM78_INIT_TEMP_OVER));
|
||||
lm78_write_value(client,LM78_REG_TEMP_HYST,TEMP_TO_REG(LM78_INIT_TEMP_HYST));
|
||||
|
||||
/* Start monitoring */
|
||||
lm78_write_value(client,LM78_REG_CONFIG,
|
||||
(lm78_read_value(client,LM78_REG_CONFIG) & 0xf7) | 0x01);
|
||||
|
||||
}
|
||||
|
||||
/* OK, this is a test entry. Just ignore, it is not important. */
|
||||
static struct proc_dir_entry proc_entry =
|
||||
{
|
||||
0,12,"sensors-test",
|
||||
S_IFREG | S_IRUGO, 1, 0, 0,
|
||||
0, NULL,
|
||||
&proc_function
|
||||
};
|
||||
void lm78_update_client(struct i2c_client *client)
|
||||
{
|
||||
struct lm78_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 = 0; i <= 6; i++) {
|
||||
data->in[i] = lm78_read_value(client,LM78_REG_IN(i));
|
||||
data->in_min[i] = lm78_read_value(client,LM78_REG_IN_MIN(i));
|
||||
data->in_max[i] = lm78_read_value(client,LM78_REG_IN_MAX(i));
|
||||
}
|
||||
for (i = 1; i <= 3; i++) {
|
||||
data->fan[i-1] = lm78_read_value(client,LM78_REG_FAN(i));
|
||||
data->fan_min[i-1] = lm78_read_value(client,LM78_REG_FAN_MIN(i));
|
||||
}
|
||||
data->temp = lm78_read_value(client,LM78_REG_TEMP);
|
||||
data->temp_over = lm78_read_value(client,LM78_REG_TEMP_OVER);
|
||||
data->temp_hyst = lm78_read_value(client,LM78_REG_TEMP_HYST);
|
||||
i = lm78_read_value(client,LM78_REG_VID_FANDIV);
|
||||
data->vid = i & 0x0f;
|
||||
data->fan_div[0] = (i >> 4) & 0x03;
|
||||
data->fan_div[1] = i >> 6;
|
||||
data->alarms = lm78_read_value(client,LM78_REG_ALARM1) +
|
||||
(lm78_read_value(client,LM78_REG_ALARM2) >> 8);
|
||||
data->last_updated = jiffies;
|
||||
data->valid = 1;
|
||||
}
|
||||
|
||||
up(&data->update_lock);
|
||||
}
|
||||
|
||||
/* This function is called when /proc/sys/dev/lm78-???/... is accessed */
|
||||
int lm78_proc (ctl_table *ctl, int write, struct file * filp,
|
||||
void *buffer, size_t *lenp)
|
||||
{
|
||||
int nrels,mag;
|
||||
long results[7];
|
||||
struct i2c_client *client = ctl -> extra1;
|
||||
|
||||
/* If buffer is size 0, or we try to read when not at the start, we
|
||||
return nothing. Note that I think writing when not at the start
|
||||
does not work either, but anyway, this is straight from the kernel
|
||||
sources. */
|
||||
if (!*lenp || (filp->f_pos && !write)) {
|
||||
*lenp = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* How many numbers are found within these files, and how to scale them? */
|
||||
switch (ctl->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: case LM78_SYSCTL_IN1: case LM78_SYSCTL_IN2:
|
||||
case LM78_SYSCTL_IN3: case LM78_SYSCTL_IN4: case LM78_SYSCTL_IN5:
|
||||
case LM78_SYSCTL_IN6:
|
||||
nrels=3;
|
||||
mag=2;
|
||||
break;
|
||||
case LM78_SYSCTL_FAN_DIV: case LM78_SYSCTL_TEMP:
|
||||
nrels=3;
|
||||
mag=0;
|
||||
break;
|
||||
case LM78_SYSCTL_FAN1: case LM78_SYSCTL_FAN2: case LM78_SYSCTL_FAN3:
|
||||
nrels=2;
|
||||
mag=0;
|
||||
break;
|
||||
case LM78_SYSCTL_VID:
|
||||
nrels=1;
|
||||
mag=2;
|
||||
break;
|
||||
case LM78_SYSCTL_ALARMS:
|
||||
nrels=1;
|
||||
mag=0;
|
||||
break;
|
||||
default: /* Should never be called */
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* OK, try writing stuff. */
|
||||
if (write) {
|
||||
sensors_parse_reals(&nrels,buffer,*lenp,results,mag);
|
||||
if (nrels == 0)
|
||||
return 0;
|
||||
switch (ctl->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: write_in(client,0,nrels,results); break;
|
||||
case LM78_SYSCTL_IN1: write_in(client,1,nrels,results); break;
|
||||
case LM78_SYSCTL_IN2: write_in(client,2,nrels,results); break;
|
||||
case LM78_SYSCTL_IN3: write_in(client,3,nrels,results); break;
|
||||
case LM78_SYSCTL_IN4: write_in(client,4,nrels,results); break;
|
||||
case LM78_SYSCTL_IN5: write_in(client,5,nrels,results); break;
|
||||
case LM78_SYSCTL_IN6: write_in(client,6,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN1: write_fan(client,1,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN2: write_fan(client,2,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN3: write_fan(client,3,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN_DIV: write_fan_div(client,nrels,results);break;
|
||||
case LM78_SYSCTL_TEMP: write_temp(client,nrels,results);break;
|
||||
case LM78_SYSCTL_VID: case LM78_SYSCTL_ALARMS: break;
|
||||
default: /* Should never be called */ *lenp=0; return -EINVAL; break;
|
||||
}
|
||||
filp->f_pos += *lenp;
|
||||
return 0;
|
||||
} else { /* read */
|
||||
/* Update all values in LM_Sensor_Data */
|
||||
|
||||
lm78_update_client((struct i2c_client *) (ctl->extra1));
|
||||
|
||||
/* Read the values to print into results */
|
||||
switch (ctl->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: read_in(client,0,results);break;
|
||||
case LM78_SYSCTL_IN1: read_in(client,1,results);break;
|
||||
case LM78_SYSCTL_IN2: read_in(client,2,results);break;
|
||||
case LM78_SYSCTL_IN3: read_in(client,3,results);break;
|
||||
case LM78_SYSCTL_IN4: read_in(client,4,results);break;
|
||||
case LM78_SYSCTL_IN5: read_in(client,5,results);break;
|
||||
case LM78_SYSCTL_IN6: read_in(client,6,results);break;
|
||||
case LM78_SYSCTL_FAN1: read_fan(client,1,results);break;
|
||||
case LM78_SYSCTL_FAN2: read_fan(client,2,results);break;
|
||||
case LM78_SYSCTL_FAN3: read_fan(client,3,results);break;
|
||||
case LM78_SYSCTL_TEMP: read_temp(client,results);break;
|
||||
case LM78_SYSCTL_FAN_DIV: read_fan_div(client,results);break;
|
||||
case LM78_SYSCTL_VID: read_vid(client,results);break;
|
||||
case LM78_SYSCTL_ALARMS: read_alarms(client,results);break;
|
||||
default: /* Should never be called */ return -EINVAL;
|
||||
}
|
||||
/* OK, print it now */
|
||||
sensors_write_reals(nrels,buffer,lenp,results,mag);
|
||||
filp->f_pos += *lenp;
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
/* This function is called when a sysctl on a lm78 file is done */
|
||||
int lm78_sysctl (ctl_table *table, int *name, int nlen, void *oldval,
|
||||
size_t *oldlenp, void *newval, size_t newlen,
|
||||
void **context)
|
||||
{
|
||||
long results[7];
|
||||
int nrels,oldlen;
|
||||
struct i2c_client *client = table -> extra1;
|
||||
|
||||
/* How many numbers are found within these files, and how to scale them? */
|
||||
switch (table->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: case LM78_SYSCTL_IN1: case LM78_SYSCTL_IN2:
|
||||
case LM78_SYSCTL_IN3: case LM78_SYSCTL_IN4: case LM78_SYSCTL_IN5:
|
||||
case LM78_SYSCTL_IN6: case LM78_SYSCTL_TEMP: case LM78_SYSCTL_FAN_DIV:
|
||||
nrels=3;
|
||||
break;
|
||||
case LM78_SYSCTL_FAN1: case LM78_SYSCTL_FAN2: case LM78_SYSCTL_FAN3:
|
||||
nrels=2;
|
||||
break;
|
||||
case LM78_SYSCTL_VID: case LM78_SYSCTL_ALARMS:
|
||||
nrels=1;
|
||||
break;
|
||||
default: /* Should never be called */
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
/* Check if we need to output the old values */
|
||||
if (oldval && oldlenp && ! get_user_data(oldlen,oldlenp) && oldlen) {
|
||||
|
||||
/* Update all values in LM_Sensor_Data */
|
||||
lm78_update_client((struct i2c_client *) (table->extra1));
|
||||
switch (table->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: read_in(client,0,results);break;
|
||||
case LM78_SYSCTL_IN1: read_in(client,1,results);break;
|
||||
case LM78_SYSCTL_IN2: read_in(client,2,results);break;
|
||||
case LM78_SYSCTL_IN3: read_in(client,3,results);break;
|
||||
case LM78_SYSCTL_IN4: read_in(client,4,results);break;
|
||||
case LM78_SYSCTL_IN5: read_in(client,5,results);break;
|
||||
case LM78_SYSCTL_IN6: read_in(client,6,results);break;
|
||||
case LM78_SYSCTL_FAN1: read_fan(client,1,results);break;
|
||||
case LM78_SYSCTL_FAN2: read_fan(client,2,results);break;
|
||||
case LM78_SYSCTL_FAN3: read_fan(client,3,results);break;
|
||||
case LM78_SYSCTL_TEMP: read_temp(client,results);break;
|
||||
case LM78_SYSCTL_FAN_DIV: read_fan_div(client,results);break;
|
||||
case LM78_SYSCTL_VID: read_vid(client,results);break;
|
||||
case LM78_SYSCTL_ALARMS: read_alarms(client,results);break;
|
||||
default: /* Should never be called */ return -EINVAL;
|
||||
}
|
||||
|
||||
/* Note the rounding factor! */
|
||||
if (nrels * sizeof(long) < oldlen)
|
||||
oldlen = nrels * sizeof(long);
|
||||
oldlen = (oldlen / sizeof(long)) * sizeof(long);
|
||||
copy_to_user(oldval,results,oldlen);
|
||||
put_user(oldlen,oldlenp);
|
||||
}
|
||||
|
||||
/* Check to see whether we need to read the new values */
|
||||
if (newval && newlen) {
|
||||
if (nrels * sizeof(long) < newlen)
|
||||
newlen = nrels * sizeof(long);
|
||||
nrels = newlen / sizeof(long);
|
||||
newlen = (newlen / sizeof(long)) * sizeof(long);
|
||||
copy_from_user(results,newval,newlen);
|
||||
|
||||
switch (table->ctl_name) {
|
||||
case LM78_SYSCTL_IN0: write_in(client,0,nrels,results); break;
|
||||
case LM78_SYSCTL_IN1: write_in(client,1,nrels,results); break;
|
||||
case LM78_SYSCTL_IN2: write_in(client,2,nrels,results); break;
|
||||
case LM78_SYSCTL_IN3: write_in(client,3,nrels,results); break;
|
||||
case LM78_SYSCTL_IN4: write_in(client,4,nrels,results); break;
|
||||
case LM78_SYSCTL_IN5: write_in(client,5,nrels,results); break;
|
||||
case LM78_SYSCTL_IN6: write_in(client,6,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN1: write_fan(client,1,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN2: write_fan(client,2,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN3: write_fan(client,3,nrels,results); break;
|
||||
case LM78_SYSCTL_TEMP: write_temp(client,nrels,results); break;
|
||||
case LM78_SYSCTL_FAN_DIV: write_fan_div(client,nrels,results);break;
|
||||
case LM78_SYSCTL_VID: case LM78_SYSCTL_ALARMS: break;
|
||||
default: /* Should never be called */ return -EINVAL; break;
|
||||
}
|
||||
}
|
||||
return 1; /* We have done all the work */
|
||||
}
|
||||
|
||||
void write_in(struct i2c_client *client, int nr, int nrels, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
if (nrels >= 1) {
|
||||
data->in_min[nr] = IN_TO_REG(results[0],nr);
|
||||
lm78_write_value(client,LM78_REG_IN_MIN(nr),data->in_min[nr]);
|
||||
}
|
||||
if (nrels >= 2) {
|
||||
data->in_max[nr] = IN_TO_REG(results[1],nr);
|
||||
lm78_write_value(client,LM78_REG_IN_MAX(nr),data->in_max[nr]);
|
||||
}
|
||||
}
|
||||
|
||||
void read_in(struct i2c_client *client, int nr, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = IN_FROM_REG(data->in_min[nr],nr);
|
||||
results[1] = IN_FROM_REG(data->in_min[nr],nr);
|
||||
results[2] = IN_FROM_REG(data->in_min[nr],nr);
|
||||
}
|
||||
|
||||
void write_fan(struct i2c_client *client, int nr, int nrels, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
if (nrels >= 1) {
|
||||
data->fan_min[nr-1] = FAN_TO_REG(results[0]);
|
||||
lm78_write_value(client,LM78_REG_FAN_MIN(nr),data->fan_min[nr-1]);
|
||||
}
|
||||
}
|
||||
|
||||
void read_fan(struct i2c_client *client, int nr, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = FAN_FROM_REG(data->fan_min[nr-1]);
|
||||
results[1] = FAN_FROM_REG(data->fan[nr-1]);
|
||||
}
|
||||
|
||||
void write_temp(struct i2c_client *client, int nrels, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
if (nrels >= 1) {
|
||||
data->temp_over = TEMP_TO_REG(results[0]);
|
||||
lm78_write_value(client,LM78_REG_TEMP_OVER,data->temp_over);
|
||||
}
|
||||
if (nrels >= 2) {
|
||||
data->temp_hyst = TEMP_TO_REG(results[0]);
|
||||
lm78_write_value(client,LM78_REG_TEMP_HYST,data->temp_hyst);
|
||||
}
|
||||
}
|
||||
|
||||
void read_temp(struct i2c_client *client, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = TEMP_FROM_REG(data->temp_over);
|
||||
results[1] = TEMP_FROM_REG(data->temp_hyst);
|
||||
results[2] = TEMP_FROM_REG(data->temp);
|
||||
}
|
||||
|
||||
void read_vid(struct i2c_client *client, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = VID_FROM_REG(data->vid);
|
||||
}
|
||||
|
||||
void read_alarms(struct i2c_client *client, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = ALARMS_FROM_REG(data->alarms);
|
||||
}
|
||||
|
||||
void read_fan_div(struct i2c_client *client, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
results[0] = DIV_FROM_REG(data->fan_div[0]);
|
||||
results[1] = DIV_FROM_REG(data->fan_div[1]);
|
||||
}
|
||||
|
||||
void write_fan_div(struct i2c_client *client, int nrels, long *results)
|
||||
{
|
||||
struct lm78_data *data = client->data;
|
||||
if (nrels >= 2)
|
||||
data->fan_div[1] = DIV_TO_REG(results[1]);
|
||||
if (nrels >= 1) {
|
||||
data->fan_div[0] = DIV_TO_REG(results[0]);
|
||||
lm78_write_value(client,LM78_REG_VID_FANDIV,
|
||||
(data->fan_div[0] >> 4) | (data->fan_div[1] >> 6));
|
||||
}
|
||||
}
|
||||
|
||||
int lm78_init(void)
|
||||
{
|
||||
int res;
|
||||
@@ -354,16 +904,6 @@ int lm78_init(void)
|
||||
printk("lm78.o version %s (%s)\n",LM_VERSION,LM_DATE);
|
||||
lm78_initialized = 0;
|
||||
|
||||
/* OK, we register some stupid proc file here. This is *just* *temporary*,
|
||||
for test purposes. Ignore if you want. Only works for kernels 2.0.x. */
|
||||
if ((res = proc_register_dynamic(&proc_root,&proc_entry))) {
|
||||
printk("lm78.o: Couldn't create /proc/sensors-test, "
|
||||
"module not inserted.\n");
|
||||
lm78_cleanup();
|
||||
return res;
|
||||
}
|
||||
lm78_initialized ++;
|
||||
|
||||
if ((res =i2c_add_driver(&lm78_driver))) {
|
||||
printk("lm78.o: Driver registration failed, module not inserted.\n");
|
||||
lm78_cleanup();
|
||||
@@ -377,7 +917,7 @@ int lm78_cleanup(void)
|
||||
{
|
||||
int res;
|
||||
|
||||
if (lm78_initialized >= 2) {
|
||||
if (lm78_initialized >= 1) {
|
||||
if ((res = i2c_del_driver(&lm78_driver))) {
|
||||
printk("lm78.o: Driver deregistration failed, module not removed.\n");
|
||||
return res;
|
||||
@@ -385,14 +925,6 @@ int lm78_cleanup(void)
|
||||
} else
|
||||
lm78_initialized --;
|
||||
|
||||
if (lm78_initialized >= 1) {
|
||||
if((res = proc_unregister(&proc_root,proc_entry.low_ino))) {
|
||||
printk("lm78.o: Deregistration of /proc/sensors_test failed, "
|
||||
"module not removed.\n");
|
||||
return res;
|
||||
}
|
||||
} else
|
||||
lm78_initialized --;
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
Reference in new issue
Block a user