1fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller/* 2fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * This file is part of wl18xx 3fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 4fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * Copyright (C) 2011 Texas Instruments Inc. 5fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 6fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * This program is free software; you can redistribute it and/or 7fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * modify it under the terms of the GNU General Public License 8fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * version 2 as published by the Free Software Foundation. 9fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 10fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * This program is distributed in the hope that it will be useful, but 11fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * WITHOUT ANY WARRANTY; without even the implied warranty of 12fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 13fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * General Public License for more details. 14fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 15fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * You should have received a copy of the GNU General Public License 16fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * along with this program; if not, write to the Free Software 17fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 18fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 02110-1301 USA 19fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller * 20fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller */ 21fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 22fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller#include "../wlcore/cmd.h" 23fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller#include "../wlcore/debug.h" 24fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller#include "../wlcore/hw_ops.h" 25fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 26fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller#include "cmd.h" 27fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 28fcab189027cdd68df7f97474d1419aaa4a82130cEliad Pellerint wl18xx_cmd_channel_switch(struct wl1271 *wl, 29fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller struct wl12xx_vif *wlvif, 30fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller struct ieee80211_channel_switch *ch_switch) 31fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller{ 32fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller struct wl18xx_cmd_channel_switch *cmd; 33fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller u32 supported_rates; 34fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller int ret; 35fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 36fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller wl1271_debug(DEBUG_ACX, "cmd channel switch"); 37fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 38fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd = kzalloc(sizeof(*cmd), GFP_KERNEL); 39fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller if (!cmd) { 40fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller ret = -ENOMEM; 41fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller goto out; 42fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller } 43fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 44fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->role_id = wlvif->role_id; 4585220d71bf3ca1ba9129e0744247ae5f61bec559Johannes Berg cmd->channel = ch_switch->chandef.chan->hw_value; 46fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->switch_time = ch_switch->count; 47fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->stop_tx = ch_switch->block_tx; 48fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 4985220d71bf3ca1ba9129e0744247ae5f61bec559Johannes Berg switch (ch_switch->chandef.chan->band) { 50fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller case IEEE80211_BAND_2GHZ: 51fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->band = WLCORE_BAND_2_4GHZ; 52fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller break; 53fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller case IEEE80211_BAND_5GHZ: 54fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->band = WLCORE_BAND_5GHZ; 55fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller break; 56fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller default: 57fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller wl1271_error("invalid channel switch band: %d", 5885220d71bf3ca1ba9129e0744247ae5f61bec559Johannes Berg ch_switch->chandef.chan->band); 59fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller ret = -EINVAL; 60fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller goto out_free; 61fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller } 62fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 63fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller supported_rates = CONF_TX_ENABLED_RATES | CONF_TX_MCS_RATES | 64fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller wlcore_hw_sta_get_ap_rate_mask(wl, wlvif); 65fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller if (wlvif->p2p) 66fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller supported_rates &= ~CONF_TX_CCK_RATES; 67fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->local_supported_rates = cpu_to_le32(supported_rates); 68fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller cmd->channel_type = wlvif->channel_type; 69fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 70fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller ret = wl1271_cmd_send(wl, CMD_CHANNEL_SWITCH, cmd, sizeof(*cmd), 0); 71fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller if (ret < 0) { 72fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller wl1271_error("failed to send channel switch command"); 73fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller goto out_free; 74fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller } 75fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller 76fcab189027cdd68df7f97474d1419aaa4a82130cEliad Pellerout_free: 77fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller kfree(cmd); 78fcab189027cdd68df7f97474d1419aaa4a82130cEliad Pellerout: 79fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller return ret; 80fcab189027cdd68df7f97474d1419aaa4a82130cEliad Peller} 81ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 82ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerint wl18xx_cmd_smart_config_start(struct wl1271 *wl, u32 group_bitmap) 83ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller{ 84ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller struct wl18xx_cmd_smart_config_start *cmd; 85ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller int ret = 0; 86ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 87ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_debug(DEBUG_CMD, "cmd smart config start group_bitmap=0x%x", 88ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller group_bitmap); 89ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 90ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller cmd = kzalloc(sizeof(*cmd), GFP_KERNEL); 91ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (!cmd) { 92ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = -ENOMEM; 93ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out; 94ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 95ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 96ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller cmd->group_id_bitmask = cpu_to_le32(group_bitmap); 97ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 98ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = wl1271_cmd_send(wl, CMD_SMART_CONFIG_START, cmd, sizeof(*cmd), 0); 99ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (ret < 0) { 100ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_error("failed to send smart config start command"); 101ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out_free; 102ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 103ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 104ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout_free: 105ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller kfree(cmd); 106ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout: 107ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller return ret; 108ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller} 109ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 110ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerint wl18xx_cmd_smart_config_stop(struct wl1271 *wl) 111ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller{ 112ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller struct wl1271_cmd_header *cmd; 113ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller int ret = 0; 114ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 115ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_debug(DEBUG_CMD, "cmd smart config stop"); 116ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 117ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller cmd = kzalloc(sizeof(*cmd), GFP_KERNEL); 118ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (!cmd) { 119ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = -ENOMEM; 120ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out; 121ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 122ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 123ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = wl1271_cmd_send(wl, CMD_SMART_CONFIG_STOP, cmd, sizeof(*cmd), 0); 124ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (ret < 0) { 125ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_error("failed to send smart config stop command"); 126ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out_free; 127ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 128ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 129ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout_free: 130ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller kfree(cmd); 131ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout: 132ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller return ret; 133ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller} 134ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 135ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerint wl18xx_cmd_smart_config_set_group_key(struct wl1271 *wl, u16 group_id, 136ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller u8 key_len, u8 *key) 137ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller{ 138ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller struct wl18xx_cmd_smart_config_set_group_key *cmd; 139ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller int ret = 0; 140ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 141ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_debug(DEBUG_CMD, "cmd smart config set group key id=0x%x", 142ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller group_id); 143ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 144ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (key_len != sizeof(cmd->key)) { 145ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_error("invalid group key size: %d", key_len); 146ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller return -E2BIG; 147ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 148ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 149ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller cmd = kzalloc(sizeof(*cmd), GFP_KERNEL); 150ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (!cmd) { 151ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = -ENOMEM; 152ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out; 153ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 154ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 155ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller cmd->group_id = cpu_to_le32(group_id); 156ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller memcpy(cmd->key, key, key_len); 157ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 158ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller ret = wl1271_cmd_send(wl, CMD_SMART_CONFIG_SET_GROUP_KEY, cmd, 159ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller sizeof(*cmd), 0); 160ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller if (ret < 0) { 161ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller wl1271_error("failed to send smart config set group key cmd"); 162ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller goto out_free; 163ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller } 164ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller 165ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout_free: 166ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller kfree(cmd); 167ccb1df948085abcac0a91154e9cabeb563b65833Eliad Pellerout: 168ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller return ret; 169ccb1df948085abcac0a91154e9cabeb563b65833Eliad Peller} 170