1 files changed, 24 insertions, 1 deletions

diff --git a/drivers/usb/musb/musb_dsps.c b/drivers/usb/musb/musb_dsps.c
index 09648b4e40c2..b23ad150a165 100644
--- a/drivers/usb/musb/musb_dsps.c
+++ b/drivers/usb/musb/musb_dsps.c
@@ -615,6 +615,24 @@ static int dsps_musb_recover(struct musb *musb)
         return session_restart ? 0 : -EPIPE;
 }
 
+/* Similar to am35x, dm81xx support only 32-bit read operation */
+static void dsps_read_fifo32(struct musb_hw_ep *hw_ep, u16 len, u8 *dst)
+{
+        void __iomem *fifo = hw_ep->fifo;
+
+        if (len >= 4) {
+                readsl(fifo, dst, len >> 2);
+                dst += len & ~0x03;
+                len &= 0x03;
+        }
+
+        /* Read any remaining 1 to 3 bytes */
+        if (len > 0) {
+                u32 val = musb_readl(fifo, 0);
+                memcpy(dst, &val, len);
+        }
+}
+
 static struct musb_platform_ops dsps_ops = {
         .quirks         = MUSB_INDEXED_EP,
         .init           = dsps_musb_init,
@@ -761,6 +779,9 @@ static int dsps_probe(struct platform_device *pdev)
         }
         wrp = match->data;
 
+        if (of_device_is_compatible(pdev->dev.of_node, "ti,musb-dm816"))
+                dsps_ops.read_fifo = dsps_read_fifo32;
+
         /* allocate glue */
         glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
         if (!glue)
@@ -837,7 +858,9 @@ static const struct dsps_musb_wrapper am33xx_driver_data = {
 
 static const struct of_device_id musb_dsps_of_match[] = {
         { .compatible = "ti,musb-am33xx",
-                .data = (void *) &am33xx_driver_data, },
+                .data = &am33xx_driver_data, },
+        { .compatible = "ti,musb-dm816",
+                .data = &am33xx_driver_data, },
         {  },
 };
 MODULE_DEVICE_TABLE(of, musb_dsps_of_match);