mwifiex: add set_antenna handler support

This enables user to set mode of Tx/Rx path using "iw set antenna"
command. For non MIMO chips, the command will be used for selecting
specific antenna or configuring antenna diversity mode.

Signed-off-by: Amitkumar Karwar <akarwar@marvell.com>
Signed-off-by: Bing Zhao <bzhao@marvell.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

1 files changed, 37 insertions, 0 deletions

diff --git a/drivers/net/wireless/mwifiex/sta_cmd.c b/drivers/net/wireless/mwifiex/sta_cmd.c
index 2d4319a8941f..75eaa6f877fa 100644
--- a/drivers/net/wireless/mwifiex/sta_cmd.c
+++ b/drivers/net/wireless/mwifiex/sta_cmd.c
@@ -277,6 +277,39 @@ static int mwifiex_cmd_rf_tx_power(struct mwifiex_private *priv,
 }
 
 /*
+ * This function prepares command to set rf antenna.
+ */
+static int mwifiex_cmd_rf_antenna(struct mwifiex_private *priv,
+                                  struct host_cmd_ds_command *cmd,
+                                  u16 cmd_action,
+                                  struct mwifiex_ds_ant_cfg *ant_cfg)
+{
+        struct host_cmd_ds_rf_ant_mimo *ant_mimo = &cmd->params.ant_mimo;
+        struct host_cmd_ds_rf_ant_siso *ant_siso = &cmd->params.ant_siso;
+
+        cmd->command = cpu_to_le16(HostCmd_CMD_RF_ANTENNA);
+
+        if (cmd_action != HostCmd_ACT_GEN_SET)
+                return 0;
+
+        if (priv->adapter->hw_dev_mcs_support == HT_STREAM_2X2) {
+                cmd->size = cpu_to_le16(sizeof(struct host_cmd_ds_rf_ant_mimo) +
+                                        S_DS_GEN);
+                ant_mimo->action_tx = cpu_to_le16(HostCmd_ACT_SET_TX);
+                ant_mimo->tx_ant_mode = cpu_to_le16((u16)ant_cfg->tx_ant);
+                ant_mimo->action_rx = cpu_to_le16(HostCmd_ACT_SET_RX);
+                ant_mimo->rx_ant_mode = cpu_to_le16((u16)ant_cfg->rx_ant);
+        } else {
+                cmd->size = cpu_to_le16(sizeof(struct host_cmd_ds_rf_ant_siso) +
+                                        S_DS_GEN);
+                ant_siso->action = cpu_to_le16(HostCmd_ACT_SET_BOTH);
+                ant_siso->ant_mode = cpu_to_le16((u16)ant_cfg->tx_ant);
+        }
+
+        return 0;
+}
+
+/*
  * This function prepares command to set Host Sleep configuration.
  *
  * Preparation includes -
@@ -1076,6 +1109,10 @@ int mwifiex_sta_prepare_cmd(struct mwifiex_private *priv, uint16_t cmd_no,
                 ret = mwifiex_cmd_rf_tx_power(priv, cmd_ptr, cmd_action,
                                               data_buf);
                 break;
+        case HostCmd_CMD_RF_ANTENNA:
+                ret = mwifiex_cmd_rf_antenna(priv, cmd_ptr, cmd_action,
+                                             data_buf);
+                break;
         case HostCmd_CMD_802_11_PS_MODE_ENH:
                 ret = mwifiex_cmd_enh_power_mode(priv, cmd_ptr, cmd_action,
                                                  (uint16_t)cmd_oid, data_buf);