usb: host: xhci-omap: invoke board_usb_cleanup in xhci_hcd_stop

[u-boot] / drivers / usb / musb / am35x.c

diff --git a/drivers/usb/musb/am35x.c b/drivers/usb/musb/am35x.c
index 2024940cdd83809cd86efba7326b17ce99c526cb..62c3a6f60aa8c066177ec11b79b68e023176142a 100644 (file)
--- a/drivers/usb/musb/am35x.c
+++ b/drivers/usb/musb/am35x.c
@@ -7,20 +7,9 @@
  *
  * Copyright (c) 2010 Texas Instruments Incorporated
  *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ * SPDX-License-Identifier:    GPL-2.0+
  */
+
 #include <common.h>
 
 #include "am35x.h"
@@ -116,3 +105,35 @@ void musb_platform_deinit(void)
        /* Turn off the phy */
        phy_off();
 }
+
+/*
+ * This function reads data from endpoint fifo for AM35x
+ * which supports only 32bit read operation.
+ *
+ * ep           - endpoint number
+ * length       - number of bytes to read from FIFO
+ * fifo_data    - pointer to data buffer into which data is read
+ */
+__attribute__((weak))
+void read_fifo(u8 ep, u32 length, void *fifo_data)
+{
+       u8  *data = (u8 *)fifo_data;
+       u32 val;
+       int i;
+
+       /* select the endpoint index */
+       writeb(ep, &musbr->index);
+
+       if (length > 4) {
+               for (i = 0; i < (length >> 2); i++) {
+                       val = readl(&musbr->fifox[ep]);
+                       memcpy(data, &val, 4);
+                       data += 4;
+               }
+               length %= 4;
+       }
+       if (length > 0) {
+               val = readl(&musbr->fifox[ep]);
+               memcpy(data, &val, length);
+       }
+}