mirror of
https://github.com/lm-sensors/lm-sensors
synced 2025-09-03 15:55:15 +00:00
Completed i2c-dev. Not tested yet.
git-svn-id: http://lm-sensors.org/svn/lm-sensors/trunk@160 7894878c-1315-0410-8ee3-d5d059ff63e0
This commit is contained in:
1
TODO
1
TODO
@@ -1,5 +1,6 @@
|
|||||||
Many, many things. Most notably:
|
Many, many things. Most notably:
|
||||||
|
|
||||||
|
* Check for block read/writes in smbus-on-i2c emulation code
|
||||||
* Merge newest Simon Vogl archive
|
* Merge newest Simon Vogl archive
|
||||||
* Merge man-pages
|
* Merge man-pages
|
||||||
* Rename some public kernel header files
|
* Rename some public kernel header files
|
||||||
|
180
kernel/i2c-dev.c
180
kernel/i2c-dev.c
@@ -28,9 +28,11 @@
|
|||||||
#include <linux/malloc.h>
|
#include <linux/malloc.h>
|
||||||
#include "compat.h"
|
#include "compat.h"
|
||||||
#include "i2c.h"
|
#include "i2c.h"
|
||||||
|
#include "smbus.h"
|
||||||
#include "isa.h"
|
#include "isa.h"
|
||||||
#include "sensors.h"
|
#include "sensors.h"
|
||||||
#include "version.h"
|
#include "version.h"
|
||||||
|
#include "i2c-dev.h"
|
||||||
|
|
||||||
#ifdef MODULE
|
#ifdef MODULE
|
||||||
extern int init_module(void);
|
extern int init_module(void);
|
||||||
@@ -144,6 +146,13 @@ int i2cdev_lseek (struct inode *inode, struct file *file, off_t offset,
|
|||||||
int origin)
|
int origin)
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,56))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
printk("i2c_dev,o: i2c-%d lseek to %ld bytes relative to %d.\n",
|
||||||
|
MINOR(inode->i_rdev),offset,origin);
|
||||||
|
#endif /* DEBUG */
|
||||||
return -ESPIPE;
|
return -ESPIPE;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -161,17 +170,23 @@ static int i2cdev_read(struct inode *inode, struct file *file, char *buf,
|
|||||||
char *tmp;
|
char *tmp;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
#ifdef DEBUG
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
printk("i2cdev_read: i2c%d reading %d bytes from %d.\n",minor,count,
|
|
||||||
client->addr);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* copy user space data to kernel space. */
|
/* copy user space data to kernel space. */
|
||||||
tmp = kmalloc(count,GFP_KERNEL);
|
tmp = kmalloc(count,GFP_KERNEL);
|
||||||
if (tmp==NULL)
|
if (tmp==NULL)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c_dev,o: i2c-%d reading %d bytes.\n",MINOR(inode->i_rdev),count);
|
||||||
|
#endif
|
||||||
|
|
||||||
ret = i2c_master_recv(client,tmp,count);
|
ret = i2c_master_recv(client,tmp,count);
|
||||||
copy_to_user(buf,tmp,count);
|
copy_to_user(buf,tmp,count);
|
||||||
kfree(tmp);
|
kfree(tmp);
|
||||||
@@ -193,6 +208,12 @@ static int i2cdev_write(struct inode *inode, struct file *file,
|
|||||||
char *tmp;
|
char *tmp;
|
||||||
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
/* copy user space data to kernel space. */
|
/* copy user space data to kernel space. */
|
||||||
tmp = kmalloc(count,GFP_KERNEL);
|
tmp = kmalloc(count,GFP_KERNEL);
|
||||||
if (tmp==NULL)
|
if (tmp==NULL)
|
||||||
@@ -200,14 +221,127 @@ static int i2cdev_write(struct inode *inode, struct file *file,
|
|||||||
copy_from_user(tmp,buf,count);
|
copy_from_user(tmp,buf,count);
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c_write: i2c%d writing %d bytes.\n",minor,count);
|
printk("i2c_dev,o: i2c-%d writing %d bytes.\n",MINOR(inode->i_rdev),count);
|
||||||
#endif
|
#endif
|
||||||
ret = i2c_master_send(client,tmp,count);
|
ret = i2c_master_send(client,tmp,count);
|
||||||
kfree(tmp);
|
kfree(tmp);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int i2cdev_ioctl (struct inode *inode, struct file *file, unsigned int cmd,
|
||||||
|
unsigned long arg)
|
||||||
|
{
|
||||||
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
|
struct i2c_smbus_data *data_arg;
|
||||||
|
union smbus_data temp;
|
||||||
|
int ver,datasize,res;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
printk("i2c_dev.o: i2c-%d ioctl, cmd: 0x%x, arg: %lx.\n",
|
||||||
|
MINOR(inode->i_rdev),cmd, arg);
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
|
switch ( cmd ) {
|
||||||
|
case I2C_SLAVE:
|
||||||
|
if (arg > 0x7f)
|
||||||
|
return -EINVAL;
|
||||||
|
client->addr = arg;
|
||||||
|
return 0;
|
||||||
|
case I2C_TENBIT:
|
||||||
|
printk("i2c-dev.o: ioctl I2C_TENBIT not (yet) supported!\n");
|
||||||
|
return -EINVAL;
|
||||||
|
case I2C_SMBUS:
|
||||||
|
if (! (data_arg = (struct i2c_smbus_data *) arg)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: NULL argument pointer in ioctl I2C_SMBUS.\n");
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if (verify_area(VERIFY_READ,data_arg,sizeof(struct i2c_smbus_data))) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: invalid argument pointer (%p) "
|
||||||
|
"in IOCTL I2C_SMBUS.\n", data_arg);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if ((data_arg->size != SMBUS_BYTE) &&
|
||||||
|
(data_arg->size != SMBUS_QUICK) &&
|
||||||
|
(data_arg->size != SMBUS_BYTE_DATA) &&
|
||||||
|
(data_arg->size != SMBUS_WORD_DATA) &&
|
||||||
|
(data_arg->size != SMBUS_PROC_CALL) &&
|
||||||
|
(data_arg->size != SMBUS_BLOCK_DATA)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: size out of range (%x) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->size);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
/* Note that SMBUS_READ and SMBUS_WRITE are 0 and 1, so the check is
|
||||||
|
valid if size==SMBUS_QUICK too. */
|
||||||
|
if ((data_arg->read_write != SMBUS_READ) &&
|
||||||
|
(data_arg->read_write != SMBUS_WRITE)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: read_write out of range (%x) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->read_write);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Note that command values are always valid! */
|
||||||
|
|
||||||
|
if ((data_arg->size == SMBUS_QUICK) ||
|
||||||
|
((data_arg->size == SMBUS_BYTE) &&
|
||||||
|
(data_arg->read_write == SMBUS_WRITE)))
|
||||||
|
/* These are special: we do not use data */
|
||||||
|
return smbus_access(client->adapter, client->addr,
|
||||||
|
data_arg->read_write, data_arg->command,
|
||||||
|
data_arg->size, NULL);
|
||||||
|
|
||||||
|
if (data_arg->data == NULL) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: data is NULL pointer in ioctl I2C_SMBUS.\n");
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* This seems unlogical but it is not: if the user wants to read a
|
||||||
|
value, we must write that value to user memory! */
|
||||||
|
ver = (data_arg->read_write == SMBUS_WRITE)?VERIFY_READ:VERIFY_WRITE;
|
||||||
|
|
||||||
|
if ((data_arg->size == SMBUS_BYTE_DATA) || (data_arg->size == SMBUS_BYTE))
|
||||||
|
datasize = sizeof(data_arg->data->byte);
|
||||||
|
else if (data_arg->size == SMBUS_WORD_DATA)
|
||||||
|
datasize = sizeof(data_arg->data->word);
|
||||||
|
else /* size == SMBUS_BLOCK_DATA */
|
||||||
|
datasize = sizeof(data_arg->data->block);
|
||||||
|
|
||||||
|
if (verify_area(ver,data_arg->data,datasize)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: invalid pointer data (%p) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->data);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if (data_arg->read_write == SMBUS_WRITE) {
|
||||||
|
copy_from_user(&temp,data_arg->data,datasize);
|
||||||
|
return smbus_access(client->adapter,client->addr,data_arg->read_write,
|
||||||
|
data_arg->command,data_arg->size,&temp);
|
||||||
|
} else {
|
||||||
|
res = smbus_access(client->adapter,client->addr,data_arg->read_write,
|
||||||
|
data_arg->command,data_arg->size,&temp);
|
||||||
|
if (!res)
|
||||||
|
copy_to_user(data_arg->data,&temp,datasize);
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
default:
|
||||||
|
return i2c_control(client,cmd,arg);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
int i2cdev_open (struct inode *inode, struct file *file)
|
int i2cdev_open (struct inode *inode, struct file *file)
|
||||||
{
|
{
|
||||||
unsigned int minor = MINOR(inode->i_rdev);
|
unsigned int minor = MINOR(inode->i_rdev);
|
||||||
@@ -215,7 +349,7 @@ int i2cdev_open (struct inode *inode, struct file *file)
|
|||||||
|
|
||||||
if (! i2cdev_clients[minor]) {
|
if (! i2cdev_clients[minor]) {
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2cdev: trying to open unattached adapter i2c-%d\n",minor);
|
printk("i2c-dev.o: Trying to open unattached adapter i2c-%d\n",minor);
|
||||||
#endif
|
#endif
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
@@ -231,7 +365,7 @@ int i2cdev_open (struct inode *inode, struct file *file)
|
|||||||
MOD_INC_USE_COUNT;
|
MOD_INC_USE_COUNT;
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2cdev_open: i2c-%d\n",minor);
|
printk("i2c-dev.o: opened i2c-%d\n",minor);
|
||||||
#endif
|
#endif
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@@ -245,7 +379,7 @@ static void i2cdev_release (struct inode *inode, struct file *file)
|
|||||||
kfree(file->private_data);
|
kfree(file->private_data);
|
||||||
file->private_data=NULL;
|
file->private_data=NULL;
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c_close: i2c-%d\n", MINOR(inode->i_rdev));
|
printk("i2c-dev.o: Closed: i2c-%d\n", MINOR(inode->i_rdev));
|
||||||
#endif
|
#endif
|
||||||
MOD_DEC_USE_COUNT;
|
MOD_DEC_USE_COUNT;
|
||||||
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,31))
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,31))
|
||||||
@@ -259,20 +393,22 @@ int i2cdev_attach_adapter(struct i2c_adapter *adap)
|
|||||||
struct i2c_client *client;
|
struct i2c_client *client;
|
||||||
|
|
||||||
if ((i = i2c_adapter_id(adap)) < 0) {
|
if ((i = i2c_adapter_id(adap)) < 0) {
|
||||||
printk("i2cdev_attach_adapter: unknown adapter?!?\n");
|
printk("i2c-dev.o: Unknown adapter to attach?!?\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i >= I2CDEV_CLIENTS_MAX) {
|
if (i >= I2CDEV_CLIENTS_MAX) {
|
||||||
printk("i2cdev_attach_adapter: adapter number too large?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter number to attach too large?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i2cdev_clients[i]) {
|
if (i2cdev_clients[i]) {
|
||||||
printk("i2cdev_attach_adapter: adapter already in use?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter to attach already in use?!? (%d)\n",i);
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
}
|
}
|
||||||
if (i2c_is_isa_adapter(adap)) {
|
if (i2c_is_isa_adapter(adap)) {
|
||||||
printk("i2cdev_attach_adapter: Can't open ISA adapter!\n");
|
#ifdef DEBUG
|
||||||
return -ENODEV;
|
printk("i2c-dev.o: Can't open ISA adapter!\n");
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (! (client = (struct i2c_client *)kmalloc(sizeof(struct i2c_client),
|
if (! (client = (struct i2c_client *)kmalloc(sizeof(struct i2c_client),
|
||||||
@@ -281,12 +417,12 @@ int i2cdev_attach_adapter(struct i2c_adapter *adap)
|
|||||||
memcpy(client,&i2cdev_client_template,sizeof(struct i2c_client));
|
memcpy(client,&i2cdev_client_template,sizeof(struct i2c_client));
|
||||||
client->adapter = adap;
|
client->adapter = adap;
|
||||||
if ((res = i2c_attach_client(client))) {
|
if ((res = i2c_attach_client(client))) {
|
||||||
printk("i2cdev_attach_adapter: attaching client failed.\n");
|
printk("i2c-dev.o: Attaching client failed.\n");
|
||||||
kfree(client);
|
kfree(client);
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
i2cdev_clients[i] = client;
|
i2cdev_clients[i] = client;
|
||||||
printk("i2cdev: registered '%s' as minor %d\n",adap->name,i);
|
printk("i2cdev.o: Registered '%s' as minor %d\n",adap->name,i);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -296,20 +432,20 @@ int i2cdev_detach_client(struct i2c_client *client)
|
|||||||
int i,res;
|
int i,res;
|
||||||
|
|
||||||
if ((i = i2c_adapter_id(adap)) < 0) {
|
if ((i = i2c_adapter_id(adap)) < 0) {
|
||||||
printk("i2cdev_detach_adapter: unknown adapter?!?\n");
|
printk("i2c-dev.o: Detaching unknown adapter?!?\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i >= I2CDEV_CLIENTS_MAX) {
|
if (i >= I2CDEV_CLIENTS_MAX) {
|
||||||
printk("i2cdev_detach_adapter: adapter number too large?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter number to detach too large?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (!i2cdev_clients[i]) {
|
if (!i2cdev_clients[i]) {
|
||||||
printk("i2cdev_detach_adapter: adapter not in use?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter to detach not in use?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((res = i2c_detach_client(client))) {
|
if ((res = i2c_detach_client(client))) {
|
||||||
printk("i2cdev_detach_adapter: detaching client failed.\n");
|
printk("i2c-dev.o: detaching client %d failed.\n",i);
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -317,7 +453,7 @@ int i2cdev_detach_client(struct i2c_client *client)
|
|||||||
i2cdev_clients[i] = NULL;
|
i2cdev_clients[i] = NULL;
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c(char): adapter unregistered: %s\n",adap->name);
|
printk("i2c-dev.o: Adapter unregistered: %s\n",adap->name);
|
||||||
#endif
|
#endif
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@@ -23,8 +23,10 @@
|
|||||||
|
|
||||||
#ifdef LM_SENSORS
|
#ifdef LM_SENSORS
|
||||||
#include "i2c.h"
|
#include "i2c.h"
|
||||||
|
#include "smbus.h"
|
||||||
#else /* ndef LM_SENSORS */
|
#else /* ndef LM_SENSORS */
|
||||||
#include <linux/i2c.h>
|
#include <linux/i2c.h>
|
||||||
|
#include <linux/smbus.h>
|
||||||
#endif /* def LM_SENSORS */
|
#endif /* def LM_SENSORS */
|
||||||
|
|
||||||
/* Some IOCTL commands are defined in <linux/i2c.h> */
|
/* Some IOCTL commands are defined in <linux/i2c.h> */
|
||||||
@@ -34,12 +36,16 @@
|
|||||||
|
|
||||||
/* This is the structure as used in the I2C_SMBUS ioctl call */
|
/* This is the structure as used in the I2C_SMBUS ioctl call */
|
||||||
struct i2c_smbus_data {
|
struct i2c_smbus_data {
|
||||||
char read_write,
|
char read_write;
|
||||||
u8 command,
|
u8 command;
|
||||||
int size,
|
int size;
|
||||||
union smbus_data data
|
union smbus_data *data;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
#ifndef __KERNEL__
|
||||||
|
|
||||||
|
#include <linux/ioctl.h>
|
||||||
|
|
||||||
extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
||||||
int size, union smbus_data *data)
|
int size, union smbus_data *data)
|
||||||
{
|
{
|
||||||
@@ -49,12 +55,8 @@ extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
|||||||
args.read_write = read_write;
|
args.read_write = read_write;
|
||||||
args.command = command;
|
args.command = command;
|
||||||
args.size = size;
|
args.size = size;
|
||||||
if (data)
|
args.data = data;
|
||||||
memcpy(&args.data,data,sizeof(union smbus_data));
|
return ioctl(file,I2C_SMBUS,&args);
|
||||||
res = ioctl(f,I2C_SMBUS,&args);
|
|
||||||
if (data)
|
|
||||||
memcpy(data,&args,sizeof(union smbus_data));
|
|
||||||
return res;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@@ -147,4 +149,6 @@ extern inline s32 i2c_smbus_write_block_data(int file, u8 command, u8 length,
|
|||||||
return i2c_smbus_access(file,SMBUS_WRITE,command,SMBUS_BLOCK_DATA,&data);
|
return i2c_smbus_access(file,SMBUS_WRITE,command,SMBUS_BLOCK_DATA,&data);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif /* ndef __KERNEL__ */
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
180
src/i2c-dev.c
180
src/i2c-dev.c
@@ -28,9 +28,11 @@
|
|||||||
#include <linux/malloc.h>
|
#include <linux/malloc.h>
|
||||||
#include "compat.h"
|
#include "compat.h"
|
||||||
#include "i2c.h"
|
#include "i2c.h"
|
||||||
|
#include "smbus.h"
|
||||||
#include "isa.h"
|
#include "isa.h"
|
||||||
#include "sensors.h"
|
#include "sensors.h"
|
||||||
#include "version.h"
|
#include "version.h"
|
||||||
|
#include "i2c-dev.h"
|
||||||
|
|
||||||
#ifdef MODULE
|
#ifdef MODULE
|
||||||
extern int init_module(void);
|
extern int init_module(void);
|
||||||
@@ -144,6 +146,13 @@ int i2cdev_lseek (struct inode *inode, struct file *file, off_t offset,
|
|||||||
int origin)
|
int origin)
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,56))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
printk("i2c_dev,o: i2c-%d lseek to %ld bytes relative to %d.\n",
|
||||||
|
MINOR(inode->i_rdev),offset,origin);
|
||||||
|
#endif /* DEBUG */
|
||||||
return -ESPIPE;
|
return -ESPIPE;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -161,17 +170,23 @@ static int i2cdev_read(struct inode *inode, struct file *file, char *buf,
|
|||||||
char *tmp;
|
char *tmp;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
#ifdef DEBUG
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
printk("i2cdev_read: i2c%d reading %d bytes from %d.\n",minor,count,
|
|
||||||
client->addr);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* copy user space data to kernel space. */
|
/* copy user space data to kernel space. */
|
||||||
tmp = kmalloc(count,GFP_KERNEL);
|
tmp = kmalloc(count,GFP_KERNEL);
|
||||||
if (tmp==NULL)
|
if (tmp==NULL)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c_dev,o: i2c-%d reading %d bytes.\n",MINOR(inode->i_rdev),count);
|
||||||
|
#endif
|
||||||
|
|
||||||
ret = i2c_master_recv(client,tmp,count);
|
ret = i2c_master_recv(client,tmp,count);
|
||||||
copy_to_user(buf,tmp,count);
|
copy_to_user(buf,tmp,count);
|
||||||
kfree(tmp);
|
kfree(tmp);
|
||||||
@@ -193,6 +208,12 @@ static int i2cdev_write(struct inode *inode, struct file *file,
|
|||||||
char *tmp;
|
char *tmp;
|
||||||
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
/* copy user space data to kernel space. */
|
/* copy user space data to kernel space. */
|
||||||
tmp = kmalloc(count,GFP_KERNEL);
|
tmp = kmalloc(count,GFP_KERNEL);
|
||||||
if (tmp==NULL)
|
if (tmp==NULL)
|
||||||
@@ -200,14 +221,127 @@ static int i2cdev_write(struct inode *inode, struct file *file,
|
|||||||
copy_from_user(tmp,buf,count);
|
copy_from_user(tmp,buf,count);
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c_write: i2c%d writing %d bytes.\n",minor,count);
|
printk("i2c_dev,o: i2c-%d writing %d bytes.\n",MINOR(inode->i_rdev),count);
|
||||||
#endif
|
#endif
|
||||||
ret = i2c_master_send(client,tmp,count);
|
ret = i2c_master_send(client,tmp,count);
|
||||||
kfree(tmp);
|
kfree(tmp);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int i2cdev_ioctl (struct inode *inode, struct file *file, unsigned int cmd,
|
||||||
|
unsigned long arg)
|
||||||
|
{
|
||||||
|
struct i2c_client *client = (struct i2c_client *)file->private_data;
|
||||||
|
struct i2c_smbus_data *data_arg;
|
||||||
|
union smbus_data temp;
|
||||||
|
int ver,datasize,res;
|
||||||
|
|
||||||
|
#ifdef DEBUG
|
||||||
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70))
|
||||||
|
struct inode *inode = file->f_dentry->d_inode;
|
||||||
|
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,70)) */
|
||||||
|
printk("i2c_dev.o: i2c-%d ioctl, cmd: 0x%x, arg: %lx.\n",
|
||||||
|
MINOR(inode->i_rdev),cmd, arg);
|
||||||
|
#endif /* DEBUG */
|
||||||
|
|
||||||
|
switch ( cmd ) {
|
||||||
|
case I2C_SLAVE:
|
||||||
|
if (arg > 0x7f)
|
||||||
|
return -EINVAL;
|
||||||
|
client->addr = arg;
|
||||||
|
return 0;
|
||||||
|
case I2C_TENBIT:
|
||||||
|
printk("i2c-dev.o: ioctl I2C_TENBIT not (yet) supported!\n");
|
||||||
|
return -EINVAL;
|
||||||
|
case I2C_SMBUS:
|
||||||
|
if (! (data_arg = (struct i2c_smbus_data *) arg)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: NULL argument pointer in ioctl I2C_SMBUS.\n");
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if (verify_area(VERIFY_READ,data_arg,sizeof(struct i2c_smbus_data))) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: invalid argument pointer (%p) "
|
||||||
|
"in IOCTL I2C_SMBUS.\n", data_arg);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if ((data_arg->size != SMBUS_BYTE) &&
|
||||||
|
(data_arg->size != SMBUS_QUICK) &&
|
||||||
|
(data_arg->size != SMBUS_BYTE_DATA) &&
|
||||||
|
(data_arg->size != SMBUS_WORD_DATA) &&
|
||||||
|
(data_arg->size != SMBUS_PROC_CALL) &&
|
||||||
|
(data_arg->size != SMBUS_BLOCK_DATA)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: size out of range (%x) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->size);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
/* Note that SMBUS_READ and SMBUS_WRITE are 0 and 1, so the check is
|
||||||
|
valid if size==SMBUS_QUICK too. */
|
||||||
|
if ((data_arg->read_write != SMBUS_READ) &&
|
||||||
|
(data_arg->read_write != SMBUS_WRITE)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: read_write out of range (%x) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->read_write);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Note that command values are always valid! */
|
||||||
|
|
||||||
|
if ((data_arg->size == SMBUS_QUICK) ||
|
||||||
|
((data_arg->size == SMBUS_BYTE) &&
|
||||||
|
(data_arg->read_write == SMBUS_WRITE)))
|
||||||
|
/* These are special: we do not use data */
|
||||||
|
return smbus_access(client->adapter, client->addr,
|
||||||
|
data_arg->read_write, data_arg->command,
|
||||||
|
data_arg->size, NULL);
|
||||||
|
|
||||||
|
if (data_arg->data == NULL) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: data is NULL pointer in ioctl I2C_SMBUS.\n");
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* This seems unlogical but it is not: if the user wants to read a
|
||||||
|
value, we must write that value to user memory! */
|
||||||
|
ver = (data_arg->read_write == SMBUS_WRITE)?VERIFY_READ:VERIFY_WRITE;
|
||||||
|
|
||||||
|
if ((data_arg->size == SMBUS_BYTE_DATA) || (data_arg->size == SMBUS_BYTE))
|
||||||
|
datasize = sizeof(data_arg->data->byte);
|
||||||
|
else if (data_arg->size == SMBUS_WORD_DATA)
|
||||||
|
datasize = sizeof(data_arg->data->word);
|
||||||
|
else /* size == SMBUS_BLOCK_DATA */
|
||||||
|
datasize = sizeof(data_arg->data->block);
|
||||||
|
|
||||||
|
if (verify_area(ver,data_arg->data,datasize)) {
|
||||||
|
#ifdef DEBUG
|
||||||
|
printk("i2c-dev.o: invalid pointer data (%p) in ioctl I2C_SMBUS.\n",
|
||||||
|
data_arg->data);
|
||||||
|
#endif
|
||||||
|
return -EINVAL;
|
||||||
|
}
|
||||||
|
if (data_arg->read_write == SMBUS_WRITE) {
|
||||||
|
copy_from_user(&temp,data_arg->data,datasize);
|
||||||
|
return smbus_access(client->adapter,client->addr,data_arg->read_write,
|
||||||
|
data_arg->command,data_arg->size,&temp);
|
||||||
|
} else {
|
||||||
|
res = smbus_access(client->adapter,client->addr,data_arg->read_write,
|
||||||
|
data_arg->command,data_arg->size,&temp);
|
||||||
|
if (!res)
|
||||||
|
copy_to_user(data_arg->data,&temp,datasize);
|
||||||
|
return res;
|
||||||
|
}
|
||||||
|
default:
|
||||||
|
return i2c_control(client,cmd,arg);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
int i2cdev_open (struct inode *inode, struct file *file)
|
int i2cdev_open (struct inode *inode, struct file *file)
|
||||||
{
|
{
|
||||||
unsigned int minor = MINOR(inode->i_rdev);
|
unsigned int minor = MINOR(inode->i_rdev);
|
||||||
@@ -215,7 +349,7 @@ int i2cdev_open (struct inode *inode, struct file *file)
|
|||||||
|
|
||||||
if (! i2cdev_clients[minor]) {
|
if (! i2cdev_clients[minor]) {
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2cdev: trying to open unattached adapter i2c-%d\n",minor);
|
printk("i2c-dev.o: Trying to open unattached adapter i2c-%d\n",minor);
|
||||||
#endif
|
#endif
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
@@ -231,7 +365,7 @@ int i2cdev_open (struct inode *inode, struct file *file)
|
|||||||
MOD_INC_USE_COUNT;
|
MOD_INC_USE_COUNT;
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2cdev_open: i2c-%d\n",minor);
|
printk("i2c-dev.o: opened i2c-%d\n",minor);
|
||||||
#endif
|
#endif
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
@@ -245,7 +379,7 @@ static void i2cdev_release (struct inode *inode, struct file *file)
|
|||||||
kfree(file->private_data);
|
kfree(file->private_data);
|
||||||
file->private_data=NULL;
|
file->private_data=NULL;
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c_close: i2c-%d\n", MINOR(inode->i_rdev));
|
printk("i2c-dev.o: Closed: i2c-%d\n", MINOR(inode->i_rdev));
|
||||||
#endif
|
#endif
|
||||||
MOD_DEC_USE_COUNT;
|
MOD_DEC_USE_COUNT;
|
||||||
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,31))
|
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,1,31))
|
||||||
@@ -259,20 +393,22 @@ int i2cdev_attach_adapter(struct i2c_adapter *adap)
|
|||||||
struct i2c_client *client;
|
struct i2c_client *client;
|
||||||
|
|
||||||
if ((i = i2c_adapter_id(adap)) < 0) {
|
if ((i = i2c_adapter_id(adap)) < 0) {
|
||||||
printk("i2cdev_attach_adapter: unknown adapter?!?\n");
|
printk("i2c-dev.o: Unknown adapter to attach?!?\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i >= I2CDEV_CLIENTS_MAX) {
|
if (i >= I2CDEV_CLIENTS_MAX) {
|
||||||
printk("i2cdev_attach_adapter: adapter number too large?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter number to attach too large?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i2cdev_clients[i]) {
|
if (i2cdev_clients[i]) {
|
||||||
printk("i2cdev_attach_adapter: adapter already in use?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter to attach already in use?!? (%d)\n",i);
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
}
|
}
|
||||||
if (i2c_is_isa_adapter(adap)) {
|
if (i2c_is_isa_adapter(adap)) {
|
||||||
printk("i2cdev_attach_adapter: Can't open ISA adapter!\n");
|
#ifdef DEBUG
|
||||||
return -ENODEV;
|
printk("i2c-dev.o: Can't open ISA adapter!\n");
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (! (client = (struct i2c_client *)kmalloc(sizeof(struct i2c_client),
|
if (! (client = (struct i2c_client *)kmalloc(sizeof(struct i2c_client),
|
||||||
@@ -281,12 +417,12 @@ int i2cdev_attach_adapter(struct i2c_adapter *adap)
|
|||||||
memcpy(client,&i2cdev_client_template,sizeof(struct i2c_client));
|
memcpy(client,&i2cdev_client_template,sizeof(struct i2c_client));
|
||||||
client->adapter = adap;
|
client->adapter = adap;
|
||||||
if ((res = i2c_attach_client(client))) {
|
if ((res = i2c_attach_client(client))) {
|
||||||
printk("i2cdev_attach_adapter: attaching client failed.\n");
|
printk("i2c-dev.o: Attaching client failed.\n");
|
||||||
kfree(client);
|
kfree(client);
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
i2cdev_clients[i] = client;
|
i2cdev_clients[i] = client;
|
||||||
printk("i2cdev: registered '%s' as minor %d\n",adap->name,i);
|
printk("i2cdev.o: Registered '%s' as minor %d\n",adap->name,i);
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -296,20 +432,20 @@ int i2cdev_detach_client(struct i2c_client *client)
|
|||||||
int i,res;
|
int i,res;
|
||||||
|
|
||||||
if ((i = i2c_adapter_id(adap)) < 0) {
|
if ((i = i2c_adapter_id(adap)) < 0) {
|
||||||
printk("i2cdev_detach_adapter: unknown adapter?!?\n");
|
printk("i2c-dev.o: Detaching unknown adapter?!?\n");
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (i >= I2CDEV_CLIENTS_MAX) {
|
if (i >= I2CDEV_CLIENTS_MAX) {
|
||||||
printk("i2cdev_detach_adapter: adapter number too large?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter number to detach too large?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
if (!i2cdev_clients[i]) {
|
if (!i2cdev_clients[i]) {
|
||||||
printk("i2cdev_detach_adapter: adapter not in use?!? (%d)\n",i);
|
printk("i2c-dev.o: Adapter to detach not in use?!? (%d)\n",i);
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
if ((res = i2c_detach_client(client))) {
|
if ((res = i2c_detach_client(client))) {
|
||||||
printk("i2cdev_detach_adapter: detaching client failed.\n");
|
printk("i2c-dev.o: detaching client %d failed.\n",i);
|
||||||
return res;
|
return res;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -317,7 +453,7 @@ int i2cdev_detach_client(struct i2c_client *client)
|
|||||||
i2cdev_clients[i] = NULL;
|
i2cdev_clients[i] = NULL;
|
||||||
|
|
||||||
#ifdef DEBUG
|
#ifdef DEBUG
|
||||||
printk("i2c(char): adapter unregistered: %s\n",adap->name);
|
printk("i2c-dev.o: Adapter unregistered: %s\n",adap->name);
|
||||||
#endif
|
#endif
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@@ -23,8 +23,10 @@
|
|||||||
|
|
||||||
#ifdef LM_SENSORS
|
#ifdef LM_SENSORS
|
||||||
#include "i2c.h"
|
#include "i2c.h"
|
||||||
|
#include "smbus.h"
|
||||||
#else /* ndef LM_SENSORS */
|
#else /* ndef LM_SENSORS */
|
||||||
#include <linux/i2c.h>
|
#include <linux/i2c.h>
|
||||||
|
#include <linux/smbus.h>
|
||||||
#endif /* def LM_SENSORS */
|
#endif /* def LM_SENSORS */
|
||||||
|
|
||||||
/* Some IOCTL commands are defined in <linux/i2c.h> */
|
/* Some IOCTL commands are defined in <linux/i2c.h> */
|
||||||
@@ -34,12 +36,16 @@
|
|||||||
|
|
||||||
/* This is the structure as used in the I2C_SMBUS ioctl call */
|
/* This is the structure as used in the I2C_SMBUS ioctl call */
|
||||||
struct i2c_smbus_data {
|
struct i2c_smbus_data {
|
||||||
char read_write,
|
char read_write;
|
||||||
u8 command,
|
u8 command;
|
||||||
int size,
|
int size;
|
||||||
union smbus_data data
|
union smbus_data *data;
|
||||||
};
|
};
|
||||||
|
|
||||||
|
#ifndef __KERNEL__
|
||||||
|
|
||||||
|
#include <linux/ioctl.h>
|
||||||
|
|
||||||
extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
||||||
int size, union smbus_data *data)
|
int size, union smbus_data *data)
|
||||||
{
|
{
|
||||||
@@ -49,12 +55,8 @@ extern inline s32 i2c_smbus_access(int file, char read_write, u8 command,
|
|||||||
args.read_write = read_write;
|
args.read_write = read_write;
|
||||||
args.command = command;
|
args.command = command;
|
||||||
args.size = size;
|
args.size = size;
|
||||||
if (data)
|
args.data = data;
|
||||||
memcpy(&args.data,data,sizeof(union smbus_data));
|
return ioctl(file,I2C_SMBUS,&args);
|
||||||
res = ioctl(f,I2C_SMBUS,&args);
|
|
||||||
if (data)
|
|
||||||
memcpy(data,&args,sizeof(union smbus_data));
|
|
||||||
return res;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
@@ -147,4 +149,6 @@ extern inline s32 i2c_smbus_write_block_data(int file, u8 command, u8 length,
|
|||||||
return i2c_smbus_access(file,SMBUS_WRITE,command,SMBUS_BLOCK_DATA,&data);
|
return i2c_smbus_access(file,SMBUS_WRITE,command,SMBUS_BLOCK_DATA,&data);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif /* ndef __KERNEL__ */
|
||||||
|
|
||||||
#endif
|
#endif
|
||||||
|
Reference in New Issue
Block a user