brcmfmac: pcie: Replace brcmf_pcie_copy_mem_todev with memcpy_toio
commit 9466987f246758eb7e9071ae58005253f631271e upstream.
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: 9e37f045d5
("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
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:

committed by
Greg Kroah-Hartman

parent
f3820ddaf4
commit
1cbcf93a93
@@ -12,6 +12,7 @@
|
|||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/bcma/bcma.h>
|
#include <linux/bcma/bcma.h>
|
||||||
#include <linux/sched.h>
|
#include <linux/sched.h>
|
||||||
|
#include <linux/io.h>
|
||||||
#include <asm/unaligned.h>
|
#include <asm/unaligned.h>
|
||||||
|
|
||||||
#include <soc.h>
|
#include <soc.h>
|
||||||
@@ -446,47 +447,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
|
static void
|
||||||
brcmf_pcie_copy_dev_tomem(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
|
brcmf_pcie_copy_dev_tomem(struct brcmf_pciedev_info *devinfo, u32 mem_offset,
|
||||||
void *dstaddr, u32 len)
|
void *dstaddr, u32 len)
|
||||||
@@ -1561,8 +1521,8 @@ static int brcmf_pcie_download_fw_nvram(struct brcmf_pciedev_info *devinfo,
|
|||||||
return err;
|
return err;
|
||||||
|
|
||||||
brcmf_dbg(PCIE, "Download FW %s\n", devinfo->fw_name);
|
brcmf_dbg(PCIE, "Download FW %s\n", devinfo->fw_name);
|
||||||
brcmf_pcie_copy_mem_todev(devinfo, devinfo->ci->rambase,
|
memcpy_toio(devinfo->tcm + devinfo->ci->rambase,
|
||||||
(void *)fw->data, fw->size);
|
(void *)fw->data, fw->size);
|
||||||
|
|
||||||
resetintr = get_unaligned_le32(fw->data);
|
resetintr = get_unaligned_le32(fw->data);
|
||||||
release_firmware(fw);
|
release_firmware(fw);
|
||||||
@@ -1576,7 +1536,7 @@ static int brcmf_pcie_download_fw_nvram(struct brcmf_pciedev_info *devinfo,
|
|||||||
brcmf_dbg(PCIE, "Download NVRAM %s\n", devinfo->nvram_name);
|
brcmf_dbg(PCIE, "Download NVRAM %s\n", devinfo->nvram_name);
|
||||||
address = devinfo->ci->rambase + devinfo->ci->ramsize -
|
address = devinfo->ci->rambase + devinfo->ci->ramsize -
|
||||||
nvram_len;
|
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);
|
brcmf_fw_nvram_free(nvram);
|
||||||
} else {
|
} else {
|
||||||
brcmf_dbg(PCIE, "No matching NVRAM file found %s\n",
|
brcmf_dbg(PCIE, "No matching NVRAM file found %s\n",
|
||||||
|
Reference in New Issue
Block a user