2 # -*- coding: iso-8859-15 -*-
11 from time import sleep
14 I2C_FILENAME = "/dev/i2c-2"
15 logger = logging.getLogger(__name__)
18 libc = CDLL("libc.so.6")
19 I2C_SLAVE = 0x0703 # Use this slave address
21 __lock = threading.Lock()
24 def __init__(self, addr):
28 parent = inspect.stack()[1][3]
33 parent_owner = "%s (%d), %s()" % (self.__parent_owner[1], self.__parent_owner[2], self.__parent_owner[3])
34 logger.warning("Error: (%s) I2C blocked %fs by %s!", parent, count*0.001, parent_owner)
35 i2c.__parent_owner = inspect.stack()[1]
37 self.dev = i2c.libc.open(I2C_FILENAME, os.O_RDWR)
40 fcntl.flock(self.dev, fcntl.LOCK_EX)
41 err = i2c.libc.ioctl(self.dev, i2c.I2C_SLAVE, addr>>1)
43 raise IOError("ioctl")
46 num_write = i2c.libc.write(self.dev, s, len(s))
47 if num_write != len(s):
49 raise IOError("write: %d" % (num_write))
52 buf = create_string_buffer(num)
53 num_read = i2c.libc.read(self.dev, buf, num)
56 raise IOError("read: %d" % (num_read))
61 i2c.libc.close(self.dev)
63 #i2c.__parent_owner = None
70 def i2c_write_reg(addr, reg, buf):
72 s = struct.pack(">B", reg) + buf
77 def i2c_read_reg(addr, reg, num=1):
79 s = struct.pack(">B", reg)
86 if __name__ == "__main__":
91 s = struct.pack(">Bh", int(sys.argv[1]), int(sys.argv[2]))