Commit | Line | Data |
---|---|---|
8ca151b5 JB |
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 - 2013 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 | |
410dc5aa | 25 | * in the file called COPYING. |
8ca151b5 JB |
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 - 2013 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 | ||
68 | struct iwl_mvm_quota_iterator_data { | |
69 | int n_interfaces[MAX_BINDINGS]; | |
70 | int colors[MAX_BINDINGS]; | |
71 | struct ieee80211_vif *new_vif; | |
72 | }; | |
73 | ||
74 | static void iwl_mvm_quota_iterator(void *_data, u8 *mac, | |
75 | struct ieee80211_vif *vif) | |
76 | { | |
77 | struct iwl_mvm_quota_iterator_data *data = _data; | |
78 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
79 | u16 id; | |
80 | ||
81 | /* | |
82 | * We'll account for the new interface (if any) below, | |
83 | * skip it here in case we're not called from within | |
84 | * the add_interface callback (otherwise it won't show | |
85 | * up in iteration) | |
86 | */ | |
87 | if (vif == data->new_vif) | |
88 | return; | |
89 | ||
90 | if (!mvmvif->phy_ctxt) | |
91 | return; | |
92 | ||
93 | /* currently, PHY ID == binding ID */ | |
94 | id = mvmvif->phy_ctxt->id; | |
95 | ||
96 | /* need at least one binding per PHY */ | |
97 | BUILD_BUG_ON(NUM_PHY_CTX > MAX_BINDINGS); | |
98 | ||
99 | if (WARN_ON_ONCE(id >= MAX_BINDINGS)) | |
100 | return; | |
101 | ||
102 | if (data->colors[id] < 0) | |
103 | data->colors[id] = mvmvif->phy_ctxt->color; | |
104 | else | |
105 | WARN_ON_ONCE(data->colors[id] != mvmvif->phy_ctxt->color); | |
106 | ||
107 | switch (vif->type) { | |
108 | case NL80211_IFTYPE_STATION: | |
109 | if (vif->bss_conf.assoc) | |
110 | data->n_interfaces[id]++; | |
111 | break; | |
112 | case NL80211_IFTYPE_AP: | |
5023d966 JB |
113 | case NL80211_IFTYPE_ADHOC: |
114 | if (mvmvif->ap_ibss_active) | |
8ca151b5 JB |
115 | data->n_interfaces[id]++; |
116 | break; | |
117 | case NL80211_IFTYPE_MONITOR: | |
1e1391ca IP |
118 | if (mvmvif->monitor_active) |
119 | data->n_interfaces[id]++; | |
8ca151b5 JB |
120 | break; |
121 | case NL80211_IFTYPE_P2P_DEVICE: | |
122 | break; | |
8ca151b5 JB |
123 | default: |
124 | WARN_ON_ONCE(1); | |
125 | break; | |
126 | } | |
127 | } | |
128 | ||
507cadf2 DS |
129 | static void iwl_mvm_adjust_quota_for_noa(struct iwl_mvm *mvm, |
130 | struct iwl_time_quota_cmd *cmd) | |
131 | { | |
132 | #ifdef CONFIG_NL80211_TESTMODE | |
133 | struct iwl_mvm_vif *mvmvif; | |
134 | int i, phy_id = -1, beacon_int = 0; | |
135 | ||
136 | if (!mvm->noa_duration || !mvm->noa_vif) | |
137 | return; | |
138 | ||
139 | mvmvif = iwl_mvm_vif_from_mac80211(mvm->noa_vif); | |
5023d966 | 140 | if (!mvmvif->ap_ibss_active) |
507cadf2 DS |
141 | return; |
142 | ||
143 | phy_id = mvmvif->phy_ctxt->id; | |
144 | beacon_int = mvm->noa_vif->bss_conf.beacon_int; | |
145 | ||
146 | for (i = 0; i < MAX_BINDINGS; i++) { | |
147 | u32 id_n_c = le32_to_cpu(cmd->quotas[i].id_and_color); | |
148 | u32 id = (id_n_c & FW_CTXT_ID_MSK) >> FW_CTXT_ID_POS; | |
149 | u32 quota = le32_to_cpu(cmd->quotas[i].quota); | |
150 | ||
151 | if (id != phy_id) | |
152 | continue; | |
153 | ||
246dd992 DS |
154 | quota *= (beacon_int - mvm->noa_duration); |
155 | quota /= beacon_int; | |
507cadf2 DS |
156 | |
157 | cmd->quotas[i].quota = cpu_to_le32(quota); | |
158 | } | |
159 | #endif | |
160 | } | |
161 | ||
8ca151b5 JB |
162 | int iwl_mvm_update_quotas(struct iwl_mvm *mvm, struct ieee80211_vif *newvif) |
163 | { | |
f5e45f2d | 164 | struct iwl_time_quota_cmd cmd = {}; |
7b8359cf | 165 | int i, idx, ret, num_active_macs, quota, quota_rem; |
8ca151b5 JB |
166 | struct iwl_mvm_quota_iterator_data data = { |
167 | .n_interfaces = {}, | |
168 | .colors = { -1, -1, -1, -1 }, | |
169 | .new_vif = newvif, | |
170 | }; | |
171 | ||
f5e45f2d JB |
172 | lockdep_assert_held(&mvm->mutex); |
173 | ||
8ca151b5 JB |
174 | /* update all upon completion */ |
175 | if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) | |
176 | return 0; | |
177 | ||
f5e45f2d JB |
178 | /* iterator data above must match */ |
179 | BUILD_BUG_ON(MAX_BINDINGS != 4); | |
8ca151b5 JB |
180 | |
181 | ieee80211_iterate_active_interfaces_atomic( | |
182 | mvm->hw, IEEE80211_IFACE_ITER_NORMAL, | |
183 | iwl_mvm_quota_iterator, &data); | |
184 | if (newvif) { | |
185 | data.new_vif = NULL; | |
186 | iwl_mvm_quota_iterator(&data, newvif->addr, newvif); | |
187 | } | |
188 | ||
35adfd6e IP |
189 | /* |
190 | * The FW's scheduling session consists of | |
191 | * IWL_MVM_MAX_QUOTA fragments. Divide these fragments | |
192 | * equally between all the bindings that require quota | |
193 | */ | |
7b8359cf | 194 | num_active_macs = 0; |
35adfd6e IP |
195 | for (i = 0; i < MAX_BINDINGS; i++) { |
196 | cmd.quotas[i].id_and_color = cpu_to_le32(FW_CTXT_INVALID); | |
7b8359cf | 197 | num_active_macs += data.n_interfaces[i]; |
35adfd6e IP |
198 | } |
199 | ||
8d683b79 IP |
200 | quota = 0; |
201 | quota_rem = 0; | |
7b8359cf JB |
202 | if (num_active_macs) { |
203 | quota = IWL_MVM_MAX_QUOTA / num_active_macs; | |
204 | quota_rem = IWL_MVM_MAX_QUOTA % num_active_macs; | |
8d683b79 | 205 | } |
35adfd6e | 206 | |
8ca151b5 | 207 | for (idx = 0, i = 0; i < MAX_BINDINGS; i++) { |
8d683b79 | 208 | if (data.colors[i] < 0) |
8ca151b5 JB |
209 | continue; |
210 | ||
211 | cmd.quotas[idx].id_and_color = | |
212 | cpu_to_le32(FW_CMD_ID_AND_COLOR(i, data.colors[i])); | |
8d683b79 IP |
213 | |
214 | if (data.n_interfaces[i] <= 0) { | |
215 | cmd.quotas[idx].quota = cpu_to_le32(0); | |
216 | cmd.quotas[idx].max_duration = cpu_to_le32(0); | |
217 | } else { | |
7b8359cf JB |
218 | cmd.quotas[idx].quota = |
219 | cpu_to_le32(quota * data.n_interfaces[i]); | |
9470c370 | 220 | cmd.quotas[idx].max_duration = cpu_to_le32(0); |
8d683b79 | 221 | } |
8ca151b5 JB |
222 | idx++; |
223 | } | |
224 | ||
35adfd6e IP |
225 | /* Give the remainder of the session to the first binding */ |
226 | le32_add_cpu(&cmd.quotas[0].quota, quota_rem); | |
8ca151b5 | 227 | |
507cadf2 DS |
228 | iwl_mvm_adjust_quota_for_noa(mvm, &cmd); |
229 | ||
8ca151b5 JB |
230 | ret = iwl_mvm_send_cmd_pdu(mvm, TIME_QUOTA_CMD, CMD_SYNC, |
231 | sizeof(cmd), &cmd); | |
232 | if (ret) | |
233 | IWL_ERR(mvm, "Failed to send quota: %d\n", ret); | |
234 | return ret; | |
235 | } |