qcacmn: Initialize DMA rings using hal_srng APIs
Initialize DMA rings for CIR/CFR capture and program them to firmware. Change-Id: I41c32cddc3fc0f7f0a972bf69ecbacfc9f0626f7 CRs-Fixed: 2053958
This commit is contained in:
Naveen Rawat
@@ -124,6 +124,13 @@ static inline void target_if_wifi_pos_register_rx_ops(
|
||||
QDF_STATUS target_if_wifi_pos_init_cir_cfr_rings(struct wlan_objmgr_psoc *psoc,
|
||||
void *hal_soc, uint8_t num_mac,
|
||||
void *buf);
|
||||
/**
|
||||
* target_if_wifi_pos_deinit_dma_rings: frees up DMA rings
|
||||
* @psoc: pointer to psoc
|
||||
*
|
||||
* Return: status of operation
|
||||
*/
|
||||
QDF_STATUS target_if_wifi_pos_deinit_dma_rings(struct wlan_objmgr_psoc *psoc);
|
||||
#else
|
||||
static inline QDF_STATUS target_if_wifi_pos_init_cir_cfr_rings(
|
||||
struct wlan_objmgr_psoc *psoc, void *hal_soc,
|
||||
@@ -131,6 +138,12 @@ static inline QDF_STATUS target_if_wifi_pos_init_cir_cfr_rings(
|
||||
{
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static inline QDF_STATUS target_if_wifi_pos_deinit_dma_rings(
|
||||
struct wlan_objmgr_psoc *psoc)
|
||||
{
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* _WIFI_POS_TGT_IF_H_ */
|
||||
|
||||
@@ -38,6 +38,65 @@
|
||||
#include "target_if.h"
|
||||
#ifdef WLAN_FEATURE_CIF_CFR
|
||||
#include "hal_api.h"
|
||||
|
||||
#define RING_BASE_ALIGN 8
|
||||
|
||||
static void *target_if_wifi_pos_vaddr_lookup(
|
||||
struct wifi_pos_psoc_priv_obj *priv,
|
||||
void *paddr, uint8_t ring_num, uint32_t cookie)
|
||||
{
|
||||
if (priv->dma_buf_pool[ring_num][cookie].paddr == paddr) {
|
||||
return priv->dma_buf_pool[ring_num][cookie].vaddr +
|
||||
priv->dma_buf_pool[ring_num][cookie].offset;
|
||||
} else {
|
||||
target_if_err("incorrect paddr found on cookie slot");
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_replenish_ring(
|
||||
struct wifi_pos_psoc_priv_obj *priv, uint8_t ring_idx,
|
||||
void *alinged_vaddr, uint32_t cookie)
|
||||
{
|
||||
uint64_t *ring_entry;
|
||||
uint32_t dw_lo, dw_hi = 0, map_status;
|
||||
void *hal_soc = priv->hal_soc;
|
||||
void *srng = priv->dma_cfg[ring_idx].srng;
|
||||
void *paddr;
|
||||
|
||||
if (!alinged_vaddr) {
|
||||
target_if_debug("NULL alinged_vaddr provided");
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
map_status = qdf_mem_map_nbytes_single(NULL, alinged_vaddr,
|
||||
QDF_DMA_FROM_DEVICE,
|
||||
priv->dma_cap[ring_idx].min_buf_size,
|
||||
(qdf_dma_addr_t *)&paddr);
|
||||
if (map_status) {
|
||||
target_if_err("mem map failed status: %d", map_status);
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
QDF_ASSERT(!((uint64_t)paddr % priv->dma_cap[ring_idx].min_buf_align));
|
||||
priv->dma_buf_pool[ring_idx][cookie].paddr = paddr;
|
||||
|
||||
hal_srng_access_start(hal_soc, srng);
|
||||
ring_entry = hal_srng_src_get_next(hal_soc, srng);
|
||||
dw_lo = (uint64_t)paddr & 0xFFFFFFFF;
|
||||
WMI_OEM_DMA_DATA_ADDR_HI_SET(dw_hi, (uint64_t)paddr >> 32);
|
||||
WMI_OEM_DMA_DATA_ADDR_HI_HOST_DATA_SET(dw_hi, cookie);
|
||||
*ring_entry = (uint64_t)dw_hi << 32 | dw_lo;
|
||||
hal_srng_access_end(hal_soc, srng);
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
#else
|
||||
static QDF_STATUS target_if_wifi_pos_replenish_ring(
|
||||
struct wifi_pos_psoc_priv_obj *priv, uint8_t ring_idx,
|
||||
void *vaddr, uint32_t cookie)
|
||||
{
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
#endif
|
||||
|
||||
/**
|
||||
@@ -276,54 +335,234 @@ QDF_STATUS target_if_wifi_pos_deregister_events(struct wlan_objmgr_psoc *psoc)
|
||||
}
|
||||
|
||||
#ifdef WLAN_FEATURE_CIF_CFR
|
||||
static QDF_STATUS target_if_wifi_pos_init_srngs(struct wlan_objmgr_psoc *psoc,
|
||||
void *hal_soc, struct wifi_pos_psoc_priv_obj *priv_obj)
|
||||
static QDF_STATUS target_if_wifi_pos_fill_ring(uint8_t ring_idx,
|
||||
struct hal_srng *srng,
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
uint32_t i;
|
||||
void *buf, *buf_aligned;
|
||||
|
||||
for (i = 0; i < priv->dma_cfg[ring_idx].num_ptr; i++) {
|
||||
buf = qdf_mem_malloc(priv->dma_cap[ring_idx].min_buf_size +
|
||||
priv->dma_cap[ring_idx].min_buf_align - 1);
|
||||
if (!buf) {
|
||||
target_if_err("malloc failed");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
priv->dma_buf_pool[ring_idx][i].vaddr = buf;
|
||||
buf_aligned = (void *)qdf_roundup((uint64_t)buf,
|
||||
priv->dma_cap[ring_idx].min_buf_align);
|
||||
priv->dma_buf_pool[ring_idx][i].offset = buf_aligned - buf;
|
||||
priv->dma_buf_pool[ring_idx][i].cookie = i;
|
||||
target_if_wifi_pos_replenish_ring(priv, ring_idx,
|
||||
buf_aligned, i);
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_empty_ring(uint8_t ring_idx,
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
uint32_t i;
|
||||
|
||||
for (i = 0; i < priv->dma_cfg[ring_idx].num_ptr; i++) {
|
||||
qdf_mem_unmap_nbytes_single(NULL,
|
||||
(qdf_dma_addr_t)priv->dma_buf_pool[ring_idx][i].vaddr,
|
||||
QDF_DMA_FROM_DEVICE,
|
||||
priv->dma_cap[ring_idx].min_buf_size);
|
||||
qdf_mem_free(priv->dma_buf_pool[ring_idx][i].vaddr);
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_init_ring(uint8_t ring_idx,
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
void *srng;
|
||||
uint32_t num_entries;
|
||||
qdf_dma_addr_t paddr;
|
||||
uint32_t ring_alloc_size;
|
||||
void *hal_soc = priv->hal_soc;
|
||||
struct hal_srng_params ring_params = {0};
|
||||
uint32_t max_entries = hal_srng_max_entries(hal_soc, WIFI_POS_SRC);
|
||||
uint32_t entry_size = hal_srng_get_entrysize(hal_soc, WIFI_POS_SRC);
|
||||
|
||||
num_entries = priv->dma_cap[ring_idx].min_num_ptr > max_entries ?
|
||||
max_entries : priv->dma_cap[ring_idx].min_num_ptr;
|
||||
priv->dma_cfg[ring_idx].num_ptr = num_entries;
|
||||
priv->dma_buf_pool[ring_idx] = qdf_mem_malloc(num_entries *
|
||||
sizeof(struct wifi_pos_dma_buf_info));
|
||||
if (!priv->dma_buf_pool[ring_idx]) {
|
||||
target_if_err("malloc failed");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
|
||||
ring_alloc_size = (num_entries * entry_size) + RING_BASE_ALIGN - 1;
|
||||
priv->dma_cfg[ring_idx].ring_alloc_size = ring_alloc_size;
|
||||
priv->dma_cfg[ring_idx].base_vaddr_unaligned =
|
||||
qdf_mem_alloc_consistent(NULL, NULL, ring_alloc_size, &paddr);
|
||||
priv->dma_cfg[ring_idx].base_paddr_unaligned = (void *)paddr;
|
||||
if (!priv->dma_cfg[ring_idx].base_vaddr_unaligned) {
|
||||
target_if_err("malloc failed");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
|
||||
priv->dma_cfg[ring_idx].base_vaddr_aligned = (void *)qdf_roundup(
|
||||
(uint64_t)priv->dma_cfg[ring_idx].base_vaddr_unaligned,
|
||||
RING_BASE_ALIGN);
|
||||
ring_params.ring_base_vaddr =
|
||||
priv->dma_cfg[ring_idx].base_vaddr_aligned;
|
||||
priv->dma_cfg[ring_idx].base_paddr_aligned = (void *)qdf_roundup(
|
||||
(uint64_t)priv->dma_cfg[ring_idx].base_paddr_unaligned,
|
||||
RING_BASE_ALIGN);
|
||||
ring_params.ring_base_paddr =
|
||||
(qdf_dma_addr_t)priv->dma_cfg[ring_idx].base_paddr_aligned;
|
||||
ring_params.num_entries = num_entries;
|
||||
srng = hal_srng_setup(hal_soc, WIFI_POS_SRC, 0,
|
||||
priv->dma_cap[ring_idx].pdev_id, &ring_params);
|
||||
if (!srng) {
|
||||
target_if_err("srng setup failed");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
priv->dma_cfg[ring_idx].srng = srng;
|
||||
priv->dma_cfg[ring_idx].tail_idx_addr =
|
||||
(void *)hal_srng_get_tp_addr(hal_soc, srng);
|
||||
priv->dma_cfg[ring_idx].head_idx_addr =
|
||||
(void *)hal_srng_get_tp_addr(hal_soc, srng);
|
||||
|
||||
return target_if_wifi_pos_fill_ring(ring_idx, srng, priv);
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_deinit_ring(uint8_t ring_idx,
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
target_if_wifi_pos_empty_ring(ring_idx, priv);
|
||||
priv->dma_buf_pool[ring_idx] = NULL;
|
||||
hal_srng_cleanup(priv->hal_soc, priv->dma_cfg[ring_idx].srng);
|
||||
qdf_mem_free_consistent(NULL, NULL,
|
||||
priv->dma_cfg[ring_idx].ring_alloc_size,
|
||||
priv->dma_cfg[ring_idx].base_vaddr_unaligned,
|
||||
(qdf_dma_addr_t)priv->dma_cfg[ring_idx].base_paddr_unaligned,
|
||||
0);
|
||||
qdf_mem_free(priv->dma_buf_pool[ring_idx]);
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_init_srngs(
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
uint8_t i;
|
||||
QDF_STATUS status;
|
||||
|
||||
/* allocate memory for num_rings pointers */
|
||||
priv->dma_cfg = qdf_mem_malloc(priv->num_rings *
|
||||
sizeof(struct wifi_pos_dma_rings_cap));
|
||||
if (!priv->dma_cfg) {
|
||||
target_if_err("malloc failed");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
|
||||
priv->dma_buf_pool = qdf_mem_malloc(priv->num_rings *
|
||||
sizeof(struct wifi_pos_dma_buf_info *));
|
||||
if (!priv->dma_buf_pool) {
|
||||
target_if_err("malloc failed");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
|
||||
for (i = 0; i < priv->num_rings; i++) {
|
||||
status = target_if_wifi_pos_init_ring(i, priv);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
target_if_err("init for ring[%d] failed", i);
|
||||
return status;
|
||||
}
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_deinit_srngs(
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
uint8_t i;
|
||||
|
||||
for (i = 0; i < priv->num_rings; i++)
|
||||
target_if_wifi_pos_deinit_ring(i, priv);
|
||||
|
||||
qdf_mem_free(priv->dma_buf_pool);
|
||||
priv->dma_buf_pool = NULL;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
static QDF_STATUS target_if_wifi_pos_cfg_fw(struct wlan_objmgr_psoc *psoc,
|
||||
struct wifi_pos_psoc_priv_obj *priv_obj)
|
||||
struct wifi_pos_psoc_priv_obj *priv)
|
||||
{
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
QDF_STATUS target_if_wifi_pos_deinit_dma_rings(struct wlan_objmgr_psoc *psoc)
|
||||
{
|
||||
struct wifi_pos_psoc_priv_obj *priv = wifi_pos_get_psoc_priv_obj(psoc);
|
||||
|
||||
target_if_wifi_pos_deinit_srngs(priv);
|
||||
qdf_mem_free(priv->dma_cap);
|
||||
priv->dma_cap = NULL;
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
QDF_STATUS target_if_wifi_pos_init_cir_cfr_rings(struct wlan_objmgr_psoc *psoc,
|
||||
void *hal_soc, uint8_t num_mac,
|
||||
void *buf)
|
||||
{
|
||||
uint8_t i;
|
||||
struct wifi_pos_psoc_priv_obj *priv_obj =
|
||||
wifi_pos_get_psoc_priv_obj(psoc);
|
||||
QDF_STATUS status = QDF_STATUS_SUCCESS;
|
||||
WMI_OEM_DMA_RING_CAPABILITIES *dma_cap = buf;
|
||||
struct wifi_pos_psoc_priv_obj *priv = wifi_pos_get_psoc_priv_obj(psoc);
|
||||
|
||||
if (!priv_obj) {
|
||||
if (!priv) {
|
||||
target_if_err("unable to get wifi_pos psoc obj");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
priv_obj->hal_soc = hal_soc;
|
||||
priv_obj->num_rings = num_mac;
|
||||
priv_obj->dma_cap = qdf_mem_malloc(priv_obj->num_rings *
|
||||
priv->hal_soc = hal_soc;
|
||||
priv->num_rings = num_mac;
|
||||
priv->dma_cap = qdf_mem_malloc(priv->num_rings *
|
||||
sizeof(struct wifi_pos_dma_rings_cap));
|
||||
if (!priv_obj->dma_cap) {
|
||||
if (!priv->dma_cap) {
|
||||
target_if_err("unable to get wifi_pos psoc obj");
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
}
|
||||
|
||||
for (i = 0; i < num_mac; i++) {
|
||||
priv_obj->dma_cap[i].pdev_id = dma_cap[i].pdev_id;
|
||||
priv_obj->dma_cap[i].min_num_ptr = dma_cap[i].min_num_ptr;
|
||||
priv_obj->dma_cap[i].min_buf_size = dma_cap[i].min_buf_size;
|
||||
priv_obj->dma_cap[i].min_buf_align = dma_cap[i].min_buf_align;
|
||||
priv->dma_cap[i].pdev_id = dma_cap[i].pdev_id;
|
||||
priv->dma_cap[i].min_num_ptr = dma_cap[i].min_num_ptr;
|
||||
priv->dma_cap[i].min_buf_size = dma_cap[i].min_buf_size;
|
||||
priv->dma_cap[i].min_buf_align = dma_cap[i].min_buf_align;
|
||||
}
|
||||
|
||||
/* initialize DMA rings now */
|
||||
target_if_wifi_pos_init_srngs(psoc, hal_soc, priv_obj);
|
||||
status = target_if_wifi_pos_init_srngs(priv);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
target_if_err("dma init failed: %d", status);
|
||||
goto dma_init_failed;
|
||||
}
|
||||
|
||||
/* send cfg req cmd to firmware */
|
||||
target_if_wifi_pos_cfg_fw(psoc, priv_obj);
|
||||
status = target_if_wifi_pos_cfg_fw(psoc, priv);
|
||||
if (QDF_IS_STATUS_ERROR(status)) {
|
||||
target_if_err("configure to FW failed: %d", status);
|
||||
goto dma_init_failed;
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
|
||||
dma_init_failed:
|
||||
target_if_wifi_pos_deinit_dma_rings(psoc);
|
||||
return status;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user