From 0504d0310e97d8a47f3f4858868235e29c35204f Mon Sep 17 00:00:00 2001
From: Brendan Le Foll <brendan.le.foll@intel.com>
Date: Fri, 11 Apr 2014 11:51:40 +0100
Subject: [PATCH] i2c.cxx: add functionality to write to i2c

Signed-off-by: Brendan Le Foll <brendan.le.foll@intel.com>
---
 src/i2c/i2c.cxx | 9 +++++++++
 1 file changed, 9 insertions(+)

diff --git a/src/i2c/i2c.cxx b/src/i2c/i2c.cxx
index 39ea2f0..2c591ad 100644
--- a/src/i2c/i2c.cxx
+++ b/src/i2c/i2c.cxx
@@ -64,12 +64,21 @@ I2C::read(int ack)
 int
 I2C::write(int address, const char *data, int length, bool repeated)
 {
+    if (i2c_smbus_write_i2c_block_data(i2c_handle, data[0], length, (uint8_t*) data) < 0) {
+        fprintf(stderr, "Failed to write to I2C slave\n");
+	return -1;
+    }
     return 0;
 }
 
 int
 I2C::write(int data)
 {
+    if (i2c_smbus_write_byte(i2c_handle, data) < 0) {
+        fprintf(stderr, "Failed to write to I2C slave\n");
+	return -1;
+    }
+    return 0;
 }
 
 void