| /* |
| i2c-proc.c - Part of lm_sensors, Linux kernel modules for hardware |
| monitoring |
| Copyright (c) 1998 - 2001 Frodo Looijaard <frodol@dds.nl> and |
| 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. |
| */ |
| |
| /* |
| This driver puts entries in /proc/sys/dev/sensors for each I2C device |
| */ |
| |
| #include <linux/version.h> |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/slab.h> |
| #include <linux/ctype.h> |
| #include <linux/sysctl.h> |
| #include <linux/proc_fs.h> |
| #include <linux/ioport.h> |
| #include <asm/uaccess.h> |
| |
| #include <linux/i2c.h> |
| #include <linux/i2c-proc.h> |
| |
| #include <linux/init.h> |
| |
| /* FIXME need i2c versioning */ |
| #define LM_DATE "20010825" |
| #define LM_VERSION "2.6.1" |
| |
| #ifndef THIS_MODULE |
| #define THIS_MODULE NULL |
| #endif |
| |
| static int i2c_create_name(char **name, const char *prefix, |
| struct i2c_adapter *adapter, int addr); |
| static int i2c_parse_reals(int *nrels, void *buffer, int bufsize, |
| long *results, int magnitude); |
| static int i2c_write_reals(int nrels, void *buffer, int *bufsize, |
| long *results, int magnitude); |
| static int i2c_proc_chips(ctl_table * ctl, int write, |
| struct file *filp, void *buffer, |
| size_t * lenp); |
| static int i2c_sysctl_chips(ctl_table * table, int *name, int nlen, |
| void *oldval, size_t * oldlenp, |
| void *newval, size_t newlen, |
| void **context); |
| |
| int __init sensors_init(void); |
| |
| #define SENSORS_ENTRY_MAX 20 |
| static struct ctl_table_header *i2c_entries[SENSORS_ENTRY_MAX]; |
| |
| static struct i2c_client *i2c_clients[SENSORS_ENTRY_MAX]; |
| static unsigned short i2c_inodes[SENSORS_ENTRY_MAX]; |
| #if LINUX_VERSION_CODE < KERNEL_VERSION(2,3,1) |
| static void i2c_fill_inode(struct inode *inode, int fill); |
| static void i2c_dir_fill_inode(struct inode *inode, int fill); |
| #endif /* LINUX_VERSION_CODE < KERNEL_VERSION(2,3,1) */ |
| |
| static ctl_table sysctl_table[] = { |
| {CTL_DEV, "dev", NULL, 0, 0555}, |
| {0}, |
| {DEV_SENSORS, "sensors", NULL, 0, 0555}, |
| {0}, |
| {0, NULL, NULL, 0, 0555}, |
| {0} |
| }; |
| |
| static ctl_table i2c_proc_dev_sensors[] = { |
| {SENSORS_CHIPS, "chips", NULL, 0, 0644, NULL, &i2c_proc_chips, |
| &i2c_sysctl_chips}, |
| {0} |
| }; |
| |
| static ctl_table i2c_proc_dev[] = { |
| {DEV_SENSORS, "sensors", NULL, 0, 0555, i2c_proc_dev_sensors}, |
| {0}, |
| }; |
| |
| |
| static ctl_table i2c_proc[] = { |
| {CTL_DEV, "dev", NULL, 0, 0555, i2c_proc_dev}, |
| {0} |
| }; |
| |
| |
| static struct ctl_table_header *i2c_proc_header; |
| static int i2c_initialized; |
| |
| /* This returns a nice name for a new directory; for example lm78-isa-0310 |
| (for a LM78 chip on the ISA bus at port 0x310), or lm75-i2c-3-4e (for |
| a LM75 chip on the third i2c bus at address 0x4e). |
| name is allocated first. */ |
| int i2c_create_name(char **name, const char *prefix, |
| struct i2c_adapter *adapter, int addr) |
| { |
| char name_buffer[50]; |
| int id; |
| if (i2c_is_isa_adapter(adapter)) |
| sprintf(name_buffer, "%s-isa-%04x", prefix, addr); |
| else { |
| if ((id = i2c_adapter_id(adapter)) < 0) |
| return -ENOENT; |
| sprintf(name_buffer, "%s-i2c-%d-%02x", prefix, id, addr); |
| } |
| *name = kmalloc(strlen(name_buffer) + 1, GFP_KERNEL); |
| strcpy(*name, name_buffer); |
| return 0; |
| } |
| |
| /* This rather complex function must be called when you want to add an entry |
| to /proc/sys/dev/sensors/chips. It also creates a new directory within |
| /proc/sys/dev/sensors/. |
| ctl_template should be a template of the newly created directory. It is |
| copied in memory. The extra2 field of each file is set to point to client. |
| If any driver wants subdirectories within the newly created directory, |
| this function must be updated! |
| controlling_mod is the controlling module. It should usually be |
| THIS_MODULE when calling. Note that this symbol is not defined in |
| kernels before 2.3.13; define it to NULL in that case. We will not use it |
| for anything older than 2.3.27 anyway. */ |
| int i2c_register_entry(struct i2c_client *client, const char *prefix, |
| ctl_table * ctl_template, |
| struct module *controlling_mod) |
| { |
| int i, res, len, id; |
| ctl_table *new_table; |
| char *name; |
| struct ctl_table_header *new_header; |
| |
| if ((res = i2c_create_name(&name, prefix, client->adapter, |
| client->addr))) return res; |
| |
| for (id = 0; id < SENSORS_ENTRY_MAX; id++) |
| if (!i2c_entries[id]) { |
| break; |
| } |
| if (id == SENSORS_ENTRY_MAX) { |
| kfree(name); |
| return -ENOMEM; |
| } |
| id += 256; |
| |
| len = 0; |
| while (ctl_template[len].procname) |
| len++; |
| len += 7; |
| if (!(new_table = kmalloc(sizeof(ctl_table) * len, GFP_KERNEL))) { |
| kfree(name); |
| return -ENOMEM; |
| } |
| |
| memcpy(new_table, sysctl_table, 6 * sizeof(ctl_table)); |
| new_table[0].child = &new_table[2]; |
| new_table[2].child = &new_table[4]; |
| new_table[4].child = &new_table[6]; |
| new_table[4].procname = name; |
| new_table[4].ctl_name = id; |
| memcpy(new_table + 6, ctl_template, (len - 6) * sizeof(ctl_table)); |
| for (i = 6; i < len; i++) |
| new_table[i].extra2 = client; |
| |
| if (!(new_header = register_sysctl_table(new_table, 0))) { |
| kfree(new_table); |
| kfree(name); |
| return -ENOMEM; |
| } |
| |
| i2c_entries[id - 256] = new_header; |
| |
| i2c_clients[id - 256] = client; |
| #ifdef DEBUG |
| if (!new_header || !new_header->ctl_table || |
| !new_header->ctl_table->child || |
| !new_header->ctl_table->child->child || |
| !new_header->ctl_table->child->child->de) { |
| printk |
| ("i2c-proc.o: NULL pointer when trying to install fill_inode fix!\n"); |
| return id; |
| } |
| #endif /* DEBUG */ |
| i2c_inodes[id - 256] = |
| new_header->ctl_table->child->child->de->low_ino; |
| #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,27)) |
| new_header->ctl_table->child->child->de->owner = controlling_mod; |
| #else |
| new_header->ctl_table->child->child->de->fill_inode = |
| &i2c_dir_fill_inode; |
| #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,27)) */ |
| |
| return id; |
| } |
| |
| void i2c_deregister_entry(int id) |
| { |
| ctl_table *table; |
| char *temp; |
| id -= 256; |
| if (i2c_entries[id]) { |
| table = i2c_entries[id]->ctl_table; |
| unregister_sysctl_table(i2c_entries[id]); |
| /* 2-step kfree needed to keep gcc happy about const points */ |
| (const char *) temp = table[4].procname; |
| kfree(temp); |
| kfree(table); |
| i2c_entries[id] = NULL; |
| i2c_clients[id] = NULL; |
| } |
| } |
| |
| /* Monitor access for /proc/sys/dev/sensors; make unloading i2c-proc.o |
| impossible if some process still uses it or some file in it */ |
| void i2c_fill_inode(struct inode *inode, int fill) |
| { |
| if (fill) |
| MOD_INC_USE_COUNT; |
| else |
| MOD_DEC_USE_COUNT; |
| } |
| |
| /* Monitor access for /proc/sys/dev/sensors/ directories; make unloading |
| the corresponding module impossible if some process still uses it or |
| some file in it */ |
| void i2c_dir_fill_inode(struct inode *inode, int fill) |
| { |
| int i; |
| struct i2c_client *client; |
| |
| #ifdef DEBUG |
| if (!inode) { |
| printk("i2c-proc.o: Warning: inode NULL in fill_inode()\n"); |
| return; |
| } |
| #endif /* def DEBUG */ |
| |
| for (i = 0; i < SENSORS_ENTRY_MAX; i++) |
| if (i2c_clients[i] |
| && (i2c_inodes[i] == inode->i_ino)) break; |
| #ifdef DEBUG |
| if (i == SENSORS_ENTRY_MAX) { |
| printk |
| ("i2c-proc.o: Warning: inode (%ld) not found in fill_inode()\n", |
| inode->i_ino); |
| return; |
| } |
| #endif /* def DEBUG */ |
| client = i2c_clients[i]; |
| if (fill) |
| client->driver->inc_use(client); |
| else |
| client->driver->dec_use(client); |
| } |
| |
| int i2c_proc_chips(ctl_table * ctl, int write, struct file *filp, |
| void *buffer, size_t * lenp) |
| { |
| char BUF[SENSORS_PREFIX_MAX + 30]; |
| int buflen, curbufsize, i; |
| struct ctl_table *client_tbl; |
| |
| if (write) |
| return 0; |
| |
| /* 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; |
| } |
| curbufsize = 0; |
| for (i = 0; i < SENSORS_ENTRY_MAX; i++) |
| if (i2c_entries[i]) { |
| client_tbl = |
| i2c_entries[i]->ctl_table->child->child; |
| buflen = |
| sprintf(BUF, "%d\t%s\n", client_tbl->ctl_name, |
| client_tbl->procname); |
| if (buflen + curbufsize > *lenp) |
| buflen = *lenp - curbufsize; |
| if(copy_to_user(buffer, BUF, buflen)) |
| return -EFAULT; |
| curbufsize += buflen; |
| (char *) buffer += buflen; |
| } |
| *lenp = curbufsize; |
| filp->f_pos += curbufsize; |
| return 0; |
| } |
| |
| int i2c_sysctl_chips(ctl_table * table, int *name, int nlen, |
| void *oldval, size_t * oldlenp, void *newval, |
| size_t newlen, void **context) |
| { |
| struct i2c_chips_data data; |
| int i, oldlen, nrels, maxels,ret=0; |
| struct ctl_table *client_tbl; |
| |
| if (oldval && oldlenp && !((ret = get_user(oldlen, oldlenp))) && |
| oldlen) { |
| maxels = oldlen / sizeof(struct i2c_chips_data); |
| nrels = 0; |
| for (i = 0; (i < SENSORS_ENTRY_MAX) && (nrels < maxels); |
| i++) |
| if (i2c_entries[i]) { |
| client_tbl = |
| i2c_entries[i]->ctl_table->child-> |
| child; |
| data.sysctl_id = client_tbl->ctl_name; |
| strcpy(data.name, client_tbl->procname); |
| if(copy_to_user(oldval, &data, |
| sizeof(struct |
| i2c_chips_data))) |
| return -EFAULT; |
| (char *) oldval += |
| sizeof(struct i2c_chips_data); |
| nrels++; |
| } |
| oldlen = nrels * sizeof(struct i2c_chips_data); |
| if(put_user(oldlen, oldlenp)) |
| return -EFAULT; |
| } |
| return ret; |
| } |
| |
| |
| /* This funcion reads or writes a 'real' value (encoded by the combination |
| of an integer and a magnitude, the last is the power of ten the value |
| should be divided with) to a /proc/sys directory. To use this function, |
| you must (before registering the ctl_table) set the extra2 field to the |
| client, and the extra1 field to a function of the form: |
| void func(struct i2c_client *client, int operation, int ctl_name, |
| int *nrels_mag, long *results) |
| This function can be called for three values of operation. If operation |
| equals SENSORS_PROC_REAL_INFO, the magnitude should be returned in |
| nrels_mag. If operation equals SENSORS_PROC_REAL_READ, values should |
| be read into results. nrels_mag should return the number of elements |
| read; the maximum number is put in it on entry. Finally, if operation |
| equals SENSORS_PROC_REAL_WRITE, the values in results should be |
| written to the chip. nrels_mag contains on entry the number of elements |
| found. |
| In all cases, client points to the client we wish to interact with, |
| and ctl_name is the SYSCTL id of the file we are accessing. */ |
| int i2c_proc_real(ctl_table * ctl, int write, struct file *filp, |
| void *buffer, size_t * lenp) |
| { |
| #define MAX_RESULTS 32 |
| int mag, nrels = MAX_RESULTS; |
| long results[MAX_RESULTS]; |
| i2c_real_callback callback = ctl->extra1; |
| struct i2c_client *client = ctl->extra2; |
| int res; |
| |
| /* 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; |
| } |
| |
| /* Get the magnitude */ |
| callback(client, SENSORS_PROC_REAL_INFO, ctl->ctl_name, &mag, |
| NULL); |
| |
| if (write) { |
| /* Read the complete input into results, converting to longs */ |
| res = i2c_parse_reals(&nrels, buffer, *lenp, results, mag); |
| if (res) |
| return res; |
| |
| if (!nrels) |
| return 0; |
| |
| /* Now feed this information back to the client */ |
| callback(client, SENSORS_PROC_REAL_WRITE, ctl->ctl_name, |
| &nrels, results); |
| |
| filp->f_pos += *lenp; |
| return 0; |
| } else { /* read */ |
| /* Get the information from the client into results */ |
| callback(client, SENSORS_PROC_REAL_READ, ctl->ctl_name, |
| &nrels, results); |
| |
| /* And write them to buffer, converting to reals */ |
| res = i2c_write_reals(nrels, buffer, lenp, results, mag); |
| if (res) |
| return res; |
| filp->f_pos += *lenp; |
| return 0; |
| } |
| } |
| |
| /* This function is equivalent to i2c_proc_real, only it interacts with |
| the sysctl(2) syscall, and returns no reals, but integers */ |
| int i2c_sysctl_real(ctl_table * table, int *name, int nlen, |
| void *oldval, size_t * oldlenp, void *newval, |
| size_t newlen, void **context) |
| { |
| long results[MAX_RESULTS]; |
| int oldlen, nrels = MAX_RESULTS,ret=0; |
| i2c_real_callback callback = table->extra1; |
| struct i2c_client *client = table->extra2; |
| |
| /* Check if we need to output the old values */ |
| if (oldval && oldlenp && !((ret=get_user(oldlen, oldlenp))) && oldlen) { |
| callback(client, SENSORS_PROC_REAL_READ, table->ctl_name, |
| &nrels, results); |
| |
| /* Note the rounding factor! */ |
| if (nrels * sizeof(long) < oldlen) |
| oldlen = nrels * sizeof(long); |
| oldlen = (oldlen / sizeof(long)) * sizeof(long); |
| if(copy_to_user(oldval, results, oldlen)) |
| return -EFAULT; |
| if(put_user(oldlen, oldlenp)) |
| return -EFAULT; |
| } |
| |
| if (newval && newlen) { |
| /* Note the rounding factor! */ |
| newlen -= newlen % sizeof(long); |
| nrels = newlen / sizeof(long); |
| if(copy_from_user(results, newval, newlen)) |
| return -EFAULT; |
| |
| /* Get the new values back to the client */ |
| callback(client, SENSORS_PROC_REAL_WRITE, table->ctl_name, |
| &nrels, results); |
| } |
| return ret; |
| } |
| |
| |
| /* nrels contains initially the maximum number of elements which can be |
| put in results, and finally the number of elements actually put there. |
| A magnitude of 1 will multiply everything with 10; etc. |
| buffer, bufsize is the character buffer we read from and its length. |
| results will finally contain the parsed integers. |
| |
| Buffer should contain several reals, separated by whitespace. A real |
| has the following syntax: |
| [ Minus ] Digit* [ Dot Digit* ] |
| (everything between [] is optional; * means zero or more). |
| When the next character is unparsable, everything is skipped until the |
| next whitespace. |
| |
| WARNING! This is tricky code. I have tested it, but there may still be |
| hidden bugs in it, even leading to crashes and things! |
| */ |
| int i2c_parse_reals(int *nrels, void *buffer, int bufsize, |
| long *results, int magnitude) |
| { |
| int maxels, min, mag; |
| long res,ret=0; |
| char nextchar = 0; |
| |
| maxels = *nrels; |
| *nrels = 0; |
| |
| while (bufsize && (*nrels < maxels)) { |
| |
| /* Skip spaces at the start */ |
| while (bufsize && |
| !((ret=get_user(nextchar, (char *) buffer))) && |
| isspace((int) nextchar)) { |
| bufsize--; |
| ((char *) buffer)++; |
| } |
| |
| if (ret) |
| return -EFAULT; |
| /* Well, we may be done now */ |
| if (!bufsize) |
| return 0; |
| |
| /* New defaults for our result */ |
| min = 0; |
| res = 0; |
| mag = magnitude; |
| |
| /* Check for a minus */ |
| if (!((ret=get_user(nextchar, (char *) buffer))) |
| && (nextchar == '-')) { |
| min = 1; |
| bufsize--; |
| ((char *) buffer)++; |
| } |
| if (ret) |
| return -EFAULT; |
| |
| /* Digits before a decimal dot */ |
| while (bufsize && |
| !((ret=get_user(nextchar, (char *) buffer))) && |
| isdigit((int) nextchar)) { |
| res = res * 10 + nextchar - '0'; |
| bufsize--; |
| ((char *) buffer)++; |
| } |
| if (ret) |
| return -EFAULT; |
| |
| /* If mag < 0, we must actually divide here! */ |
| while (mag < 0) { |
| res = res / 10; |
| mag++; |
| } |
| |
| if (bufsize && (nextchar == '.')) { |
| /* Skip the dot */ |
| bufsize--; |
| ((char *) buffer)++; |
| |
| /* Read digits while they are significant */ |
| while (bufsize && (mag > 0) && |
| !((ret=get_user(nextchar, (char *) buffer))) && |
| isdigit((int) nextchar)) { |
| res = res * 10 + nextchar - '0'; |
| mag--; |
| bufsize--; |
| ((char *) buffer)++; |
| } |
| if (ret) |
| return -EFAULT; |
| } |
| /* If we are out of data, but mag > 0, we need to scale here */ |
| while (mag > 0) { |
| res = res * 10; |
| mag--; |
| } |
| |
| /* Skip everything until we hit whitespace */ |
| while (bufsize && |
| !((ret=get_user(nextchar, (char *) buffer))) && |
| isspace((int) nextchar)) { |
| bufsize--; |
| ((char *) buffer)++; |
| } |
| if (ret) |
| return -EFAULT; |
| |
| /* Put res in results */ |
| results[*nrels] = (min ? -1 : 1) * res; |
| (*nrels)++; |
| } |
| |
| /* Well, there may be more in the buffer, but we need no more data. |
| Ignore anything that is left. */ |
| return 0; |
| } |
| |
| int i2c_write_reals(int nrels, void *buffer, int *bufsize, |
| long *results, int magnitude) |
| { |
| #define BUFLEN 20 |
| char BUF[BUFLEN + 1]; /* An individual representation should fit! */ |
| char printfstr[10]; |
| int nr = 0; |
| int buflen, mag, times; |
| int curbufsize = 0; |
| |
| while ((nr < nrels) && (curbufsize < *bufsize)) { |
| mag = magnitude; |
| |
| if (nr != 0) { |
| if(put_user(' ', (char *) buffer)) |
| return -EFAULT; |
| curbufsize++; |
| ((char *) buffer)++; |
| } |
| |
| /* Fill BUF with the representation of the next string */ |
| if (mag <= 0) { |
| buflen = sprintf(BUF, "%ld", results[nr]); |
| if (buflen < 0) { /* Oops, a sprintf error! */ |
| *bufsize = 0; |
| return -EINVAL; |
| } |
| while ((mag < 0) && (buflen < BUFLEN)) { |
| BUF[buflen++] = '0'; |
| mag++; |
| } |
| BUF[buflen] = 0; |
| } else { |
| times = 1; |
| for (times = 1; mag-- > 0; times *= 10); |
| if (results[nr] < 0) { |
| BUF[0] = '-'; |
| buflen = 1; |
| } else |
| buflen = 0; |
| strcpy(printfstr, "%ld.%0Xld"); |
| printfstr[6] = magnitude + '0'; |
| buflen += |
| sprintf(BUF + buflen, printfstr, |
| abs(results[nr]) / times, |
| abs(results[nr]) % times); |
| if (buflen < 0) { /* Oops, a sprintf error! */ |
| *bufsize = 0; |
| return -EINVAL; |
| } |
| } |
| |
| /* Now copy it to the user-space buffer */ |
| if (buflen + curbufsize > *bufsize) |
| buflen = *bufsize - curbufsize; |
| if(copy_to_user(buffer, BUF, buflen)) |
| return -EFAULT; |
| curbufsize += buflen; |
| (char *) buffer += buflen; |
| |
| nr++; |
| } |
| if (curbufsize < *bufsize) { |
| if(put_user('\n', (char *) buffer)) |
| return -EFAULT; |
| curbufsize++; |
| } |
| *bufsize = curbufsize; |
| return 0; |
| } |
| |
| |
| /* Very inefficient for ISA detects, and won't work for 10-bit addresses! */ |
| int i2c_detect(struct i2c_adapter *adapter, |
| struct i2c_address_data *address_data, |
| i2c_found_addr_proc * found_proc) |
| { |
| int addr, i, found, j, err; |
| struct i2c_force_data *this_force; |
| int is_isa = i2c_is_isa_adapter(adapter); |
| int adapter_id = |
| is_isa ? SENSORS_ISA_BUS : i2c_adapter_id(adapter); |
| |
| /* Forget it if we can't probe using SMBUS_QUICK */ |
| if ((!is_isa) |
| && !i2c_check_functionality(adapter, |
| I2C_FUNC_SMBUS_QUICK)) return -1; |
| |
| for (addr = 0x00; addr <= (is_isa ? 0xffff : 0x7f); addr++) { |
| if ((is_isa && check_region(addr, 1)) || |
| (!is_isa && i2c_check_addr(adapter, addr))) |
| continue; |
| |
| /* If it is in one of the force entries, we don't do any |
| detection at all */ |
| found = 0; |
| for (i = 0; |
| !found |
| && (this_force = |
| address_data->forces + i, this_force->force); i++) { |
| for (j = 0; |
| !found |
| && (this_force->force[j] != SENSORS_I2C_END); |
| j += 2) { |
| if ( |
| ((adapter_id == this_force->force[j]) |
| || |
| ((this_force-> |
| force[j] == SENSORS_ANY_I2C_BUS) |
| && !is_isa)) |
| && (addr == this_force->force[j + 1])) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found force parameter for adapter %d, addr %04x\n", |
| adapter_id, addr); |
| #endif |
| if ( |
| (err = |
| found_proc(adapter, addr, 0, |
| this_force-> |
| kind))) return err; |
| found = 1; |
| } |
| } |
| } |
| if (found) |
| continue; |
| |
| /* If this address is in one of the ignores, we can forget about it |
| right now */ |
| for (i = 0; |
| !found |
| && (address_data->ignore[i] != SENSORS_I2C_END); |
| i += 2) { |
| if ( |
| ((adapter_id == address_data->ignore[i]) |
| || |
| ((address_data-> |
| ignore[i] == SENSORS_ANY_I2C_BUS) |
| && !is_isa)) |
| && (addr == address_data->ignore[i + 1])) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found ignore parameter for adapter %d, " |
| "addr %04x\n", adapter_id, addr); |
| #endif |
| found = 1; |
| } |
| } |
| for (i = 0; |
| !found |
| && (address_data->ignore_range[i] != SENSORS_I2C_END); |
| i += 3) { |
| if ( |
| ((adapter_id == address_data->ignore_range[i]) |
| || |
| ((address_data-> |
| ignore_range[i] == |
| SENSORS_ANY_I2C_BUS) & !is_isa)) |
| && (addr >= address_data->ignore_range[i + 1]) |
| && (addr <= address_data->ignore_range[i + 2])) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found ignore_range parameter for adapter %d, " |
| "addr %04x\n", adapter_id, addr); |
| #endif |
| found = 1; |
| } |
| } |
| if (found) |
| continue; |
| |
| /* Now, we will do a detection, but only if it is in the normal or |
| probe entries */ |
| if (is_isa) { |
| for (i = 0; |
| !found |
| && (address_data->normal_isa[i] != |
| SENSORS_ISA_END); i += 1) { |
| if (addr == address_data->normal_isa[i]) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found normal isa entry for adapter %d, " |
| "addr %04x\n", adapter_id, |
| addr); |
| #endif |
| found = 1; |
| } |
| } |
| for (i = 0; |
| !found |
| && (address_data->normal_isa_range[i] != |
| SENSORS_ISA_END); i += 3) { |
| if ((addr >= |
| address_data->normal_isa_range[i]) |
| && (addr <= |
| address_data->normal_isa_range[i + 1]) |
| && |
| ((addr - |
| address_data->normal_isa_range[i]) % |
| address_data->normal_isa_range[i + 2] == |
| 0)) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found normal isa_range entry for adapter %d, " |
| "addr %04x", adapter_id, addr); |
| #endif |
| found = 1; |
| } |
| } |
| } else { |
| for (i = 0; |
| !found && (address_data->normal_i2c[i] != |
| SENSORS_I2C_END); i += 1) { |
| if (addr == address_data->normal_i2c[i]) { |
| found = 1; |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found normal i2c entry for adapter %d, " |
| "addr %02x", adapter_id, addr); |
| #endif |
| } |
| } |
| for (i = 0; |
| !found |
| && (address_data->normal_i2c_range[i] != |
| SENSORS_I2C_END); i += 2) { |
| if ((addr >= |
| address_data->normal_i2c_range[i]) |
| && (addr <= |
| address_data->normal_i2c_range[i + 1])) |
| { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found normal i2c_range entry for adapter %d, " |
| "addr %04x\n", adapter_id, addr); |
| #endif |
| found = 1; |
| } |
| } |
| } |
| |
| for (i = 0; |
| !found && (address_data->probe[i] != SENSORS_I2C_END); |
| i += 2) { |
| if (((adapter_id == address_data->probe[i]) || |
| ((address_data-> |
| probe[i] == SENSORS_ANY_I2C_BUS) & !is_isa)) |
| && (addr == address_data->probe[i + 1])) { |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found probe parameter for adapter %d, " |
| "addr %04x\n", adapter_id, addr); |
| #endif |
| found = 1; |
| } |
| } |
| for (i = 0; !found && |
| (address_data->probe_range[i] != SENSORS_I2C_END); |
| i += 3) { |
| if ( |
| ((adapter_id == address_data->probe_range[i]) |
| || |
| ((address_data->probe_range[i] == |
| SENSORS_ANY_I2C_BUS) & !is_isa)) |
| && (addr >= address_data->probe_range[i + 1]) |
| && (addr <= address_data->probe_range[i + 2])) { |
| found = 1; |
| #ifdef DEBUG |
| printk |
| ("i2c-proc.o: found probe_range parameter for adapter %d, " |
| "addr %04x\n", adapter_id, addr); |
| #endif |
| } |
| } |
| if (!found) |
| continue; |
| |
| /* OK, so we really should examine this address. First check |
| whether there is some client here at all! */ |
| if (is_isa || |
| (i2c_smbus_xfer |
| (adapter, addr, 0, 0, 0, I2C_SMBUS_QUICK, NULL) >= 0)) |
| if ((err = found_proc(adapter, addr, 0, -1))) |
| return err; |
| } |
| return 0; |
| } |
| |
| int __init sensors_init(void) |
| { |
| printk("i2c-proc.o version %s (%s)\n", LM_VERSION, LM_DATE); |
| i2c_initialized = 0; |
| if (! |
| (i2c_proc_header = |
| register_sysctl_table(i2c_proc, 0))) return -ENOMEM; |
| #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,1)) |
| i2c_proc_header->ctl_table->child->de->owner = THIS_MODULE; |
| #else |
| i2c_proc_header->ctl_table->child->de->fill_inode = |
| &i2c_fill_inode; |
| #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,1)) */ |
| i2c_initialized++; |
| return 0; |
| } |
| |
| EXPORT_SYMBOL(i2c_deregister_entry); |
| EXPORT_SYMBOL(i2c_detect); |
| EXPORT_SYMBOL(i2c_proc_real); |
| EXPORT_SYMBOL(i2c_register_entry); |
| EXPORT_SYMBOL(i2c_sysctl_real); |
| |
| #ifdef MODULE |
| |
| MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>"); |
| MODULE_DESCRIPTION("i2c-proc driver"); |
| MODULE_LICENSE("GPL"); |
| |
| int i2c_cleanup(void) |
| { |
| if (i2c_initialized >= 1) { |
| unregister_sysctl_table(i2c_proc_header); |
| i2c_initialized--; |
| } |
| return 0; |
| } |
| |
| int init_module(void) |
| { |
| return sensors_init(); |
| } |
| |
| int cleanup_module(void) |
| { |
| return i2c_cleanup(); |
| } |
| #endif /* MODULE */ |