wl12xx: add ROC/CROC commands

Add structs and functions to support the ROC/CROC commands.

Signed-off-by: Eliad Peller <eliad@wizery.com>
Signed-off-by: Luciano Coelho <coelho@ti.com>

diff --git a/drivers/net/wireless/wl12xx/cmd.c b/drivers/net/wireless/wl12xx/cmd.c
index e29343ed6ea2c69dbe5f4b43218e62aa82a2b0ef..1b04102144e60755c5009dc3524378ac7a7f099f 100644 (file)
--- a/drivers/net/wireless/wl12xx/cmd.c
+++ b/drivers/net/wireless/wl12xx/cmd.c
@@ -1481,3 +1481,76 @@ out_free:
 out:
        return ret;
 }
+
+static int wl12xx_cmd_roc(struct wl1271 *wl, u8 role_id)
+{
+       struct wl12xx_cmd_roc *cmd;
+       int ret = 0;
+
+       wl1271_debug(DEBUG_CMD, "cmd roc %d (%d)", wl->channel, role_id);
+
+       if (WARN_ON(role_id == WL12XX_INVALID_ROLE_ID))
+               return -EINVAL;
+
+       cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
+       if (!cmd) {
+               ret = -ENOMEM;
+               goto out;
+       }
+
+       cmd->role_id = role_id;
+       cmd->channel = wl->channel;
+       switch (wl->band) {
+       case IEEE80211_BAND_2GHZ:
+               cmd->band = RADIO_BAND_2_4GHZ;
+               break;
+       case IEEE80211_BAND_5GHZ:
+               cmd->band = RADIO_BAND_5GHZ;
+               break;
+       default:
+               wl1271_error("roc - unknown band: %d", (int)wl->band);
+               ret = -EINVAL;
+               goto out_free;
+       }
+
+
+       ret = wl1271_cmd_send(wl, CMD_REMAIN_ON_CHANNEL, cmd, sizeof(*cmd), 0);
+       if (ret < 0) {
+               wl1271_error("failed to send ROC command");
+               goto out_free;
+       }
+
+out_free:
+       kfree(cmd);
+
+out:
+       return ret;
+}
+
+static int wl12xx_cmd_croc(struct wl1271 *wl, u8 role_id)
+{
+       struct wl12xx_cmd_croc *cmd;
+       int ret = 0;
+
+       wl1271_debug(DEBUG_CMD, "cmd croc (%d)", role_id);
+
+       cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
+       if (!cmd) {
+               ret = -ENOMEM;
+               goto out;
+       }
+       cmd->role_id = role_id;
+
+       ret = wl1271_cmd_send(wl, CMD_CANCEL_REMAIN_ON_CHANNEL, cmd,
+                             sizeof(*cmd), 0);
+       if (ret < 0) {
+               wl1271_error("failed to send ROC command");
+               goto out_free;
+       }
+
+out_free:
+       kfree(cmd);
+
+out:
+       return ret;
+}

diff --git a/drivers/net/wireless/wl12xx/cmd.h b/drivers/net/wireless/wl12xx/cmd.h
index 6950759172f0f9e2353656597ec55a0093daf742..80b02ed0e3f287e453ee91f9b0892fafa8099668 100644 (file)
--- a/drivers/net/wireless/wl12xx/cmd.h
+++ b/drivers/net/wireless/wl12xx/cmd.h
@@ -565,6 +565,22 @@ struct wl12xx_cmd_set_peer_state {
        u8 padding[2];
 } __packed;
 
+struct wl12xx_cmd_roc {
+       struct wl1271_cmd_header header;
+
+       u8 role_id;
+       u8 channel;
+       u8 band;
+       u8 padding;
+};
+
+struct wl12xx_cmd_croc {
+       struct wl1271_cmd_header header;
+
+       u8 role_id;
+       u8 padding[3];
+};
+
 enum wl12xx_ssid_type {
        WL12XX_SSID_TYPE_PUBLIC = 0,
        WL12XX_SSID_TYPE_HIDDEN = 1,