1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2018-2019 The Linux Foundation. All rights reserved.
3*5113495bSYour Name *
4*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for
5*5113495bSYour Name * any purpose with or without fee is hereby granted, provided that the
6*5113495bSYour Name * above copyright notice and this permission notice appear in all
7*5113495bSYour Name * copies.
8*5113495bSYour Name *
9*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
10*5113495bSYour Name * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
11*5113495bSYour Name * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
12*5113495bSYour Name * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
13*5113495bSYour Name * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
14*5113495bSYour Name * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
15*5113495bSYour Name * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
16*5113495bSYour Name * PERFORMANCE OF THIS SOFTWARE.
17*5113495bSYour Name */
18*5113495bSYour Name
19*5113495bSYour Name /**
20*5113495bSYour Name * DOC: implementation of the driver FTM functions interfacing with linux kernel
21*5113495bSYour Name */
22*5113495bSYour Name
23*5113495bSYour Name #include <qdf_util.h>
24*5113495bSYour Name #include <wlan_objmgr_pdev_obj.h>
25*5113495bSYour Name #include <wlan_ftm_ucfg_api.h>
26*5113495bSYour Name #include <qdf_types.h>
27*5113495bSYour Name #include <qdf_module.h>
28*5113495bSYour Name #include <wlan_cfg80211_ftm.h>
29*5113495bSYour Name #include <wlan_ioctl_ftm.h>
30*5113495bSYour Name
31*5113495bSYour Name static QDF_STATUS
wlan_process_ftm_ioctl_cmd(struct wlan_objmgr_pdev * pdev,uint8_t * userdata)32*5113495bSYour Name wlan_process_ftm_ioctl_cmd(struct wlan_objmgr_pdev *pdev, uint8_t *userdata)
33*5113495bSYour Name {
34*5113495bSYour Name uint8_t *buffer;
35*5113495bSYour Name QDF_STATUS error;
36*5113495bSYour Name int length;
37*5113495bSYour Name
38*5113495bSYour Name if (get_user(length, (uint32_t *)userdata) != 0)
39*5113495bSYour Name return QDF_STATUS_E_FAILURE;
40*5113495bSYour Name
41*5113495bSYour Name if (length > WLAN_FTM_DATA_MAX_LEN)
42*5113495bSYour Name return QDF_STATUS_E_FAILURE;
43*5113495bSYour Name
44*5113495bSYour Name buffer = qdf_mem_malloc(length);
45*5113495bSYour Name if (!buffer)
46*5113495bSYour Name return QDF_STATUS_E_NOMEM;
47*5113495bSYour Name
48*5113495bSYour Name if (copy_from_user(buffer, &userdata[sizeof(length)], length))
49*5113495bSYour Name error = QDF_STATUS_E_FAILURE;
50*5113495bSYour Name else
51*5113495bSYour Name error = ucfg_wlan_ftm_testmode_cmd(pdev, buffer, length);
52*5113495bSYour Name
53*5113495bSYour Name qdf_mem_free(buffer);
54*5113495bSYour Name
55*5113495bSYour Name return error;
56*5113495bSYour Name }
57*5113495bSYour Name
58*5113495bSYour Name static QDF_STATUS
wlan_process_ftm_ioctl_rsp(struct wlan_objmgr_pdev * pdev,uint8_t * userdata)59*5113495bSYour Name wlan_process_ftm_ioctl_rsp(struct wlan_objmgr_pdev *pdev, uint8_t *userdata)
60*5113495bSYour Name {
61*5113495bSYour Name uint8_t *buffer;
62*5113495bSYour Name QDF_STATUS error;
63*5113495bSYour Name int length;
64*5113495bSYour Name
65*5113495bSYour Name length = WLAN_FTM_DATA_MAX_LEN + sizeof(u_int32_t);
66*5113495bSYour Name
67*5113495bSYour Name buffer = qdf_mem_malloc(length);
68*5113495bSYour Name if (!buffer)
69*5113495bSYour Name return QDF_STATUS_E_NOMEM;
70*5113495bSYour Name
71*5113495bSYour Name error = ucfg_wlan_ftm_testmode_rsp(pdev, buffer);
72*5113495bSYour Name if (!error)
73*5113495bSYour Name error = copy_to_user((userdata - sizeof(int)), buffer, length);
74*5113495bSYour Name else
75*5113495bSYour Name error = QDF_STATUS_E_AGAIN;
76*5113495bSYour Name
77*5113495bSYour Name qdf_mem_free(buffer);
78*5113495bSYour Name
79*5113495bSYour Name return error;
80*5113495bSYour Name }
81*5113495bSYour Name
82*5113495bSYour Name int
wlan_ioctl_ftm_testmode_cmd(struct wlan_objmgr_pdev * pdev,int cmd,uint8_t * userdata)83*5113495bSYour Name wlan_ioctl_ftm_testmode_cmd(struct wlan_objmgr_pdev *pdev, int cmd,
84*5113495bSYour Name uint8_t *userdata)
85*5113495bSYour Name {
86*5113495bSYour Name QDF_STATUS error;
87*5113495bSYour Name struct wifi_ftm_pdev_priv_obj *ftm_pdev_obj;
88*5113495bSYour Name
89*5113495bSYour Name ftm_pdev_obj = wlan_objmgr_pdev_get_comp_private_obj(pdev,
90*5113495bSYour Name WLAN_UMAC_COMP_FTM);
91*5113495bSYour Name if (!ftm_pdev_obj) {
92*5113495bSYour Name ftm_err("Failed to get ftm pdev component");
93*5113495bSYour Name return QDF_STATUS_E_FAILURE;
94*5113495bSYour Name }
95*5113495bSYour Name
96*5113495bSYour Name ftm_pdev_obj->cmd_type = WIFI_FTM_CMD_IOCTL;
97*5113495bSYour Name
98*5113495bSYour Name switch (cmd) {
99*5113495bSYour Name case FTM_IOCTL_UNIFIED_UTF_CMD:
100*5113495bSYour Name error = wlan_process_ftm_ioctl_cmd(pdev, userdata);
101*5113495bSYour Name break;
102*5113495bSYour Name case FTM_IOCTL_UNIFIED_UTF_RSP:
103*5113495bSYour Name error = wlan_process_ftm_ioctl_rsp(pdev, userdata);
104*5113495bSYour Name break;
105*5113495bSYour Name default:
106*5113495bSYour Name ftm_err("FTM Unknown cmd - not supported");
107*5113495bSYour Name error = QDF_STATUS_E_NOSUPPORT;
108*5113495bSYour Name }
109*5113495bSYour Name
110*5113495bSYour Name return qdf_status_to_os_return(error);
111*5113495bSYour Name }
112*5113495bSYour Name
113*5113495bSYour Name qdf_export_symbol(wlan_ioctl_ftm_testmode_cmd);
114