A function to calculate the frequency divider and digital filter sampling rate
for the 85xx processors is added to the i2c-imx driver. Hence, this driver is
usable on IMX and 85xx machines.

Signed-off-by: Renaud Barbier <renaud.barb...@ge.com>
---
 arch/ppc/mach-mpc85xx/include/mach/immap_85xx.h |    3 +
 drivers/i2c/busses/Kconfig                      |    4 +-
 drivers/i2c/busses/i2c-imx.c                    |   91 ++++++++++++++++++++---
 3 files changed, 86 insertions(+), 12 deletions(-)

diff --git a/arch/ppc/mach-mpc85xx/include/mach/immap_85xx.h 
b/arch/ppc/mach-mpc85xx/include/mach/immap_85xx.h
index bf0f7f5..d2f8bbe 100644
--- a/arch/ppc/mach-mpc85xx/include/mach/immap_85xx.h
+++ b/arch/ppc/mach-mpc85xx/include/mach/immap_85xx.h
@@ -136,4 +136,7 @@
 
 #define GFAR_BASE_ADDR         (CFG_IMMR + TSEC1_OFFSET)
 #define MDIO_BASE_ADDR         (CFG_IMMR + 0x24000)
+
+#define I2C1_BASE_ADDR         (CFG_IMMR + 0x3000)
+#define I2C2_BASE_ADDR         (CFG_IMMR + 0x3100)
 #endif /*__IMMAP_85xx__*/
diff --git a/drivers/i2c/busses/Kconfig b/drivers/i2c/busses/Kconfig
index 1ce5c00..3f998ea 100644
--- a/drivers/i2c/busses/Kconfig
+++ b/drivers/i2c/busses/Kconfig
@@ -5,8 +5,8 @@
 menu "I2C Hardware Bus support"
 
 config I2C_IMX
-       bool "i.MX I2C Master driver"
-       depends on ARCH_IMX && !ARCH_IMX1
+       bool "MPC85xx/i.MX I2C Master driver"
+       depends on (ARCH_IMX && !ARCH_IMX1) || ARCH_MPC85XX
 
 config I2C_OMAP
        bool "OMAP I2C Master driver"
diff --git a/drivers/i2c/busses/i2c-imx.c b/drivers/i2c/busses/i2c-imx.c
index 8bbe87b..6018204 100644
--- a/drivers/i2c/busses/i2c-imx.c
+++ b/drivers/i2c/busses/i2c-imx.c
@@ -23,7 +23,8 @@
  *
  * Desc.:
  *  Implementation of I2C Adapter/Algorithm Driver
- *  for I2C Bus integrated in Freescale i.MX/MXC processors
+ *  for I2C Bus integrated in Freescale i.MX/MXC processors and
+ *  85xx processors.
  *
  * Derived from Motorola GSG China I2C example driver
  *
@@ -37,7 +38,6 @@
 #include <clock.h>
 #include <common.h>
 #include <driver.h>
-#include <gpio.h>
 #include <init.h>
 #include <malloc.h>
 #include <types.h>
@@ -47,7 +47,6 @@
 
 #include <io.h>
 #include <i2c/i2c.h>
-#include <mach/generic.h>
 #include <mach/clock.h>
 
 /* This will be the driver name */
@@ -62,6 +61,7 @@
 #define FSL_I2C_I2CR   0x08    /* i2c control */
 #define FSL_I2C_I2SR   0x0C    /* i2c status */
 #define FSL_I2C_I2DR   0x10    /* i2c transfer data */
+#define FSL_I2C_DFSRR  0x14    /* i2c digital filter sampling rate */
 
 /* Bits of FSL I2C registers */
 #define I2SR_RXAK      0x01
@@ -86,6 +86,7 @@
  *
  * Duplicated divider values removed from list
  */
