bcma: scan for extra address space

Some cores like the USB core have two address spaces. In the USB host
controller one address space is used for the OHCI and the other for the
EHCI controller interface. The USB controller is the only core I found
with two address spaces. This code is based on the AI scan function
ai_scan() in shared/aiutils.c in the Broadcom SDK.

CC: Rafał Miłecki <zajec5@gmail.com>
CC: linux-wireless@vger.kernel.org
Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>

1 files changed, 18 insertions, 1 deletions

diff --git a/drivers/bcma/scan.c b/drivers/bcma/scan.c
index f94cccccfa56..3bea7fe25b20 100644
--- a/drivers/bcma/scan.c
+++ b/drivers/bcma/scan.c
@@ -297,6 +297,23 @@ static int bcma_get_next_core(struct bcma_bus *bus, u32 __iomem **eromptr,
                         return -EILSEQ;
         }
 
+        /* First Slave Address Descriptor should be port 0:
+         * the main register space for the core
+         */
+        tmp = bcma_erom_get_addr_desc(bus, eromptr, SCAN_ADDR_TYPE_SLAVE, 0);
+        if (tmp <= 0) {
+                /* Try again to see if it is a bridge */
+                tmp = bcma_erom_get_addr_desc(bus, eromptr,
+                                              SCAN_ADDR_TYPE_BRIDGE, 0);
+                if (tmp <= 0) {
+                        return -EILSEQ;
+                } else {
+                        pr_info("Bridge found\n");
+                        return -ENXIO;
+                }
+        }
+        core->addr = tmp;
+
         /* get & parse slave ports */
         for (i = 0; i < ports[1]; i++) {
                 for (j = 0; ; j++) {
@@ -309,7 +326,7 @@ static int bcma_get_next_core(struct bcma_bus *bus, u32 __iomem **eromptr,
                                 break;
                         } else {
                                 if (i == 0 && j == 0)
-                                        core->addr = tmp;
+                                        core->addr1 = tmp;
                         }
                 }
         }