Merge pull request #3 from hgxl64/wait-write-timeout
wait for eeprom write to complete
This commit is contained in:
		
						commit
						fd58aaae76
					
				
					 5 changed files with 58 additions and 395 deletions
				
			
		
							
								
								
									
										14
									
								
								24cXX.c
									
									
									
									
									
								
							
							
						
						
									
										14
									
								
								24cXX.c
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -89,6 +89,7 @@ int eeprom_open(char *dev_fqn, int addr, int type, struct eeprom* e)
 | 
			
		|||
 | 
			
		||||
 | 
			
		||||
	// check for req funcs
 | 
			
		||||
	CHECK_I2C_FUNC( funcs, I2C_FUNC_SMBUS_QUICK );
 | 
			
		||||
	CHECK_I2C_FUNC( funcs, I2C_FUNC_SMBUS_READ_BYTE );
 | 
			
		||||
	CHECK_I2C_FUNC( funcs, I2C_FUNC_SMBUS_WRITE_BYTE );
 | 
			
		||||
	CHECK_I2C_FUNC( funcs, I2C_FUNC_SMBUS_READ_BYTE_DATA );
 | 
			
		||||
| 
						 | 
				
			
			@ -187,3 +188,16 @@ int eeprom_write_byte(struct eeprom *e, __u16 mem_addr, __u8 data)
 | 
			
		|||
	return -1;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int eeprom_wait_ready(struct eeprom *e, int max_ms_to_wait)
 | 
			
		||||
{
 | 
			
		||||
	while (max_ms_to_wait > 0) {
 | 
			
		||||
		int r = i2c_smbus_write_quick(e->fd, 0);
 | 
			
		||||
		if (r == 0) {
 | 
			
		||||
			return r;
 | 
			
		||||
		}
 | 
			
		||||
		usleep(1000);
 | 
			
		||||
		--max_ms_to_wait;
 | 
			
		||||
	}
 | 
			
		||||
	return -1;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										6
									
								
								24cXX.h
									
									
									
									
									
								
							
							
						
						
									
										6
									
								
								24cXX.h
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -15,7 +15,7 @@
 | 
			
		|||
 ***************************************************************************/
 | 
			
		||||
#ifndef _24CXX_H_
 | 
			
		||||
#define _24CXX_H_
 | 
			
		||||
#include "i2c-dev.h"
 | 
			
		||||
#include <linux/i2c-dev.h>
 | 
			
		||||
 | 
			
		||||
#define EEPROM_TYPE_UNKNOWN	0
 | 
			
		||||
#define EEPROM_TYPE_8BIT_ADDR	1
 | 
			
		||||
| 
						 | 
				
			
			@ -53,6 +53,10 @@ int eeprom_read_current_byte(struct eeprom *e);
 | 
			
		|||
 * Note: eeprom must have been selected by ioctl(fd,I2C_SLAVE,address)
 | 
			
		||||
 */
 | 
			
		||||
int eeprom_write_byte(struct eeprom *e, __u16 mem_addr, __u8 data);
 | 
			
		||||
/*
 | 
			
		||||
 * wait for the eeprom to accept new commands, to be called after a write
 | 
			
		||||
 */
 | 
			
		||||
int eeprom_wait_ready(struct eeprom *e, int max_ms_to_wait);
 | 
			
		||||
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										2
									
								
								Makefile
									
									
									
									
									
								
							
							
						
						
									
										2
									
								
								Makefile
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -3,7 +3,7 @@ CFLAGS=-g -I. -Wall -O2
 | 
			
		|||
all: eeprog 
 | 
			
		||||
 | 
			
		||||
clean: 
 | 
			
		||||
	rm -f eeprog *.o
 | 
			
		||||
	rm -f eeprog eeprog.o 24cXX.o
 | 
			
		||||
 | 
			
		||||
eeprog: eeprog.o 24cXX.o
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										16
									
								
								eeprog.c
									
									
									
									
									
								
							
							
						
						
									
										16
									
								
								eeprog.c
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -46,6 +46,7 @@ const static char *eeprog_usage =
 | 
			
		|||
"	-r addr[:count]	Read [count] (1 if omitted) bytes from [addr]\n"
 | 
			
		||||
"			and print them to the standard output\n"
 | 
			
		||||
"	-w addr		Write input (stdin) at address [addr] of the EEPROM\n"
 | 
			
		||||
"	-t n		write timeout in ms (default 10)\n"
 | 
			
		||||
"	-h		Print this help\n"
 | 
			
		||||
"  Options: \n"
 | 
			
		||||
"	-x		Set hex output mode\n"
 | 
			
		||||
| 
						 | 
				
			
			@ -140,7 +141,7 @@ int read_from_eeprom(struct eeprom *e, int addr, int size, int hex)
 | 
			
		|||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int write_to_eeprom(struct eeprom *e, int addr)
 | 
			
		||||
int write_to_eeprom(struct eeprom *e, int addr, int timeout)
 | 
			
		||||
{
 | 
			
		||||
	int c;
 | 
			
		||||
	while((c = getchar()) != EOF)
 | 
			
		||||
| 
						 | 
				
			
			@ -148,6 +149,7 @@ int write_to_eeprom(struct eeprom *e, int addr)
 | 
			
		|||
		print_info(".");
 | 
			
		||||
		fflush(stdout);
 | 
			
		||||
		die_if(eeprom_write_byte(e, addr++, c), "write error");
 | 
			
		||||
		die_if(eeprom_wait_ready(e, timeout), "write timeout");
 | 
			
		||||
	}
 | 
			
		||||
	print_info("\n\n");
 | 
			
		||||
	return 0;
 | 
			
		||||
| 
						 | 
				
			
			@ -157,6 +159,7 @@ int main(int argc, char** argv)
 | 
			
		|||
{
 | 
			
		||||
	struct eeprom e;
 | 
			
		||||
	int ret, op, i2c_addr, memaddr, size, want_hex, dummy, force, sixteen;
 | 
			
		||||
	int timeout = 10;
 | 
			
		||||
	char *device, *arg = 0, *i2c_addr_s;
 | 
			
		||||
	struct stat st;
 | 
			
		||||
	int eeprom_type = 0;
 | 
			
		||||
| 
						 | 
				
			
			@ -164,7 +167,7 @@ int main(int argc, char** argv)
 | 
			
		|||
	op = want_hex = dummy = force = sixteen = 0;
 | 
			
		||||
	g_quiet = 0;
 | 
			
		||||
 | 
			
		||||
	while((ret = getopt(argc, argv, "1:8fr:qhw:xd")) != -1)
 | 
			
		||||
	while((ret = getopt(argc, argv, "1:8fr:qhw:xdt:")) != -1)
 | 
			
		||||
	{
 | 
			
		||||
		switch(ret)
 | 
			
		||||
		{
 | 
			
		||||
| 
						 | 
				
			
			@ -192,6 +195,9 @@ int main(int argc, char** argv)
 | 
			
		|||
		case 'h':
 | 
			
		||||
			usage_if(1);
 | 
			
		||||
			break;
 | 
			
		||||
		case 't':
 | 
			
		||||
			timeout = atoi(optarg);
 | 
			
		||||
			break;
 | 
			
		||||
		default:
 | 
			
		||||
			die_if(op != 0, "Both read and write requested");
 | 
			
		||||
			arg = optarg;
 | 
			
		||||
| 
						 | 
				
			
			@ -257,9 +263,9 @@ int main(int argc, char** argv)
 | 
			
		|||
		if(force == 0)
 | 
			
		||||
			confirm_action();
 | 
			
		||||
		parse_arg(arg, &memaddr, &size);
 | 
			
		||||
		print_info("  Writing stdin starting at address 0x%x\n", 
 | 
			
		||||
			memaddr);
 | 
			
		||||
		write_to_eeprom(&e, memaddr);
 | 
			
		||||
		print_info("  Writing stdin starting at address 0x%x with timeout %dms\n",
 | 
			
		||||
			memaddr, timeout);
 | 
			
		||||
		write_to_eeprom(&e, memaddr, timeout);
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		usage_if(1);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										361
									
								
								i2c-dev.h
									
									
									
									
									
								
							
							
						
						
									
										361
									
								
								i2c-dev.h
									
									
									
									
									
								
							| 
						 | 
				
			
			@ -1,361 +0,0 @@
 | 
			
		|||
/*
 | 
			
		||||
    i2c-dev.h - i2c-bus driver, char device interface
 | 
			
		||||
 | 
			
		||||
    Copyright (C) 1995-97 Simon G. Vogl
 | 
			
		||||
    Copyright (C) 1998-99 Frodo Looijaard <frodol@dds.nl>
 | 
			
		||||
 | 
			
		||||
    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.
 | 
			
		||||
*/
 | 
			
		||||
 | 
			
		||||
/* $Id: i2c-dev.h,v 1.4 2003/11/27 23:08:06 tat Exp $ */
 | 
			
		||||
 | 
			
		||||
#ifndef LIB_I2CDEV_H
 | 
			
		||||
#define LIB_I2CDEV_H
 | 
			
		||||
 | 
			
		||||
#include <linux/types.h>
 | 
			
		||||
#include <sys/ioctl.h>
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/* -- i2c.h -- */
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * I2C Message - used for pure i2c transaction, also from /dev interface
 | 
			
		||||
 */
 | 
			
		||||
struct i2c_msg {
 | 
			
		||||
	__u16 addr;	/* slave address			*/
 | 
			
		||||
	unsigned short flags;		
 | 
			
		||||
#define I2C_M_TEN	0x10	/* we have a ten bit chip address	*/
 | 
			
		||||
#define I2C_M_RD	0x01
 | 
			
		||||
#define I2C_M_NOSTART	0x4000
 | 
			
		||||
#define I2C_M_REV_DIR_ADDR	0x2000
 | 
			
		||||
#define I2C_M_IGNORE_NAK	0x1000
 | 
			
		||||
#define I2C_M_NO_RD_ACK		0x0800
 | 
			
		||||
	short len;		/* msg length				*/
 | 
			
		||||
	char *buf;		/* pointer to msg data			*/
 | 
			
		||||
	int err;
 | 
			
		||||
	short done;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* To determine what functionality is present */
 | 
			
		||||
 | 
			
		||||
#define I2C_FUNC_I2C			0x00000001
 | 
			
		||||
#define I2C_FUNC_10BIT_ADDR		0x00000002
 | 
			
		||||
#define I2C_FUNC_PROTOCOL_MANGLING	0x00000004 /* I2C_M_{REV_DIR_ADDR,NOSTART,..} */
 | 
			
		||||
#define I2C_FUNC_SMBUS_HWPEC_CALC	0x00000008 /* SMBus 2.0 */
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_WORD_DATA_PEC  0x00000800 /* SMBus 2.0 */ 
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_WORD_DATA_PEC 0x00001000 /* SMBus 2.0 */ 
 | 
			
		||||
#define I2C_FUNC_SMBUS_PROC_CALL_PEC	0x00002000 /* SMBus 2.0 */
 | 
			
		||||
#define I2C_FUNC_SMBUS_BLOCK_PROC_CALL_PEC 0x00004000 /* SMBus 2.0 */
 | 
			
		||||
#define I2C_FUNC_SMBUS_BLOCK_PROC_CALL	0x00008000 /* SMBus 2.0 */
 | 
			
		||||
#define I2C_FUNC_SMBUS_QUICK		0x00010000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BYTE	0x00020000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BYTE	0x00040000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BYTE_DATA	0x00080000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BYTE_DATA	0x00100000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_WORD_DATA	0x00200000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_WORD_DATA	0x00400000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_PROC_CALL	0x00800000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BLOCK_DATA	0x01000000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BLOCK_DATA 0x02000000 
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_I2C_BLOCK	0x04000000 /* I2C-like block xfer  */
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_I2C_BLOCK	0x08000000 /* w/ 1-byte reg. addr. */
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_I2C_BLOCK_2	 0x10000000 /* I2C-like block xfer  */
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_I2C_BLOCK_2 0x20000000 /* w/ 2-byte reg. addr. */
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BLOCK_DATA_PEC  0x40000000 /* SMBus 2.0 */
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BLOCK_DATA_PEC 0x80000000 /* SMBus 2.0 */
 | 
			
		||||
 | 
			
		||||
#define I2C_FUNC_SMBUS_BYTE I2C_FUNC_SMBUS_READ_BYTE | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_WRITE_BYTE
 | 
			
		||||
#define I2C_FUNC_SMBUS_BYTE_DATA I2C_FUNC_SMBUS_READ_BYTE_DATA | \
 | 
			
		||||
                                 I2C_FUNC_SMBUS_WRITE_BYTE_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_WORD_DATA I2C_FUNC_SMBUS_READ_WORD_DATA | \
 | 
			
		||||
                                 I2C_FUNC_SMBUS_WRITE_WORD_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_BLOCK_DATA I2C_FUNC_SMBUS_READ_BLOCK_DATA | \
 | 
			
		||||
                                  I2C_FUNC_SMBUS_WRITE_BLOCK_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_I2C_BLOCK I2C_FUNC_SMBUS_READ_I2C_BLOCK | \
 | 
			
		||||
                                  I2C_FUNC_SMBUS_WRITE_I2C_BLOCK
 | 
			
		||||
#define I2C_FUNC_SMBUS_I2C_BLOCK_2 I2C_FUNC_SMBUS_READ_I2C_BLOCK_2 | \
 | 
			
		||||
                                   I2C_FUNC_SMBUS_WRITE_I2C_BLOCK_2
 | 
			
		||||
#define I2C_FUNC_SMBUS_BLOCK_DATA_PEC I2C_FUNC_SMBUS_READ_BLOCK_DATA_PEC | \
 | 
			
		||||
                                      I2C_FUNC_SMBUS_WRITE_BLOCK_DATA_PEC
 | 
			
		||||
#define I2C_FUNC_SMBUS_WORD_DATA_PEC  I2C_FUNC_SMBUS_READ_WORD_DATA_PEC | \
 | 
			
		||||
                                      I2C_FUNC_SMBUS_WRITE_WORD_DATA_PEC
 | 
			
		||||
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BYTE_PEC		I2C_FUNC_SMBUS_READ_BYTE_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BYTE_PEC		I2C_FUNC_SMBUS_WRITE_BYTE_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_READ_BYTE_DATA_PEC	I2C_FUNC_SMBUS_READ_WORD_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_WRITE_BYTE_DATA_PEC	I2C_FUNC_SMBUS_WRITE_WORD_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_BYTE_PEC			I2C_FUNC_SMBUS_BYTE_DATA
 | 
			
		||||
#define I2C_FUNC_SMBUS_BYTE_DATA_PEC		I2C_FUNC_SMBUS_WORD_DATA
 | 
			
		||||
 | 
			
		||||
#define I2C_FUNC_SMBUS_EMUL I2C_FUNC_SMBUS_QUICK | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_BYTE | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_BYTE_DATA | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_WORD_DATA | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_PROC_CALL | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_WRITE_BLOCK_DATA | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_WRITE_BLOCK_DATA_PEC | \
 | 
			
		||||
                            I2C_FUNC_SMBUS_I2C_BLOCK
 | 
			
		||||
 | 
			
		||||
/* 
 | 
			
		||||
 * Data for SMBus Messages 
 | 
			
		||||
 */
 | 
			
		||||
#define I2C_SMBUS_BLOCK_MAX	32	/* As specified in SMBus standard */	
 | 
			
		||||
#define I2C_SMBUS_I2C_BLOCK_MAX	32	/* Not specified but we use same structure */
 | 
			
		||||
union i2c_smbus_data {
 | 
			
		||||
	__u8 byte;
 | 
			
		||||
	__u16 word;
 | 
			
		||||
	__u8 block[I2C_SMBUS_BLOCK_MAX + 3]; /* block[0] is used for length */
 | 
			
		||||
                          /* one more for read length in block process call */
 | 
			
		||||
	                                            /* and one more for PEC */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* smbus_access read or write markers */
 | 
			
		||||
#define I2C_SMBUS_READ	1
 | 
			
		||||
#define I2C_SMBUS_WRITE	0
 | 
			
		||||
 | 
			
		||||
/* SMBus transaction types (size parameter in the above functions) 
 | 
			
		||||
   Note: these no longer correspond to the (arbitrary) PIIX4 internal codes! */
 | 
			
		||||
#define I2C_SMBUS_QUICK		    0
 | 
			
		||||
#define I2C_SMBUS_BYTE		    1
 | 
			
		||||
#define I2C_SMBUS_BYTE_DATA	    2 
 | 
			
		||||
#define I2C_SMBUS_WORD_DATA	    3
 | 
			
		||||
#define I2C_SMBUS_PROC_CALL	    4
 | 
			
		||||
#define I2C_SMBUS_BLOCK_DATA	    5
 | 
			
		||||
#define I2C_SMBUS_I2C_BLOCK_DATA    6
 | 
			
		||||
#define I2C_SMBUS_BLOCK_PROC_CALL   7		/* SMBus 2.0 */
 | 
			
		||||
#define I2C_SMBUS_BLOCK_DATA_PEC    8		/* SMBus 2.0 */
 | 
			
		||||
#define I2C_SMBUS_PROC_CALL_PEC     9		/* SMBus 2.0 */
 | 
			
		||||
#define I2C_SMBUS_BLOCK_PROC_CALL_PEC  10	/* SMBus 2.0 */
 | 
			
		||||
#define I2C_SMBUS_WORD_DATA_PEC	   11		/* SMBus 2.0 */
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/* ----- commands for the ioctl like i2c_command call:
 | 
			
		||||
 * note that additional calls are defined in the algorithm and hw 
 | 
			
		||||
 *	dependent layers - these can be listed here, or see the 
 | 
			
		||||
 *	corresponding header files.
 | 
			
		||||
 */
 | 
			
		||||
				/* -> bit-adapter specific ioctls	*/
 | 
			
		||||
#define I2C_RETRIES	0x0701	/* number of times a device address      */
 | 
			
		||||
				/* should be polled when not            */
 | 
			
		||||
                                /* acknowledging 			*/
 | 
			
		||||
#define I2C_TIMEOUT	0x0702	/* set timeout - call with int 		*/
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/* this is for i2c-dev.c	*/
 | 
			
		||||
#define I2C_SLAVE	0x0703	/* Change slave address			*/
 | 
			
		||||
				/* Attn.: Slave address is 7 or 10 bits */
 | 
			
		||||
#define I2C_SLAVE_FORCE	0x0706	/* Change slave address			*/
 | 
			
		||||
				/* Attn.: Slave address is 7 or 10 bits */
 | 
			
		||||
				/* This changes the address, even if it */
 | 
			
		||||
				/* is already taken!			*/
 | 
			
		||||
#define I2C_TENBIT	0x0704	/* 0 for 7 bit addrs, != 0 for 10 bit	*/
 | 
			
		||||
 | 
			
		||||
#define I2C_FUNCS	0x0705	/* Get the adapter functionality */
 | 
			
		||||
#define I2C_RDWR	0x0707	/* Combined R/W transfer (one stop only)*/
 | 
			
		||||
#define I2C_PEC		0x0708	/* != 0 for SMBus PEC                   */
 | 
			
		||||
#if 0
 | 
			
		||||
#define I2C_ACK_TEST	0x0710	/* See if a slave is at a specific address */
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#define I2C_SMBUS	0x0720	/* SMBus-level access */
 | 
			
		||||
 | 
			
		||||
/* -- i2c.h -- */
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/* Note: 10-bit addresses are NOT supported! */
 | 
			
		||||
 | 
			
		||||
/* This is the structure as used in the I2C_SMBUS ioctl call */
 | 
			
		||||
struct i2c_smbus_ioctl_data {
 | 
			
		||||
	char read_write;
 | 
			
		||||
	__u8 command;
 | 
			
		||||
	int size;
 | 
			
		||||
	union i2c_smbus_data *data;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* This is the structure as used in the I2C_RDWR ioctl call */
 | 
			
		||||
struct i2c_rdwr_ioctl_data {
 | 
			
		||||
	struct i2c_msg *msgs;	/* pointers to i2c_msgs */
 | 
			
		||||
	int nmsgs;		/* number of i2c_msgs */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_access(int file, char read_write, __u8 command, 
 | 
			
		||||
                                     int size, union i2c_smbus_data *data)
 | 
			
		||||
{
 | 
			
		||||
	struct i2c_smbus_ioctl_data args;
 | 
			
		||||
 | 
			
		||||
	args.read_write = read_write;
 | 
			
		||||
	args.command = command;
 | 
			
		||||
	args.size = size;
 | 
			
		||||
	args.data = data;
 | 
			
		||||
	return ioctl(file,I2C_SMBUS,&args);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_quick(int file, __u8 value)
 | 
			
		||||
{
 | 
			
		||||
	return i2c_smbus_access(file,value,0,I2C_SMBUS_QUICK,NULL);
 | 
			
		||||
}
 | 
			
		||||
	
 | 
			
		||||
static inline __s32 i2c_smbus_read_byte(int file)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_READ,0,I2C_SMBUS_BYTE,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else
 | 
			
		||||
		return 0x0FF & data.byte;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_byte(int file, __u8 value)
 | 
			
		||||
{
 | 
			
		||||
	return i2c_smbus_access(file,I2C_SMBUS_WRITE,value,
 | 
			
		||||
	                        I2C_SMBUS_BYTE,NULL);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_read_byte_data(int file, __u8 command)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_READ,command,
 | 
			
		||||
	                     I2C_SMBUS_BYTE_DATA,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else
 | 
			
		||||
		return 0x0FF & data.byte;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_byte_data(int file, __u8 command, 
 | 
			
		||||
                                              __u8 value)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	data.byte = value;
 | 
			
		||||
	return i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                        I2C_SMBUS_BYTE_DATA, &data);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_read_word_data(int file, __u8 command)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_READ,command,
 | 
			
		||||
	                     I2C_SMBUS_WORD_DATA,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else
 | 
			
		||||
		return 0x0FFFF & data.word;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_word_data(int file, __u8 command, 
 | 
			
		||||
                                              __u16 value)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	data.word = value;
 | 
			
		||||
	return i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                        I2C_SMBUS_WORD_DATA, &data);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_process_call(int file, __u8 command, __u16 value)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	data.word = value;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                     I2C_SMBUS_PROC_CALL,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else
 | 
			
		||||
		return 0x0FFFF & data.word;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/* Returns the number of read bytes */
 | 
			
		||||
static inline __s32 i2c_smbus_read_block_data(int file, __u8 command, 
 | 
			
		||||
                                              __u8 *values)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	int i;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_READ,command,
 | 
			
		||||
	                     I2C_SMBUS_BLOCK_DATA,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else {
 | 
			
		||||
		for (i = 1; i <= data.block[0]; i++)
 | 
			
		||||
			values[i-1] = data.block[i];
 | 
			
		||||
		return data.block[0];
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_block_data(int file, __u8 command, 
 | 
			
		||||
                                               __u8 length, __u8 *values)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	int i;
 | 
			
		||||
	if (length > 32)
 | 
			
		||||
		length = 32;
 | 
			
		||||
	for (i = 1; i <= length; i++)
 | 
			
		||||
		data.block[i] = values[i-1];
 | 
			
		||||
	data.block[0] = length;
 | 
			
		||||
	return i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                        I2C_SMBUS_BLOCK_DATA, &data);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Returns the number of read bytes */
 | 
			
		||||
static inline __s32 i2c_smbus_read_i2c_block_data(int file, __u8 command,
 | 
			
		||||
                                                  __u8 *values)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	int i;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_READ,command,
 | 
			
		||||
	                      I2C_SMBUS_I2C_BLOCK_DATA,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else {
 | 
			
		||||
		for (i = 1; i <= data.block[0]; i++)
 | 
			
		||||
			values[i-1] = data.block[i];
 | 
			
		||||
		return data.block[0];
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline __s32 i2c_smbus_write_i2c_block_data(int file, __u8 command,
 | 
			
		||||
                                               __u8 length, __u8 *values)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	int i;
 | 
			
		||||
	if (length > 32)
 | 
			
		||||
		length = 32;
 | 
			
		||||
	for (i = 1; i <= length; i++)
 | 
			
		||||
		data.block[i] = values[i-1];
 | 
			
		||||
	data.block[0] = length;
 | 
			
		||||
	return i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                        I2C_SMBUS_I2C_BLOCK_DATA, &data);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Returns the number of read bytes */
 | 
			
		||||
static inline __s32 i2c_smbus_block_process_call(int file, __u8 command,
 | 
			
		||||
                                                 __u8 length, __u8 *values)
 | 
			
		||||
{
 | 
			
		||||
	union i2c_smbus_data data;
 | 
			
		||||
	int i;
 | 
			
		||||
	if (length > 32)
 | 
			
		||||
		length = 32;
 | 
			
		||||
	for (i = 1; i <= length; i++)
 | 
			
		||||
		data.block[i] = values[i-1];
 | 
			
		||||
	data.block[0] = length;
 | 
			
		||||
	if (i2c_smbus_access(file,I2C_SMBUS_WRITE,command,
 | 
			
		||||
	                     I2C_SMBUS_BLOCK_PROC_CALL,&data))
 | 
			
		||||
		return -1;
 | 
			
		||||
	else {
 | 
			
		||||
		for (i = 1; i <= data.block[0]; i++)
 | 
			
		||||
			values[i-1] = data.block[i];
 | 
			
		||||
		return data.block[0];
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
#endif /* LIB_I2CDEV_H */
 | 
			
		||||
		Loading…
	
		Reference in a new issue