[PATCH] usb: musb: dsps: implement vbus_status method

[Roman Alyautdin <ralyautdin@dev.rtsoft.ru>]

Implement vbus_status  method of musb_platform_ops that allows
musb_core to properly represent the VBUS status of musb_dsps devices in
corresponding sysfs entry

Signed-off-by: Roman Alyautdin <ralyautdin@dev.rtsoft.ru>
---
 drivers/usb/musb/musb_dsps.c |   13 +++++++++++++
 1 file changed, 13 insertions(+)

diff --git a/drivers/usb/musb/musb_dsps.c b/drivers/usb/musb/musb_dsps.c
index 84512d1..9c00edf 100644
--- a/drivers/usb/musb/musb_dsps.c
+++ b/drivers/usb/musb/musb_dsps.c
@@ -632,6 +632,18 @@ static void dsps_read_fifo32(struct musb_hw_ep *hw_ep, u16 len, u8 *dst)
 	}
 }
 
+static int dsps_musb_vbus_status(struct musb *musb)
+{
+	void __iomem *mregs = musb->mregs;
+	u8 devctl;
+
+	devctl = dsps_readb(mregs, MUSB_DEVCTL);
+	if ((devctl & MUSB_DEVCTL_VBUS) == (3 << MUSB_DEVCTL_VBUS_SHIFT))
+		return 1;
+	else
+		return 0;
+}
+
 static struct musb_platform_ops dsps_ops = {
 	.quirks		= MUSB_DMA_CPPI41 | MUSB_INDEXED_EP,
 	.init		= dsps_musb_init,
@@ -647,6 +659,7 @@ static struct musb_platform_ops dsps_ops = {
 	.try_idle	= dsps_musb_try_idle,
 	.set_mode	= dsps_musb_set_mode,
 	.recover	= dsps_musb_recover,
+	.vbus_status	= dsps_musb_vbus_status,
 };
 
 static u64 musb_dmamask = DMA_BIT_MASK(32);
-- 
1.7.9.5