add support for mpc551x based GW_LCFM system

1 files changed, 112 insertions, 0 deletions

diff --git a/c/src/lib/libbsp/powerpc/mpc55xxevb/i2c/i2c_init.c b/c/src/lib/libbsp/powerpc/mpc55xxevb/i2c/i2c_init.c
new file mode 100644
index 0000000000..db07b67948
--- /dev/null
+++ b/c/src/lib/libbsp/powerpc/mpc55xxevb/i2c/i2c_init.c
@@ -0,0 +1,112 @@
+/*===============================================================*\
+| Project: RTEMS support for GWLCFM                               |
++-----------------------------------------------------------------+
+|                    Copyright (c) 2010                           |
+|                    Embedded Brains GmbH                         |
+|                    Obere Lagerstr. 30                           |
+|                    D-82178 Puchheim                             |
+|                    Germany                                      |
+|                    rtems@embedded-brains.de                     |
++-----------------------------------------------------------------+
+| The license and distribution terms for this file may be         |
+| found in the file LICENSE in this distribution or at            |
+|                                                                 |
+| http://www.rtems.com/license/LICENSE.                           |
+|                                                                 |
++-----------------------------------------------------------------+
+| this file contains the low level MPC5516 I2C driver parameters  |
+\*===============================================================*/
+#if 0 /* FIXME: make this work... */
+#include <mpc55xx/mpc55xx_i2cdrv.h>
+#include <libchip/i2c-2b-eeprom.h>
+#include <bsp/irq.h>
+#include <bsp.h>
+
+static mpc55xx_i2c_desc_t mpc55xx_i2c_bus_tbl[] = {
+  /* first channel */
+  {
+    {/* public fields */
+      .ops = &mpc55xx_i2c_ops,
+      .size = sizeof(mpc55xx_i2c_bus_tbl[0]),
+    },
+    { /* our private fields */
+      .reg_ptr = &mpc55xx.i2c[0],
+      .initialized = FALSE,
+      .irq_number = BSP_IPIC_IRQ_I2C1,
+      .base_frq = 0 /* will be set during initiailization */
+    }
+  }
+};
+
+rtems_libi2c_bus_t *mpc55xx_i2c_bus_descriptor[] = {
+  &mpc55xx_i2c_bus_tbl[0].bus_desc
+};
+
+/*=========================================================================*\
+| Function:                                                                 |
+\*-------------------------------------------------------------------------*/
+rtems_status_code bsp_register_i2c
+(
+/*-------------------------------------------------------------------------*\
+| Purpose:                                                                  |
+|   register I2C busses and devices                                         |
++---------------------------------------------------------------------------+
+| Input Parameters:                                                         |
+\*-------------------------------------------------------------------------*/
+ void                                    /* <none>                         */
+)
+/*-------------------------------------------------------------------------*\
+| Return Value:                                                             |
+|    0 or error code                                                        |
+\*=========================================================================*/
+
+{
+  int ret_code;
+  int i2c1_busno,i2c2_busno;
+
+  /*
+   * init I2C library (if not already done)
+   */
+  rtems_libi2c_initialize ();
+
+  /*
+   * FIXME: update input frequency of I2c modules into descriptor
+   */
+#if 0
+  /*
+   * I2C1 is clocked with TSEC 1
+   */
+  if (((mpc55xx.clk.sccr >> (31-1)) & 0x03) > 0) {
+    mpc55xx_i2c_bus_tbl[0].softc.base_frq =
+      (BSP_bus_frequency
+       /((mpc55xx.clk.sccr >> (31-1)) & 0x03));
+  }
+#endif
+  mpc55xx_i2c_bus_tbl[1].softc.base_frq = BSP_bus_frequency;
+  /*
+   * register first I2C bus
+   */
+  ret_code = rtems_libi2c_register_bus("/dev/i2c1",
+				       mpc55xx_i2c_bus_descriptor[0]);
+  if (ret_code < 0) {
+    return -ret_code;
+  }
+  i2c1_busno = ret_code;
+
+#ifdef RTEMS_BSP_I2C_EEPROM_DEVICE_NAME
+
+  /*
+   * register EEPROM to bus 1, Address 0x50
+   */
+  ret_code = rtems_libi2c_register_drv(RTEMS_BSP_I2C_EEPROM_DEVICE_NAME,
+				       i2c_2b_eeprom_driver_descriptor,
+				       i2c1_busno,0x50);
+
+  if (ret_code < 0) {
+    return -ret_code;
+  }
+
+#endif /* RTEMS_BSP_I2C_EEPROM_DEVICE_NAME */
+  return 0;
+}
+#endif /* 0 */