qcacmn: Add support to send hw_mode in init cmd

Support to add hw_mode in init command is added by FW
to let host choose the mode to be use. Change init cmd
send API to enable upper layer to send the hw_mode selected.
Since this is new TLV in init command, init cmd send API
needs to be changed to accommodate this parameter.

Change-Id: I172d8d737425599c36666d9fec8a6cdd48085097
CRs-Fixed: 2004652
This commit is contained in:
Kiran Venkatappa
2016-12-23 19:58:54 +05:30
committed by qcabuildsw
szülő 36445a7f49
commit 26117057ef
3 fájl változott, egészen pontosan 96 új sor hozzáadva és 36 régi sor törölve

Fájl megtekintése

@@ -4578,21 +4578,17 @@ QDF_STATUS wmi_unified_set_psmode_cmd_send(void *wmi_hdl,
/**
* wmi_unified_init_cmd_send() - send initialization cmd to fw
* @wmi_handle: wmi handle
* @param tgt_res_cfg: pointer to target resource configuration
* @param num_mem_chunks: Number of memory chunks
* @param mem_chunks: pointer to target memory chunks
* @param param: pointer to wmi init param
*
* Return: QDF_STATUS_SUCCESS on success and QDF_STATUS_E_FAILURE for failure
*/
QDF_STATUS wmi_unified_init_cmd_send(void *wmi_hdl,
target_resource_config *res_cfg, uint8_t num_mem_chunks,
struct wmi_host_mem_chunk *mem_chunk)
struct wmi_init_cmd_param *param)
{
wmi_unified_t wmi_handle = (wmi_unified_t) wmi_hdl;
if (wmi_handle->ops->init_cmd_send)
return wmi_handle->ops->init_cmd_send(wmi_handle, res_cfg,
num_mem_chunks, mem_chunk);
return wmi_handle->ops->init_cmd_send(wmi_handle, param);
return QDF_STATUS_E_FAILURE;
}

Fájl megtekintése

