usb: musb: Fix fifo reads for dm816x with musb_dsps
authorTony Lindgren <tony@atomide.com>
Fri, 20 Mar 2015 00:10:16 +0000 (17:10 -0700)
committerFelipe Balbi <balbi@ti.com>
Tue, 24 Mar 2015 16:36:38 +0000 (11:36 -0500)
Looks like dm81xx can only do 32-bit fifo reads like am35x. Let's set
up musb-dsps with a custom read_fifo function based on the compatible
flag.

Otherwise we can get the following errors when starting dhclient on a
asix USB Ethernet adapter:

asix 2-1:1.0 eth2: asix_rx_fixup() Bad Header Length 0xffff003c, offset 4

While at it, let's also remove pointless cast of the driver data.

Cc: Bin Liu <binmlist@gmail.com>
Cc: Brian Hutchinson <b.hutchman@gmail.com>
Cc: George Cherian <george.cherian@ti.com>
Cc: Sergei Shtylyov <sergei.shtylyov@cogentembedded.com>
Signed-off-by: Tony Lindgren <tony@atomide.com>
Signed-off-by: Felipe Balbi <balbi@ti.com>
drivers/usb/musb/musb_dsps.c

index 09648b4e40c2f08e7bf8bd719ec5b1794cb2451c..b23ad150a165acd145febb1d1c96b058857b5970 100644 (file)
@@ -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);