|
|
@@ -0,0 +1,167 @@
|
|
|
+/*
|
|
|
+ * Copyright (c) 2010-2011 Atheros Communications Inc.
|
|
|
+ *
|
|
|
+ * 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.
|
|
|
+ */
|
|
|
+
|
|
|
+#include "testmode.h"
|
|
|
+
|
|
|
+#include <net/netlink.h>
|
|
|
+
|
|
|
+enum ath6kl_tm_attr {
|
|
|
+ __ATH6KL_TM_ATTR_INVALID = 0,
|
|
|
+ ATH6KL_TM_ATTR_CMD = 1,
|
|
|
+ ATH6KL_TM_ATTR_DATA = 2,
|
|
|
+
|
|
|
+ /* keep last */
|
|
|
+ __ATH6KL_TM_ATTR_AFTER_LAST,
|
|
|
+ ATH6KL_TM_ATTR_MAX = __ATH6KL_TM_ATTR_AFTER_LAST - 1,
|
|
|
+};
|
|
|
+
|
|
|
+enum ath6kl_tm_cmd {
|
|
|
+ ATH6KL_TM_CMD_TCMD = 0,
|
|
|
+ ATH6KL_TM_CMD_RX_REPORT = 1,
|
|
|
+};
|
|
|
+
|
|
|
+#define ATH6KL_TM_DATA_MAX_LEN 5000
|
|
|
+
|
|
|
+static const struct nla_policy ath6kl_tm_policy[ATH6KL_TM_ATTR_MAX + 1] = {
|
|
|
+ [ATH6KL_TM_ATTR_CMD] = { .type = NLA_U32 },
|
|
|
+ [ATH6KL_TM_ATTR_DATA] = { .type = NLA_BINARY,
|
|
|
+ .len = ATH6KL_TM_DATA_MAX_LEN },
|
|
|
+};
|
|
|
+
|
|
|
+void ath6kl_tm_rx_report_event(struct ath6kl *ar, void *buf, size_t buf_len)
|
|
|
+{
|
|
|
+ if (down_interruptible(&ar->sem))
|
|
|
+ return;
|
|
|
+
|
|
|
+ kfree(ar->tm.rx_report);
|
|
|
+
|
|
|
+ ar->tm.rx_report = kmemdup(buf, buf_len, GFP_KERNEL);
|
|
|
+ ar->tm.rx_report_len = buf_len;
|
|
|
+
|
|
|
+ up(&ar->sem);
|
|
|
+
|
|
|
+ wake_up(&ar->event_wq);
|
|
|
+}
|
|
|
+
|
|
|
+static int ath6kl_tm_rx_report(struct ath6kl *ar, void *buf, size_t buf_len,
|
|
|
+ struct sk_buff *skb)
|
|
|
+{
|
|
|
+ int ret = 0;
|
|
|
+ long left;
|
|
|
+
|
|
|
+ if (down_interruptible(&ar->sem))
|
|
|
+ return -ERESTARTSYS;
|
|
|
+
|
|
|
+ if (!test_bit(WMI_READY, &ar->flag)) {
|
|
|
+ ret = -EIO;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) {
|
|
|
+ ret = -EBUSY;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ath6kl_wmi_test_cmd(ar->wmi, buf, buf_len) < 0) {
|
|
|
+ up(&ar->sem);
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+
|
|
|
+ left = wait_event_interruptible_timeout(ar->event_wq,
|
|
|
+ ar->tm.rx_report != NULL,
|
|
|
+ WMI_TIMEOUT);
|
|
|
+
|
|
|
+ if (left == 0) {
|
|
|
+ ret = -ETIMEDOUT;
|
|
|
+ goto out;
|
|
|
+ } else if (left < 0) {
|
|
|
+ ret = left;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (ar->tm.rx_report == NULL || ar->tm.rx_report_len == 0) {
|
|
|
+ ret = -EINVAL;
|
|
|
+ goto out;
|
|
|
+ }
|
|
|
+
|
|
|
+ NLA_PUT(skb, ATH6KL_TM_ATTR_DATA, ar->tm.rx_report_len,
|
|
|
+ ar->tm.rx_report);
|
|
|
+
|
|
|
+ kfree(ar->tm.rx_report);
|
|
|
+ ar->tm.rx_report = NULL;
|
|
|
+
|
|
|
+out:
|
|
|
+ up(&ar->sem);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+
|
|
|
+nla_put_failure:
|
|
|
+ ret = -ENOBUFS;
|
|
|
+ goto out;
|
|
|
+}
|
|
|
+
|
|
|
+int ath6kl_tm_cmd(struct wiphy *wiphy, void *data, int len)
|
|
|
+{
|
|
|
+ struct ath6kl *ar = wiphy_priv(wiphy);
|
|
|
+ struct nlattr *tb[ATH6KL_TM_ATTR_MAX + 1];
|
|
|
+ int err, buf_len, reply_len;
|
|
|
+ struct sk_buff *skb;
|
|
|
+ void *buf;
|
|
|
+
|
|
|
+ err = nla_parse(tb, ATH6KL_TM_ATTR_MAX, data, len,
|
|
|
+ ath6kl_tm_policy);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
+
|
|
|
+ if (!tb[ATH6KL_TM_ATTR_CMD])
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ switch (nla_get_u32(tb[ATH6KL_TM_ATTR_CMD])) {
|
|
|
+ case ATH6KL_TM_CMD_TCMD:
|
|
|
+ if (!tb[ATH6KL_TM_ATTR_DATA])
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]);
|
|
|
+ buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]);
|
|
|
+
|
|
|
+ ath6kl_wmi_test_cmd(ar->wmi, buf, buf_len);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ break;
|
|
|
+ case ATH6KL_TM_CMD_RX_REPORT:
|
|
|
+ if (!tb[ATH6KL_TM_ATTR_DATA])
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ buf = nla_data(tb[ATH6KL_TM_ATTR_DATA]);
|
|
|
+ buf_len = nla_len(tb[ATH6KL_TM_ATTR_DATA]);
|
|
|
+
|
|
|
+ reply_len = nla_total_size(ATH6KL_TM_DATA_MAX_LEN);
|
|
|
+ skb = cfg80211_testmode_alloc_reply_skb(wiphy, reply_len);
|
|
|
+ if (!skb)
|
|
|
+ return -ENOMEM;
|
|
|
+
|
|
|
+ err = ath6kl_tm_rx_report(ar, buf, buf_len, skb);
|
|
|
+ if (err < 0) {
|
|
|
+ kfree_skb(skb);
|
|
|
+ return err;
|
|
|
+ }
|
|
|
+
|
|
|
+ return cfg80211_testmode_reply(skb);
|
|
|
+ default:
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+ }
|
|
|
+}
|
Kalle Valo