X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=scripts%2Fi2c.py;h=c597c85b150e042d33d5cd51d24a69044a30c1b3;hp=2e9a109e0fe2891175726af4e6d739958e032208;hb=6bbe85b249210dd265f51cfde4288530d9bb05fb;hpb=3d875e0b7d29c59be6a65b13cd4e2b0d157b6744

diff --git a/scripts/i2c.py b/scripts/i2c.py
index 2e9a109..c597c85 100755
--- a/scripts/i2c.py
+++ b/scripts/i2c.py
@@ -5,6 +5,7 @@ import threading
 import inspect
 import os
 import logging
+import struct
 from ctypes import *
 from time import sleep
 
@@ -62,6 +63,23 @@ class i2c:
 	def __del__(self):
 		self.close()
 
+
+def i2c_write_reg(addr, reg, buf):
+	dev = i2c(addr)
+	s = struct.pack(">B", reg) + buf
+	dev.write(s)
+	dev.close()
+
+
+def i2c_read_reg(addr, reg, num=1):
+	dev = i2c(addr)
+	s = struct.pack(">B", reg)
+	dev.write(s)
+	s = dev.read(num)
+	dev.close()
+	return s
+
+
 if __name__ == "__main__":
 	import struct
 	import sys