brcmfmac: pcie: Replace brcmf_pcie_copy_mem_todev with memcpy_toio

The alignment check was wrong (e.g. & 4 instead of & 3), and the logic
was also inefficient if the length was not a multiple of 4, since it
would needlessly fall back to copying the entire buffer bytewise.

We already have a perfectly good memcpy_toio function, so just call that
instead of rolling our own copy logic here. brcmf_pcie_init_ringbuffers
was already using it anyway.

Fixes: 9e37f045d5e7 ("brcmfmac: Adding PCIe bus layer support.")
Reviewed-by: Linus Walleij <linus.walleij@linaro.org>
Reviewed-by: Arend van Spriel <arend.vanspriel@broadcom.com>
Reviewed-by: Andy Shevchenko <andy.shevchenko@gmail.com>
Cc: stable@vger.kernel.org
Signed-off-by: Hector Martin <marcan@marcan.st>
Signed-off-by: Kalle Valo <kvalo@kernel.org>
Link: https://lore.kernel.org/r/20220131160713.245637-6-marcan@marcan.st

diff --git a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/pcie.c b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/pcie.c
index c399628..3f3ca76 100644 (file)
--- a/drivers/net/wireless/broadcom/brcm80211/brcmfmac/pcie.c
+++ b/drivers/net/wireless/broadcom/brcm80211/brcmfmac/pcie.c
@@ -12,6 +12,7 @@
 #include <linux/interrupt.h>
 #include <linux/bcma/bcma.h>
 #include <linux/sched.h>
+#include <linux/io.h>
 #include <asm/unaligned.h>
 
 #include <soc.h>
@@ -455,47 +456,6 @@ brcmf_pcie_write_ram32(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
 
 
 static void
-brcmf_pcie_copy_mem_todev(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
-                         void *srcaddr, u32 len)
-{
-       void __iomem *address = devinfo->tcm + mem_offset;
-       __le32 *src32;
-       __le16 *src16;
-       u8 *src8;
-
-       if (((ulong)address & 4) || ((ulong)srcaddr & 4) || (len & 4)) {
-               if (((ulong)address & 2) || ((ulong)srcaddr & 2) || (len & 2)) {
-                       src8 = (u8 *)srcaddr;
-                       while (len) {
-                               iowrite8(*src8, address);
-                               address++;
-                               src8++;
-                               len--;
-                       }
-               } else {
-                       len = len / 2;
-                       src16 = (__le16 *)srcaddr;
-                       while (len) {
-                               iowrite16(le16_to_cpu(*src16), address);
-                               address += 2;
-                               src16++;
-                               len--;
-                       }
-               }
-       } else {
-               len = len / 4;
-               src32 = (__le32 *)srcaddr;
-               while (len) {
-                       iowrite32(le32_to_cpu(*src32), address);
-                       address += 4;
-                       src32++;
-                       len--;
-               }
-       }
-}
-
-
-static void
 brcmf_pcie_copy_dev_tomem(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
                          void *dstaddr, u32 len)
 {
@@ -1570,8 +1530,8 @@ static int brcmf_pcie_download_fw_nvram(struct brcmf_pciedev_info *devinfo,
                return err;
 
        brcmf_dbg(PCIE, "Download FW %s\n", devinfo->fw_name);
-       brcmf_pcie_copy_mem_todev(devinfo, devinfo->ci->rambase,
-                                 (void *)fw->data, fw->size);
+       memcpy_toio(devinfo->tcm + devinfo->ci->rambase,
+                   (void *)fw->data, fw->size);
 
        resetintr = get_unaligned_le32(fw->data);
        release_firmware(fw);
@@ -1585,7 +1545,7 @@ static int brcmf_pcie_download_fw_nvram(struct brcmf_pciedev_info *devinfo,
                brcmf_dbg(PCIE, "Download NVRAM %s\n", devinfo->nvram_name);
                address = devinfo->ci->rambase + devinfo->ci->ramsize -
                          nvram_len;
-               brcmf_pcie_copy_mem_todev(devinfo, address, nvram, nvram_len);
+               memcpy_toio(devinfo->tcm + address, nvram, nvram_len);
                brcmf_fw_nvram_free(nvram);
        } else {
                brcmf_dbg(PCIE, "No matching NVRAM file found %s\n",