First cut at I2C tool

git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@3927 42af7a65-404d-4744-a932-0658087f49c3

1 files changed, 155 insertions, 0 deletions

diff --git a/apps/system/i2c/i2c_dev.c b/apps/system/i2c/i2c_dev.c
index 2458aec18..a8340f0d8 100644
--- a/apps/system/i2c/i2c_dev.c
+++ b/apps/system/i2c/i2c_dev.c
@@ -39,6 +39,10 @@
 
 #include <nuttx/config.h>
 
+#include <stdlib.h>
+
+#include <nuttx/i2c.h>
+
 #include "i2ctool.h"
 
 /****************************************************************************
@@ -75,5 +79,156 @@
 
 int cmd_dev(FAR struct i2ctool_s *i2ctool, int argc, char **argv)
 {
+  FAR struct i2c_dev_s *dev;
+  struct i2c_msg_s msg[2];
+  FAR char *ptr;
+  union
+  {
+    uint16_t data16;
+    uint8_t  data8;
+  } u;
+
+  uint8_t regaddr;
+  long first;
+  long last;
+  int addr;
+  int nargs;
+  int argndx;
+  int ret;
+  int i;
+  int j;
+
+  /* Parse any command line arguments */
+
+  for (argndx = 1; argndx < argc; )
+    {
+      /* Break out of the look when the last option has been parsed */
+
+      ptr = argv[argndx];
+      if (*ptr != '-')
+        {
+          break;
+        }
+
+      /* Otherwise, check for common options */
+
+      nargs = common_args(i2ctool, &argv[argndx]);
+      if (nargs < 0)
+        {
+          return ERROR;
+        }
+      argndx += nargs;
+    }
+
+  /* There should be exactly two more things on the command line:  The first and
+   * last addresses to be probed.
+   */
+
+  if (argndx+1 < argc)
+    {
+      first = strtol(argv[argndx], NULL, 16);
+      last  = strtol(argv[argndx+1], NULL, 16);
+      if (first < 0 || first > 0x7f || last < 0 || last > 0x7f || first > last)
+        {
+          i2ctool_printf(i2ctool, g_i2cargrange, argv[0]);
+          return ERROR;
+        }
+
+      argndx += 2;
+    }
+  else
+    {
+      i2ctool_printf(i2ctool, g_i2cargrequired, argv[0]);
+      return ERROR;
+    }
+
+  if (argndx != argc)
+    {
+      i2ctool_printf(i2ctool, g_i2ctoomanyargs, argv[0]);
+      return ERROR;
+    }
+
+  /* Get a handle to the I2C bus */
+
+  dev = up_i2cinitialize(i2ctool->bus);
+  if (!dev)
+    {
+       i2ctool_printf(i2ctool, "Failed to get bus %d\n", i2ctool->bus);
+       return ERROR;
+    }
+
+  /* Set the frequency and address (NOTE:  Only 7-bit address supported now) */
+
+  I2C_SETFREQUENCY(dev, i2ctool->freq);
+
+  /* Probe each address */
+
+  i2ctool_printf(i2ctool, "     0  1  2  3  4  5  6  7  8  9  a  b  c  d  e  f\n");
+  for (i = 0; i < 128; i += 16)
+    {
+      i2ctool_printf(i2ctool, "%02x: ", i);
+      for (j = 0; j < 16; j++)
+        {
+          /* Skip addresses that are out of the selected range */
+
+          addr = i+j;
+          if (addr < first || addr > last)
+            {
+              i2ctool_printf(i2ctool, "   ");
+              continue;
+            }
+            
+          /* Set the I2C address */
+
+          I2C_SETADDRESS(dev, addr, 7);
+
+          /* Set up data structures */
+
+          regaddr       = 0;
+
+          msg[0].addr   = addr;
+          msg[0].flags  = 0;
+          msg[0].buffer = &regaddr;
+          msg[0].length = 1;
+
+          msg[1].addr   = addr;
+          msg[1].flags  = I2C_M_READ;
+          if (i2ctool->width == 8)
+            {
+              msg[1].buffer = &u.data8;
+              msg[1].length = 1;
+            }
+          else
+            {
+              msg[1].buffer = (uint8_t*)&u.data16;
+              msg[2].length = 2;
+            }
+
+          if (i2ctool->start)
+            {
+              ret = I2C_TRANSFER(dev, &msg[0], 1);
+              if (ret == OK)
+                {
+                  ret = I2C_TRANSFER(dev, &msg[1], 1);
+                }
+            }
+          else
+            {
+              ret = I2C_TRANSFER(dev, msg, 2);
+            }
+
+          if (ret == OK)
+            {
+              i2ctool_printf(i2ctool, "%02x ", addr);
+            }
+          else
+            {
+              i2ctool_printf(i2ctool, "-- ");
+            }
+        }
+      i2ctool_printf(i2ctool, "\n");
+    }
+
+  (void)up_i2cuninitialize(dev);
   return OK;
 }