os_if/linux/ftm/src/wlan_ioctl_ftm.c

/*
 * Copyright (c) 2019 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)
{
	uint8_t *buffer;
	QDF_STATUS error;
	int length;

	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)
{
	uint8_t *buffer;
	QDF_STATUS error;
	int length;

	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)
{
	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);
		break;
	case FTM_IOCTL_UNIFIED_UTF_RSP:
		error = wlan_process_ftm_ioctl_rsp(pdev, userdata);
		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);