1 files changed, 43 insertions, 0 deletions

diff --git a/arch/arm/mach-omap1/board-nokia770.c b/arch/arm/mach-omap1/board-nokia770.c
index 24d2f2df11a0..ecd3f2a61bd4 100644
--- a/arch/arm/mach-omap1/board-nokia770.c
+++ b/arch/arm/mach-omap1/board-nokia770.c
@@ -7,6 +7,7 @@
  * it under the terms of the GNU General Public License version 2 as
  * published by the Free Software Foundation.
  */
+#include <linux/irq.h>
 #include <linux/gpio.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
@@ -23,6 +24,8 @@
 
 #include <linux/platform_data/keypad-omap.h>
 #include <linux/platform_data/lcd-mipid.h>
+#include <linux/platform_data/gpio-omap.h>
+#include <linux/platform_data/i2c-cbus-gpio.h>
 
 #include <asm/mach-types.h>
 #include <asm/mach/arch.h>
@@ -212,6 +215,45 @@ static inline void nokia770_mmc_init(void)
 }
 #endif
 
+#if defined(CONFIG_I2C_CBUS_GPIO) || defined(CONFIG_I2C_CBUS_GPIO_MODULE)
+static struct i2c_cbus_platform_data nokia770_cbus_data = {
+        .clk_gpio = OMAP_MPUIO(9),
+        .dat_gpio = OMAP_MPUIO(10),
+        .sel_gpio = OMAP_MPUIO(11),
+};
+
+static struct platform_device nokia770_cbus_device = {
+        .name   = "i2c-cbus-gpio",
+        .id     = 2,
+        .dev    = {
+                .platform_data = &nokia770_cbus_data,
+        },
+};
+
+static struct i2c_board_info nokia770_i2c_board_info_2[] __initdata = {
+        {
+                I2C_BOARD_INFO("retu-mfd", 0x01),
+        },
+};
+
+static void __init nokia770_cbus_init(void)
+{
+        const int retu_irq_gpio = 62;
+
+        if (gpio_request_one(retu_irq_gpio, GPIOF_IN, "Retu IRQ"))
+                return;
+        irq_set_irq_type(gpio_to_irq(retu_irq_gpio), IRQ_TYPE_EDGE_RISING);
+        nokia770_i2c_board_info_2[0].irq = gpio_to_irq(retu_irq_gpio);
+        i2c_register_board_info(2, nokia770_i2c_board_info_2,
+                                ARRAY_SIZE(nokia770_i2c_board_info_2));
+        platform_device_register(&nokia770_cbus_device);
+}
+#else /* CONFIG_I2C_CBUS_GPIO */
+static void __init nokia770_cbus_init(void)
+{
+}
+#endif /* CONFIG_I2C_CBUS_GPIO */
+
 static void __init omap_nokia770_init(void)
 {
         /* On Nokia 770, the SleepX signal is masked with an
@@ -233,6 +275,7 @@ static void __init omap_nokia770_init(void)
         mipid_dev_init();
         omap1_usb_init(&nokia770_usb_config);
         nokia770_mmc_init();
+        nokia770_cbus_init();
 }
 
 MACHINE_START(NOKIA770, "Nokia 770")