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@xxxxxxxxxxxxx>
---
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))