1 /*-
2 * Copyright (c) 2013 Adrian Chadd <adrian@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer,
10 * without modification.
11 * 2. Redistributions in binary form must reproduce at minimum a disclaimer
12 * similar to the "NO WARRANTY" disclaimer below ("Disclaimer") and any
13 * redistribution must be conditioned upon including a substantially
14 * similar Disclaimer requirement for further binary redistribution.
15 *
16 * NO WARRANTY
17 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
18 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
19 * LIMITED TO, THE IMPLIED WARRANTIES OF NONINFRINGEMENT, MERCHANTIBILITY
20 * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL
21 * THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY,
22 * OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER
25 * IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
27 * THE POSSIBILITY OF SUCH DAMAGES.
28 *
29 * $FreeBSD: releng/11.2/sys/dev/ath/if_ath_spectral.c 332303 2018-04-08 20:50:16Z emaste $
30 */
31 #include <sys/cdefs.h>
32 __FBSDID("$FreeBSD: releng/11.2/sys/dev/ath/if_ath_spectral.c 332303 2018-04-08 20:50:16Z emaste $");
33
34 /*
35 * Implement some basic spectral scan control logic.
36 */
37 #include "opt_ath.h"
38 #include "opt_inet.h"
39 #include "opt_wlan.h"
40
41 #include <sys/param.h>
42 #include <sys/systm.h>
43 #include <sys/sysctl.h>
44 #include <sys/kernel.h>
45 #include <sys/lock.h>
46 #include <sys/malloc.h>
47 #include <sys/mutex.h>
48 #include <sys/errno.h>
49
50 #include <machine/bus.h>
51 #include <machine/resource.h>
52 #include <sys/bus.h>
53
54 #include <sys/socket.h>
55
56 #include <net/if.h>
57 #include <net/if_var.h>
58 #include <net/if_media.h>
59 #include <net/if_arp.h>
60 #include <net/ethernet.h> /* XXX for ether_sprintf */
61
62 #include <net80211/ieee80211_var.h>
63
64 #include <net/bpf.h>
65
66 #ifdef INET
67 #include <netinet/in.h>
68 #include <netinet/if_ether.h>
69 #endif
70
71 #include <dev/ath/if_athvar.h>
72 #include <dev/ath/if_ath_spectral.h>
73
74 #include <dev/ath/ath_hal/ah_desc.h>
75
76 struct ath_spectral_state {
77 HAL_SPECTRAL_PARAM spectral_state;
78
79 /*
80 * Should we enable spectral scan upon
81 * each network interface reset/change?
82 *
83 * This is intended to allow spectral scan
84 * frame reporting during channel scans.
85 *
86 * Later on it can morph into a larger
87 * scale config method where it pushes
88 * a "channel scan" config into the hardware
89 * rather than just the spectral_state
90 * config.
91 */
92 int spectral_enable_after_reset;
93 };
94
95 /*
96 * Methods which are required
97 */
98
99 /*
100 * Attach spectral to the given interface
101 */
102 int
103 ath_spectral_attach(struct ath_softc *sc)
104 {
105 struct ath_spectral_state *ss;
106
107 /*
108 * If spectral isn't supported, don't error - just
109 * quietly complete.
110 */
111 if (! ath_hal_spectral_supported(sc->sc_ah))
112 return (0);
113
114 ss = malloc(sizeof(struct ath_spectral_state),
115 M_TEMP, M_WAITOK | M_ZERO);
116
117 if (ss == NULL) {
118 device_printf(sc->sc_dev, "%s: failed to alloc memory\n",
119 __func__);
120 return (-ENOMEM);
121 }
122
123 sc->sc_spectral = ss;
124
125 (void) ath_hal_spectral_get_config(sc->sc_ah, &ss->spectral_state);
126
127 return (0);
128 }
129
130 /*
131 * Detach spectral from the given interface
132 */
133 int
134 ath_spectral_detach(struct ath_softc *sc)
135 {
136
137 if (! ath_hal_spectral_supported(sc->sc_ah))
138 return (0);
139
140 if (sc->sc_spectral != NULL) {
141 free(sc->sc_spectral, M_TEMP);
142 }
143 return (0);
144 }
145
146 /*
147 * Check whether spectral needs enabling and if so,
148 * flip it on.
149 */
150 int
151 ath_spectral_enable(struct ath_softc *sc, struct ieee80211_channel *ch)
152 {
153 struct ath_spectral_state *ss = sc->sc_spectral;
154
155 /* Default to disable spectral PHY reporting */
156 sc->sc_dospectral = 0;
157
158 if (ss == NULL)
159 return (0);
160
161 if (ss->spectral_enable_after_reset) {
162 ath_hal_spectral_configure(sc->sc_ah,
163 &ss->spectral_state);
164 (void) ath_hal_spectral_start(sc->sc_ah);
165 sc->sc_dospectral = 1;
166 }
167 return (0);
168 }
169
170 /*
171 * Handle ioctl requests from the diagnostic interface.
172 *
173 * The initial part of this code resembles ath_ioctl_diag();
174 * it's likely a good idea to reduce duplication between
175 * these two routines.
176 */
177 int
178 ath_ioctl_spectral(struct ath_softc *sc, struct ath_diag *ad)
179 {
180 unsigned int id = ad->ad_id & ATH_DIAG_ID;
181 void *indata = NULL;
182 void *outdata = NULL;
183 u_int32_t insize = ad->ad_in_size;
184 u_int32_t outsize = ad->ad_out_size;
185 int error = 0;
186 HAL_SPECTRAL_PARAM peout;
187 HAL_SPECTRAL_PARAM *pe;
188 struct ath_spectral_state *ss = sc->sc_spectral;
189 int val;
190
191 if (! ath_hal_spectral_supported(sc->sc_ah))
192 return (EINVAL);
193
194 if (ad->ad_id & ATH_DIAG_IN) {
195 /*
196 * Copy in data.
197 */
198 indata = malloc(insize, M_TEMP, M_NOWAIT);
199 if (indata == NULL) {
200 error = ENOMEM;
201 goto bad;
202 }
203 error = copyin(ad->ad_in_data, indata, insize);
204 if (error)
205 goto bad;
206 }
207 if (ad->ad_id & ATH_DIAG_DYN) {
208 /*
209 * Allocate a buffer for the results (otherwise the HAL
210 * returns a pointer to a buffer where we can read the
211 * results). Note that we depend on the HAL leaving this
212 * pointer for us to use below in reclaiming the buffer;
213 * may want to be more defensive.
214 */
215 outdata = malloc(outsize, M_TEMP, M_NOWAIT | M_ZERO);
216 if (outdata == NULL) {
217 error = ENOMEM;
218 goto bad;
219 }
220 }
221 switch (id) {
222 case SPECTRAL_CONTROL_GET_PARAMS:
223 memset(&peout, 0, sizeof(peout));
224 outsize = sizeof(HAL_SPECTRAL_PARAM);
225 ath_hal_spectral_get_config(sc->sc_ah, &peout);
226 pe = (HAL_SPECTRAL_PARAM *) outdata;
227 memcpy(pe, &peout, sizeof(*pe));
228 break;
229 case SPECTRAL_CONTROL_SET_PARAMS:
230 if (insize < sizeof(HAL_SPECTRAL_PARAM)) {
231 error = EINVAL;
232 break;
233 }
234 pe = (HAL_SPECTRAL_PARAM *) indata;
235 ath_hal_spectral_configure(sc->sc_ah, pe);
236 /* Save a local copy of the updated parameters */
237 ath_hal_spectral_get_config(sc->sc_ah,
238 &ss->spectral_state);
239 break;
240 case SPECTRAL_CONTROL_START:
241 ath_hal_spectral_configure(sc->sc_ah,
242 &ss->spectral_state);
243 (void) ath_hal_spectral_start(sc->sc_ah);
244 sc->sc_dospectral = 1;
245 /* XXX need to update the PHY mask in the driver */
246 break;
247 case SPECTRAL_CONTROL_STOP:
248 (void) ath_hal_spectral_stop(sc->sc_ah);
249 sc->sc_dospectral = 0;
250 /* XXX need to update the PHY mask in the driver */
251 break;
252 case SPECTRAL_CONTROL_ENABLE_AT_RESET:
253 if (insize < sizeof(int)) {
254 device_printf(sc->sc_dev, "%d != %d\n",
255 insize,
256 (int) sizeof(int));
257 error = EINVAL;
258 break;
259 }
260 if (indata == NULL) {
261 device_printf(sc->sc_dev, "indata=NULL\n");
262 error = EINVAL;
263 break;
264 }
265 val = * ((int *) indata);
266 if (val == 0)
267 ss->spectral_enable_after_reset = 0;
268 else
269 ss->spectral_enable_after_reset = 1;
270 break;
271 case SPECTRAL_CONTROL_ENABLE:
272 /* XXX TODO */
273 case SPECTRAL_CONTROL_DISABLE:
274 /* XXX TODO */
275 break;
276 default:
277 error = EINVAL;
278 goto bad;
279 }
280 if (outsize < ad->ad_out_size)
281 ad->ad_out_size = outsize;
282 if (outdata && copyout(outdata, ad->ad_out_data, ad->ad_out_size))
283 error = EFAULT;
284 bad:
285 if ((ad->ad_id & ATH_DIAG_IN) && indata != NULL)
286 free(indata, M_TEMP);
287 if ((ad->ad_id & ATH_DIAG_DYN) && outdata != NULL)
288 free(outdata, M_TEMP);
289 return (error);
290 }
291
Cache object: 1cedac30c171e395e4d3acaf33f1655b
|