1*5113495bSYour Name /*
2*5113495bSYour Name * Copyright (c) 2020, The Linux Foundation. All rights reserved.
3*5113495bSYour Name * Copyright (c) 2022 Qualcomm Innovation Center, Inc. All rights reserved.
4*5113495bSYour Name *
5*5113495bSYour Name * Permission to use, copy, modify, and/or distribute this software for any
6*5113495bSYour Name * purpose with or without fee is hereby granted, provided that the above
7*5113495bSYour Name * copyright notice and this permission notice appear in all copies.
8*5113495bSYour Name *
9*5113495bSYour Name * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10*5113495bSYour Name * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11*5113495bSYour Name * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12*5113495bSYour Name * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13*5113495bSYour Name * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14*5113495bSYour Name * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15*5113495bSYour Name * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16*5113495bSYour Name */
17*5113495bSYour Name
18*5113495bSYour Name /**
19*5113495bSYour Name * DOC: defines driver functions interfacing with linux kernel
20*5113495bSYour Name */
21*5113495bSYour Name #include <wmi_unified_param.h>
22*5113495bSYour Name #include <wlan_osif_request_manager.h>
23*5113495bSYour Name #include <osif_sync.h>
24*5113495bSYour Name #include <wlan_objmgr_psoc_obj_i.h>
25*5113495bSYour Name #include <wlan_coex_main.h>
26*5113495bSYour Name #include <wlan_coex_ucfg_api.h>
27*5113495bSYour Name #include <wlan_cfg80211_coex.h>
28*5113495bSYour Name
29*5113495bSYour Name const struct nla_policy
30*5113495bSYour Name btc_chain_mode_policy[QCA_VENDOR_ATTR_BTC_CHAIN_MODE_MAX + 1] = {
31*5113495bSYour Name [QCA_VENDOR_ATTR_BTC_CHAIN_MODE] = {.type = NLA_U32},
32*5113495bSYour Name [QCA_VENDOR_ATTR_BTC_CHAIN_MODE_RESTART] = {.type = NLA_FLAG},
33*5113495bSYour Name };
34*5113495bSYour Name
35*5113495bSYour Name static enum coex_btc_chain_mode
__wlan_cfg80211_coex_map_btc_chain_mode(enum qca_btc_chain_mode mode)36*5113495bSYour Name __wlan_cfg80211_coex_map_btc_chain_mode(enum qca_btc_chain_mode mode)
37*5113495bSYour Name {
38*5113495bSYour Name switch (mode) {
39*5113495bSYour Name case QCA_BTC_CHAIN_SHARED:
40*5113495bSYour Name return WLAN_COEX_BTC_CHAIN_MODE_SHARED;
41*5113495bSYour Name case QCA_BTC_CHAIN_SEPARATED_HYBRID:
42*5113495bSYour Name return WLAN_COEX_BTC_CHAIN_MODE_HYBRID;
43*5113495bSYour Name case QCA_BTC_CHAIN_SEPARATED_FDD:
44*5113495bSYour Name return WLAN_COEX_BTC_CHAIN_MODE_FDD;
45*5113495bSYour Name default:
46*5113495bSYour Name return WLAN_COEX_BTC_CHAIN_MODE_UNSETTLED;
47*5113495bSYour Name }
48*5113495bSYour Name }
49*5113495bSYour Name
50*5113495bSYour Name static int
__wlan_cfg80211_coex_set_btc_chain_mode(struct wlan_objmgr_vdev * vdev,enum coex_btc_chain_mode mode,bool do_restart)51*5113495bSYour Name __wlan_cfg80211_coex_set_btc_chain_mode(struct wlan_objmgr_vdev *vdev,
52*5113495bSYour Name enum coex_btc_chain_mode mode,
53*5113495bSYour Name bool do_restart)
54*5113495bSYour Name {
55*5113495bSYour Name QDF_STATUS status;
56*5113495bSYour Name enum coex_btc_chain_mode cur_mode;
57*5113495bSYour Name int err;
58*5113495bSYour Name struct wlan_objmgr_psoc *psoc;
59*5113495bSYour Name struct wlan_objmgr_vdev *vdev_tmp;
60*5113495bSYour Name int vdev_id;
61*5113495bSYour Name struct coex_psoc_obj *coex_obj;
62*5113495bSYour Name
63*5113495bSYour Name if (!vdev) {
64*5113495bSYour Name coex_err("Null vdev");
65*5113495bSYour Name return -EINVAL;
66*5113495bSYour Name }
67*5113495bSYour Name
68*5113495bSYour Name psoc = wlan_vdev_get_psoc(vdev);
69*5113495bSYour Name if (!psoc) {
70*5113495bSYour Name coex_err("NULL psoc");
71*5113495bSYour Name return -EINVAL;
72*5113495bSYour Name }
73*5113495bSYour Name
74*5113495bSYour Name coex_obj = wlan_psoc_get_coex_obj(psoc);
75*5113495bSYour Name if (!coex_obj)
76*5113495bSYour Name return -EINVAL;
77*5113495bSYour Name
78*5113495bSYour Name status = ucfg_coex_psoc_get_btc_chain_mode(psoc, &cur_mode);
79*5113495bSYour Name if (QDF_IS_STATUS_ERROR(status)) {
80*5113495bSYour Name coex_err("failed to get cur BTC chain mode, status %d", status);
81*5113495bSYour Name return -EFAULT;
82*5113495bSYour Name }
83*5113495bSYour Name
84*5113495bSYour Name if (cur_mode == mode)
85*5113495bSYour Name return -EALREADY;
86*5113495bSYour Name
87*5113495bSYour Name status = ucfg_coex_psoc_set_btc_chain_mode(psoc, mode);
88*5113495bSYour Name if (!QDF_IS_STATUS_SUCCESS(status)) {
89*5113495bSYour Name coex_err("unable to set BTC chain mode to %d", mode);
90*5113495bSYour Name return -EFAULT;
91*5113495bSYour Name }
92*5113495bSYour Name
93*5113495bSYour Name wlan_objmgr_for_each_psoc_vdev(psoc, vdev_id, vdev_tmp) {
94*5113495bSYour Name status = ucfg_coex_send_btc_chain_mode(vdev_tmp, mode);
95*5113495bSYour Name err = qdf_status_to_os_return(status);
96*5113495bSYour Name if (err) {
97*5113495bSYour Name coex_err("Failed to set btc chain mode to %d for vdev %d",
98*5113495bSYour Name mode, vdev_id);
99*5113495bSYour Name return err;
100*5113495bSYour Name }
101*5113495bSYour Name coex_debug("Set btc chain mode to %d for vdev %d",
102*5113495bSYour Name mode, vdev_id);
103*5113495bSYour Name
104*5113495bSYour Name if (!do_restart)
105*5113495bSYour Name continue;
106*5113495bSYour Name
107*5113495bSYour Name wlan_coex_config_updated(vdev_tmp, COEX_CONFIG_BTC_CHAIN_MODE);
108*5113495bSYour Name }
109*5113495bSYour Name
110*5113495bSYour Name return 0;
111*5113495bSYour Name }
112*5113495bSYour Name
113*5113495bSYour Name /**
114*5113495bSYour Name * wlan_cfg80211_coex_set_btc_chain_mode() - set btc chain mode
115*5113495bSYour Name * @vdev: pointer to vdev structure.
116*5113495bSYour Name * @data: pointer to btc chain mode command parameters.
117*5113495bSYour Name * @data_len: the length in byte of btc chain mode command parameters.
118*5113495bSYour Name *
119*5113495bSYour Name * Return: An error code or 0 on success.
120*5113495bSYour Name */
wlan_cfg80211_coex_set_btc_chain_mode(struct wlan_objmgr_vdev * vdev,const void * data,int data_len)121*5113495bSYour Name int wlan_cfg80211_coex_set_btc_chain_mode(struct wlan_objmgr_vdev *vdev,
122*5113495bSYour Name const void *data, int data_len)
123*5113495bSYour Name {
124*5113495bSYour Name struct nlattr *tb[QCA_VENDOR_ATTR_BTC_CHAIN_MODE_MAX + 1];
125*5113495bSYour Name uint32_t mode;
126*5113495bSYour Name enum coex_btc_chain_mode chain_mode;
127*5113495bSYour Name bool restart;
128*5113495bSYour Name
129*5113495bSYour Name if (wlan_cfg80211_nla_parse(tb, QCA_VENDOR_ATTR_BTC_CHAIN_MODE_MAX,
130*5113495bSYour Name data, data_len, btc_chain_mode_policy)) {
131*5113495bSYour Name coex_err("Invalid btc chain mode ATTR");
132*5113495bSYour Name return -EINVAL;
133*5113495bSYour Name }
134*5113495bSYour Name
135*5113495bSYour Name if (!tb[QCA_VENDOR_ATTR_BTC_CHAIN_MODE]) {
136*5113495bSYour Name coex_err("btc chain mode - no attr mode");
137*5113495bSYour Name return -EINVAL;
138*5113495bSYour Name }
139*5113495bSYour Name
140*5113495bSYour Name mode = nla_get_u32(tb[QCA_VENDOR_ATTR_BTC_CHAIN_MODE]);
141*5113495bSYour Name if (mode > QCA_BTC_CHAIN_SEPARATED_FDD) {
142*5113495bSYour Name coex_err("Invalid btc chain mode %d", mode);
143*5113495bSYour Name return -EINVAL;
144*5113495bSYour Name }
145*5113495bSYour Name
146*5113495bSYour Name restart = nla_get_flag(tb[QCA_VENDOR_ATTR_BTC_CHAIN_MODE_RESTART]);
147*5113495bSYour Name
148*5113495bSYour Name /* map to internal mode definitions */
149*5113495bSYour Name chain_mode = __wlan_cfg80211_coex_map_btc_chain_mode(mode);
150*5113495bSYour Name if (chain_mode == WLAN_COEX_BTC_CHAIN_MODE_UNSETTLED) {
151*5113495bSYour Name coex_err("Invalid wlan btc chain mode %d", chain_mode);
152*5113495bSYour Name return -EINVAL;
153*5113495bSYour Name }
154*5113495bSYour Name
155*5113495bSYour Name coex_debug("vdev_id %u mode %u restart %u",
156*5113495bSYour Name wlan_vdev_get_id(vdev), chain_mode, restart);
157*5113495bSYour Name
158*5113495bSYour Name return __wlan_cfg80211_coex_set_btc_chain_mode(vdev,
159*5113495bSYour Name chain_mode,
160*5113495bSYour Name restart);
161*5113495bSYour Name }
162