1/****************************************************************************** 2 * 3 * This file is provided under a dual BSD/GPLv2 license. When using or 4 * redistributing this file, you may do so under either license. 5 * 6 * GPL LICENSE SUMMARY 7 * 8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of version 2 of the GNU General Public License as 12 * published by the Free Software Foundation. 13 * 14 * This program is distributed in the hope that it will be useful, but 15 * WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 17 * General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, 22 * USA 23 * 24 * The full GNU General Public License is included in this distribution 25 * in the file called COPYING. 26 * 27 * Contact Information: 28 * Intel Linux Wireless <ilw@linux.intel.com> 29 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 30 * 31 * BSD LICENSE 32 * 33 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. 34 * All rights reserved. 35 * 36 * Redistribution and use in source and binary forms, with or without 37 * modification, are permitted provided that the following conditions 38 * are met: 39 * 40 * * Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * * Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in 44 * the documentation and/or other materials provided with the 45 * distribution. 46 * * Neither the name Intel Corporation nor the names of its 47 * contributors may be used to endorse or promote products derived 48 * from this software without specific prior written permission. 49 * 50 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 51 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 52 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 53 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 54 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 55 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 56 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 57 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 58 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 59 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 60 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 61 * 62 *****************************************************************************/ 63 64#include <net/mac80211.h> 65#include "fw-api.h" 66#include "mvm.h" 67 68struct iwl_mvm_iface_iterator_data { 69 struct ieee80211_vif *ignore_vif; 70 int idx; 71 72 struct iwl_mvm_phy_ctxt *phyctxt; 73 74 u16 ids[MAX_MACS_IN_BINDING]; 75 u16 colors[MAX_MACS_IN_BINDING]; 76}; 77 78static int iwl_mvm_binding_cmd(struct iwl_mvm *mvm, u32 action, 79 struct iwl_mvm_iface_iterator_data *data) 80{ 81 struct iwl_binding_cmd cmd; 82 struct iwl_mvm_phy_ctxt *phyctxt = data->phyctxt; 83 int i, ret; 84 u32 status; 85 86 memset(&cmd, 0, sizeof(cmd)); 87 88 cmd.id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(phyctxt->id, 89 phyctxt->color)); 90 cmd.action = cpu_to_le32(action); 91 cmd.phy = cpu_to_le32(FW_CMD_ID_AND_COLOR(phyctxt->id, 92 phyctxt->color)); 93 94 for (i = 0; i < MAX_MACS_IN_BINDING; i++) 95 cmd.macs[i] = cpu_to_le32(FW_CTXT_INVALID); 96 for (i = 0; i < data->idx; i++) 97 cmd.macs[i] = cpu_to_le32(FW_CMD_ID_AND_COLOR(data->ids[i], 98 data->colors[i])); 99 100 status = 0; 101 ret = iwl_mvm_send_cmd_pdu_status(mvm, BINDING_CONTEXT_CMD, 102 sizeof(cmd), &cmd, &status); 103 if (ret) { 104 IWL_ERR(mvm, "Failed to send binding (action:%d): %d\n", 105 action, ret); 106 return ret; 107 } 108 109 if (status) { 110 IWL_ERR(mvm, "Binding command failed: %u\n", status); 111 ret = -EIO; 112 } 113 114 return ret; 115} 116 117static void iwl_mvm_iface_iterator(void *_data, u8 *mac, 118 struct ieee80211_vif *vif) 119{ 120 struct iwl_mvm_iface_iterator_data *data = _data; 121 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 122 123 if (vif == data->ignore_vif) 124 return; 125 126 if (mvmvif->phy_ctxt != data->phyctxt) 127 return; 128 129 if (WARN_ON_ONCE(data->idx >= MAX_MACS_IN_BINDING)) 130 return; 131 132 data->ids[data->idx] = mvmvif->id; 133 data->colors[data->idx] = mvmvif->color; 134 data->idx++; 135} 136 137static int iwl_mvm_binding_update(struct iwl_mvm *mvm, 138 struct ieee80211_vif *vif, 139 struct iwl_mvm_phy_ctxt *phyctxt, 140 bool add) 141{ 142 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 143 struct iwl_mvm_iface_iterator_data data = { 144 .ignore_vif = vif, 145 .phyctxt = phyctxt, 146 }; 147 u32 action = FW_CTXT_ACTION_MODIFY; 148 149 lockdep_assert_held(&mvm->mutex); 150 151 ieee80211_iterate_active_interfaces_atomic(mvm->hw, 152 IEEE80211_IFACE_ITER_NORMAL, 153 iwl_mvm_iface_iterator, 154 &data); 155 156 /* 157 * If there are no other interfaces yet we 158 * need to create a new binding. 159 */ 160 if (data.idx == 0) { 161 if (add) 162 action = FW_CTXT_ACTION_ADD; 163 else 164 action = FW_CTXT_ACTION_REMOVE; 165 } 166 167 if (add) { 168 if (WARN_ON_ONCE(data.idx >= MAX_MACS_IN_BINDING)) 169 return -EINVAL; 170 171 data.ids[data.idx] = mvmvif->id; 172 data.colors[data.idx] = mvmvif->color; 173 data.idx++; 174 } 175 176 return iwl_mvm_binding_cmd(mvm, action, &data); 177} 178 179int iwl_mvm_binding_add_vif(struct iwl_mvm *mvm, struct ieee80211_vif *vif) 180{ 181 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 182 183 if (WARN_ON_ONCE(!mvmvif->phy_ctxt)) 184 return -EINVAL; 185 186 /* 187 * Update SF - Disable if needed. if this fails, SF might still be on 188 * while many macs are bound, which is forbidden - so fail the binding. 189 */ 190 if (iwl_mvm_sf_update(mvm, vif, false)) 191 return -EINVAL; 192 193 return iwl_mvm_binding_update(mvm, vif, mvmvif->phy_ctxt, true); 194} 195 196int iwl_mvm_binding_remove_vif(struct iwl_mvm *mvm, struct ieee80211_vif *vif) 197{ 198 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); 199 int ret; 200 201 if (WARN_ON_ONCE(!mvmvif->phy_ctxt)) 202 return -EINVAL; 203 204 ret = iwl_mvm_binding_update(mvm, vif, mvmvif->phy_ctxt, false); 205 206 if (!ret) 207 if (iwl_mvm_sf_update(mvm, vif, true)) 208 IWL_ERR(mvm, "Failed to update SF state\n"); 209 210 return ret; 211} 212