lpc176x: Convert i2c code to use standard i2ccmds.c

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>

1 files changed, 10 insertions, 3 deletions

diff --git a/klippy/extras/mcp4451.py b/klippy/extras/mcp4451.py
index a7eda9aa..9a79671b 100644
--- a/klippy/extras/mcp4451.py
+++ b/klippy/extras/mcp4451.py
@@ -10,8 +10,9 @@ WiperRegisters = [0x00, 0x01, 0x06, 0x07]
 class mcp4451:
     def __init__(self, config):
         printer = config.get_printer()
+        # Read config parameters
         self.mcu = mcu.get_printer_mcu(printer, config.get('mcu', 'mcu'))
-        self.i2c_addr = config.getint('i2c_address')
+        i2c_addr = config.getint('i2c_address')
         scale = config.getfloat('scale', 1., above=0.)
         wipers = [None]*4
         for i in range(len(wipers)):
@@ -19,14 +20,20 @@ class mcp4451:
                                   minval=0., maxval=scale)
             if val is not None:
                 wipers[i] = int(val * 255. / scale + .5)
+        # Setup i2c
+        self.oid = self.mcu.create_oid()
+        self.mcu.add_config_cmd(
+            "config_i2c oid=%d bus=0 rate=100000 addr=%d" % (
+                self.oid, i2c_addr))
+        # Configure registers
         self.add_config_cmd(0x04, 0xff)
         self.add_config_cmd(0x0a, 0xff)
         for reg, val in zip(WiperRegisters, wipers):
             if val is not None:
                 self.add_config_cmd(reg, val)
     def add_config_cmd(self, reg, val):
-        self.mcu.add_config_cmd("i2c_send data=%02x%02x%02x" % (
-            self.i2c_addr, (reg << 4) | ((val >> 8) & 0x03), val), is_init=True)
+        self.mcu.add_config_cmd("i2c_write oid=%d data=%02x%02x" % (
+            self.oid, (reg << 4) | ((val >> 8) & 0x03), val), is_init=True)
 
 def load_config_prefix(config):
     return mcp4451(config)