From 0c8256185a9f46c725e8574b05de0165fc1e657a Mon Sep 17 00:00:00 2001
From: lfcorreia <lfcorreia@3ae390bd-cb1e-0410-b409-cd5a39f66f1f>
Date: Sat, 29 Jul 2006 21:04:43 +0000
Subject: [lcd4linux @ 2006-07-29 21:04:43 by lfcorreia] Better error handling,
 add proper I2C SLAVE device detection (not 100% finished)

git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@676 3ae390bd-cb1e-0410-b409-cd5a39f66f1f
---
 drv_generic_i2c.c | 31 +++++++++++++++++++------------
 1 file changed, 19 insertions(+), 12 deletions(-)

(limited to 'drv_generic_i2c.c')

diff --git a/drv_generic_i2c.c b/drv_generic_i2c.c
index 5f0851f..343ea80 100644
--- a/drv_generic_i2c.c
+++ b/drv_generic_i2c.c
@@ -1,4 +1,4 @@
-/* $Id: drv_generic_i2c.c,v 1.5 2005/06/01 12:50:25 reinelt Exp $
+/* $Id: drv_generic_i2c.c,v 1.6 2006/07/29 21:04:43 lfcorreia Exp $
  *
  * generic driver helper for i2c displays
  *
@@ -23,6 +23,9 @@
  *
  *
  * $Log: drv_generic_i2c.c,v $
+ * Revision 1.6  2006/07/29 21:04:43  lfcorreia
+ * Better error handling, add proper I2C SLAVE device detection (not 100% finished)
+ *
  * Revision 1.5  2005/06/01 12:50:25  reinelt
  * ifdef'ed unused function to avoid compiler warning
  *
@@ -125,25 +128,29 @@ int drv_generic_i2c_open(const char *section, const char *driver)
     device = cfg_get(Section, "Device", NULL);
     dev = atoi(device);
     info("%s: initializing I2C bus %s", Driver, bus);
-    info("device %d", dev);
     if ((i2c_device = open(bus, O_WRONLY)) < 0) {
 	error("%s: I2C bus %s open failed !\n", Driver, bus);
-	return -1;
+	goto exit_error;
     }
-    info("%s: initializing I2C slave device 0x%x", Driver, dev);
+    info("%s: selecting slave device 0x%x", Driver, dev);
     if (ioctl(i2c_device, I2C_SLAVE, dev) < 0) {
-	error("%s: error initializing device 0x%x\n", Driver, dev);
-	close(i2c_device);
-	return -1;
+	error("%s: error selecting slave device 0x%x\n", Driver, dev);
+	goto exit_error;
     }
-    return 0;
-}
 
+    info("%s: initializing I2C slave device 0x%x", Driver, dev);
+    if (i2c_smbus_write_quick(i2c_device, I2C_SMBUS_WRITE) < 0 ){
+	error("%s: error initializing device 0x%x\n", Driver, dev);
+	close(i2c_device);
+		}
 
-int drv_generic_i2c_close(void)
-{
-    close(i2c_device);
     return 0;
+
+  exit_error:
+    free(bus);
+    free(device);
+		close(i2c_device);
+		return -1;
 }
 
 
-- 
cgit v1.2.3