blob: f702c8949ec9781bfc8ce66c1d20fc887b741e70 [file] [log] [blame]
/*
* Linux OS Independent Layer
*
* Copyright (C) 1999-2018, Broadcom.
*
* Unless you and Broadcom execute a separate written software license
* agreement governing use of this software, this software is licensed to you
* under the terms of the GNU General Public License version 2 (the "GPL"),
* available at http://www.broadcom.com/licenses/GPLv2.php, with the
* following added to such license:
*
* As a special exception, the copyright holders of this software give you
* permission to link this software with independent modules, and to copy and
* distribute the resulting executable under terms of your choice, provided that
* you also meet, for each linked independent module, the terms and conditions of
* the license of that module. An independent module is a module which is not
* derived from this software. The special exception does not apply to any
* modifications of the software.
*
* Notwithstanding the above, under no circumstances may you combine this
* software in any way with any other Broadcom software provided under a license
* other than the GPL, without Broadcom's express prior written consent.
*
*
* <<Broadcom-WL-IPTag/Open:>>
*
* $Id: linux_osl.c 767848 2018-06-15 09:33:44Z $
*/
#define LINUX_PORT
#include <typedefs.h>
#include <bcmendian.h>
#include <linuxver.h>
#include <bcmdefs.h>
#if defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)
#include <asm/cacheflush.h>
#endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
#include <linux/random.h>
#include <osl.h>
#include <bcmutils.h>
#include <linux/delay.h>
#include <linux/vmalloc.h>
#include <pcicfg.h>
#ifdef BCM_SECURE_DMA
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/io.h>
#include <linux/printk.h>
#include <linux/errno.h>
#include <linux/mm.h>
#include <linux/moduleparam.h>
#include <asm/io.h>
#include <linux/skbuff.h>
#include <stbutils.h>
#include <linux/highmem.h>
#include <linux/dma-mapping.h>
#include <asm/memory.h>
#endif /* BCM_SECURE_DMA */
#include <linux/fs.h>
#if defined(STB)
#include <linux/spinlock.h>
extern spinlock_t l2x0_reg_lock;
#endif // endif
#ifdef BCM_OBJECT_TRACE
#include <bcmutils.h>
#endif /* BCM_OBJECT_TRACE */
#include "linux_osl_priv.h"
#define PCI_CFG_RETRY 10
#define DUMPBUFSZ 1024
#ifdef BCM_SECURE_DMA
static void * osl_sec_dma_ioremap(osl_t *osh, struct page *page, size_t size,
bool iscache, bool isdecr);
static void osl_sec_dma_iounmap(osl_t *osh, void *contig_base_va, size_t size);
static int osl_sec_dma_init_elem_mem_block(osl_t *osh, size_t mbsize, int max,
sec_mem_elem_t **list);
static void osl_sec_dma_deinit_elem_mem_block(osl_t *osh, size_t mbsize, int max,
void *sec_list_base);
static sec_mem_elem_t * osl_sec_dma_alloc_mem_elem(osl_t *osh, void *va, uint size,
int direction, struct sec_cma_info *ptr_cma_info, uint offset);
static void osl_sec_dma_free_mem_elem(osl_t *osh, sec_mem_elem_t *sec_mem_elem);
static void osl_sec_dma_init_consistent(osl_t *osh);
static void *osl_sec_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits,
ulong *pap);
static void osl_sec_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa);
#endif /* BCM_SECURE_DMA */
/* PCMCIA attribute space access macros */
uint32 g_assert_type = 0; /* By Default Kernel Panic */
module_param(g_assert_type, int, 0);
#ifdef BCM_SECURE_DMA
#define SECDMA_MODULE_PARAMS 0
#define SECDMA_EXT_FILE 1
unsigned long secdma_addr = 0;
unsigned long secdma_addr2 = 0;
u32 secdma_size = 0;
u32 secdma_size2 = 0;
module_param(secdma_addr, ulong, 0);
module_param(secdma_size, int, 0);
module_param(secdma_addr2, ulong, 0);
module_param(secdma_size2, int, 0);
static int secdma_found = 0;
#endif /* BCM_SECURE_DMA */
#ifdef USE_DMA_LOCK
static void osl_dma_lock(osl_t *osh);
static void osl_dma_unlock(osl_t *osh);
static void osl_dma_lock_init(osl_t *osh);
#define DMA_LOCK(osh) osl_dma_lock(osh)
#define DMA_UNLOCK(osh) osl_dma_unlock(osh)
#define DMA_LOCK_INIT(osh) osl_dma_lock_init(osh);
#else
#define DMA_LOCK(osh) do { /* noop */ } while(0)
#define DMA_UNLOCK(osh) do { /* noop */ } while(0)
#define DMA_LOCK_INIT(osh) do { /* noop */ } while(0)
#endif /* USE_DMA_LOCK */
static int16 linuxbcmerrormap[] =
{ 0, /* 0 */
-EINVAL, /* BCME_ERROR */
-EINVAL, /* BCME_BADARG */
-EINVAL, /* BCME_BADOPTION */
-EINVAL, /* BCME_NOTUP */
-EINVAL, /* BCME_NOTDOWN */
-EINVAL, /* BCME_NOTAP */
-EINVAL, /* BCME_NOTSTA */
-EINVAL, /* BCME_BADKEYIDX */
-EINVAL, /* BCME_RADIOOFF */
-EINVAL, /* BCME_NOTBANDLOCKED */
-EINVAL, /* BCME_NOCLK */
-EINVAL, /* BCME_BADRATESET */
-EINVAL, /* BCME_BADBAND */
-E2BIG, /* BCME_BUFTOOSHORT */
-E2BIG, /* BCME_BUFTOOLONG */
-EBUSY, /* BCME_BUSY */
-EINVAL, /* BCME_NOTASSOCIATED */
-EINVAL, /* BCME_BADSSIDLEN */
-EINVAL, /* BCME_OUTOFRANGECHAN */
-EINVAL, /* BCME_BADCHAN */
-EFAULT, /* BCME_BADADDR */
-ENOMEM, /* BCME_NORESOURCE */
-EOPNOTSUPP, /* BCME_UNSUPPORTED */
-EMSGSIZE, /* BCME_BADLENGTH */
-EINVAL, /* BCME_NOTREADY */
-EPERM, /* BCME_EPERM */
-ENOMEM, /* BCME_NOMEM */
-EINVAL, /* BCME_ASSOCIATED */
-ERANGE, /* BCME_RANGE */
-EINVAL, /* BCME_NOTFOUND */
-EINVAL, /* BCME_WME_NOT_ENABLED */
-EINVAL, /* BCME_TSPEC_NOTFOUND */
-EINVAL, /* BCME_ACM_NOTSUPPORTED */
-EINVAL, /* BCME_NOT_WME_ASSOCIATION */
-EIO, /* BCME_SDIO_ERROR */
-ENODEV, /* BCME_DONGLE_DOWN */
-EINVAL, /* BCME_VERSION */
-EIO, /* BCME_TXFAIL */
-EIO, /* BCME_RXFAIL */
-ENODEV, /* BCME_NODEVICE */
-EINVAL, /* BCME_NMODE_DISABLED */
-ENODATA, /* BCME_NONRESIDENT */
-EINVAL, /* BCME_SCANREJECT */
-EINVAL, /* BCME_USAGE_ERROR */
-EIO, /* BCME_IOCTL_ERROR */
-EIO, /* BCME_SERIAL_PORT_ERR */
-EOPNOTSUPP, /* BCME_DISABLED, BCME_NOTENABLED */
-EIO, /* BCME_DECERR */
-EIO, /* BCME_ENCERR */
-EIO, /* BCME_MICERR */
-ERANGE, /* BCME_REPLAY */
-EINVAL, /* BCME_IE_NOTFOUND */
-EINVAL, /* BCME_DATA_NOTFOUND */
-EINVAL, /* BCME_NOT_GC */
-EINVAL, /* BCME_PRS_REQ_FAILED */
-EINVAL, /* BCME_NO_P2P_SE */
-EINVAL, /* BCME_NOA_PND */
-EINVAL, /* BCME_FRAG_Q_FAILED */
-EINVAL, /* BCME_GET_AF_FAILED */
-EINVAL, /* BCME_MSCH_NOTREADY */
-EINVAL, /* BCME_IOV_LAST_CMD */
-EINVAL, /* BCME_MINIPMU_CAL_FAIL */
-EINVAL, /* BCME_RCAL_FAIL */
-EINVAL, /* BCME_LPF_RCCAL_FAIL */
-EINVAL, /* BCME_DACBUF_RCCAL_FAIL */
-EINVAL, /* BCME_VCOCAL_FAIL */
-EINVAL, /* BCME_BANDLOCKED */
-EINVAL, /* BCME_DNGL_DEVRESET */
/* When an new error code is added to bcmutils.h, add os
* specific error translation here as well
*/
/* check if BCME_LAST changed since the last time this function was updated */
#if BCME_LAST != -68
#error "You need to add a OS error translation in the linuxbcmerrormap \
for new error code defined in bcmutils.h"
#endif // endif
};
uint lmtest = FALSE;
#ifdef DHD_MAP_LOGGING
#define DHD_MAP_LOG_SIZE 2048
typedef struct dhd_map_record {
dma_addr_t addr;
uint64 time;
} dhd_map_log_t;
dhd_map_log_t *dhd_map_log = NULL, *dhd_unmap_log = NULL;
uint32 map_idx = 0, unmap_idx = 0;
void
osl_dma_map_dump(void)
{
printk("%s: map_idx=%d unmap_idx=%d current time=%llu\n",
__FUNCTION__, map_idx, unmap_idx, OSL_SYSUPTIME_US());
if (dhd_map_log && dhd_unmap_log) {
printk("%s: dhd_map_log(pa)=%llx size=%d, dma_unmap_log(pa)=%llx size=%d\n",
__FUNCTION__, (uint64)__virt_to_phys((ulong)dhd_map_log),
(uint32)(sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE),
(uint64)__virt_to_phys((ulong)dhd_unmap_log),
(uint32)(sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE));
}
}
#endif /* DHD_MAP_LOGGING */
/* translate bcmerrors into linux errors */
int
osl_error(int bcmerror)
{
if (bcmerror > 0)
bcmerror = 0;
else if (bcmerror < BCME_LAST)
bcmerror = BCME_ERROR;
/* Array bounds covered by ASSERT in osl_attach */
return linuxbcmerrormap[-bcmerror];
}
osl_t *
osl_attach(void *pdev, uint bustype, bool pkttag)
{
void **osl_cmn = NULL;
osl_t *osh;
gfp_t flags;
#ifdef BCM_SECURE_DMA
u32 secdma_memsize;
#endif // endif
flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
if (!(osh = kmalloc(sizeof(osl_t), flags)))
return osh;
ASSERT(osh);
bzero(osh, sizeof(osl_t));
if (osl_cmn == NULL || *osl_cmn == NULL) {
if (!(osh->cmn = kmalloc(sizeof(osl_cmn_t), flags))) {
kfree(osh);
return NULL;
}
bzero(osh->cmn, sizeof(osl_cmn_t));
if (osl_cmn)
*osl_cmn = osh->cmn;
atomic_set(&osh->cmn->malloced, 0);
osh->cmn->dbgmem_list = NULL;
spin_lock_init(&(osh->cmn->dbgmem_lock));
spin_lock_init(&(osh->cmn->pktalloc_lock));
} else {
osh->cmn = *osl_cmn;
}
atomic_add(1, &osh->cmn->refcount);
bcm_object_trace_init();
/* Check that error map has the right number of entries in it */
ASSERT(ABS(BCME_LAST) == (ARRAYSIZE(linuxbcmerrormap) - 1));
osh->failed = 0;
osh->pdev = pdev;
osh->pub.pkttag = pkttag;
osh->bustype = bustype;
osh->magic = OS_HANDLE_MAGIC;
#ifdef BCM_SECURE_DMA
if ((secdma_addr != 0) && (secdma_size != 0)) {
printk("linux_osl.c: Buffer info passed via module params, using it.\n");
if (secdma_found == 0) {
osh->contig_base_alloc = (phys_addr_t)secdma_addr;
secdma_memsize = secdma_size;
} else if (secdma_found == 1) {
osh->contig_base_alloc = (phys_addr_t)secdma_addr2;
secdma_memsize = secdma_size2;
} else {
printk("linux_osl.c secdma: secDMA instances %d \n", secdma_found);
kfree(osh);
return NULL;
}
osh->contig_base = (phys_addr_t)osh->contig_base_alloc;
printf("linux_osl.c: secdma_cma_size = 0x%x\n", secdma_memsize);
printf("linux_osl.c: secdma_cma_addr = 0x%x \n",
(unsigned int)osh->contig_base_alloc);
osh->stb_ext_params = SECDMA_MODULE_PARAMS;
}
else if (stbpriv_init(osh) == 0) {
printk("linux_osl.c: stbpriv.txt found. Get buffer info.\n");
if (secdma_found == 0) {
osh->contig_base_alloc =
(phys_addr_t)bcm_strtoul(stbparam_get("secdma_cma_addr"), NULL, 0);
secdma_memsize = bcm_strtoul(stbparam_get("secdma_cma_size"), NULL, 0);
} else if (secdma_found == 1) {
osh->contig_base_alloc =
(phys_addr_t)bcm_strtoul(stbparam_get("secdma_cma_addr2"), NULL, 0);
secdma_memsize = bcm_strtoul(stbparam_get("secdma_cma_size2"), NULL, 0);
} else {
printk("linux_osl.c secdma: secDMA instances %d \n", secdma_found);
kfree(osh);
return NULL;
}
osh->contig_base = (phys_addr_t)osh->contig_base_alloc;
printf("linux_osl.c: secdma_cma_size = 0x%x\n", secdma_memsize);
printf("linux_osl.c: secdma_cma_addr = 0x%x \n",
(unsigned int)osh->contig_base_alloc);
osh->stb_ext_params = SECDMA_EXT_FILE;
}
else {
printk("linux_osl.c: secDMA no longer supports internal buffer allocation.\n");
kfree(osh);
return NULL;
}
secdma_found++;
osh->contig_base_alloc_coherent_va = osl_sec_dma_ioremap(osh,
phys_to_page((u32)osh->contig_base_alloc),
CMA_DMA_DESC_MEMBLOCK, FALSE, TRUE);
if (osh->contig_base_alloc_coherent_va == NULL) {
if (osh->cmn)
kfree(osh->cmn);
kfree(osh);
return NULL;
}
osh->contig_base_coherent_va = osh->contig_base_alloc_coherent_va;
osh->contig_base_alloc_coherent = osh->contig_base_alloc;
osl_sec_dma_init_consistent(osh);
osh->contig_base_alloc += CMA_DMA_DESC_MEMBLOCK;
osh->contig_base_alloc_va = osl_sec_dma_ioremap(osh,
phys_to_page((u32)osh->contig_base_alloc), CMA_DMA_DATA_MEMBLOCK, TRUE, FALSE);
if (osh->contig_base_alloc_va == NULL) {
osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
if (osh->cmn)
kfree(osh->cmn);
kfree(osh);
return NULL;
}
osh->contig_base_va = osh->contig_base_alloc_va;
#ifdef NOT_YET
/*
* osl_sec_dma_init_elem_mem_block(osh, CMA_BUFSIZE_512, CMA_BUFNUM, &osh->sec_list_512);
* osh->sec_list_base_512 = osh->sec_list_512;
* osl_sec_dma_init_elem_mem_block(osh, CMA_BUFSIZE_2K, CMA_BUFNUM, &osh->sec_list_2048);
* osh->sec_list_base_2048 = osh->sec_list_2048;
*/
#endif // endif
if (BCME_OK != osl_sec_dma_init_elem_mem_block(osh,
CMA_BUFSIZE_4K, CMA_BUFNUM, &osh->sec_list_4096)) {
osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
osl_sec_dma_iounmap(osh, osh->contig_base_va, CMA_DMA_DATA_MEMBLOCK);
if (osh->cmn)
kfree(osh->cmn);
kfree(osh);
return NULL;
}
osh->sec_list_base_4096 = osh->sec_list_4096;
#endif /* BCM_SECURE_DMA */
switch (bustype) {
case PCI_BUS:
case SI_BUS:
case PCMCIA_BUS:
osh->pub.mmbus = TRUE;
break;
case JTAG_BUS:
case SDIO_BUS:
case USB_BUS:
case SPI_BUS:
case RPC_BUS:
osh->pub.mmbus = FALSE;
break;
default:
ASSERT(FALSE);
break;
}
DMA_LOCK_INIT(osh);
#ifdef DHD_MAP_LOGGING
dhd_map_log = kmalloc(sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE, flags);
if (dhd_map_log) {
memset(dhd_map_log, 0, sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE);
}
dhd_unmap_log = kmalloc(sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE, flags);
if (dhd_unmap_log) {
memset(dhd_unmap_log, 0, sizeof(dhd_map_log_t) * DHD_MAP_LOG_SIZE);
}
#endif /* DHD_MAP_LOGGING */
return osh;
}
void osl_set_bus_handle(osl_t *osh, void *bus_handle)
{
osh->bus_handle = bus_handle;
}
void* osl_get_bus_handle(osl_t *osh)
{
return osh->bus_handle;
}
#if defined(BCM_BACKPLANE_TIMEOUT)
void osl_set_bpt_cb(osl_t *osh, void *bpt_cb, void *bpt_ctx)
{
if (osh) {
osh->bpt_cb = (bpt_cb_fn)bpt_cb;
osh->sih = bpt_ctx;
}
}
#endif /* BCM_BACKPLANE_TIMEOUT */
void
osl_detach(osl_t *osh)
{
if (osh == NULL)
return;
#ifdef BCM_SECURE_DMA
if (osh->stb_ext_params == SECDMA_EXT_FILE)
stbpriv_exit(osh);
#ifdef NOT_YET
osl_sec_dma_deinit_elem_mem_block(osh, CMA_BUFSIZE_512, CMA_BUFNUM, osh->sec_list_base_512);
osl_sec_dma_deinit_elem_mem_block(osh, CMA_BUFSIZE_2K, CMA_BUFNUM, osh->sec_list_base_2048);
#endif /* NOT_YET */
osl_sec_dma_deinit_elem_mem_block(osh, CMA_BUFSIZE_4K, CMA_BUFNUM, osh->sec_list_base_4096);
osl_sec_dma_iounmap(osh, osh->contig_base_coherent_va, CMA_DMA_DESC_MEMBLOCK);
osl_sec_dma_iounmap(osh, osh->contig_base_va, CMA_DMA_DATA_MEMBLOCK);
secdma_found--;
#endif /* BCM_SECURE_DMA */
bcm_object_trace_deinit();
#ifdef DHD_MAP_LOGGING
if (dhd_map_log) {
kfree(dhd_map_log);
}
if (dhd_unmap_log) {
kfree(dhd_unmap_log);
}
#endif /* DHD_MAP_LOGGING */
ASSERT(osh->magic == OS_HANDLE_MAGIC);
atomic_sub(1, &osh->cmn->refcount);
if (atomic_read(&osh->cmn->refcount) == 0) {
kfree(osh->cmn);
}
kfree(osh);
}
/* APIs to set/get specific quirks in OSL layer */
void BCMFASTPATH
osl_flag_set(osl_t *osh, uint32 mask)
{
osh->flags |= mask;
}
void
osl_flag_clr(osl_t *osh, uint32 mask)
{
osh->flags &= ~mask;
}
#if defined(STB)
inline bool BCMFASTPATH
#else
bool
#endif // endif
osl_is_flag_set(osl_t *osh, uint32 mask)
{
return (osh->flags & mask);
}
#if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
defined(STB_SOC_WIFI)
inline int BCMFASTPATH
osl_arch_is_coherent(void)
{
return 0;
}
inline int BCMFASTPATH
osl_acp_war_enab(void)
{
return 0;
}
inline void BCMFASTPATH
osl_cache_flush(void *va, uint size)
{
if (size > 0)
#ifdef STB_SOC_WIFI
dma_sync_single_for_device(OSH_NULL, virt_to_phys(va), size, DMA_TX);
#else /* STB_SOC_WIFI */
dma_sync_single_for_device(OSH_NULL, virt_to_dma(OSH_NULL, va), size,
DMA_TO_DEVICE);
#endif /* STB_SOC_WIFI */
}
inline void BCMFASTPATH
osl_cache_inv(void *va, uint size)
{
#ifdef STB_SOC_WIFI
dma_sync_single_for_cpu(OSH_NULL, virt_to_phys(va), size, DMA_RX);
#else /* STB_SOC_WIFI */
dma_sync_single_for_cpu(OSH_NULL, virt_to_dma(OSH_NULL, va), size, DMA_FROM_DEVICE);
#endif /* STB_SOC_WIFI */
}
inline void BCMFASTPATH
osl_prefetch(const void *ptr)
{
#if !defined(STB_SOC_WIFI)
__asm__ __volatile__("pld\t%0" :: "o"(*(const char *)ptr) : "cc");
#endif // endif
}
#endif // endif
uint32
osl_pci_read_config(osl_t *osh, uint offset, uint size)
{
uint val = 0;
uint retry = PCI_CFG_RETRY;
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
/* only 4byte access supported */
ASSERT(size == 4);
do {
pci_read_config_dword(osh->pdev, offset, &val);
if (val != 0xffffffff)
break;
} while (retry--);
return (val);
}
void
osl_pci_write_config(osl_t *osh, uint offset, uint size, uint val)
{
uint retry = PCI_CFG_RETRY;
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
/* only 4byte access supported */
ASSERT(size == 4);
do {
pci_write_config_dword(osh->pdev, offset, val);
if (offset != PCI_BAR0_WIN)
break;
if (osl_pci_read_config(osh, offset, size) == val)
break;
} while (retry--);
}
/* return bus # for the pci device pointed by osh->pdev */
uint
osl_pci_bus(osl_t *osh)
{
ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
#if defined(__ARM_ARCH_7A__) && LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)
return pci_domain_nr(((struct pci_dev *)osh->pdev)->bus);
#else
return ((struct pci_dev *)osh->pdev)->bus->number;
#endif // endif
}
/* return slot # for the pci device pointed by osh->pdev */
uint
osl_pci_slot(osl_t *osh)
{
ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
#if defined(__ARM_ARCH_7A__) && LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)
return PCI_SLOT(((struct pci_dev *)osh->pdev)->devfn) + 1;
#else
return PCI_SLOT(((struct pci_dev *)osh->pdev)->devfn);
#endif // endif
}
/* return domain # for the pci device pointed by osh->pdev */
uint
osl_pcie_domain(osl_t *osh)
{
ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
return pci_domain_nr(((struct pci_dev *)osh->pdev)->bus);
}
/* return bus # for the pci device pointed by osh->pdev */
uint
osl_pcie_bus(osl_t *osh)
{
ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
return ((struct pci_dev *)osh->pdev)->bus->number;
}
/* return the pci device pointed by osh->pdev */
struct pci_dev *
osl_pci_device(osl_t *osh)
{
ASSERT(osh && (osh->magic == OS_HANDLE_MAGIC) && osh->pdev);
return osh->pdev;
}
static void
osl_pcmcia_attr(osl_t *osh, uint offset, char *buf, int size, bool write)
{
}
void
osl_pcmcia_read_attr(osl_t *osh, uint offset, void *buf, int size)
{
osl_pcmcia_attr(osh, offset, (char *) buf, size, FALSE);
}
void
osl_pcmcia_write_attr(osl_t *osh, uint offset, void *buf, int size)
{
osl_pcmcia_attr(osh, offset, (char *) buf, size, TRUE);
}
void *
osl_malloc(osl_t *osh, uint size)
{
void *addr;
gfp_t flags;
/* only ASSERT if osh is defined */
if (osh)
ASSERT(osh->magic == OS_HANDLE_MAGIC);
#ifdef CONFIG_DHD_USE_STATIC_BUF
if (bcm_static_buf)
{
unsigned long irq_flags;
int i = 0;
if ((size >= PAGE_SIZE)&&(size <= STATIC_BUF_SIZE))
{
spin_lock_irqsave(&bcm_static_buf->static_lock, irq_flags);
for (i = 0; i < STATIC_BUF_MAX_NUM; i++)
{
if (bcm_static_buf->buf_use[i] == 0)
break;
}
if (i == STATIC_BUF_MAX_NUM)
{
spin_unlock_irqrestore(&bcm_static_buf->static_lock, irq_flags);
printk("all static buff in use!\n");
goto original;
}
bcm_static_buf->buf_use[i] = 1;
spin_unlock_irqrestore(&bcm_static_buf->static_lock, irq_flags);
bzero(bcm_static_buf->buf_ptr+STATIC_BUF_SIZE*i, size);
if (osh)
atomic_add(size, &osh->cmn->malloced);
return ((void *)(bcm_static_buf->buf_ptr+STATIC_BUF_SIZE*i));
}
}
original:
#endif /* CONFIG_DHD_USE_STATIC_BUF */
flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
if ((addr = kmalloc(size, flags)) == NULL) {
if (osh)
osh->failed++;
return (NULL);
}
if (osh && osh->cmn)
atomic_add(size, &osh->cmn->malloced);
return (addr);
}
void *
osl_mallocz(osl_t *osh, uint size)
{
void *ptr;
ptr = osl_malloc(osh, size);
if (ptr != NULL) {
bzero(ptr, size);
}
return ptr;
}
void
osl_mfree(osl_t *osh, void *addr, uint size)
{
#ifdef CONFIG_DHD_USE_STATIC_BUF
unsigned long flags;
if (bcm_static_buf)
{
if ((addr > (void *)bcm_static_buf) && ((unsigned char *)addr
<= ((unsigned char *)bcm_static_buf + STATIC_BUF_TOTAL_LEN)))
{
int buf_idx = 0;
buf_idx = ((unsigned char *)addr - bcm_static_buf->buf_ptr)/STATIC_BUF_SIZE;
spin_lock_irqsave(&bcm_static_buf->static_lock, flags);
bcm_static_buf->buf_use[buf_idx] = 0;
spin_unlock_irqrestore(&bcm_static_buf->static_lock, flags);
if (osh && osh->cmn) {
ASSERT(osh->magic == OS_HANDLE_MAGIC);
atomic_sub(size, &osh->cmn->malloced);
}
return;
}
}
#endif /* CONFIG_DHD_USE_STATIC_BUF */
if (osh && osh->cmn) {
ASSERT(osh->magic == OS_HANDLE_MAGIC);
ASSERT(size <= osl_malloced(osh));
atomic_sub(size, &osh->cmn->malloced);
}
kfree(addr);
}
void *
osl_vmalloc(osl_t *osh, uint size)
{
void *addr;
/* only ASSERT if osh is defined */
if (osh)
ASSERT(osh->magic == OS_HANDLE_MAGIC);
if ((addr = vmalloc(size)) == NULL) {
if (osh)
osh->failed++;
return (NULL);
}
if (osh && osh->cmn)
atomic_add(size, &osh->cmn->malloced);
return (addr);
}
void *
osl_vmallocz(osl_t *osh, uint size)
{
void *ptr;
ptr = osl_vmalloc(osh, size);
if (ptr != NULL) {
bzero(ptr, size);
}
return ptr;
}
void
osl_vmfree(osl_t *osh, void *addr, uint size)
{
if (osh && osh->cmn) {
ASSERT(osh->magic == OS_HANDLE_MAGIC);
ASSERT(size <= osl_malloced(osh));
atomic_sub(size, &osh->cmn->malloced);
}
vfree(addr);
}
uint
osl_check_memleak(osl_t *osh)
{
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
if (atomic_read(&osh->cmn->refcount) == 1)
return (atomic_read(&osh->cmn->malloced));
else
return 0;
}
uint
osl_malloced(osl_t *osh)
{
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
return (atomic_read(&osh->cmn->malloced));
}
uint
osl_malloc_failed(osl_t *osh)
{
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
return (osh->failed);
}
uint
osl_dma_consistent_align(void)
{
return (PAGE_SIZE);
}
void*
osl_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits, uint *alloced, dmaaddr_t *pap)
{
void *va;
uint16 align = (1 << align_bits);
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
if (!ISALIGNED(DMA_CONSISTENT_ALIGN, align))
size += align;
*alloced = size;
#ifndef BCM_SECURE_DMA
#if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
defined(STB_SOC_WIFI)
va = kmalloc(size, GFP_ATOMIC | __GFP_ZERO);
if (va)
*pap = (ulong)__virt_to_phys((ulong)va);
#else
{
dma_addr_t pap_lin;
struct pci_dev *hwdev = osh->pdev;
gfp_t flags;
#ifdef DHD_ALLOC_COHERENT_MEM_FROM_ATOMIC_POOL
flags = GFP_ATOMIC;
#else
flags = CAN_SLEEP() ? GFP_KERNEL: GFP_ATOMIC;
#endif /* DHD_ALLOC_COHERENT_MEM_FROM_ATOMIC_POOL */
va = dma_alloc_coherent(&hwdev->dev, size, &pap_lin, flags);
#ifdef BCMDMA64OSL
PHYSADDRLOSET(*pap, pap_lin & 0xffffffff);
PHYSADDRHISET(*pap, (pap_lin >> 32) & 0xffffffff);
#else
*pap = (dmaaddr_t)pap_lin;
#endif /* BCMDMA64OSL */
}
#endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
#else
va = osl_sec_dma_alloc_consistent(osh, size, align_bits, pap);
#endif /* BCM_SECURE_DMA */
return va;
}
void
osl_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa)
{
#ifdef BCMDMA64OSL
dma_addr_t paddr;
#endif /* BCMDMA64OSL */
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
#ifndef BCM_SECURE_DMA
#if (defined(__ARM_ARCH_7A__) && !defined(DHD_USE_COHERENT_MEM_FOR_RING)) || \
defined(STB_SOC_WIFI)
kfree(va);
#else
#ifdef BCMDMA64OSL
PHYSADDRTOULONG(pa, paddr);
pci_free_consistent(osh->pdev, size, va, paddr);
#else
pci_free_consistent(osh->pdev, size, va, (dma_addr_t)pa);
#endif /* BCMDMA64OSL */
#endif /* __ARM_ARCH_7A__ && !DHD_USE_COHERENT_MEM_FOR_RING */
#else
osl_sec_dma_free_consistent(osh, va, size, pa);
#endif /* BCM_SECURE_DMA */
}
void *
osl_virt_to_phys(void *va)
{
return (void *)(uintptr)virt_to_phys(va);
}
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)
#include <asm/cacheflush.h>
void BCMFASTPATH
osl_dma_flush(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *dmah)
{
return;
}
#endif /* LINUX_VERSION_CODE >= 2.6.36 */
dmaaddr_t BCMFASTPATH
osl_dma_map(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *dmah)
{
int dir;
dmaaddr_t ret_addr;
dma_addr_t map_addr;
int ret;
DMA_LOCK(osh);
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
#ifdef STB_SOC_WIFI
#if (__LINUX_ARM_ARCH__ == 8)
/* need to flush or invalidate the cache here */
if (dir == DMA_TX) { /* to device */
osl_cache_flush(va, size);
} else if (dir == DMA_RX) { /* from device */
osl_cache_inv(va, size);
} else { /* both */
osl_cache_flush(va, size);
osl_cache_inv(va, size);
}
DMA_UNLOCK(osh);
return virt_to_phys(va);
#else /* (__LINUX_ARM_ARCH__ == 8) */
map_addr = dma_map_single(osh->pdev, va, size, dir);
DMA_UNLOCK(osh);
return map_addr;
#endif /* (__LINUX_ARM_ARCH__ == 8) */
#else /* ! STB_SOC_WIFI */
map_addr = pci_map_single(osh->pdev, va, size, dir);
#endif /* ! STB_SOC_WIFI */
#ifdef DHD_MAP_LOGGING
if (dhd_map_log) {
dhd_map_log[map_idx].addr = map_addr;
dhd_map_log[map_idx].time = OSL_SYSUPTIME_US();
map_idx++;
map_idx = map_idx % DHD_MAP_LOG_SIZE;
}
#endif /* DHD_MAP_LOGGING */
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 27))
ret = pci_dma_mapping_error(osh->pdev, map_addr);
#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 5))
ret = pci_dma_mapping_error(map_addr);
#else
ret = 0;
#endif // endif
if (ret) {
printk("%s: Failed to map memory\n", __FUNCTION__);
PHYSADDRLOSET(ret_addr, 0);
PHYSADDRHISET(ret_addr, 0);
} else {
PHYSADDRLOSET(ret_addr, map_addr & 0xffffffff);
PHYSADDRHISET(ret_addr, (map_addr >> 32) & 0xffffffff);
}
DMA_UNLOCK(osh);
return ret_addr;
}
void BCMFASTPATH
osl_dma_unmap(osl_t *osh, dmaaddr_t pa, uint size, int direction)
{
int dir;
#ifdef BCMDMA64OSL
dma_addr_t paddr;
#endif /* BCMDMA64OSL */
ASSERT((osh && (osh->magic == OS_HANDLE_MAGIC)));
DMA_LOCK(osh);
dir = (direction == DMA_TX)? PCI_DMA_TODEVICE: PCI_DMA_FROMDEVICE;
#ifdef BCMDMA64OSL
PHYSADDRTOULONG(pa, paddr);
#ifdef DHD_MAP_LOGGING
if (dhd_unmap_log) {
dhd_unmap_log[unmap_idx].addr = paddr;
dhd_unmap_log[unmap_idx].time = OSL_SYSUPTIME_US();
unmap_idx++;
unmap_idx = unmap_idx % DHD_MAP_LOG_SIZE;
}
#endif /* DHD_MAP_LOGGING */
pci_unmap_single(osh->pdev, paddr, size, dir);
#else /* BCMDMA64OSL */
#ifdef STB_SOC_WIFI
#if (__LINUX_ARM_ARCH__ == 8)
if (dir == DMA_TX) { /* to device */
dma_sync_single_for_device(OSH_NULL, pa, size, DMA_TX);
} else if (dir == DMA_RX) { /* from device */
dma_sync_single_for_cpu(OSH_NULL, pa, size, DMA_RX);
} else { /* both */
dma_sync_single_for_device(OSH_NULL, pa, size, DMA_TX);
dma_sync_single_for_cpu(OSH_NULL, pa, size, DMA_RX);
}
#else /* (__LINUX_ARM_ARCH__ == 8) */
dma_unmap_single(osh->pdev, (uintptr)pa, size, dir);
#endif /* (__LINUX_ARM_ARCH__ == 8) */
#else /* STB_SOC_WIFI */
#ifdef DHD_MAP_LOGGING
if (dhd_unmap_log) {
dhd_unmap_log[unmap_idx].addr = pa;
dhd_unmap_log[unmap_idx].time = OSL_SYSUPTIME_US();
unmap_idx++;
unmap_idx = unmap_idx % DHD_MAP_LOG_SIZE;
}
#endif /* DHD_MAP_LOGGING */
pci_unmap_single(osh->pdev, (uint32)pa, size, dir);
#endif /* STB_SOC_WIFI */
#endif /* BCMDMA64OSL */
DMA_UNLOCK(osh);
}
/* OSL function for CPU relax */
inline void BCMFASTPATH
osl_cpu_relax(void)
{
cpu_relax();
}
extern void osl_preempt_disable(osl_t *osh)
{
preempt_disable();
}
extern void osl_preempt_enable(osl_t *osh)
{
preempt_enable();
}
#if defined(BCMASSERT_LOG)
void
osl_assert(const char *exp, const char *file, int line)
{
char tempbuf[256];
const char *basename;
basename = strrchr(file, '/');
/* skip the '/' */
if (basename)
basename++;
if (!basename)
basename = file;
#ifdef BCMASSERT_LOG
snprintf(tempbuf, 64, "\"%s\": file \"%s\", line %d\n",
exp, basename, line);
#endif /* BCMASSERT_LOG */
switch (g_assert_type) {
case 0:
panic("%s", tempbuf);
break;
case 1:
/* fall through */
case 3:
printk("%s", tempbuf);
break;
case 2:
printk("%s", tempbuf);
BUG();
break;
default:
break;
}
}
#endif // endif
void
osl_delay(uint usec)
{
uint d;
while (usec > 0) {
d = MIN(usec, 1000);
udelay(d);
usec -= d;
}
}
void
osl_sleep(uint ms)
{
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)
if (ms < 20)
usleep_range(ms*1000, ms*1000 + 1000);
else
#endif // endif
msleep(ms);
}
uint64
osl_sysuptime_us(void)
{
struct timeval tv;
uint64 usec;
do_gettimeofday(&tv);
/* tv_usec content is fraction of a second */
usec = (uint64)tv.tv_sec * 1000000ul + tv.tv_usec;
return usec;
}
/*
* OSLREGOPS specifies the use of osl_XXX routines to be used for register access
*/
/*
* BINOSL selects the slightly slower function-call-based binary compatible osl.
*/
uint32
osl_rand(void)
{
uint32 rand;
get_random_bytes(&rand, sizeof(rand));
return rand;
}
/* Linux Kernel: File Operations: start */
void *
osl_os_open_image(char *filename)
{
struct file *fp;
fp = filp_open(filename, O_RDONLY, 0);
/*
* 2.6.11 (FC4) supports filp_open() but later revs don't?
* Alternative:
* fp = open_namei(AT_FDCWD, filename, O_RD, 0);
* ???
*/
if (IS_ERR(fp))
fp = NULL;
return fp;
}
int
osl_os_get_image_block(char *buf, int len, void *image)
{
struct file *fp = (struct file *)image;
int rdlen;
if (!image)
return 0;
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0))
rdlen = kernel_read(fp, buf, len, &fp->f_pos);
#else
rdlen = kernel_read(fp, fp->f_pos, buf, len);
#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) */
if (rdlen > 0)
fp->f_pos += rdlen;
return rdlen;
}
void
osl_os_close_image(void *image)
{
if (image)
filp_close((struct file *)image, NULL);
}
int
osl_os_image_size(void *image)
{
int len = 0, curroffset;
if (image) {
/* store the current offset */
curroffset = generic_file_llseek(image, 0, 1);
/* goto end of file to get length */
len = generic_file_llseek(image, 0, 2);
/* restore back the offset */
generic_file_llseek(image, curroffset, 0);
}
return len;
}
/* Linux Kernel: File Operations: end */
#if (defined(STB) && defined(__arm__))
inline void osl_pcie_rreg(osl_t *osh, ulong addr, volatile void *v, uint size)
{
unsigned long flags = 0;
int pci_access = 0;
int acp_war_enab = ACP_WAR_ENAB();
if (osh && BUSTYPE(osh->bustype) == PCI_BUS)
pci_access = 1;
if (pci_access && acp_war_enab)
spin_lock_irqsave(&l2x0_reg_lock, flags);
switch (size) {
case sizeof(uint8):
*(volatile uint8*)v = readb((volatile uint8*)(addr));
break;
case sizeof(uint16):
*(volatile uint16*)v = readw((volatile uint16*)(addr));
break;
case sizeof(uint32):
*(volatile uint32*)v = readl((volatile uint32*)(addr));
break;
case sizeof(uint64):
*(volatile uint64*)v = *((volatile uint64*)(addr));
break;
}
if (pci_access && acp_war_enab)
spin_unlock_irqrestore(&l2x0_reg_lock, flags);
}
#endif // endif
#if defined(BCM_BACKPLANE_TIMEOUT)
inline void osl_bpt_rreg(osl_t *osh, ulong addr, volatile void *v, uint size)
{
bool poll_timeout = FALSE;
static int in_si_clear = FALSE;
switch (size) {
case sizeof(uint8):
*(volatile uint8*)v = readb((volatile uint8*)(addr));
if (*(volatile uint8*)v == 0xff)
poll_timeout = TRUE;
break;
case sizeof(uint16):
*(volatile uint16*)v = readw((volatile uint16*)(addr));
if (*(volatile uint16*)v == 0xffff)
poll_timeout = TRUE;
break;
case sizeof(uint32):
*(volatile uint32*)v = readl((volatile uint32*)(addr));
if (*(volatile uint32*)v == 0xffffffff)
poll_timeout = TRUE;
break;
case sizeof(uint64):
*(volatile uint64*)v = *((volatile uint64*)(addr));
if (*(volatile uint64*)v == 0xffffffffffffffff)
poll_timeout = TRUE;
break;
}
if (osh && osh->sih && (in_si_clear == FALSE) && poll_timeout && osh->bpt_cb) {
in_si_clear = TRUE;
osh->bpt_cb((void *)osh->sih, (void *)addr);
in_si_clear = FALSE;
}
}
#endif /* BCM_BACKPLANE_TIMEOUT */
#ifdef BCM_SECURE_DMA
static void *
osl_sec_dma_ioremap(osl_t *osh, struct page *page, size_t size, bool iscache, bool isdecr)
{
struct page **map;
int order, i;
void *addr = NULL;
size = PAGE_ALIGN(size);
order = get_order(size);
map = kmalloc(sizeof(struct page *) << order, GFP_ATOMIC);
if (map == NULL)
return NULL;
for (i = 0; i < (size >> PAGE_SHIFT); i++)
map[i] = page + i;
if (iscache) {
addr = vmap(map, size >> PAGE_SHIFT, VM_MAP, __pgprot(PAGE_KERNEL));
if (isdecr) {
osh->contig_delta_va_pa = ((uint8 *)addr - page_to_phys(page));
}
} else {
#if defined(__ARM_ARCH_7A__)
addr = vmap(map, size >> PAGE_SHIFT, VM_MAP,
pgprot_noncached(__pgprot(PAGE_KERNEL)));
#endif // endif
if (isdecr) {
osh->contig_delta_va_pa = ((uint8 *)addr - page_to_phys(page));
}
}
kfree(map);
return (void *)addr;
}
static void
osl_sec_dma_iounmap(osl_t *osh, void *contig_base_va, size_t size)
{
vunmap(contig_base_va);
}
static int
osl_sec_dma_init_elem_mem_block(osl_t *osh, size_t mbsize, int max, sec_mem_elem_t **list)
{
int i;
int ret = BCME_OK;
sec_mem_elem_t *sec_mem_elem;
if ((sec_mem_elem = kmalloc(sizeof(sec_mem_elem_t)*(max), GFP_ATOMIC)) != NULL) {
*list = sec_mem_elem;
bzero(sec_mem_elem, sizeof(sec_mem_elem_t)*(max));
for (i = 0; i < max-1; i++) {
sec_mem_elem->next = (sec_mem_elem + 1);
sec_mem_elem->size = mbsize;
sec_mem_elem->pa_cma = osh->contig_base_alloc;
sec_mem_elem->vac = osh->contig_base_alloc_va;
sec_mem_elem->pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
osh->contig_base_alloc += mbsize;
osh->contig_base_alloc_va = ((uint8 *)osh->contig_base_alloc_va + mbsize);
sec_mem_elem = sec_mem_elem + 1;
}
sec_mem_elem->next = NULL;
sec_mem_elem->size = mbsize;
sec_mem_elem->pa_cma = osh->contig_base_alloc;
sec_mem_elem->vac = osh->contig_base_alloc_va;
sec_mem_elem->pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
osh->contig_base_alloc += mbsize;
osh->contig_base_alloc_va = ((uint8 *)osh->contig_base_alloc_va + mbsize);
} else {
printf("%s sec mem elem kmalloc failed\n", __FUNCTION__);
ret = BCME_ERROR;
}
return ret;
}
static void
osl_sec_dma_deinit_elem_mem_block(osl_t *osh, size_t mbsize, int max, void *sec_list_base)
{
if (sec_list_base)
kfree(sec_list_base);
}
static sec_mem_elem_t * BCMFASTPATH
osl_sec_dma_alloc_mem_elem(osl_t *osh, void *va, uint size, int direction,
struct sec_cma_info *ptr_cma_info, uint offset)
{
sec_mem_elem_t *sec_mem_elem = NULL;
#ifdef NOT_YET
if (size <= 512 && osh->sec_list_512) {
sec_mem_elem = osh->sec_list_512;
osh->sec_list_512 = sec_mem_elem->next;
}
else if (size <= 2048 && osh->sec_list_2048) {
sec_mem_elem = osh->sec_list_2048;
osh->sec_list_2048 = sec_mem_elem->next;
}
else
#else
ASSERT(osh->sec_list_4096);
sec_mem_elem = osh->sec_list_4096;
osh->sec_list_4096 = sec_mem_elem->next;
#endif /* NOT_YET */
sec_mem_elem->next = NULL;
if (ptr_cma_info->sec_alloc_list_tail) {
ptr_cma_info->sec_alloc_list_tail->next = sec_mem_elem;
ptr_cma_info->sec_alloc_list_tail = sec_mem_elem;
}
else {
/* First allocation: If tail is NULL, sec_alloc_list MUST also be NULL */
ASSERT(ptr_cma_info->sec_alloc_list == NULL);
ptr_cma_info->sec_alloc_list = sec_mem_elem;
ptr_cma_info->sec_alloc_list_tail = sec_mem_elem;
}
return sec_mem_elem;
}
static void BCMFASTPATH
osl_sec_dma_free_mem_elem(osl_t *osh, sec_mem_elem_t *sec_mem_elem)
{
sec_mem_elem->dma_handle = 0x0;
sec_mem_elem->va = NULL;
#ifdef NOT_YET
if (sec_mem_elem->size == 512) {
sec_mem_elem->next = osh->sec_list_512;
osh->sec_list_512 = sec_mem_elem;
} else if (sec_mem_elem->size == 2048) {
sec_mem_elem->next = osh->sec_list_2048;
osh->sec_list_2048 = sec_mem_elem;
} else if (sec_mem_elem->size == 4096) {
#endif /* NOT_YET */
sec_mem_elem->next = osh->sec_list_4096;
osh->sec_list_4096 = sec_mem_elem;
#ifdef NOT_YET
}
else
printf("%s free failed size=%d\n", __FUNCTION__, sec_mem_elem->size);
#endif /* NOT_YET */
}
static sec_mem_elem_t * BCMFASTPATH
osl_sec_dma_find_rem_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info, dma_addr_t dma_handle)
{
sec_mem_elem_t *sec_mem_elem = ptr_cma_info->sec_alloc_list;
sec_mem_elem_t *sec_prv_elem = ptr_cma_info->sec_alloc_list;
if (sec_mem_elem->dma_handle == dma_handle) {
ptr_cma_info->sec_alloc_list = sec_mem_elem->next;
if (sec_mem_elem == ptr_cma_info->sec_alloc_list_tail) {
ptr_cma_info->sec_alloc_list_tail = NULL;
ASSERT(ptr_cma_info->sec_alloc_list == NULL);
}
return sec_mem_elem;
}
sec_mem_elem = sec_mem_elem->next;
while (sec_mem_elem != NULL) {
if (sec_mem_elem->dma_handle == dma_handle) {
sec_prv_elem->next = sec_mem_elem->next;
if (sec_mem_elem == ptr_cma_info->sec_alloc_list_tail)
ptr_cma_info->sec_alloc_list_tail = sec_prv_elem;
return sec_mem_elem;
}
sec_prv_elem = sec_mem_elem;
sec_mem_elem = sec_mem_elem->next;
}
return NULL;
}
static sec_mem_elem_t *
osl_sec_dma_rem_first_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info)
{
sec_mem_elem_t *sec_mem_elem = ptr_cma_info->sec_alloc_list;
if (sec_mem_elem) {
ptr_cma_info->sec_alloc_list = sec_mem_elem->next;
if (ptr_cma_info->sec_alloc_list == NULL)
ptr_cma_info->sec_alloc_list_tail = NULL;
return sec_mem_elem;
} else
return NULL;
}
static void * BCMFASTPATH
osl_sec_dma_last_elem(osl_t *osh, struct sec_cma_info *ptr_cma_info)
{
return ptr_cma_info->sec_alloc_list_tail;
}
dma_addr_t BCMFASTPATH
osl_sec_dma_map_txmeta(osl_t *osh, void *va, uint size, int direction, void *p,
hnddma_seg_map_t *dmah, void *ptr_cma_info)
{
sec_mem_elem_t *sec_mem_elem;
struct page *pa_cma_page;
uint loffset;
void *vaorig = ((uint8 *)va + size);
dma_addr_t dma_handle = 0x0;
/* packet will be the one added with osl_sec_dma_map() just before this call */
sec_mem_elem = osl_sec_dma_last_elem(osh, ptr_cma_info);
if (sec_mem_elem && sec_mem_elem->va == vaorig) {
pa_cma_page = phys_to_page(sec_mem_elem->pa_cma);
loffset = sec_mem_elem->pa_cma -(sec_mem_elem->pa_cma & ~(PAGE_SIZE-1));
dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset, size,
(direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
} else {
printf("%s: error orig va not found va = 0x%p \n",
__FUNCTION__, vaorig);
}
return dma_handle;
}
dma_addr_t BCMFASTPATH
osl_sec_dma_map(osl_t *osh, void *va, uint size, int direction, void *p,
hnddma_seg_map_t *dmah, void *ptr_cma_info, uint offset)
{
sec_mem_elem_t *sec_mem_elem;
struct page *pa_cma_page;
void *pa_cma_kmap_va = NULL;
uint buflen = 0;
dma_addr_t dma_handle = 0x0;
uint loffset;
#ifdef NOT_YET
int *fragva;
struct sk_buff *skb;
int i = 0;
#endif /* NOT_YET */
ASSERT((direction == DMA_RX) || (direction == DMA_TX));
sec_mem_elem = osl_sec_dma_alloc_mem_elem(osh, va, size, direction, ptr_cma_info, offset);
sec_mem_elem->va = va;
sec_mem_elem->direction = direction;
pa_cma_page = sec_mem_elem->pa_cma_page;
loffset = sec_mem_elem->pa_cma -(sec_mem_elem->pa_cma & ~(PAGE_SIZE-1));
/* pa_cma_kmap_va = kmap_atomic(pa_cma_page);
* pa_cma_kmap_va += loffset;
*/
pa_cma_kmap_va = sec_mem_elem->vac;
pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + offset);
buflen = size;
if (direction == DMA_TX) {
memcpy((uint8*)pa_cma_kmap_va+offset, va, size);
#ifdef NOT_YET
if (p == NULL) {
memcpy(pa_cma_kmap_va, va, size);
/* prhex("Txpkt",pa_cma_kmap_va, size); */
} else {
for (skb = (struct sk_buff *)p; skb != NULL; skb = PKTNEXT(osh, skb)) {
if (skb_is_nonlinear(skb)) {
for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
skb_frag_t *f = &skb_shinfo(skb)->frags[i];
fragva = kmap_atomic(skb_frag_page(f));
pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + buflen);
memcpy((pa_cma_kmap_va),
(fragva + f->page_offset), skb_frag_size(f));
kunmap_atomic(fragva);
buflen += skb_frag_size(f);
}
} else {
pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + buflen);
memcpy(pa_cma_kmap_va, skb->data, skb->len);
buflen += skb->len;
}
}
}
#endif /* NOT_YET */
if (dmah) {
dmah->nsegs = 1;
dmah->origsize = buflen;
}
}
else
{
if ((p != NULL) && (dmah != NULL)) {
dmah->nsegs = 1;
dmah->origsize = buflen;
}
*(uint32 *)(pa_cma_kmap_va) = 0x0;
}
if (direction == DMA_RX) {
flush_kernel_vmap_range(pa_cma_kmap_va, sizeof(int));
}
dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset+offset, buflen,
(direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
if (dmah) {
dmah->segs[0].addr = dma_handle;
dmah->segs[0].length = buflen;
}
sec_mem_elem->dma_handle = dma_handle;
/* kunmap_atomic(pa_cma_kmap_va-loffset); */
return dma_handle;
}
dma_addr_t BCMFASTPATH
osl_sec_dma_dd_map(osl_t *osh, void *va, uint size, int direction, void *p, hnddma_seg_map_t *map)
{
struct page *pa_cma_page;
phys_addr_t pa_cma;
dma_addr_t dma_handle = 0x0;
uint loffset;
pa_cma = ((uint8 *)va - (uint8 *)osh->contig_delta_va_pa);
pa_cma_page = phys_to_page(pa_cma);
loffset = pa_cma -(pa_cma & ~(PAGE_SIZE-1));
dma_handle = dma_map_page(OSH_NULL, pa_cma_page, loffset, size,
(direction == DMA_TX ? DMA_TO_DEVICE:DMA_FROM_DEVICE));
return dma_handle;
}
void BCMFASTPATH
osl_sec_dma_unmap(osl_t *osh, dma_addr_t dma_handle, uint size, int direction,
void *p, hnddma_seg_map_t *map, void *ptr_cma_info, uint offset)
{
sec_mem_elem_t *sec_mem_elem;
#ifdef NOT_YET
struct page *pa_cma_page;
#endif // endif
void *pa_cma_kmap_va = NULL;
uint buflen = 0;
dma_addr_t pa_cma;
void *va;
int read_count = 0;
BCM_REFERENCE(buflen);
BCM_REFERENCE(read_count);
sec_mem_elem = osl_sec_dma_find_rem_elem(osh, ptr_cma_info, dma_handle);
ASSERT(sec_mem_elem);
va = sec_mem_elem->va;
va = (uint8 *)va - offset;
pa_cma = sec_mem_elem->pa_cma;
#ifdef NOT_YET
pa_cma_page = sec_mem_elem->pa_cma_page;
#endif // endif
if (direction == DMA_RX) {
if (p == NULL) {
/* pa_cma_kmap_va = kmap_atomic(pa_cma_page);
* pa_cma_kmap_va += loffset;
*/
pa_cma_kmap_va = sec_mem_elem->vac;
do {
invalidate_kernel_vmap_range(pa_cma_kmap_va, sizeof(int));
buflen = *(uint *)(pa_cma_kmap_va);
if (buflen)
break;
OSL_DELAY(1);
read_count++;
} while (read_count < 200);
dma_unmap_page(OSH_NULL, pa_cma, size, DMA_FROM_DEVICE);
memcpy(va, pa_cma_kmap_va, size);
/* kunmap_atomic(pa_cma_kmap_va); */
}
#ifdef NOT_YET
else {
buflen = 0;
for (skb = (struct sk_buff *)p; (buflen < size) &&
(skb != NULL); skb = skb->next) {
if (skb_is_nonlinear(skb)) {
pa_cma_kmap_va = kmap_atomic(pa_cma_page);
for (i = 0; (buflen < size) &&
(i < skb_shinfo(skb)->nr_frags); i++) {
skb_frag_t *f = &skb_shinfo(skb)->frags[i];
cpuaddr = kmap_atomic(skb_frag_page(f));
pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + buflen);
memcpy((cpuaddr + f->page_offset),
pa_cma_kmap_va, skb_frag_size(f));
kunmap_atomic(cpuaddr);
buflen += skb_frag_size(f);
}
kunmap_atomic(pa_cma_kmap_va);
} else {
pa_cma_kmap_va = kmap_atomic(pa_cma_page);
pa_cma_kmap_va = ((uint8 *)pa_cma_kmap_va + buflen);
memcpy(skb->data, pa_cma_kmap_va, skb->len);
kunmap_atomic(pa_cma_kmap_va);
buflen += skb->len;
}
}
}
#endif /* NOT YET */
} else {
dma_unmap_page(OSH_NULL, pa_cma, size+offset, DMA_TO_DEVICE);
}
osl_sec_dma_free_mem_elem(osh, sec_mem_elem);
}
void
osl_sec_dma_unmap_all(osl_t *osh, void *ptr_cma_info)
{
sec_mem_elem_t *sec_mem_elem;
sec_mem_elem = osl_sec_dma_rem_first_elem(osh, ptr_cma_info);
while (sec_mem_elem != NULL) {
dma_unmap_page(OSH_NULL, sec_mem_elem->pa_cma, sec_mem_elem->size,
sec_mem_elem->direction == DMA_TX ? DMA_TO_DEVICE : DMA_FROM_DEVICE);
osl_sec_dma_free_mem_elem(osh, sec_mem_elem);
sec_mem_elem = osl_sec_dma_rem_first_elem(osh, ptr_cma_info);
}
}
static void
osl_sec_dma_init_consistent(osl_t *osh)
{
int i;
void *temp_va = osh->contig_base_alloc_coherent_va;
phys_addr_t temp_pa = osh->contig_base_alloc_coherent;
for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
osh->sec_cma_coherent[i].avail = TRUE;
osh->sec_cma_coherent[i].va = temp_va;
osh->sec_cma_coherent[i].pa = temp_pa;
temp_va = ((uint8 *)temp_va)+SEC_CMA_COHERENT_BLK;
temp_pa += SEC_CMA_COHERENT_BLK;
}
}
static void *
osl_sec_dma_alloc_consistent(osl_t *osh, uint size, uint16 align_bits, ulong *pap)
{
void *temp_va = NULL;
ulong temp_pa = 0;
int i;
if (size > SEC_CMA_COHERENT_BLK) {
printf("%s unsupported size\n", __FUNCTION__);
return NULL;
}
for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
if (osh->sec_cma_coherent[i].avail == TRUE) {
temp_va = osh->sec_cma_coherent[i].va;
temp_pa = osh->sec_cma_coherent[i].pa;
osh->sec_cma_coherent[i].avail = FALSE;
break;
}
}
if (i == SEC_CMA_COHERENT_MAX)
printf("%s:No coherent mem: va = 0x%p pa = 0x%lx size = %d\n", __FUNCTION__,
temp_va, (ulong)temp_pa, size);
*pap = (unsigned long)temp_pa;
return temp_va;
}
static void
osl_sec_dma_free_consistent(osl_t *osh, void *va, uint size, dmaaddr_t pa)
{
int i = 0;
for (i = 0; i < SEC_CMA_COHERENT_MAX; i++) {
if (osh->sec_cma_coherent[i].va == va) {
osh->sec_cma_coherent[i].avail = TRUE;
break;
}
}
if (i == SEC_CMA_COHERENT_MAX)
printf("%s:Error: va = 0x%p pa = 0x%lx size = %d\n", __FUNCTION__,
va, (ulong)pa, size);
}
#endif /* BCM_SECURE_DMA */
/* timer apis */
/* Note: All timer api's are thread unsafe and should be protected with locks by caller */
#ifdef REPORT_FATAL_TIMEOUTS
osl_timer_t *
osl_timer_init(osl_t *osh, const char *name, void (*fn)(void *arg), void *arg)
{
osl_timer_t *t;
BCM_REFERENCE(fn);
if ((t = MALLOCZ(NULL, sizeof(osl_timer_t))) == NULL) {
printk(KERN_ERR "osl_timer_init: out of memory, malloced %d bytes\n",
(int)sizeof(osl_timer_t));
return (NULL);
}
bzero(t, sizeof(osl_timer_t));
if ((t->timer = MALLOCZ(NULL, sizeof(struct timer_list))) == NULL) {
printf("osl_timer_init: malloc failed\n");
MFREE(NULL, t, sizeof(osl_timer_t));
return (NULL);
}
t->timer->data = (ulong)arg;
t->timer->function = (linux_timer_fn)fn;
t->set = TRUE;
init_timer(t->timer);
return (t);
}
void
osl_timer_add(osl_t *osh, osl_timer_t *t, uint32 ms, bool periodic)
{
if (t == NULL) {
printf("%s: Timer handle is NULL\n", __FUNCTION__);
return;
}
ASSERT(!t->set);
t->set = TRUE;
if (periodic) {
printf("Periodic timers are not supported by Linux timer apis\n");
}
t->timer->expires = jiffies + ms*HZ/1000;
add_timer(t->timer);
return;
}
void
osl_timer_update(osl_t *osh, osl_timer_t *t, uint32 ms, bool periodic)
{
if (t == NULL) {
printf("%s: Timer handle is NULL\n", __FUNCTION__);
return;
}
if (periodic) {
printf("Periodic timers are not supported by Linux timer apis\n");
}
t->set = TRUE;
t->timer->expires = jiffies + ms*HZ/1000;
mod_timer(t->timer, t->timer->expires);
return;
}
/*
* Return TRUE if timer successfully deleted, FALSE if still pending
*/
bool
osl_timer_del(osl_t *osh, osl_timer_t *t)
{
if (t == NULL) {
printf("%s: Timer handle is NULL\n", __FUNCTION__);
return (FALSE);
}
if (t->set) {
t->set = FALSE;
if (t->timer) {
del_timer(t->timer);
MFREE(NULL, t->timer, sizeof(struct timer_list));
}
MFREE(NULL, t, sizeof(osl_timer_t));
}
return (TRUE);
}
#endif
#ifdef USE_DMA_LOCK
static void
osl_dma_lock(osl_t *osh)
{
/* XXX: The conditional check is to avoid the scheduling bug.
* If the spin_lock_bh is used under the spin_lock_irqsave,
* Kernel triggered the warning message as the spin_lock_irqsave
* disables the interrupt and the spin_lock_bh doesn't use in case
* interrupt is disabled.
* Please refer to the __local_bh_enable_ip() function
* in kernel/softirq.c to understand the condtion.
*/
if (likely(in_irq() || irqs_disabled())) {
spin_lock(&osh->dma_lock);
} else {
spin_lock_bh(&osh->dma_lock);
osh->dma_lock_bh = TRUE;
}
}
static void
osl_dma_unlock(osl_t *osh)
{
if (unlikely(osh->dma_lock_bh)) {
osh->dma_lock_bh = FALSE;
spin_unlock_bh(&osh->dma_lock);
} else {
spin_unlock(&osh->dma_lock);
}
}
static void
osl_dma_lock_init(osl_t *osh)
{
spin_lock_init(&osh->dma_lock);
osh->dma_lock_bh = FALSE;
}
#endif /* USE_DMA_LOCK */