Branch data Line data Source code
1 : : /*
2 : : * Copyright (c) 2013 Qualcomm Atheros, Inc.
3 : : *
4 : : * Permission to use, copy, modify, and/or distribute this software for any
5 : : * purpose with or without fee is hereby granted, provided that the above
6 : : * copyright notice and this permission notice appear in all copies.
7 : : *
8 : : * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 : : * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 : : * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 : : * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 : : * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 : : * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 : : * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 : : */
16 : :
17 : : #include <linux/relay.h>
18 : : #include <linux/random.h>
19 : : #include "ath9k.h"
20 : :
21 : 0 : static s8 fix_rssi_inv_only(u8 rssi_val)
22 : : {
23 : 0 : if (rssi_val == 128)
24 : 0 : rssi_val = 0;
25 : 0 : return (s8) rssi_val;
26 : : }
27 : :
28 : 0 : static void ath_debug_send_fft_sample(struct ath_spec_scan_priv *spec_priv,
29 : : struct fft_sample_tlv *fft_sample_tlv)
30 : : {
31 : 0 : int length;
32 : 0 : if (!spec_priv->rfs_chan_spec_scan)
33 : : return;
34 : :
35 : 0 : length = __be16_to_cpu(fft_sample_tlv->length) +
36 : : sizeof(*fft_sample_tlv);
37 : 0 : relay_write(spec_priv->rfs_chan_spec_scan, fft_sample_tlv, length);
38 : : }
39 : :
40 : : typedef int (ath_cmn_fft_idx_validator) (u8 *sample_end, int bytes_read);
41 : :
42 : : static int
43 : 0 : ath_cmn_max_idx_verify_ht20_fft(u8 *sample_end, int bytes_read)
44 : : {
45 : 0 : struct ath_ht20_mag_info *mag_info;
46 : 0 : u8 *sample;
47 : 0 : u16 max_magnitude;
48 : 0 : u8 max_index;
49 : 0 : u8 max_exp;
50 : :
51 : : /* Sanity check so that we don't read outside the read
52 : : * buffer
53 : : */
54 [ # # ]: 0 : if (bytes_read < SPECTRAL_HT20_SAMPLE_LEN - 1)
55 : : return -1;
56 : :
57 : 0 : mag_info = (struct ath_ht20_mag_info *) (sample_end -
58 : : sizeof(struct ath_ht20_mag_info) + 1);
59 : :
60 : 0 : sample = sample_end - SPECTRAL_HT20_SAMPLE_LEN + 1;
61 : :
62 [ # # ]: 0 : max_index = spectral_max_index_ht20(mag_info->all_bins);
63 [ # # ]: 0 : max_magnitude = spectral_max_magnitude(mag_info->all_bins);
64 : :
65 : 0 : max_exp = mag_info->max_exp & 0xf;
66 : :
67 : : /* Don't try to read something outside the read buffer
68 : : * in case of a missing byte (so bins[0] will be outside
69 : : * the read buffer)
70 : : */
71 [ # # # # ]: 0 : if (bytes_read < SPECTRAL_HT20_SAMPLE_LEN && max_index < 1)
72 : : return -1;
73 : :
74 [ # # ]: 0 : if ((sample[max_index] & 0xf8) != ((max_magnitude >> max_exp) & 0xf8))
75 : : return -1;
76 : : else
77 : 0 : return 0;
78 : : }
79 : :
80 : : static int
81 : 0 : ath_cmn_max_idx_verify_ht20_40_fft(u8 *sample_end, int bytes_read)
82 : : {
83 : 0 : struct ath_ht20_40_mag_info *mag_info;
84 : 0 : u8 *sample;
85 : 0 : u16 lower_mag, upper_mag;
86 : 0 : u8 lower_max_index, upper_max_index;
87 : 0 : u8 max_exp;
88 : 0 : int dc_pos = SPECTRAL_HT20_40_NUM_BINS / 2;
89 : :
90 : : /* Sanity check so that we don't read outside the read
91 : : * buffer
92 : : */
93 [ # # ]: 0 : if (bytes_read < SPECTRAL_HT20_40_SAMPLE_LEN - 1)
94 : : return -1;
95 : :
96 : 0 : mag_info = (struct ath_ht20_40_mag_info *) (sample_end -
97 : : sizeof(struct ath_ht20_40_mag_info) + 1);
98 : :
99 : 0 : sample = sample_end - SPECTRAL_HT20_40_SAMPLE_LEN + 1;
100 : :
101 [ # # ]: 0 : lower_mag = spectral_max_magnitude(mag_info->lower_bins);
102 [ # # ]: 0 : lower_max_index = spectral_max_index_ht40(mag_info->lower_bins);
103 : :
104 [ # # ]: 0 : upper_mag = spectral_max_magnitude(mag_info->upper_bins);
105 [ # # ]: 0 : upper_max_index = spectral_max_index_ht40(mag_info->upper_bins);
106 : :
107 : 0 : max_exp = mag_info->max_exp & 0xf;
108 : :
109 : : /* Don't try to read something outside the read buffer
110 : : * in case of a missing byte (so bins[0] will be outside
111 : : * the read buffer)
112 : : */
113 [ # # # # ]: 0 : if (bytes_read < SPECTRAL_HT20_40_SAMPLE_LEN &&
114 [ # # ]: 0 : ((upper_max_index < 1) || (lower_max_index < 1)))
115 : : return -1;
116 : :
117 : 0 : if (((sample[upper_max_index + dc_pos] & 0xf8) !=
118 [ # # ]: 0 : ((upper_mag >> max_exp) & 0xf8)) ||
119 : 0 : ((sample[lower_max_index] & 0xf8) !=
120 [ # # ]: 0 : ((lower_mag >> max_exp) & 0xf8)))
121 : : return -1;
122 : : else
123 : 0 : return 0;
124 : : }
125 : :
126 : : typedef int (ath_cmn_fft_sample_handler) (struct ath_rx_status *rs,
127 : : struct ath_spec_scan_priv *spec_priv,
128 : : u8 *sample_buf, u64 tsf, u16 freq, int chan_type);
129 : :
130 : : static int
131 : 0 : ath_cmn_process_ht20_fft(struct ath_rx_status *rs,
132 : : struct ath_spec_scan_priv *spec_priv,
133 : : u8 *sample_buf,
134 : : u64 tsf, u16 freq, int chan_type)
135 : : {
136 : 0 : struct fft_sample_ht20 fft_sample_20;
137 [ # # ]: 0 : struct ath_common *common = ath9k_hw_common(spec_priv->ah);
138 : 0 : struct ath_hw *ah = spec_priv->ah;
139 : 0 : struct ath_ht20_mag_info *mag_info;
140 : 0 : struct fft_sample_tlv *tlv;
141 : 0 : int i = 0;
142 : 0 : int ret = 0;
143 : 0 : int dc_pos = SPECTRAL_HT20_NUM_BINS / 2;
144 : 0 : u16 magnitude, tmp_mag, length;
145 : 0 : u8 max_index, bitmap_w, max_exp;
146 : :
147 : 0 : length = sizeof(fft_sample_20) - sizeof(struct fft_sample_tlv);
148 : 0 : fft_sample_20.tlv.type = ATH_FFT_SAMPLE_HT20;
149 : 0 : fft_sample_20.tlv.length = __cpu_to_be16(length);
150 : 0 : fft_sample_20.freq = __cpu_to_be16(freq);
151 [ # # ]: 0 : fft_sample_20.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
152 : 0 : fft_sample_20.noise = ah->noise;
153 : :
154 : 0 : mag_info = (struct ath_ht20_mag_info *) (sample_buf +
155 : : SPECTRAL_HT20_NUM_BINS);
156 : :
157 [ # # ]: 0 : magnitude = spectral_max_magnitude(mag_info->all_bins);
158 : 0 : fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
159 : :
160 [ # # ]: 0 : max_index = spectral_max_index_ht20(mag_info->all_bins);
161 : 0 : fft_sample_20.max_index = max_index;
162 : :
163 [ # # ]: 0 : bitmap_w = spectral_bitmap_weight(mag_info->all_bins);
164 : 0 : fft_sample_20.bitmap_weight = bitmap_w;
165 : :
166 : 0 : max_exp = mag_info->max_exp & 0xf;
167 : 0 : fft_sample_20.max_exp = max_exp;
168 : :
169 : 0 : fft_sample_20.tsf = __cpu_to_be64(tsf);
170 : :
171 : 0 : memcpy(fft_sample_20.data, sample_buf, SPECTRAL_HT20_NUM_BINS);
172 : :
173 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "FFT HT20 frame: max mag 0x%X,"
174 : : "max_mag_idx %i\n",
175 : : magnitude >> max_exp,
176 : : max_index);
177 : :
178 : 0 : if ((fft_sample_20.data[max_index] & 0xf8) !=
179 [ # # ]: 0 : ((magnitude >> max_exp) & 0xf8)) {
180 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "Magnitude mismatch !\n");
181 : : ret = -1;
182 : : }
183 : :
184 : : /* DC value (value in the middle) is the blind spot of the spectral
185 : : * sample and invalid, interpolate it.
186 : : */
187 : 0 : fft_sample_20.data[dc_pos] = (fft_sample_20.data[dc_pos + 1] +
188 : 0 : fft_sample_20.data[dc_pos - 1]) / 2;
189 : :
190 : : /* Check if the maximum magnitude is indeed maximum,
191 : : * also if the maximum value was at dc_pos, calculate
192 : : * a new one (since value at dc_pos is invalid).
193 : : */
194 [ # # ]: 0 : if (max_index == dc_pos) {
195 : : tmp_mag = 0;
196 [ # # ]: 0 : for (i = 0; i < dc_pos; i++) {
197 [ # # ]: 0 : if (fft_sample_20.data[i] > tmp_mag) {
198 : 0 : tmp_mag = fft_sample_20.data[i];
199 : 0 : fft_sample_20.max_index = i;
200 : : }
201 : : }
202 : :
203 : 0 : magnitude = tmp_mag << max_exp;
204 : 0 : fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
205 : :
206 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
207 : : "Calculated new lower max 0x%X at %i\n",
208 : : tmp_mag, fft_sample_20.max_index);
209 : : } else
210 [ # # ]: 0 : for (i = 0; i < SPECTRAL_HT20_NUM_BINS; i++) {
211 [ # # ]: 0 : if (fft_sample_20.data[i] == (magnitude >> max_exp))
212 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
213 : : "Got max: 0x%X at index %i\n",
214 : : fft_sample_20.data[i], i);
215 : :
216 [ # # ]: 0 : if (fft_sample_20.data[i] > (magnitude >> max_exp)) {
217 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
218 : : "Got bin %i greater than max: 0x%X\n",
219 : : i, fft_sample_20.data[i]);
220 : : ret = -1;
221 : : }
222 : : }
223 : :
224 [ # # ]: 0 : if (ret < 0)
225 : : return ret;
226 : :
227 : 0 : tlv = (struct fft_sample_tlv *)&fft_sample_20;
228 : :
229 [ # # ]: 0 : ath_debug_send_fft_sample(spec_priv, tlv);
230 : :
231 : : return 0;
232 : : }
233 : :
234 : : static int
235 : 0 : ath_cmn_process_ht20_40_fft(struct ath_rx_status *rs,
236 : : struct ath_spec_scan_priv *spec_priv,
237 : : u8 *sample_buf,
238 : : u64 tsf, u16 freq, int chan_type)
239 : : {
240 : 0 : struct fft_sample_ht20_40 fft_sample_40;
241 [ # # ]: 0 : struct ath_common *common = ath9k_hw_common(spec_priv->ah);
242 : 0 : struct ath_hw *ah = spec_priv->ah;
243 : 0 : struct ath9k_hw_cal_data *caldata = ah->caldata;
244 : 0 : struct ath_ht20_40_mag_info *mag_info;
245 : 0 : struct fft_sample_tlv *tlv;
246 : 0 : int dc_pos = SPECTRAL_HT20_40_NUM_BINS / 2;
247 : 0 : int i = 0;
248 : 0 : int ret = 0;
249 : 0 : s16 ext_nf;
250 : 0 : u16 lower_mag, upper_mag, tmp_mag, length;
251 : 0 : s8 lower_rssi, upper_rssi;
252 : 0 : u8 lower_max_index, upper_max_index;
253 : 0 : u8 lower_bitmap_w, upper_bitmap_w, max_exp;
254 : :
255 [ # # ]: 0 : if (caldata)
256 : 0 : ext_nf = ath9k_hw_getchan_noise(ah, ah->curchan,
257 : 0 : caldata->nfCalHist[3].privNF);
258 : : else
259 : : ext_nf = ATH_DEFAULT_NOISE_FLOOR;
260 : :
261 : 0 : length = sizeof(fft_sample_40) - sizeof(struct fft_sample_tlv);
262 : 0 : fft_sample_40.tlv.type = ATH_FFT_SAMPLE_HT20_40;
263 : 0 : fft_sample_40.tlv.length = __cpu_to_be16(length);
264 : 0 : fft_sample_40.freq = __cpu_to_be16(freq);
265 : 0 : fft_sample_40.channel_type = chan_type;
266 : :
267 [ # # ]: 0 : if (chan_type == NL80211_CHAN_HT40PLUS) {
268 [ # # ]: 0 : lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
269 [ # # ]: 0 : upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
270 : :
271 : 0 : fft_sample_40.lower_noise = ah->noise;
272 : 0 : fft_sample_40.upper_noise = ext_nf;
273 : : } else {
274 [ # # ]: 0 : lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
275 [ # # ]: 0 : upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
276 : :
277 : 0 : fft_sample_40.lower_noise = ext_nf;
278 : 0 : fft_sample_40.upper_noise = ah->noise;
279 : : }
280 : :
281 : 0 : fft_sample_40.lower_rssi = lower_rssi;
282 : 0 : fft_sample_40.upper_rssi = upper_rssi;
283 : :
284 : 0 : mag_info = (struct ath_ht20_40_mag_info *) (sample_buf +
285 : : SPECTRAL_HT20_40_NUM_BINS);
286 : :
287 [ # # ]: 0 : lower_mag = spectral_max_magnitude(mag_info->lower_bins);
288 : 0 : fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
289 : :
290 : 0 : upper_mag = spectral_max_magnitude(mag_info->upper_bins);
291 : 0 : fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
292 : :
293 [ # # ]: 0 : lower_max_index = spectral_max_index_ht40(mag_info->lower_bins);
294 : 0 : fft_sample_40.lower_max_index = lower_max_index;
295 : :
296 [ # # ]: 0 : upper_max_index = spectral_max_index_ht40(mag_info->upper_bins);
297 : 0 : fft_sample_40.upper_max_index = upper_max_index;
298 : :
299 [ # # ]: 0 : lower_bitmap_w = spectral_bitmap_weight(mag_info->lower_bins);
300 : 0 : fft_sample_40.lower_bitmap_weight = lower_bitmap_w;
301 : :
302 : 0 : upper_bitmap_w = spectral_bitmap_weight(mag_info->upper_bins);
303 : 0 : fft_sample_40.upper_bitmap_weight = upper_bitmap_w;
304 : :
305 : 0 : max_exp = mag_info->max_exp & 0xf;
306 : 0 : fft_sample_40.max_exp = max_exp;
307 : :
308 : 0 : fft_sample_40.tsf = __cpu_to_be64(tsf);
309 : :
310 : 0 : memcpy(fft_sample_40.data, sample_buf, SPECTRAL_HT20_40_NUM_BINS);
311 : :
312 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "FFT HT20/40 frame: lower mag 0x%X,"
313 : : "lower_mag_idx %i, upper mag 0x%X,"
314 : : "upper_mag_idx %i\n",
315 : : lower_mag >> max_exp,
316 : : lower_max_index,
317 : : upper_mag >> max_exp,
318 : : upper_max_index);
319 : :
320 : : /* Check if we got the expected magnitude values at
321 : : * the expected bins
322 : : */
323 : 0 : if (((fft_sample_40.data[upper_max_index + dc_pos] & 0xf8)
324 [ # # ]: 0 : != ((upper_mag >> max_exp) & 0xf8)) ||
325 : 0 : ((fft_sample_40.data[lower_max_index] & 0xf8)
326 [ # # ]: 0 : != ((lower_mag >> max_exp) & 0xf8))) {
327 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "Magnitude mismatch !\n");
328 : : ret = -1;
329 : : }
330 : :
331 : : /* DC value (value in the middle) is the blind spot of the spectral
332 : : * sample and invalid, interpolate it.
333 : : */
334 : 0 : fft_sample_40.data[dc_pos] = (fft_sample_40.data[dc_pos + 1] +
335 : 0 : fft_sample_40.data[dc_pos - 1]) / 2;
336 : :
337 : : /* Check if the maximum magnitudes are indeed maximum,
338 : : * also if the maximum value was at dc_pos, calculate
339 : : * a new one (since value at dc_pos is invalid).
340 : : */
341 : 0 : if (lower_max_index == dc_pos) {
342 : : tmp_mag = 0;
343 : : for (i = 0; i < dc_pos; i++) {
344 : : if (fft_sample_40.data[i] > tmp_mag) {
345 : : tmp_mag = fft_sample_40.data[i];
346 : : fft_sample_40.lower_max_index = i;
347 : : }
348 : : }
349 : :
350 : : lower_mag = tmp_mag << max_exp;
351 : : fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
352 : :
353 : : ath_dbg(common, SPECTRAL_SCAN,
354 : : "Calculated new lower max 0x%X at %i\n",
355 : : tmp_mag, fft_sample_40.lower_max_index);
356 : : } else
357 [ # # ]: 0 : for (i = 0; i < dc_pos; i++) {
358 [ # # ]: 0 : if (fft_sample_40.data[i] == (lower_mag >> max_exp))
359 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
360 : : "Got lower mag: 0x%X at index %i\n",
361 : : fft_sample_40.data[i], i);
362 : :
363 [ # # ]: 0 : if (fft_sample_40.data[i] > (lower_mag >> max_exp)) {
364 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
365 : : "Got lower bin %i higher than max: 0x%X\n",
366 : : i, fft_sample_40.data[i]);
367 : : ret = -1;
368 : : }
369 : : }
370 : :
371 : : if (upper_max_index == dc_pos) {
372 : : tmp_mag = 0;
373 : : for (i = dc_pos; i < SPECTRAL_HT20_40_NUM_BINS; i++) {
374 : : if (fft_sample_40.data[i] > tmp_mag) {
375 : : tmp_mag = fft_sample_40.data[i];
376 : : fft_sample_40.upper_max_index = i;
377 : : }
378 : : }
379 : : upper_mag = tmp_mag << max_exp;
380 : : fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
381 : :
382 : : ath_dbg(common, SPECTRAL_SCAN,
383 : : "Calculated new upper max 0x%X at %i\n",
384 : : tmp_mag, fft_sample_40.upper_max_index);
385 : : } else
386 [ # # ]: 0 : for (i = dc_pos; i < SPECTRAL_HT20_40_NUM_BINS; i++) {
387 [ # # ]: 0 : if (fft_sample_40.data[i] == (upper_mag >> max_exp))
388 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
389 : : "Got upper mag: 0x%X at index %i\n",
390 : : fft_sample_40.data[i], i);
391 : :
392 [ # # ]: 0 : if (fft_sample_40.data[i] > (upper_mag >> max_exp)) {
393 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
394 : : "Got upper bin %i higher than max: 0x%X\n",
395 : : i, fft_sample_40.data[i]);
396 : :
397 : : ret = -1;
398 : : }
399 : : }
400 : :
401 [ # # ]: 0 : if (ret < 0)
402 : : return ret;
403 : :
404 : 0 : tlv = (struct fft_sample_tlv *)&fft_sample_40;
405 : :
406 [ # # ]: 0 : ath_debug_send_fft_sample(spec_priv, tlv);
407 : :
408 : : return 0;
409 : : }
410 : :
411 : : static inline void
412 : 0 : ath_cmn_copy_fft_frame(u8 *in, u8 *out, int sample_len, int sample_bytes)
413 : : {
414 [ # # # # : 0 : switch (sample_bytes - sample_len) {
# ]
415 : 0 : case -1:
416 : : /* First byte missing */
417 : 0 : memcpy(&out[1], in,
418 : 0 : sample_len - 1);
419 : 0 : break;
420 : 0 : case 0:
421 : : /* Length correct, nothing to do. */
422 : 0 : memcpy(out, in, sample_len);
423 : 0 : break;
424 : 0 : case 1:
425 : : /* MAC added 2 extra bytes AND first byte
426 : : * is missing.
427 : : */
428 : 0 : memcpy(&out[1], in, 30);
429 : 0 : out[31] = in[31];
430 : 0 : memcpy(&out[32], &in[33],
431 : 0 : sample_len - 32);
432 : 0 : break;
433 : 0 : case 2:
434 : : /* MAC added 2 extra bytes at bin 30 and 32,
435 : : * remove them.
436 : : */
437 : 0 : memcpy(out, in, 30);
438 : 0 : out[30] = in[31];
439 : 0 : memcpy(&out[31], &in[33],
440 : 0 : sample_len - 31);
441 : 0 : break;
442 : : default:
443 : : break;
444 : : }
445 : 0 : }
446 : :
447 : : static int
448 : : ath_cmn_is_fft_buf_full(struct ath_spec_scan_priv *spec_priv)
449 : : {
450 : : int i = 0;
451 : : int ret = 0;
452 : : struct rchan_buf *buf;
453 : : struct rchan *rc = spec_priv->rfs_chan_spec_scan;
454 : :
455 : : for_each_possible_cpu(i) {
456 : : if ((buf = *per_cpu_ptr(rc->buf, i))) {
457 : : ret += relay_buf_full(buf);
458 : : }
459 : : }
460 : :
461 : : if (ret)
462 : : return 1;
463 : : else
464 : : return 0;
465 : : }
466 : :
467 : : /* returns 1 if this was a spectral frame, even if not handled. */
468 : 0 : int ath_cmn_process_fft(struct ath_spec_scan_priv *spec_priv, struct ieee80211_hdr *hdr,
469 : : struct ath_rx_status *rs, u64 tsf)
470 : : {
471 : 0 : u8 sample_buf[SPECTRAL_SAMPLE_MAX_LEN] = {0};
472 : 0 : struct ath_hw *ah = spec_priv->ah;
473 [ # # ]: 0 : struct ath_common *common = ath9k_hw_common(spec_priv->ah);
474 : 0 : struct ath_softc *sc = (struct ath_softc *)common->priv;
475 : 0 : u8 num_bins, *vdata = (u8 *)hdr;
476 : 0 : struct ath_radar_info *radar_info;
477 : 0 : int len = rs->rs_datalen;
478 : 0 : int i;
479 : 0 : int got_slen = 0;
480 : 0 : u8 *sample_start;
481 : 0 : int sample_bytes = 0;
482 : 0 : int ret = 0;
483 : 0 : u16 fft_len, sample_len, freq = ah->curchan->chan->center_freq;
484 : 0 : enum nl80211_channel_type chan_type;
485 : 0 : ath_cmn_fft_idx_validator *fft_idx_validator;
486 : 0 : ath_cmn_fft_sample_handler *fft_handler;
487 : :
488 : : /* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
489 : : * via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
490 : : * yet, but this is supposed to be possible as well.
491 : : */
492 [ # # # # ]: 0 : if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
493 [ # # ]: 0 : rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
494 : : rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
495 : : return 0;
496 : :
497 : : /* check if spectral scan bit is set. This does not have to be checked
498 : : * if received through a SPECTRAL phy error, but shouldn't hurt.
499 : : */
500 : 0 : radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
501 [ # # ]: 0 : if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
502 : : return 0;
503 : :
504 [ # # ]: 0 : if (!spec_priv->rfs_chan_spec_scan)
505 : : return 1;
506 : :
507 : : /* Output buffers are full, no need to process anything
508 : : * since there is no space to put the result anyway
509 : : */
510 : 0 : ret = ath_cmn_is_fft_buf_full(spec_priv);
511 [ # # ]: 0 : if (ret == 1) {
512 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "FFT report ignored, no space "
513 : : "left on output buffers\n");
514 : 0 : return 1;
515 : : }
516 : :
517 : 0 : chan_type = cfg80211_get_chandef_type(&common->hw->conf.chandef);
518 [ # # ]: 0 : if ((chan_type == NL80211_CHAN_HT40MINUS) ||
519 : : (chan_type == NL80211_CHAN_HT40PLUS)) {
520 : : fft_len = SPECTRAL_HT20_40_TOTAL_DATA_LEN;
521 : : sample_len = SPECTRAL_HT20_40_SAMPLE_LEN;
522 : : num_bins = SPECTRAL_HT20_40_NUM_BINS;
523 : : fft_idx_validator = &ath_cmn_max_idx_verify_ht20_40_fft;
524 : : fft_handler = &ath_cmn_process_ht20_40_fft;
525 : : } else {
526 : 0 : fft_len = SPECTRAL_HT20_TOTAL_DATA_LEN;
527 : 0 : sample_len = SPECTRAL_HT20_SAMPLE_LEN;
528 : 0 : num_bins = SPECTRAL_HT20_NUM_BINS;
529 : 0 : fft_idx_validator = ath_cmn_max_idx_verify_ht20_fft;
530 : 0 : fft_handler = &ath_cmn_process_ht20_fft;
531 : : }
532 : :
533 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "Got radar dump bw_info: 0x%X,"
534 : : "len: %i fft_len: %i\n",
535 : : radar_info->pulse_bw_info,
536 : : len,
537 : : fft_len);
538 : : sample_start = vdata;
539 [ # # ]: 0 : for (i = 0; i < len - 2; i++) {
540 : 0 : sample_bytes++;
541 : :
542 : : /* Only a single sample received, no need to look
543 : : * for the sample's end, do the correction based
544 : : * on the packet's length instead. Note that hw
545 : : * will always put the radar_info structure on
546 : : * the end.
547 : : */
548 [ # # ]: 0 : if (len <= fft_len + 2) {
549 : 0 : sample_bytes = len - sizeof(struct ath_radar_info);
550 : 0 : got_slen = 1;
551 : : }
552 : :
553 : : /* Search for the end of the FFT frame between
554 : : * sample_len - 1 and sample_len + 2. exp_max is 3
555 : : * bits long and it's the only value on the last
556 : : * byte of the frame so since it'll be smaller than
557 : : * the next byte (the first bin of the next sample)
558 : : * 90% of the time, we can use it as a separator.
559 : : */
560 [ # # # # ]: 0 : if (vdata[i] <= 0x7 && sample_bytes >= sample_len - 1) {
561 : :
562 : : /* Got a frame length within boundaries, there are
563 : : * four scenarios here:
564 : : *
565 : : * a) sample_len -> We got the correct length
566 : : * b) sample_len + 2 -> 2 bytes added around bin[31]
567 : : * c) sample_len - 1 -> The first byte is missing
568 : : * d) sample_len + 1 -> b + c at the same time
569 : : *
570 : : * When MAC adds 2 extra bytes, bin[31] and bin[32]
571 : : * have the same value, so we can use that for further
572 : : * verification in cases b and d.
573 : : */
574 : :
575 : : /* Did we go too far ? If so we couldn't determine
576 : : * this sample's boundaries, discard any further
577 : : * data
578 : : */
579 [ # # # # ]: 0 : if ((sample_bytes > sample_len + 2) ||
580 : 0 : ((sample_bytes > sample_len) &&
581 [ # # ]: 0 : (sample_start[31] != sample_start[32])))
582 : : break;
583 : :
584 : : /* See if we got a valid frame by checking the
585 : : * consistency of mag_info fields. This is to
586 : : * prevent from "fixing" a correct frame.
587 : : * Failure is non-fatal, later frames may
588 : : * be valid.
589 : : */
590 [ # # ]: 0 : if (!fft_idx_validator(&vdata[i], i)) {
591 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN,
592 : : "Found valid fft frame at %i\n", i);
593 : : got_slen = 1;
594 : : }
595 : :
596 : : /* We expect 1 - 2 more bytes */
597 [ # # # # ]: 0 : else if ((sample_start[31] == sample_start[32]) &&
598 [ # # ]: 0 : (sample_bytes >= sample_len) &&
599 : 0 : (sample_bytes < sample_len + 2) &&
600 [ # # ]: 0 : (vdata[i + 1] <= 0x7))
601 : 0 : continue;
602 : :
603 : : /* Try to distinguish cases a and c */
604 [ # # ]: 0 : else if ((sample_bytes == sample_len - 1) &&
605 [ # # ]: 0 : (vdata[i + 1] <= 0x7))
606 : 0 : continue;
607 : :
608 : : got_slen = 1;
609 : : }
610 : :
611 [ # # ]: 0 : if (got_slen) {
612 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "FFT frame len: %i\n",
613 : : sample_bytes);
614 : :
615 : : /* Only try to fix a frame if it's the only one
616 : : * on the report, else just skip it.
617 : : */
618 [ # # # # ]: 0 : if (sample_bytes != sample_len && len <= fft_len + 2) {
619 : 0 : ath_cmn_copy_fft_frame(sample_start,
620 : : sample_buf, sample_len,
621 : : sample_bytes);
622 : :
623 : 0 : ret = fft_handler(rs, spec_priv, sample_buf,
624 : : tsf, freq, chan_type);
625 : :
626 [ # # ]: 0 : if (ret == 0)
627 : 0 : RX_STAT_INC(sc, rx_spectral_sample_good);
628 : : else
629 : 0 : RX_STAT_INC(sc, rx_spectral_sample_err);
630 : :
631 : 0 : memset(sample_buf, 0, SPECTRAL_SAMPLE_MAX_LEN);
632 : :
633 : : /* Mix the received bins to the /dev/random
634 : : * pool
635 : : */
636 : 0 : add_device_randomness(sample_buf, num_bins);
637 : : }
638 : :
639 : : /* Process a normal frame */
640 [ # # ]: 0 : if (sample_bytes == sample_len) {
641 : 0 : ret = fft_handler(rs, spec_priv, sample_start,
642 : : tsf, freq, chan_type);
643 : :
644 [ # # ]: 0 : if (ret == 0)
645 : 0 : RX_STAT_INC(sc, rx_spectral_sample_good);
646 : : else
647 : 0 : RX_STAT_INC(sc, rx_spectral_sample_err);
648 : :
649 : : /* Mix the received bins to the /dev/random
650 : : * pool
651 : : */
652 : 0 : add_device_randomness(sample_start, num_bins);
653 : : }
654 : :
655 : : /* Short report processed, break out of the
656 : : * loop.
657 : : */
658 [ # # ]: 0 : if (len <= fft_len + 2)
659 : : return 1;
660 : :
661 : 0 : sample_start = &vdata[i + 1];
662 : :
663 : : /* -1 to grab sample_len -1, -2 since
664 : : * they 'll get increased by one. In case
665 : : * of failure try to recover by going byte
666 : : * by byte instead.
667 : : */
668 [ # # ]: 0 : if (ret == 0) {
669 : 0 : i += num_bins - 2;
670 : 0 : sample_bytes = num_bins - 2;
671 : : }
672 : : got_slen = 0;
673 : : }
674 : : }
675 : :
676 : 0 : i -= num_bins - 2;
677 [ # # ]: 0 : if (len - i != sizeof(struct ath_radar_info))
678 [ # # ]: 0 : ath_dbg(common, SPECTRAL_SCAN, "FFT report truncated"
679 : : "(bytes left: %i)\n",
680 : : len - i);
681 : : return 1;
682 : : }
683 : : EXPORT_SYMBOL(ath_cmn_process_fft);
684 : :
685 : : /*********************/
686 : : /* spectral_scan_ctl */
687 : : /*********************/
688 : :
689 : 0 : static ssize_t read_file_spec_scan_ctl(struct file *file, char __user *user_buf,
690 : : size_t count, loff_t *ppos)
691 : : {
692 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
693 : 0 : char *mode = "";
694 : 0 : unsigned int len;
695 : :
696 [ # # ]: 0 : switch (spec_priv->spectral_mode) {
697 : : case SPECTRAL_DISABLED:
698 : : mode = "disable";
699 : : break;
700 : : case SPECTRAL_BACKGROUND:
701 : : mode = "background";
702 : : break;
703 : : case SPECTRAL_CHANSCAN:
704 : : mode = "chanscan";
705 : : break;
706 : : case SPECTRAL_MANUAL:
707 : : mode = "manual";
708 : : break;
709 : : }
710 : 0 : len = strlen(mode);
711 : 0 : return simple_read_from_buffer(user_buf, count, ppos, mode, len);
712 : : }
713 : :
714 : 0 : void ath9k_cmn_spectral_scan_trigger(struct ath_common *common,
715 : : struct ath_spec_scan_priv *spec_priv)
716 : : {
717 : 0 : struct ath_hw *ah = spec_priv->ah;
718 : 0 : u32 rxfilter;
719 : :
720 : 0 : if (IS_ENABLED(CONFIG_ATH9K_TX99))
721 : : return;
722 : :
723 [ # # ]: 0 : if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
724 : 0 : ath_err(common, "spectrum analyzer not implemented on this hardware\n");
725 : 0 : return;
726 : : }
727 : :
728 [ # # ]: 0 : if (!spec_priv->spec_config.enabled)
729 : : return;
730 : :
731 : 0 : ath_ps_ops(common)->wakeup(common);
732 : 0 : rxfilter = ath9k_hw_getrxfilter(ah);
733 : 0 : ath9k_hw_setrxfilter(ah, rxfilter |
734 : : ATH9K_RX_FILTER_PHYRADAR |
735 : : ATH9K_RX_FILTER_PHYERR);
736 : :
737 : : /* TODO: usually this should not be neccesary, but for some reason
738 : : * (or in some mode?) the trigger must be called after the
739 : : * configuration, otherwise the register will have its values reset
740 : : * (on my ar9220 to value 0x01002310)
741 : : */
742 : 0 : ath9k_cmn_spectral_scan_config(common, spec_priv, spec_priv->spectral_mode);
743 : 0 : ath9k_hw_ops(ah)->spectral_scan_trigger(ah);
744 : 0 : ath_ps_ops(common)->restore(common);
745 : : }
746 : : EXPORT_SYMBOL(ath9k_cmn_spectral_scan_trigger);
747 : :
748 : 0 : int ath9k_cmn_spectral_scan_config(struct ath_common *common,
749 : : struct ath_spec_scan_priv *spec_priv,
750 : : enum spectral_mode spectral_mode)
751 : : {
752 : 0 : struct ath_hw *ah = spec_priv->ah;
753 : :
754 [ # # ]: 0 : if (!ath9k_hw_ops(ah)->spectral_scan_trigger) {
755 : 0 : ath_err(common, "spectrum analyzer not implemented on this hardware\n");
756 : 0 : return -1;
757 : : }
758 : :
759 [ # # # # ]: 0 : switch (spectral_mode) {
760 : 0 : case SPECTRAL_DISABLED:
761 : 0 : spec_priv->spec_config.enabled = 0;
762 : 0 : break;
763 : 0 : case SPECTRAL_BACKGROUND:
764 : : /* send endless samples.
765 : : * TODO: is this really useful for "background"?
766 : : */
767 : 0 : spec_priv->spec_config.endless = 1;
768 : 0 : spec_priv->spec_config.enabled = 1;
769 : 0 : break;
770 : 0 : case SPECTRAL_CHANSCAN:
771 : : case SPECTRAL_MANUAL:
772 : 0 : spec_priv->spec_config.endless = 0;
773 : 0 : spec_priv->spec_config.enabled = 1;
774 : 0 : break;
775 : : default:
776 : : return -1;
777 : : }
778 : :
779 : 0 : ath_ps_ops(common)->wakeup(common);
780 : 0 : ath9k_hw_ops(ah)->spectral_scan_config(ah, &spec_priv->spec_config);
781 : 0 : ath_ps_ops(common)->restore(common);
782 : :
783 : 0 : spec_priv->spectral_mode = spectral_mode;
784 : :
785 : 0 : return 0;
786 : : }
787 : : EXPORT_SYMBOL(ath9k_cmn_spectral_scan_config);
788 : :
789 : 0 : static ssize_t write_file_spec_scan_ctl(struct file *file,
790 : : const char __user *user_buf,
791 : : size_t count, loff_t *ppos)
792 : : {
793 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
794 : 0 : struct ath_common *common = ath9k_hw_common(spec_priv->ah);
795 : 0 : char buf[32];
796 : 0 : ssize_t len;
797 : :
798 : 0 : if (IS_ENABLED(CONFIG_ATH9K_TX99))
799 : : return -EOPNOTSUPP;
800 : :
801 : 0 : len = min(count, sizeof(buf) - 1);
802 [ # # ]: 0 : if (copy_from_user(buf, user_buf, len))
803 : : return -EFAULT;
804 : :
805 : 0 : buf[len] = '\0';
806 : :
807 [ # # ]: 0 : if (strncmp("trigger", buf, 7) == 0) {
808 : 0 : ath9k_cmn_spectral_scan_trigger(common, spec_priv);
809 [ # # ]: 0 : } else if (strncmp("background", buf, 10) == 0) {
810 : 0 : ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_BACKGROUND);
811 [ # # ]: 0 : ath_dbg(common, CONFIG, "spectral scan: background mode enabled\n");
812 [ # # ]: 0 : } else if (strncmp("chanscan", buf, 8) == 0) {
813 : 0 : ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_CHANSCAN);
814 [ # # ]: 0 : ath_dbg(common, CONFIG, "spectral scan: channel scan mode enabled\n");
815 [ # # ]: 0 : } else if (strncmp("manual", buf, 6) == 0) {
816 : 0 : ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_MANUAL);
817 [ # # ]: 0 : ath_dbg(common, CONFIG, "spectral scan: manual mode enabled\n");
818 [ # # ]: 0 : } else if (strncmp("disable", buf, 7) == 0) {
819 : 0 : ath9k_cmn_spectral_scan_config(common, spec_priv, SPECTRAL_DISABLED);
820 [ # # ]: 0 : ath_dbg(common, CONFIG, "spectral scan: disabled\n");
821 : : } else {
822 : : return -EINVAL;
823 : : }
824 : :
825 : 0 : return count;
826 : : }
827 : :
828 : : static const struct file_operations fops_spec_scan_ctl = {
829 : : .read = read_file_spec_scan_ctl,
830 : : .write = write_file_spec_scan_ctl,
831 : : .open = simple_open,
832 : : .owner = THIS_MODULE,
833 : : .llseek = default_llseek,
834 : : };
835 : :
836 : : /*************************/
837 : : /* spectral_short_repeat */
838 : : /*************************/
839 : :
840 : 0 : static ssize_t read_file_spectral_short_repeat(struct file *file,
841 : : char __user *user_buf,
842 : : size_t count, loff_t *ppos)
843 : : {
844 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
845 : 0 : char buf[32];
846 : 0 : unsigned int len;
847 : :
848 : 0 : len = sprintf(buf, "%d\n", spec_priv->spec_config.short_repeat);
849 : 0 : return simple_read_from_buffer(user_buf, count, ppos, buf, len);
850 : : }
851 : :
852 : 0 : static ssize_t write_file_spectral_short_repeat(struct file *file,
853 : : const char __user *user_buf,
854 : : size_t count, loff_t *ppos)
855 : : {
856 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
857 : 0 : unsigned long val;
858 : 0 : char buf[32];
859 : 0 : ssize_t len;
860 : :
861 : 0 : len = min(count, sizeof(buf) - 1);
862 [ # # ]: 0 : if (copy_from_user(buf, user_buf, len))
863 : : return -EFAULT;
864 : :
865 : 0 : buf[len] = '\0';
866 [ # # ]: 0 : if (kstrtoul(buf, 0, &val))
867 : : return -EINVAL;
868 : :
869 [ # # ]: 0 : if (val > 1)
870 : : return -EINVAL;
871 : :
872 : 0 : spec_priv->spec_config.short_repeat = val;
873 : 0 : return count;
874 : : }
875 : :
876 : : static const struct file_operations fops_spectral_short_repeat = {
877 : : .read = read_file_spectral_short_repeat,
878 : : .write = write_file_spectral_short_repeat,
879 : : .open = simple_open,
880 : : .owner = THIS_MODULE,
881 : : .llseek = default_llseek,
882 : : };
883 : :
884 : : /******************/
885 : : /* spectral_count */
886 : : /******************/
887 : :
888 : 0 : static ssize_t read_file_spectral_count(struct file *file,
889 : : char __user *user_buf,
890 : : size_t count, loff_t *ppos)
891 : : {
892 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
893 : 0 : char buf[32];
894 : 0 : unsigned int len;
895 : :
896 : 0 : len = sprintf(buf, "%d\n", spec_priv->spec_config.count);
897 : 0 : return simple_read_from_buffer(user_buf, count, ppos, buf, len);
898 : : }
899 : :
900 : 0 : static ssize_t write_file_spectral_count(struct file *file,
901 : : const char __user *user_buf,
902 : : size_t count, loff_t *ppos)
903 : : {
904 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
905 : 0 : unsigned long val;
906 : 0 : char buf[32];
907 : 0 : ssize_t len;
908 : :
909 : 0 : len = min(count, sizeof(buf) - 1);
910 [ # # ]: 0 : if (copy_from_user(buf, user_buf, len))
911 : : return -EFAULT;
912 : :
913 : 0 : buf[len] = '\0';
914 [ # # ]: 0 : if (kstrtoul(buf, 0, &val))
915 : : return -EINVAL;
916 : :
917 [ # # ]: 0 : if (val > 255)
918 : : return -EINVAL;
919 : :
920 : 0 : spec_priv->spec_config.count = val;
921 : 0 : return count;
922 : : }
923 : :
924 : : static const struct file_operations fops_spectral_count = {
925 : : .read = read_file_spectral_count,
926 : : .write = write_file_spectral_count,
927 : : .open = simple_open,
928 : : .owner = THIS_MODULE,
929 : : .llseek = default_llseek,
930 : : };
931 : :
932 : : /*******************/
933 : : /* spectral_period */
934 : : /*******************/
935 : :
936 : 0 : static ssize_t read_file_spectral_period(struct file *file,
937 : : char __user *user_buf,
938 : : size_t count, loff_t *ppos)
939 : : {
940 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
941 : 0 : char buf[32];
942 : 0 : unsigned int len;
943 : :
944 : 0 : len = sprintf(buf, "%d\n", spec_priv->spec_config.period);
945 : 0 : return simple_read_from_buffer(user_buf, count, ppos, buf, len);
946 : : }
947 : :
948 : 0 : static ssize_t write_file_spectral_period(struct file *file,
949 : : const char __user *user_buf,
950 : : size_t count, loff_t *ppos)
951 : : {
952 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
953 : 0 : unsigned long val;
954 : 0 : char buf[32];
955 : 0 : ssize_t len;
956 : :
957 : 0 : len = min(count, sizeof(buf) - 1);
958 [ # # ]: 0 : if (copy_from_user(buf, user_buf, len))
959 : : return -EFAULT;
960 : :
961 : 0 : buf[len] = '\0';
962 [ # # ]: 0 : if (kstrtoul(buf, 0, &val))
963 : : return -EINVAL;
964 : :
965 [ # # ]: 0 : if (val > 255)
966 : : return -EINVAL;
967 : :
968 : 0 : spec_priv->spec_config.period = val;
969 : 0 : return count;
970 : : }
971 : :
972 : : static const struct file_operations fops_spectral_period = {
973 : : .read = read_file_spectral_period,
974 : : .write = write_file_spectral_period,
975 : : .open = simple_open,
976 : : .owner = THIS_MODULE,
977 : : .llseek = default_llseek,
978 : : };
979 : :
980 : : /***********************/
981 : : /* spectral_fft_period */
982 : : /***********************/
983 : :
984 : 0 : static ssize_t read_file_spectral_fft_period(struct file *file,
985 : : char __user *user_buf,
986 : : size_t count, loff_t *ppos)
987 : : {
988 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
989 : 0 : char buf[32];
990 : 0 : unsigned int len;
991 : :
992 : 0 : len = sprintf(buf, "%d\n", spec_priv->spec_config.fft_period);
993 : 0 : return simple_read_from_buffer(user_buf, count, ppos, buf, len);
994 : : }
995 : :
996 : 0 : static ssize_t write_file_spectral_fft_period(struct file *file,
997 : : const char __user *user_buf,
998 : : size_t count, loff_t *ppos)
999 : : {
1000 : 0 : struct ath_spec_scan_priv *spec_priv = file->private_data;
1001 : 0 : unsigned long val;
1002 : 0 : char buf[32];
1003 : 0 : ssize_t len;
1004 : :
1005 : 0 : len = min(count, sizeof(buf) - 1);
1006 [ # # ]: 0 : if (copy_from_user(buf, user_buf, len))
1007 : : return -EFAULT;
1008 : :
1009 : 0 : buf[len] = '\0';
1010 [ # # ]: 0 : if (kstrtoul(buf, 0, &val))
1011 : : return -EINVAL;
1012 : :
1013 [ # # ]: 0 : if (val > 15)
1014 : : return -EINVAL;
1015 : :
1016 : 0 : spec_priv->spec_config.fft_period = val;
1017 : 0 : return count;
1018 : : }
1019 : :
1020 : : static const struct file_operations fops_spectral_fft_period = {
1021 : : .read = read_file_spectral_fft_period,
1022 : : .write = write_file_spectral_fft_period,
1023 : : .open = simple_open,
1024 : : .owner = THIS_MODULE,
1025 : : .llseek = default_llseek,
1026 : : };
1027 : :
1028 : : /*******************/
1029 : : /* Relay interface */
1030 : : /*******************/
1031 : :
1032 : 6 : static struct dentry *create_buf_file_handler(const char *filename,
1033 : : struct dentry *parent,
1034 : : umode_t mode,
1035 : : struct rchan_buf *buf,
1036 : : int *is_global)
1037 : : {
1038 : 6 : struct dentry *buf_file;
1039 : :
1040 : 6 : buf_file = debugfs_create_file(filename, mode, parent, buf,
1041 : : &relay_file_operations);
1042 [ + - ]: 6 : if (IS_ERR(buf_file))
1043 : : return NULL;
1044 : :
1045 : 6 : *is_global = 1;
1046 : 6 : return buf_file;
1047 : : }
1048 : :
1049 : 0 : static int remove_buf_file_handler(struct dentry *dentry)
1050 : : {
1051 : 0 : debugfs_remove(dentry);
1052 : :
1053 : 0 : return 0;
1054 : : }
1055 : :
1056 : : static struct rchan_callbacks rfs_spec_scan_cb = {
1057 : : .create_buf_file = create_buf_file_handler,
1058 : : .remove_buf_file = remove_buf_file_handler,
1059 : : };
1060 : :
1061 : : /*********************/
1062 : : /* Debug Init/Deinit */
1063 : : /*********************/
1064 : :
1065 : 0 : void ath9k_cmn_spectral_deinit_debug(struct ath_spec_scan_priv *spec_priv)
1066 : : {
1067 [ # # ]: 0 : if (spec_priv->rfs_chan_spec_scan) {
1068 : 0 : relay_close(spec_priv->rfs_chan_spec_scan);
1069 : 0 : spec_priv->rfs_chan_spec_scan = NULL;
1070 : : }
1071 : 0 : }
1072 : : EXPORT_SYMBOL(ath9k_cmn_spectral_deinit_debug);
1073 : :
1074 : 6 : void ath9k_cmn_spectral_init_debug(struct ath_spec_scan_priv *spec_priv,
1075 : : struct dentry *debugfs_phy)
1076 : : {
1077 : 6 : spec_priv->rfs_chan_spec_scan = relay_open("spectral_scan",
1078 : : debugfs_phy,
1079 : : 1024, 256, &rfs_spec_scan_cb,
1080 : : NULL);
1081 [ + - ]: 6 : if (!spec_priv->rfs_chan_spec_scan)
1082 : : return;
1083 : :
1084 : 6 : debugfs_create_file("spectral_scan_ctl",
1085 : : 0600,
1086 : : debugfs_phy, spec_priv,
1087 : : &fops_spec_scan_ctl);
1088 : 6 : debugfs_create_file("spectral_short_repeat",
1089 : : 0600,
1090 : : debugfs_phy, spec_priv,
1091 : : &fops_spectral_short_repeat);
1092 : 6 : debugfs_create_file("spectral_count",
1093 : : 0600,
1094 : : debugfs_phy, spec_priv,
1095 : : &fops_spectral_count);
1096 : 6 : debugfs_create_file("spectral_period",
1097 : : 0600,
1098 : : debugfs_phy, spec_priv,
1099 : : &fops_spectral_period);
1100 : 6 : debugfs_create_file("spectral_fft_period",
1101 : : 0600,
1102 : : debugfs_phy, spec_priv,
1103 : : &fops_spectral_fft_period);
1104 : : }
1105 : : EXPORT_SYMBOL(ath9k_cmn_spectral_init_debug);
|
