qcacmn: Converge FTM feature
Support for FTM to make it common between WIN and MCL. Change-Id: I4a65ca6d73d83e71f6a04405b5c41cdddb0a3c71 CRs-fixed: 2148283
Este cometimento está contido em:
akosigi
cometido por
snandini
snandini
ascendente
3550d5a7f6
cometimento
fffcebf2e9
75
os_if/linux/ftm/inc/wlan_cfg80211_ftm.h
Ficheiro normal
75
os_if/linux/ftm/inc/wlan_cfg80211_ftm.h
Ficheiro normal
@@ -0,0 +1,75 @@
|
||||
/*
|
||||
* Copyright (c) 2018 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for
|
||||
* any purpose with or without fee is hereby granted, provided that the
|
||||
* above copyright notice and this permission notice appear in all
|
||||
* copies.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
|
||||
* WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
|
||||
* WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
|
||||
* AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
|
||||
* DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
|
||||
* PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
||||
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
/**
|
||||
* DOC: declares driver FTM functions interfacing with linux kernel
|
||||
*/
|
||||
|
||||
#ifndef _WLAN_CFG80211_FTM_H_
|
||||
#define _WLAN_CFG80211_FTM_H_
|
||||
|
||||
/**
|
||||
* enum wlan_cfg80211_ftm_attr - FTM Netlink attributes
|
||||
* @WLAN_CFG80211_FTM_ATTR_INVALID: attribute is invalid
|
||||
* @WLAN_CFG80211_FTM_ATTR_CMD: attribute type is FTM command
|
||||
* @WLAN_CFG80211_FTM_ATTR_DATA: attribute type is data
|
||||
*
|
||||
* @WLAN_CFG80211_FTM_ATTR_MAX: Max number of attributes
|
||||
*/
|
||||
enum wlan_cfg80211_ftm_attr {
|
||||
WLAN_CFG80211_FTM_ATTR_INVALID = 0,
|
||||
WLAN_CFG80211_FTM_ATTR_CMD = 1,
|
||||
WLAN_CFG80211_FTM_ATTR_DATA = 2,
|
||||
|
||||
/* keep last */
|
||||
WLAN_CFG80211_FTM_ATTR_MAX,
|
||||
};
|
||||
|
||||
/**
|
||||
* enum wlan_cfg80211_ftm_cmd - FTM command types
|
||||
* @WLAN_CFG80211_FTM_CMD_WLAN_FTM: command is of type FTM
|
||||
*/
|
||||
enum wlan_cfg80211_ftm_cmd {
|
||||
WLAN_CFG80211_FTM_CMD_WLAN_FTM = 0,
|
||||
};
|
||||
|
||||
#define WLAN_FTM_DATA_MAX_LEN 2048
|
||||
|
||||
/**
|
||||
* wlan_cfg80211_ftm_testmode_cmd() - process cfg80211 testmode command
|
||||
* @pdev: pdev object
|
||||
* @data: ftm testmode command data of type void
|
||||
* @len: length of the data
|
||||
*
|
||||
* Return: 0 on success or -Eerrno otherwise
|
||||
*/
|
||||
int wlan_cfg80211_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev,
|
||||
void *data, uint32_t len);
|
||||
|
||||
/**
|
||||
* wlan_cfg80211_ftm_rx_event() - handle the received ftm event
|
||||
* @pdev: pdev object
|
||||
* @data: ftm event data
|
||||
* @len: length of the data
|
||||
*
|
||||
* Return: QDF_STATUS_SUCCESS on success or QDF_STATUS_E errno otherwise
|
||||
*/
|
||||
QDF_STATUS wlan_cfg80211_ftm_rx_event(struct wlan_objmgr_pdev *pdev,
|
||||
uint8_t *data, uint32_t len);
|
||||
|
||||
#endif
|
||||
38
os_if/linux/ftm/inc/wlan_ioctl_ftm.h
Ficheiro normal
38
os_if/linux/ftm/inc/wlan_ioctl_ftm.h
Ficheiro normal
@@ -0,0 +1,38 @@
|
||||
/*
|
||||
* Copyright (c) 2018 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for
|
||||
* any purpose with or without fee is hereby granted, provided that the
|
||||
* above copyright notice and this permission notice appear in all
|
||||
* copies.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
|
||||
* WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
|
||||
* WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
|
||||
* AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
|
||||
* DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
|
||||
* PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
||||
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
/**
|
||||
* DOC: declares driver FTM functions interfacing with linux kernel
|
||||
*/
|
||||
|
||||
#ifndef _WLAN_IOCTL_FTM_H_
|
||||
#define _WLAN_IOCTL_FTM_H_
|
||||
|
||||
/**
|
||||
* wlan_ioctl_ftm_testmode_cmd() - handle the ftm ioctl command
|
||||
* @pdev: pdev object
|
||||
* @cmd: ftm command
|
||||
* @userdata: the content of the command
|
||||
* @length: the length of the userdata
|
||||
*
|
||||
* Return: 0 on success, otherwise the error code.
|
||||
*/
|
||||
int wlan_ioctl_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev, int cmd,
|
||||
uint8_t *userdata, uint32_t length);
|
||||
|
||||
#endif
|
||||
154
os_if/linux/ftm/src/wlan_cfg80211_ftm.c
Ficheiro normal
154
os_if/linux/ftm/src/wlan_cfg80211_ftm.c
Ficheiro normal
@@ -0,0 +1,154 @@
|
||||
/*
|
||||
* Copyright (c) 2018 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for
|
||||
* any purpose with or without fee is hereby granted, provided that the
|
||||
* above copyright notice and this permission notice appear in all
|
||||
* copies.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
|
||||
* WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
|
||||
* WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
|
||||
* AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
|
||||
* DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
|
||||
* PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
||||
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
/**
|
||||
* DOC: implementation of the driver FTM functions interfacing with linux kernel
|
||||
*/
|
||||
|
||||
#include <net/cfg80211.h>
|
||||
#include <qdf_util.h>
|
||||
#include <wlan_objmgr_pdev_obj.h>
|
||||
#include <wlan_cfg80211_ftm.h>
|
||||
#include <wlan_ftm_ucfg_api.h>
|
||||
#include <wlan_osif_priv.h>
|
||||
#include <qdf_types.h>
|
||||
#include <qdf_module.h>
|
||||
|
||||
static const struct nla_policy
|
||||
wlan_cfg80211_ftm_policy[WLAN_CFG80211_FTM_ATTR_MAX + 1] = {
|
||||
[WLAN_CFG80211_FTM_ATTR_CMD] = {.type = NLA_U32},
|
||||
[WLAN_CFG80211_FTM_ATTR_DATA] = {.type = NLA_BINARY,
|
||||
.len = WLAN_FTM_DATA_MAX_LEN},
|
||||
};
|
||||
|
||||
static int
|
||||
wlan_cfg80211_process_ftm_cmd(struct wlan_objmgr_pdev *pdev,
|
||||
struct nlattr *tb[])
|
||||
{
|
||||
int buf_len;
|
||||
void *buf;
|
||||
QDF_STATUS status;
|
||||
|
||||
if (!tb[WLAN_CFG80211_FTM_ATTR_DATA]) {
|
||||
ftm_err("WLAN_CFG80211_FTM_ATTR_DATA attribute is invalid");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
buf = nla_data(tb[WLAN_CFG80211_FTM_ATTR_DATA]);
|
||||
buf_len = nla_len(tb[WLAN_CFG80211_FTM_ATTR_DATA]);
|
||||
|
||||
if (buf_len > WLAN_FTM_DATA_MAX_LEN)
|
||||
return -EINVAL;
|
||||
|
||||
ftm_debug("****FTM Tx cmd len = %d*****", buf_len);
|
||||
|
||||
status = ucfg_wlan_ftm_testmode_cmd(pdev, buf, buf_len);
|
||||
|
||||
if (QDF_IS_STATUS_ERROR(status))
|
||||
status = QDF_STATUS_E_BUSY;
|
||||
|
||||
return qdf_status_to_os_return(status);
|
||||
}
|
||||
|
||||
int
|
||||
wlan_cfg80211_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev,
|
||||
void *data, uint32_t len)
|
||||
{
|
||||
struct nlattr *tb[WLAN_CFG80211_FTM_ATTR_MAX + 1];
|
||||
int err = 0, cmd;
|
||||
struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
|
||||
|
||||
ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
|
||||
WLAN_UMAC_COMP_FTM);
|
||||
if (!ftm_pdev_obj) {
|
||||
ftm_err("Failed to get ftm pdev component");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_NL80211;
|
||||
|
||||
err = nla_parse(tb, WLAN_CFG80211_FTM_ATTR_MAX - 1, data,
|
||||
len, wlan_cfg80211_ftm_policy);
|
||||
if (err) {
|
||||
ftm_err("Testmode INV ATTR");
|
||||
return err;
|
||||
}
|
||||
|
||||
if (!tb[WLAN_CFG80211_FTM_ATTR_CMD]) {
|
||||
ftm_err("Testmode INV CMD");
|
||||
return -EINVAL;
|
||||
}
|
||||
cmd = nla_get_u32(tb[WLAN_CFG80211_FTM_ATTR_CMD]);
|
||||
|
||||
switch (cmd) {
|
||||
case WLAN_CFG80211_FTM_CMD_WLAN_FTM:
|
||||
err = wlan_cfg80211_process_ftm_cmd(pdev, tb);
|
||||
break;
|
||||
|
||||
default:
|
||||
ftm_err("unknown command: %d", cmd);
|
||||
return -ENOENT;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
qdf_export_symbol(wlan_cfg80211_ftm_testmode_cmd);
|
||||
|
||||
QDF_STATUS
|
||||
wlan_cfg80211_ftm_rx_event(struct wlan_objmgr_pdev *pdev,
|
||||
uint8_t *data, uint32_t len)
|
||||
{
|
||||
struct pdev_osif_priv *pdev_ospriv;
|
||||
qdf_nbuf_t skb = NULL;
|
||||
|
||||
if (!data || !len) {
|
||||
ftm_err("Null data or invalid length");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
pdev_ospriv = wlan_pdev_get_ospriv(pdev);
|
||||
if (!pdev_ospriv) {
|
||||
ftm_err("pdev_ospriv is NULL");
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
|
||||
ftm_debug("Testmode response event generated");
|
||||
|
||||
skb = cfg80211_testmode_alloc_event_skb(pdev_ospriv->wiphy,
|
||||
len, GFP_ATOMIC);
|
||||
|
||||
if (!skb)
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
|
||||
if (nla_put_u32(skb, WLAN_CFG80211_FTM_ATTR_CMD,
|
||||
WLAN_CFG80211_FTM_CMD_WLAN_FTM) ||
|
||||
nla_put(skb, WLAN_CFG80211_FTM_ATTR_DATA, len, data)) {
|
||||
goto nla_put_failure;
|
||||
}
|
||||
|
||||
cfg80211_testmode_event(skb, GFP_ATOMIC);
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
|
||||
nla_put_failure:
|
||||
qdf_nbuf_free(skb);
|
||||
ftm_err("nla_put failed on testmode rx skb!");
|
||||
|
||||
return QDF_STATUS_E_INVAL;
|
||||
}
|
||||
115
os_if/linux/ftm/src/wlan_ioctl_ftm.c
Ficheiro normal
115
os_if/linux/ftm/src/wlan_ioctl_ftm.c
Ficheiro normal
@@ -0,0 +1,115 @@
|
||||
/*
|
||||
* Copyright (c) 2018 The Linux Foundation. All rights reserved.
|
||||
*
|
||||
* Permission to use, copy, modify, and/or distribute this software for
|
||||
* any purpose with or without fee is hereby granted, provided that the
|
||||
* above copyright notice and this permission notice appear in all
|
||||
* copies.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
|
||||
* WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
|
||||
* WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
|
||||
* AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
|
||||
* DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
|
||||
* PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
|
||||
* TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
|
||||
* PERFORMANCE OF THIS SOFTWARE.
|
||||
*/
|
||||
|
||||
/**
|
||||
* DOC: implementation of the driver FTM functions interfacing with linux kernel
|
||||
*/
|
||||
|
||||
#include <qdf_util.h>
|
||||
#include <wlan_objmgr_pdev_obj.h>
|
||||
#include <wlan_ftm_ucfg_api.h>
|
||||
#include <qdf_types.h>
|
||||
#include <qdf_module.h>
|
||||
#include <wlan_cfg80211_ftm.h>
|
||||
#include <wlan_ioctl_ftm.h>
|
||||
|
||||
static QDF_STATUS
|
||||
wlan_process_ftm_ioctl_cmd(struct wlan_objmgr_pdev *pdev,
|
||||
uint8_t *userdata, uint32_t length)
|
||||
{
|
||||
uint8_t *buffer;
|
||||
QDF_STATUS error;
|
||||
|
||||
if (get_user(length, (uint32_t *)userdata) != 0)
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
|
||||
if (length > WLAN_FTM_DATA_MAX_LEN)
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
|
||||
buffer = qdf_mem_malloc(length);
|
||||
if (!buffer)
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
|
||||
if (copy_from_user(buffer, &userdata[sizeof(length)], length))
|
||||
error = QDF_STATUS_E_FAILURE;
|
||||
else
|
||||
error = ucfg_wlan_ftm_testmode_cmd(pdev, buffer, length);
|
||||
|
||||
qdf_mem_free(buffer);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
static QDF_STATUS
|
||||
wlan_process_ftm_ioctl_rsp(struct wlan_objmgr_pdev *pdev,
|
||||
uint8_t *userdata, uint32_t length)
|
||||
{
|
||||
uint8_t *buffer;
|
||||
QDF_STATUS error;
|
||||
|
||||
length = WLAN_FTM_DATA_MAX_LEN + sizeof(u_int32_t);
|
||||
|
||||
buffer = qdf_mem_malloc(length);
|
||||
if (!buffer)
|
||||
return QDF_STATUS_E_NOMEM;
|
||||
|
||||
error = ucfg_wlan_ftm_testmode_rsp(pdev, buffer);
|
||||
if (!error)
|
||||
error = copy_to_user((userdata - sizeof(int)), buffer, length);
|
||||
else
|
||||
error = QDF_STATUS_E_AGAIN;
|
||||
|
||||
qdf_mem_free(buffer);
|
||||
|
||||
return error;
|
||||
}
|
||||
|
||||
int
|
||||
wlan_ioctl_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev, int cmd,
|
||||
uint8_t *userdata, uint32_t length)
|
||||
{
|
||||
QDF_STATUS error;
|
||||
struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
|
||||
|
||||
ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
|
||||
WLAN_UMAC_COMP_FTM);
|
||||
if (!ftm_pdev_obj) {
|
||||
ftm_err("Failed to get ftm pdev component");
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_IOCTL;
|
||||
|
||||
switch (cmd) {
|
||||
case FTM_IOCTL_UNIFIED_UTF_CMD:
|
||||
error = wlan_process_ftm_ioctl_cmd(pdev,
|
||||
userdata, length);
|
||||
break;
|
||||
case FTM_IOCTL_UNIFIED_UTF_RSP:
|
||||
error = wlan_process_ftm_ioctl_rsp(pdev,
|
||||
userdata, length);
|
||||
break;
|
||||
default:
|
||||
ftm_err("FTM Unknown cmd - not supported");
|
||||
error = QDF_STATUS_E_NOSUPPORT;
|
||||
}
|
||||
|
||||
return qdf_status_to_os_return(error);
|
||||
}
|
||||
|
||||
qdf_export_symbol(wlan_ioctl_ftm_testmode_cmd);
|
||||
Criar uma nova questão referindo esta
Bloquear um utilizador