+#ifndef CONFIG_PPC
 static u16 i2c_clk_div[50][2] = {
        { 22,   0x20 }, { 24,   0x21 }, { 26,   0x22 }, { 28,   0x23 },
        { 30,   0x00 }, { 32,   0x24 }, { 36,   0x25 }, { 40,   0x26 },
@@ -101,6 +102,7 @@ static u16 i2c_clk_div[50][2] = {
        { 1920, 0x1B }, { 2048, 0x3F }, { 2304, 0x1C }, { 2560, 0x1D },
        { 3072, 0x1E }, { 3840, 0x1F }
 };
+#endif
 
 struct fsl_i2c_struct {
        void __iomem            *base;
@@ -108,6 +110,7 @@ struct fsl_i2c_struct {
        unsigned int            disable_delay;
        int                     stopped;
        unsigned int            ifdr;   /* FSL_I2C_IFDR */
+       unsigned int            dfsrr;  /* FSL_I2C_DFSRR */
 };
 #define to_fsl_i2c_struct(a)   container_of(a, struct fsl_i2c_struct, adapter)
 
@@ -216,6 +219,9 @@ static int i2c_fsl_start(struct i2c_adapter *adapter)
        int result;
 
        writeb(i2c_fsl->ifdr, base + FSL_I2C_IFDR);
+       if (i2c_fsl->dfsrr != -1)
+               writeb(i2c_fsl->dfsrr, base + FSL_I2C_DFSRR);
+
        /* Enable I2C controller */
        writeb(0, base + FSL_I2C_I2SR);
        writeb(I2CR_IEN, base + FSL_I2C_I2CR);
@@ -255,13 +261,6 @@ static void i2c_fsl_stop(struct i2c_adapter *adapter)
                 * controller is disabled before the STOP is sent completely */
                i2c_fsl->stopped = i2c_fsl_bus_busy(adapter, 0) ? 0 : 1;
        }
-       if (cpu_is_mx1()) {
-               /*
-                * This delay caused by an i.MXL hardware bug.
-                * If no (or too short) delay, no "STOP" bit will be generated.
-                */
-               udelay(i2c_fsl->disable_delay);
-       }
 
        if (!i2c_fsl->stopped) {
                i2c_fsl_bus_busy(adapter, 0);
@@ -272,6 +271,76 @@ static void i2c_fsl_stop(struct i2c_adapter *adapter)
        writeb(0, base + FSL_I2C_I2CR);
 }
 
+#ifdef CONFIG_PPC
+static void i2c_fsl_set_clk(struct fsl_i2c_struct *i2c_fsl,
+                                   unsigned int rate)
+{
+       void __iomem *base;
+       unsigned int i2c_clk;
+       unsigned short divider;
+       /*
+        * We want to choose an FDR/DFSR that generates an I2C bus speed that
+        * is equal to or lower than the requested speed.  That means that we
+        * want the first divider that is equal to or greater than the
+        * calculated divider.
+        */
+       u8 dfsr, fdr;
+       /* a, b and dfsr matches identifiers A,B and C respectively in AN2919 */
+       unsigned short a, b, ga, gb;
+       unsigned long c_div, est_div;
+
+       fdr = 0x31; /* Default if no FDR found */
+       base = i2c_fsl->base;
+       i2c_clk = fsl_get_i2c_freq();
+       divider = min((unsigned short)(i2c_clk / rate), (unsigned short) -1);
+
+       /*
+        * Condition 1: dfsr <= 50ns/T (T=period of I2C source clock in ns).
+        * or (dfsr * T) <= 50ns.
+        * Translate to dfsr = 5 * Frequency / 100,000,000
+        */
+       dfsr = (5 * (i2c_clk / 1000)) / 100000;
+       dev_dbg(i2c_fsl->adapter.dev,
+               "<%s> requested speed:%d, i2c_clk:%d\n", __func__,
+               rate, i2c_clk);
+       if (!dfsr)
+               dfsr = 1;
+
+       est_div = ~0;
+       for (ga = 0x4, a = 10; a <= 30; ga++, a += 2) {
+               for (gb = 0; gb < 8; gb++) {
+                       b = 16 << gb;
+                       c_div = b * (a + ((3*dfsr)/b)*2);
+                       if ((c_div > divider) && (c_div < est_div)) {
+                               unsigned short bin_gb, bin_ga;
+
+                               est_div = c_div;
+                               bin_gb = gb << 2;
+                               bin_ga = (ga & 0x3) | ((ga & 0x4) << 3);
+                               fdr = bin_gb | bin_ga;
+                               rate = i2c_clk / est_div;
+                               dev_dbg(i2c_fsl->adapter.dev,
+                                       "FDR:0x%.2x, div:%ld, ga:0x%x, gb:0x%x,"
+                                       " a:%d, b:%d, speed:%d\n", fdr, est_div,
+                                       ga, gb, a, b, rate);
+                               /* Condition 2 not accounted for */
+                               dev_dbg(i2c_fsl->adapter.dev,
+                                       "Tr <= %d ns\n", (b - 3 * dfsr) *
+                                       1000000 / (i2c_clk / 1000));
+                       }
+               }
+               if (a == 20)
+                       a += 2;
+               if (a == 24)
+                       a += 4;
+       }
+       dev_dbg(i2c_fsl->adapter.dev,
+               "divider:%d, est_div:%ld, DFSR:%d\n", divider, est_div, dfsr);
+       dev_dbg(i2c_fsl->adapter.dev, "FDR:0x%.2x, speed:%d\n", fdr, rate);
+       i2c_fsl->ifdr = fdr;
+       i2c_fsl->dfsrr = dfsr;
+}
+#else
 static void i2c_fsl_set_clk(struct fsl_i2c_struct *i2c_fsl,
                            unsigned int rate)
 {
@@ -308,6 +377,7 @@ static void i2c_fsl_set_clk(struct fsl_i2c_struct *i2c_fsl,
        dev_dbg(i2c_fsl->adapter.dev, "<%s> IFDR[IC]=0x%x, REAL DIV=%d\n",
                __func__, i2c_clk_div[i][1], i2c_clk_div[i][0]);
 }
+#endif
 
 static int i2c_fsl_write(struct i2c_adapter *adapter, struct i2c_msg *msgs)
 {
@@ -475,6 +545,7 @@ static int __init i2c_fsl_probe(struct device_d *pdev)
        i2c_fsl->adapter.nr = pdev->id;
        i2c_fsl->adapter.dev = pdev;
        i2c_fsl->base = dev_request_mem_region(pdev, 0);
+       i2c_fsl->dfsrr = -1;
 
        /* Set up clock divider */
        if (pdata && pdata->bitrate)
-- 
1.7.1


_______________________________________________
barebox mailing list
barebox@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to