@@ -5323,15 +5323,12 @@ static void wmi_copy_resource_config_non_tlv(wmi_resource_config *resource_cfg,
/**
* init_cmd_send_non_tlv() - send initialization cmd to fw
* @wmi_handle: wmi handle
* @param tgt_res_cfg: pointer to target resource configuration
* @param num_mem_chunks: Number of memory chunks
* @param mem_chunks: pointer to target memory chunks
* @param param: pointer to wmi init param
*
* Return: 0 for success or error code
*/
static QDF_STATUS init_cmd_send_non_tlv(wmi_unified_t wmi_handle,
target_resource_config *tgt_res_cfg,
uint8_t num_mem_chunks, struct wmi_host_mem_chunk *mem_chunks)
struct wmi_init_cmd_param *param)
{
wmi_buf_t buf;
wmi_init_cmd *cmd;
@@ -5350,20 +5347,21 @@ static QDF_STATUS init_cmd_send_non_tlv(wmi_unified_t wmi_handle,
cmd = (wmi_init_cmd *) wmi_buf_data(buf);
wmi_copy_resource_config_non_tlv(&cmd->resource_config, tgt_res_cfg);
wmi_copy_resource_config_non_tlv(&cmd->resource_config, param->res_cfg);
host_mem_chunks = cmd->host_mem_chunks;
for (idx = 0; idx < num_mem_chunks; ++idx) {
host_mem_chunks[idx].ptr = mem_chunks[idx].paddr;
host_mem_chunks[idx].size = mem_chunks[idx].len;
host_mem_chunks[idx].req_id = mem_chunks[idx].req_id;
for (idx = 0; idx < param->num_mem_chunks; ++idx) {
host_mem_chunks[idx].ptr = param->mem_chunks[idx].paddr;
host_mem_chunks[idx].size = param->mem_chunks[idx].len;
host_mem_chunks[idx].req_id = param->mem_chunks[idx].req_id;
qdf_print("chunk %d len %d requested , ptr 0x%x\n",
idx, cmd->host_mem_chunks[idx].size,
cmd->host_mem_chunks[idx].ptr);
}
cmd->num_host_mem_chunks = num_mem_chunks;
if (num_mem_chunks > 1)
len += ((num_mem_chunks-1) * sizeof(wlan_host_memory_chunk));
cmd->num_host_mem_chunks = param->num_mem_chunks;
if (param->num_mem_chunks > 1)
len += ((param->num_mem_chunks-1) *
sizeof(wlan_host_memory_chunk));
if (wmi_unified_cmd_send(wmi_handle, buf, len, WMI_INIT_CMDID) < 0) {
wmi_buf_free(buf);

Fájl megtekintése

@@ -11880,18 +11880,73 @@ error:
return status;
}
/* copy_hw_mode_id_in_init_cmd() - Helper routine to copy hw_mode in init cmd
* @buf_ptr: pointer to current position in init command buffer
* @len: pointer to length. This will be updated with current lenght of cmd
* @param: point host parameters for init command
*
* Return: Updated pointer of buf_ptr.
*/
static inline uint8_t *copy_hw_mode_in_init_cmd(uint8_t *buf_ptr,
int *len, struct wmi_init_cmd_param *param)
{
uint16_t idx;
if (param->hw_mode_id != WMI_HOST_HW_MODE_MAX) {
wmi_pdev_set_hw_mode_cmd_fixed_param *hw_mode;
wmi_pdev_band_to_mac *band_to_mac;
hw_mode = (wmi_pdev_set_hw_mode_cmd_fixed_param *)
(buf_ptr + sizeof(wmi_init_cmd_fixed_param) +
sizeof(wmi_resource_config) +
WMI_TLV_HDR_SIZE + (param->num_mem_chunks *
sizeof(wlan_host_memory_chunk)));
WMITLV_SET_HDR(&hw_mode->tlv_header,
WMITLV_TAG_STRUC_wmi_pdev_set_hw_mode_cmd_fixed_param,
(WMITLV_GET_STRUCT_TLVLEN
(wmi_pdev_set_hw_mode_cmd_fixed_param)));
hw_mode->hw_mode_index = param->hw_mode_id;
hw_mode->num_band_to_mac = param->num_band_to_mac;
buf_ptr = (uint8_t *) (hw_mode + 1);
band_to_mac = (wmi_pdev_band_to_mac *) (buf_ptr +
WMI_TLV_HDR_SIZE);
for (idx = 0; idx < param->num_band_to_mac; idx++) {
WMITLV_SET_HDR(&band_to_mac[idx].tlv_header,
WMITLV_TAG_STRUC_wmi_pdev_band_to_mac,
WMITLV_GET_STRUCT_TLVLEN
(wmi_pdev_band_to_mac));
band_to_mac[idx].pdev_id =
param->band_to_mac[idx].pdev_id;
band_to_mac[idx].start_freq =
param->band_to_mac[idx].start_freq;
band_to_mac[idx].end_freq =
param->band_to_mac[idx].end_freq;
}
*len += sizeof(wmi_pdev_set_hw_mode_cmd_fixed_param) +
(param->num_band_to_mac *
sizeof(wmi_pdev_band_to_mac)) +
WMI_TLV_HDR_SIZE;
WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
(param->num_band_to_mac *
sizeof(wmi_pdev_band_to_mac)));
}
return buf_ptr;
}
/**
* init_cmd_send_tlv() - send initialization cmd to fw
* @wmi_handle: wmi handle
* @param tgt_res_cfg: pointer to target resource configuration
* @param num_mem_chunks: Number of memory chunks
* @param mem_chunks: pointer to target memory chunks
* @param param: pointer to wmi init param
*
* Return: QDF_STATUS_SUCCESS for success or error code
*/
static QDF_STATUS init_cmd_send_tlv(wmi_unified_t wmi_handle,
target_resource_config *tgt_res_cfg, uint8_t num_mem_chunks,
struct wmi_host_mem_chunk *mem_chunks)
struct wmi_init_cmd_param *param)
{
wmi_buf_t buf;
wmi_init_cmd_fixed_param *cmd;
@@ -11900,14 +11955,21 @@ static QDF_STATUS init_cmd_send_tlv(wmi_unified_t wmi_handle,
uint8_t *buf_ptr;
wmi_resource_config *resource_cfg;
wlan_host_memory_chunk *host_mem_chunks;
uint32_t mem_chunk_len = 0;
uint32_t mem_chunk_len = 0, hw_mode_len = 0;
uint16_t idx;
int len;
QDF_STATUS ret;
len = sizeof(*cmd) + sizeof(wmi_resource_config) + WMI_TLV_HDR_SIZE;
len = sizeof(*cmd) + sizeof(wmi_resource_config) +
WMI_TLV_HDR_SIZE;
mem_chunk_len = (sizeof(wlan_host_memory_chunk) * MAX_MEM_CHUNKS);
buf = wmi_buf_alloc(wmi_handle, len + mem_chunk_len);
if (param->hw_mode_id != WMI_HOST_HW_MODE_MAX)
hw_mode_len = sizeof(wmi_pdev_set_hw_mode_cmd_fixed_param) +
WMI_TLV_HDR_SIZE +
(param->num_band_to_mac * sizeof(wmi_pdev_band_to_mac));
buf = wmi_buf_alloc(wmi_handle, len + mem_chunk_len + hw_mode_len);
if (!buf) {
qdf_print("%s: wmi_buf_alloc failed\n", __func__);
return QDF_STATUS_E_FAILURE;
@@ -11925,29 +11987,33 @@ static QDF_STATUS init_cmd_send_tlv(wmi_unified_t wmi_handle,
WMITLV_TAG_STRUC_wmi_init_cmd_fixed_param,
WMITLV_GET_STRUCT_TLVLEN(wmi_init_cmd_fixed_param));
wmi_copy_resource_config(resource_cfg, tgt_res_cfg);
wmi_copy_resource_config(resource_cfg, param->res_cfg);
WMITLV_SET_HDR(&resource_cfg->tlv_header,
WMITLV_TAG_STRUC_wmi_resource_config,
WMITLV_GET_STRUCT_TLVLEN(wmi_resource_config));
for (idx = 0; idx < num_mem_chunks; ++idx) {
for (idx = 0; idx < param->num_mem_chunks; ++idx) {
WMITLV_SET_HDR(&(host_mem_chunks[idx].tlv_header),
WMITLV_TAG_STRUC_wlan_host_memory_chunk,
WMITLV_GET_STRUCT_TLVLEN
(wlan_host_memory_chunk));
host_mem_chunks[idx].ptr = mem_chunks[idx].paddr;
host_mem_chunks[idx].size = mem_chunks[idx].len;
host_mem_chunks[idx].req_id = mem_chunks[idx].req_id;
host_mem_chunks[idx].ptr = param->mem_chunks[idx].paddr;
host_mem_chunks[idx].size = param->mem_chunks[idx].len;
host_mem_chunks[idx].req_id = param->mem_chunks[idx].req_id;
qdf_print("chunk %d len %d requested ,ptr 0x%x ",
idx, host_mem_chunks[idx].size,
host_mem_chunks[idx].ptr);
}
cmd->num_host_mem_chunks = num_mem_chunks;
len += (num_mem_chunks * sizeof(wlan_host_memory_chunk));
cmd->num_host_mem_chunks = param->num_mem_chunks;
len += (param->num_mem_chunks * sizeof(wlan_host_memory_chunk));
WMITLV_SET_HDR((buf_ptr + sizeof(*cmd) + sizeof(wmi_resource_config)),
WMITLV_TAG_ARRAY_STRUC,
(sizeof(wlan_host_memory_chunk) *
num_mem_chunks));
param->num_mem_chunks));
/* Fill hw mode id config */
buf_ptr = copy_hw_mode_in_init_cmd(buf_ptr, &len, param);
num_whitelist = sizeof(version_whitelist) /
sizeof(wmi_whitelist_version_info);