1 files changed, 167 insertions, 0 deletions

diff --git a/drivers/net/wireless/ath/ath6kl/testmode.c b/drivers/net/wireless/ath/ath6kl/testmode.c
new file mode 100644
index 000000000000..381eb66a605f
--- /dev/null
+++ b/drivers/net/wireless/ath/ath6kl/testmode.c
@@ -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;
+        }
+}