2 * This file is part of wl1271
4 * Copyright (C) 2010 Nokia Corporation
6 * Contact: Luciano Coelho <luciano.coelho@nokia.com>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * version 2 as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
25 #include <linux/pm_runtime.h>
26 #include <linux/slab.h>
27 #include <net/genetlink.h>
34 #define WL1271_TM_MAX_DATA_LENGTH 1024
36 enum wl1271_tm_commands {
39 WL1271_TM_CMD_INTERROGATE,
40 WL1271_TM_CMD_CONFIGURE,
41 WL1271_TM_CMD_NVS_PUSH, /* Not in use. Keep to not break ABI */
42 WL1271_TM_CMD_SET_PLT_MODE,
43 WL1271_TM_CMD_RECOVER, /* Not in use. Keep to not break ABI */
44 WL1271_TM_CMD_GET_MAC,
46 __WL1271_TM_CMD_AFTER_LAST
48 #define WL1271_TM_CMD_MAX (__WL1271_TM_CMD_AFTER_LAST - 1)
50 enum wl1271_tm_attrs {
51 WL1271_TM_ATTR_UNSPEC,
52 WL1271_TM_ATTR_CMD_ID,
53 WL1271_TM_ATTR_ANSWER,
56 WL1271_TM_ATTR_PLT_MODE,
58 __WL1271_TM_ATTR_AFTER_LAST
60 #define WL1271_TM_ATTR_MAX (__WL1271_TM_ATTR_AFTER_LAST - 1)
62 static struct nla_policy wl1271_tm_policy[WL1271_TM_ATTR_MAX + 1] = {
63 [WL1271_TM_ATTR_CMD_ID] = { .type = NLA_U32 },
64 [WL1271_TM_ATTR_ANSWER] = { .type = NLA_U8 },
65 [WL1271_TM_ATTR_DATA] = { .type = NLA_BINARY,
66 .len = WL1271_TM_MAX_DATA_LENGTH },
67 [WL1271_TM_ATTR_IE_ID] = { .type = NLA_U32 },
68 [WL1271_TM_ATTR_PLT_MODE] = { .type = NLA_U32 },
72 static int wl1271_tm_cmd_test(struct wl1271 *wl, struct nlattr *tb[])
74 int buf_len, ret, len;
79 wl1271_debug(DEBUG_TESTMODE, "testmode cmd test");
81 if (!tb[WL1271_TM_ATTR_DATA])
84 buf = nla_data(tb[WL1271_TM_ATTR_DATA]);
85 buf_len = nla_len(tb[WL1271_TM_ATTR_DATA]);
87 if (tb[WL1271_TM_ATTR_ANSWER])
88 answer = nla_get_u8(tb[WL1271_TM_ATTR_ANSWER]);
90 if (buf_len > sizeof(struct wl1271_command))
93 mutex_lock(&wl->mutex);
95 if (unlikely(wl->state != WLCORE_STATE_ON)) {
100 ret = pm_runtime_get_sync(wl->dev);
102 pm_runtime_put_noidle(wl->dev);
106 ret = wl1271_cmd_test(wl, buf, buf_len, answer);
108 wl1271_warning("testmode cmd test failed: %d", ret);
113 /* If we got bip calibration answer print radio status */
114 struct wl1271_cmd_cal_p2g *params =
115 (struct wl1271_cmd_cal_p2g *) buf;
117 s16 radio_status = (s16) le16_to_cpu(params->radio_status);
119 if (params->test.id == TEST_CMD_P2G_CAL &&
121 wl1271_warning("testmode cmd: radio status=%d",
124 wl1271_info("testmode cmd: radio status=%d",
127 len = nla_total_size(buf_len);
128 skb = cfg80211_testmode_alloc_reply_skb(wl->hw->wiphy, len);
134 if (nla_put(skb, WL1271_TM_ATTR_DATA, buf_len, buf)) {
140 ret = cfg80211_testmode_reply(skb);
146 pm_runtime_mark_last_busy(wl->dev);
147 pm_runtime_put_autosuspend(wl->dev);
149 mutex_unlock(&wl->mutex);
154 static int wl1271_tm_cmd_interrogate(struct wl1271 *wl, struct nlattr *tb[])
157 struct wl1271_command *cmd;
161 wl1271_debug(DEBUG_TESTMODE, "testmode cmd interrogate");
163 if (!tb[WL1271_TM_ATTR_IE_ID])
166 ie_id = nla_get_u8(tb[WL1271_TM_ATTR_IE_ID]);
168 mutex_lock(&wl->mutex);
170 if (unlikely(wl->state != WLCORE_STATE_ON)) {
175 ret = pm_runtime_get_sync(wl->dev);
177 pm_runtime_put_noidle(wl->dev);
181 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
187 ret = wl1271_cmd_interrogate(wl, ie_id, cmd,
188 sizeof(struct acx_header), sizeof(*cmd));
190 wl1271_warning("testmode cmd interrogate failed: %d", ret);
194 skb = cfg80211_testmode_alloc_reply_skb(wl->hw->wiphy, sizeof(*cmd));
200 if (nla_put(skb, WL1271_TM_ATTR_DATA, sizeof(*cmd), cmd)) {
206 ret = cfg80211_testmode_reply(skb);
213 pm_runtime_mark_last_busy(wl->dev);
214 pm_runtime_put_autosuspend(wl->dev);
216 mutex_unlock(&wl->mutex);
221 static int wl1271_tm_cmd_configure(struct wl1271 *wl, struct nlattr *tb[])
227 wl1271_debug(DEBUG_TESTMODE, "testmode cmd configure");
229 if (!tb[WL1271_TM_ATTR_DATA])
231 if (!tb[WL1271_TM_ATTR_IE_ID])
234 ie_id = nla_get_u8(tb[WL1271_TM_ATTR_IE_ID]);
235 buf = nla_data(tb[WL1271_TM_ATTR_DATA]);
236 buf_len = nla_len(tb[WL1271_TM_ATTR_DATA]);
238 if (buf_len > sizeof(struct wl1271_command))
241 mutex_lock(&wl->mutex);
242 ret = wl1271_cmd_configure(wl, ie_id, buf, buf_len);
243 mutex_unlock(&wl->mutex);
246 wl1271_warning("testmode cmd configure failed: %d", ret);
253 static int wl1271_tm_detect_fem(struct wl1271 *wl, struct nlattr *tb[])
255 /* return FEM type */
259 ret = wl1271_plt_start(wl, PLT_FEM_DETECT);
263 mutex_lock(&wl->mutex);
265 len = nla_total_size(sizeof(wl->fem_manuf));
266 skb = cfg80211_testmode_alloc_reply_skb(wl->hw->wiphy, len);
272 if (nla_put(skb, WL1271_TM_ATTR_DATA, sizeof(wl->fem_manuf),
279 ret = cfg80211_testmode_reply(skb);
282 mutex_unlock(&wl->mutex);
284 /* We always stop plt after DETECT mode */
290 static int wl1271_tm_cmd_set_plt_mode(struct wl1271 *wl, struct nlattr *tb[])
295 wl1271_debug(DEBUG_TESTMODE, "testmode cmd set plt mode");
297 if (!tb[WL1271_TM_ATTR_PLT_MODE])
300 val = nla_get_u32(tb[WL1271_TM_ATTR_PLT_MODE]);
304 ret = wl1271_plt_stop(wl);
308 ret = wl1271_plt_start(wl, val);
311 ret = wl1271_tm_detect_fem(wl, tb);
321 static int wl12xx_tm_cmd_get_mac(struct wl1271 *wl, struct nlattr *tb[])
324 u8 mac_addr[ETH_ALEN];
327 mutex_lock(&wl->mutex);
334 if (wl->fuse_oui_addr == 0 && wl->fuse_nic_addr == 0) {
339 mac_addr[0] = (u8)(wl->fuse_oui_addr >> 16);
340 mac_addr[1] = (u8)(wl->fuse_oui_addr >> 8);
341 mac_addr[2] = (u8) wl->fuse_oui_addr;
342 mac_addr[3] = (u8)(wl->fuse_nic_addr >> 16);
343 mac_addr[4] = (u8)(wl->fuse_nic_addr >> 8);
344 mac_addr[5] = (u8) wl->fuse_nic_addr;
346 skb = cfg80211_testmode_alloc_reply_skb(wl->hw->wiphy, ETH_ALEN);
352 if (nla_put(skb, WL1271_TM_ATTR_DATA, ETH_ALEN, mac_addr)) {
358 ret = cfg80211_testmode_reply(skb);
363 mutex_unlock(&wl->mutex);
367 int wl1271_tm_cmd(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
370 struct wl1271 *wl = hw->priv;
371 struct nlattr *tb[WL1271_TM_ATTR_MAX + 1];
375 err = nla_parse(tb, WL1271_TM_ATTR_MAX, data, len, wl1271_tm_policy,
380 if (!tb[WL1271_TM_ATTR_CMD_ID])
383 nla_cmd = nla_get_u32(tb[WL1271_TM_ATTR_CMD_ID]);
385 /* Only SET_PLT_MODE is allowed in case of mode PLT_CHIP_AWAKE */
386 if (wl->plt_mode == PLT_CHIP_AWAKE &&
387 nla_cmd != WL1271_TM_CMD_SET_PLT_MODE)
391 case WL1271_TM_CMD_TEST:
392 return wl1271_tm_cmd_test(wl, tb);
393 case WL1271_TM_CMD_INTERROGATE:
394 return wl1271_tm_cmd_interrogate(wl, tb);
395 case WL1271_TM_CMD_CONFIGURE:
396 return wl1271_tm_cmd_configure(wl, tb);
397 case WL1271_TM_CMD_SET_PLT_MODE:
398 return wl1271_tm_cmd_set_plt_mode(wl, tb);
399 case WL1271_TM_CMD_GET_MAC:
400 return wl12xx_tm_cmd_get_mac(wl, tb);