usb : musb : Adding USB VBUS enable functionality for DM644x DVEVM

[platform/kernel/u-boot.git] / board / davinci / dvevm / dvevm.c

diff --git a/board/davinci/dvevm/dvevm.c b/board/davinci/dvevm/dvevm.c
index abf60b3..5dd081c 100644 (file)
--- a/board/davinci/dvevm/dvevm.c
+++ b/board/davinci/dvevm/dvevm.c
@@ -101,3 +101,26 @@ int misc_init_r(void)
 
        return(0);
 }
+
+#ifdef CONFIG_USB_DAVINCI
+
+/* IO Expander I2C address and USB VBUS enable mask */
+#define IOEXP_I2C_ADDR 0x3A
+#define IOEXP_VBUSEN_MASK 1
+
+/*
+ * This function enables USB VBUS by writting to IO expander using I2C.
+ * Note that the I2C is already initialized at this stage. This
+ * function is used by davinci specific USB wrapper code.
+ */
+void enable_vbus(void)
+{
+       uchar data;  /* IO Expander data to enable VBUS */
+
+       /* Write to IO expander to enable VBUS */
+       i2c_read(IOEXP_I2C_ADDR, 0, 0, &data, 1);
+       data &= ~IOEXP_VBUSEN_MASK;
+       i2c_write(IOEXP_I2C_ADDR, 0, 0, &data, 1);
+}
+#endif
+