arn5008.c revision 1.15.2.1 1 1.15.2.1 phil /* $NetBSD: arn5008.c,v 1.15.2.1 2018/07/12 16:35:33 phil Exp $ */
2 1.1 christos /* $OpenBSD: ar5008.c,v 1.21 2012/08/25 12:14:31 kettenis Exp $ */
3 1.1 christos
4 1.1 christos /*-
5 1.1 christos * Copyright (c) 2009 Damien Bergamini <damien.bergamini (at) free.fr>
6 1.1 christos * Copyright (c) 2008-2009 Atheros Communications Inc.
7 1.1 christos *
8 1.1 christos * Permission to use, copy, modify, and/or distribute this software for any
9 1.1 christos * purpose with or without fee is hereby granted, provided that the above
10 1.1 christos * copyright notice and this permission notice appear in all copies.
11 1.1 christos *
12 1.1 christos * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
13 1.1 christos * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
14 1.1 christos * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
15 1.1 christos * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
16 1.1 christos * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 1.1 christos * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18 1.1 christos * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 1.1 christos */
20 1.1 christos
21 1.1 christos /*
22 1.1 christos * Driver for Atheros 802.11a/g/n chipsets.
23 1.1 christos * Routines common to AR5008, AR9001 and AR9002 families.
24 1.1 christos */
25 1.1 christos
26 1.1 christos #include <sys/cdefs.h>
27 1.15.2.1 phil __KERNEL_RCSID(0, "$NetBSD: arn5008.c,v 1.15.2.1 2018/07/12 16:35:33 phil Exp $");
28 1.1 christos
29 1.1 christos #include <sys/param.h>
30 1.1 christos #include <sys/sockio.h>
31 1.1 christos #include <sys/mbuf.h>
32 1.1 christos #include <sys/kernel.h>
33 1.1 christos #include <sys/socket.h>
34 1.1 christos #include <sys/systm.h>
35 1.1 christos #include <sys/malloc.h>
36 1.1 christos #include <sys/queue.h>
37 1.1 christos #include <sys/conf.h>
38 1.1 christos #include <sys/device.h>
39 1.1 christos
40 1.1 christos #include <sys/bus.h>
41 1.1 christos #include <sys/endian.h>
42 1.1 christos #include <sys/intr.h>
43 1.1 christos
44 1.1 christos #include <net/bpf.h>
45 1.1 christos #include <net/if.h>
46 1.1 christos #include <net/if_arp.h>
47 1.1 christos #include <net/if_dl.h>
48 1.2 christos #include <net/if_ether.h>
49 1.1 christos #include <net/if_media.h>
50 1.1 christos #include <net/if_types.h>
51 1.1 christos
52 1.1 christos #include <netinet/in.h>
53 1.1 christos #include <netinet/in_systm.h>
54 1.1 christos #include <netinet/in_var.h>
55 1.1 christos #include <netinet/ip.h>
56 1.1 christos
57 1.1 christos #include <net80211/ieee80211_var.h>
58 1.1 christos #include <net80211/ieee80211_amrr.h>
59 1.1 christos #include <net80211/ieee80211_radiotap.h>
60 1.1 christos
61 1.1 christos #include <dev/ic/athnreg.h>
62 1.1 christos #include <dev/ic/athnvar.h>
63 1.1 christos
64 1.1 christos #include <dev/ic/arn5008reg.h>
65 1.1 christos #include <dev/ic/arn5008.h>
66 1.1 christos #include <dev/ic/arn5416.h>
67 1.1 christos #include <dev/ic/arn9280.h>
68 1.1 christos
69 1.1 christos #define Static static
70 1.1 christos
71 1.1 christos Static void ar5008_calib_adc_dc_off(struct athn_softc *);
72 1.1 christos Static void ar5008_calib_adc_gain(struct athn_softc *);
73 1.1 christos Static void ar5008_calib_iq(struct athn_softc *);
74 1.1 christos Static void ar5008_disable_ofdm_weak_signal(struct athn_softc *);
75 1.1 christos Static void ar5008_disable_phy(struct athn_softc *);
76 1.1 christos Static int ar5008_dma_alloc(struct athn_softc *);
77 1.1 christos Static void ar5008_dma_free(struct athn_softc *);
78 1.1 christos Static void ar5008_do_calib(struct athn_softc *);
79 1.1 christos Static void ar5008_do_noisefloor_calib(struct athn_softc *);
80 1.1 christos Static void ar5008_enable_antenna_diversity(struct athn_softc *);
81 1.1 christos Static void ar5008_enable_ofdm_weak_signal(struct athn_softc *);
82 1.1 christos Static uint8_t ar5008_get_vpd(uint8_t, const uint8_t *, const uint8_t *, int);
83 1.1 christos Static void ar5008_gpio_config_input(struct athn_softc *, int);
84 1.1 christos Static void ar5008_gpio_config_output(struct athn_softc *, int, int);
85 1.1 christos Static int ar5008_gpio_read(struct athn_softc *, int);
86 1.1 christos Static void ar5008_gpio_write(struct athn_softc *, int, int);
87 1.1 christos Static void ar5008_hw_init(struct athn_softc *, struct ieee80211_channel *,
88 1.1 christos struct ieee80211_channel *);
89 1.1 christos Static void ar5008_init_baseband(struct athn_softc *);
90 1.1 christos Static void ar5008_init_chains(struct athn_softc *);
91 1.12 nonaka Static int ar5008_intr_status(struct athn_softc *);
92 1.1 christos Static int ar5008_intr(struct athn_softc *);
93 1.1 christos Static void ar5008_next_calib(struct athn_softc *);
94 1.1 christos Static int ar5008_read_eep_word(struct athn_softc *, uint32_t,
95 1.1 christos uint16_t *);
96 1.1 christos Static int ar5008_read_rom(struct athn_softc *);
97 1.1 christos Static void ar5008_rf_bus_release(struct athn_softc *);
98 1.1 christos Static int ar5008_rf_bus_request(struct athn_softc *);
99 1.1 christos Static void ar5008_rfsilent_init(struct athn_softc *);
100 1.1 christos Static int ar5008_rx_alloc(struct athn_softc *);
101 1.1 christos Static void ar5008_rx_enable(struct athn_softc *);
102 1.1 christos Static void ar5008_rx_free(struct athn_softc *);
103 1.1 christos Static void ar5008_rx_intr(struct athn_softc *);
104 1.1 christos Static void ar5008_rx_radiotap(struct athn_softc *, struct mbuf *,
105 1.1 christos struct ar_rx_desc *);
106 1.1 christos Static void ar5008_set_cck_weak_signal(struct athn_softc *, int);
107 1.1 christos Static void ar5008_set_delta_slope(struct athn_softc *,
108 1.1 christos struct ieee80211_channel *, struct ieee80211_channel *);
109 1.1 christos Static void ar5008_set_firstep_level(struct athn_softc *, int);
110 1.1 christos Static void ar5008_set_noise_immunity_level(struct athn_softc *, int);
111 1.1 christos Static void ar5008_set_phy(struct athn_softc *, struct ieee80211_channel *,
112 1.1 christos struct ieee80211_channel *);
113 1.1 christos Static void ar5008_set_rf_mode(struct athn_softc *,
114 1.1 christos struct ieee80211_channel *);
115 1.1 christos Static void ar5008_set_rxchains(struct athn_softc *);
116 1.1 christos Static void ar5008_set_spur_immunity_level(struct athn_softc *, int);
117 1.1 christos Static void ar5008_swap_rom(struct athn_softc *);
118 1.1 christos Static int ar5008_swba_intr(struct athn_softc *);
119 1.1 christos Static int ar5008_tx(struct athn_softc *, struct mbuf *,
120 1.1 christos struct ieee80211_node *, int);
121 1.1 christos Static int ar5008_tx_alloc(struct athn_softc *);
122 1.1 christos Static void ar5008_tx_free(struct athn_softc *);
123 1.1 christos Static void ar5008_tx_intr(struct athn_softc *);
124 1.1 christos Static int ar5008_tx_process(struct athn_softc *, int);
125 1.1 christos
126 1.1 christos #ifdef notused
127 1.1 christos Static void ar5008_bb_load_noisefloor(struct athn_softc *);
128 1.1 christos Static void ar5008_get_noisefloor(struct athn_softc *,
129 1.1 christos struct ieee80211_channel *);
130 1.1 christos Static void ar5008_noisefloor_calib(struct athn_softc *);
131 1.1 christos Static void ar5008_read_noisefloor(struct athn_softc *, int16_t *,
132 1.1 christos int16_t *);
133 1.1 christos Static void ar5008_write_noisefloor(struct athn_softc *, int16_t *,
134 1.1 christos int16_t *);
135 1.1 christos #endif /* notused */
136 1.1 christos
137 1.1 christos // bf->bf_m = MCLGETI(NULL, M_DONTWAIT, NULL, ATHN_RXBUFSZ);
138 1.1 christos
139 1.1 christos /*
140 1.1 christos * XXX: see if_iwn.c:MCLGETIalt() for a better solution.
141 1.1 christos */
142 1.1 christos static struct mbuf *
143 1.1 christos MCLGETI(struct athn_softc *sc __unused, int how,
144 1.1 christos struct ifnet *ifp __unused, u_int size)
145 1.1 christos {
146 1.1 christos struct mbuf *m;
147 1.1 christos
148 1.1 christos MGETHDR(m, how, MT_DATA);
149 1.1 christos if (m == NULL)
150 1.1 christos return NULL;
151 1.1 christos
152 1.1 christos MEXTMALLOC(m, size, how);
153 1.1 christos if ((m->m_flags & M_EXT) == 0) {
154 1.1 christos m_freem(m);
155 1.1 christos return NULL;
156 1.1 christos }
157 1.1 christos return m;
158 1.1 christos }
159 1.1 christos
160 1.1 christos PUBLIC int
161 1.1 christos ar5008_attach(struct athn_softc *sc)
162 1.1 christos {
163 1.1 christos struct athn_ops *ops = &sc->sc_ops;
164 1.1 christos struct ieee80211com *ic = &sc->sc_ic;
165 1.1 christos struct ar_base_eep_header *base;
166 1.1 christos uint8_t eep_ver, kc_entries_log;
167 1.1 christos int error;
168 1.1 christos
169 1.1 christos /* Set callbacks for AR5008, AR9001 and AR9002 families. */
170 1.1 christos ops->gpio_read = ar5008_gpio_read;
171 1.1 christos ops->gpio_write = ar5008_gpio_write;
172 1.1 christos ops->gpio_config_input = ar5008_gpio_config_input;
173 1.1 christos ops->gpio_config_output = ar5008_gpio_config_output;
174 1.1 christos ops->rfsilent_init = ar5008_rfsilent_init;
175 1.1 christos
176 1.1 christos ops->dma_alloc = ar5008_dma_alloc;
177 1.1 christos ops->dma_free = ar5008_dma_free;
178 1.1 christos ops->rx_enable = ar5008_rx_enable;
179 1.12 nonaka ops->intr_status = ar5008_intr_status;
180 1.1 christos ops->intr = ar5008_intr;
181 1.1 christos ops->tx = ar5008_tx;
182 1.1 christos
183 1.1 christos ops->set_rf_mode = ar5008_set_rf_mode;
184 1.1 christos ops->rf_bus_request = ar5008_rf_bus_request;
185 1.1 christos ops->rf_bus_release = ar5008_rf_bus_release;
186 1.1 christos ops->set_phy = ar5008_set_phy;
187 1.1 christos ops->set_delta_slope = ar5008_set_delta_slope;
188 1.1 christos ops->enable_antenna_diversity = ar5008_enable_antenna_diversity;
189 1.1 christos ops->init_baseband = ar5008_init_baseband;
190 1.1 christos ops->disable_phy = ar5008_disable_phy;
191 1.1 christos ops->set_rxchains = ar5008_set_rxchains;
192 1.1 christos ops->noisefloor_calib = ar5008_do_noisefloor_calib;
193 1.1 christos ops->do_calib = ar5008_do_calib;
194 1.1 christos ops->next_calib = ar5008_next_calib;
195 1.1 christos ops->hw_init = ar5008_hw_init;
196 1.1 christos
197 1.1 christos ops->set_noise_immunity_level = ar5008_set_noise_immunity_level;
198 1.1 christos ops->enable_ofdm_weak_signal = ar5008_enable_ofdm_weak_signal;
199 1.1 christos ops->disable_ofdm_weak_signal = ar5008_disable_ofdm_weak_signal;
200 1.1 christos ops->set_cck_weak_signal = ar5008_set_cck_weak_signal;
201 1.1 christos ops->set_firstep_level = ar5008_set_firstep_level;
202 1.1 christos ops->set_spur_immunity_level = ar5008_set_spur_immunity_level;
203 1.1 christos
204 1.1 christos /* Set MAC registers offsets. */
205 1.1 christos sc->sc_obs_off = AR_OBS;
206 1.1 christos sc->sc_gpio_input_en_off = AR_GPIO_INPUT_EN_VAL;
207 1.1 christos
208 1.1 christos if (!(sc->sc_flags & ATHN_FLAG_PCIE))
209 1.1 christos athn_config_nonpcie(sc);
210 1.1 christos else
211 1.1 christos athn_config_pcie(sc);
212 1.1 christos
213 1.1 christos /* Read entire ROM content in memory. */
214 1.1 christos if ((error = ar5008_read_rom(sc)) != 0) {
215 1.6 christos aprint_error_dev(sc->sc_dev, "could not read ROM\n");
216 1.1 christos return error;
217 1.1 christos }
218 1.1 christos
219 1.1 christos /* Get RF revision. */
220 1.1 christos sc->sc_rf_rev = ar5416_get_rf_rev(sc);
221 1.1 christos
222 1.1 christos base = sc->sc_eep;
223 1.1 christos eep_ver = (base->version >> 12) & 0xf;
224 1.1 christos sc->sc_eep_rev = (base->version & 0xfff);
225 1.1 christos if (eep_ver != AR_EEP_VER || sc->sc_eep_rev == 0) {
226 1.6 christos aprint_error_dev(sc->sc_dev, "unsupported ROM version %d.%d\n",
227 1.6 christos eep_ver, sc->sc_eep_rev);
228 1.1 christos return EINVAL;
229 1.1 christos }
230 1.1 christos
231 1.1 christos if (base->opCapFlags & AR_OPFLAGS_11A)
232 1.1 christos sc->sc_flags |= ATHN_FLAG_11A;
233 1.1 christos if (base->opCapFlags & AR_OPFLAGS_11G)
234 1.1 christos sc->sc_flags |= ATHN_FLAG_11G;
235 1.1 christos if (base->opCapFlags & AR_OPFLAGS_11N)
236 1.1 christos sc->sc_flags |= ATHN_FLAG_11N;
237 1.1 christos
238 1.15.2.1 phil IEEE80211_ADDR_COPY(ic->ic_macaddr, base->macAddr);
239 1.1 christos
240 1.1 christos /* Check if we have a hardware radio switch. */
241 1.1 christos if (base->rfSilent & AR_EEP_RFSILENT_ENABLED) {
242 1.1 christos sc->sc_flags |= ATHN_FLAG_RFSILENT;
243 1.1 christos /* Get GPIO pin used by hardware radio switch. */
244 1.1 christos sc->sc_rfsilent_pin = MS(base->rfSilent,
245 1.1 christos AR_EEP_RFSILENT_GPIO_SEL);
246 1.1 christos /* Get polarity of hardware radio switch. */
247 1.1 christos if (base->rfSilent & AR_EEP_RFSILENT_POLARITY)
248 1.1 christos sc->sc_flags |= ATHN_FLAG_RFSILENT_REVERSED;
249 1.1 christos }
250 1.1 christos
251 1.1 christos /* Get the number of HW key cache entries. */
252 1.1 christos kc_entries_log = MS(base->deviceCap, AR_EEP_DEVCAP_KC_ENTRIES);
253 1.1 christos sc->sc_kc_entries = kc_entries_log != 0 ?
254 1.1 christos 1 << kc_entries_log : AR_KEYTABLE_SIZE;
255 1.1 christos
256 1.1 christos sc->sc_txchainmask = base->txMask;
257 1.1 christos if (sc->sc_mac_ver == AR_SREV_VERSION_5416_PCI &&
258 1.1 christos !(base->opCapFlags & AR_OPFLAGS_11A)) {
259 1.1 christos /* For single-band AR5416 PCI, use GPIO pin 0. */
260 1.1 christos sc->sc_rxchainmask = ar5008_gpio_read(sc, 0) ? 0x5 : 0x7;
261 1.1 christos }
262 1.1 christos else
263 1.1 christos sc->sc_rxchainmask = base->rxMask;
264 1.1 christos
265 1.1 christos ops->setup(sc);
266 1.1 christos return 0;
267 1.1 christos }
268 1.1 christos
269 1.1 christos /*
270 1.1 christos * Read 16-bit word from ROM.
271 1.1 christos */
272 1.1 christos Static int
273 1.1 christos ar5008_read_eep_word(struct athn_softc *sc, uint32_t addr, uint16_t *val)
274 1.1 christos {
275 1.1 christos uint32_t reg;
276 1.1 christos int ntries;
277 1.1 christos
278 1.1 christos reg = AR_READ(sc, AR_EEPROM_OFFSET(addr));
279 1.1 christos for (ntries = 0; ntries < 1000; ntries++) {
280 1.1 christos reg = AR_READ(sc, AR_EEPROM_STATUS_DATA);
281 1.1 christos if (!(reg & (AR_EEPROM_STATUS_DATA_BUSY |
282 1.1 christos AR_EEPROM_STATUS_DATA_PROT_ACCESS))) {
283 1.1 christos *val = MS(reg, AR_EEPROM_STATUS_DATA_VAL);
284 1.1 christos return 0;
285 1.1 christos }
286 1.1 christos DELAY(10);
287 1.1 christos }
288 1.1 christos *val = 0xffff;
289 1.1 christos return ETIMEDOUT;
290 1.1 christos }
291 1.1 christos
292 1.1 christos Static int
293 1.1 christos ar5008_read_rom(struct athn_softc *sc)
294 1.1 christos {
295 1.1 christos uint32_t addr, end;
296 1.1 christos uint16_t magic, sum, *eep;
297 1.1 christos int need_swap = 0;
298 1.1 christos int error;
299 1.1 christos
300 1.1 christos /* Determine ROM endianness. */
301 1.1 christos error = ar5008_read_eep_word(sc, AR_EEPROM_MAGIC_OFFSET, &magic);
302 1.1 christos if (error != 0)
303 1.1 christos return error;
304 1.1 christos if (magic != AR_EEPROM_MAGIC) {
305 1.1 christos if (magic != bswap16(AR_EEPROM_MAGIC)) {
306 1.1 christos DPRINTFN(DBG_INIT, sc,
307 1.1 christos "invalid ROM magic 0x%x != 0x%x\n",
308 1.1 christos magic, AR_EEPROM_MAGIC);
309 1.1 christos return EIO;
310 1.1 christos }
311 1.1 christos DPRINTFN(DBG_INIT, sc, "non-native ROM endianness\n");
312 1.1 christos need_swap = 1;
313 1.1 christos }
314 1.1 christos
315 1.1 christos /* Allocate space to store ROM in host memory. */
316 1.1 christos sc->sc_eep = malloc(sc->sc_eep_size, M_DEVBUF, M_NOWAIT);
317 1.1 christos if (sc->sc_eep == NULL)
318 1.1 christos return ENOMEM;
319 1.1 christos
320 1.1 christos /* Read entire ROM and compute checksum. */
321 1.1 christos sum = 0;
322 1.1 christos eep = sc->sc_eep;
323 1.1 christos end = sc->sc_eep_base + sc->sc_eep_size / sizeof(uint16_t);
324 1.1 christos for (addr = sc->sc_eep_base; addr < end; addr++, eep++) {
325 1.1 christos if ((error = ar5008_read_eep_word(sc, addr, eep)) != 0) {
326 1.1 christos DPRINTFN(DBG_INIT, sc,
327 1.1 christos "could not read ROM at 0x%x\n", addr);
328 1.1 christos return error;
329 1.1 christos }
330 1.1 christos if (need_swap)
331 1.1 christos *eep = bswap16(*eep);
332 1.1 christos sum ^= *eep;
333 1.1 christos }
334 1.1 christos if (sum != 0xffff) {
335 1.6 christos aprint_error_dev(sc->sc_dev, "bad ROM checksum 0x%04x\n", sum);
336 1.1 christos return EIO;
337 1.1 christos }
338 1.1 christos if (need_swap)
339 1.1 christos ar5008_swap_rom(sc);
340 1.1 christos
341 1.1 christos return 0;
342 1.1 christos }
343 1.1 christos
344 1.1 christos Static void
345 1.1 christos ar5008_swap_rom(struct athn_softc *sc)
346 1.1 christos {
347 1.1 christos struct ar_base_eep_header *base = sc->sc_eep;
348 1.1 christos
349 1.1 christos /* Swap common fields first. */
350 1.1 christos base->length = bswap16(base->length);
351 1.1 christos base->version = bswap16(base->version);
352 1.1 christos base->regDmn[0] = bswap16(base->regDmn[0]);
353 1.1 christos base->regDmn[1] = bswap16(base->regDmn[1]);
354 1.1 christos base->rfSilent = bswap16(base->rfSilent);
355 1.1 christos base->blueToothOptions = bswap16(base->blueToothOptions);
356 1.1 christos base->deviceCap = bswap16(base->deviceCap);
357 1.1 christos
358 1.1 christos /* Swap device-dependent fields. */
359 1.1 christos sc->sc_ops.swap_rom(sc);
360 1.1 christos }
361 1.1 christos
362 1.1 christos /*
363 1.1 christos * Access to General Purpose Input/Output ports.
364 1.1 christos */
365 1.1 christos Static int
366 1.1 christos ar5008_gpio_read(struct athn_softc *sc, int pin)
367 1.1 christos {
368 1.1 christos
369 1.1 christos KASSERT(pin < sc->sc_ngpiopins);
370 1.1 christos if ((sc->sc_flags & ATHN_FLAG_USB) && !AR_SREV_9271(sc))
371 1.1 christos return !((AR_READ(sc, AR7010_GPIO_IN) >> pin) & 1);
372 1.1 christos return (AR_READ(sc, AR_GPIO_IN_OUT) >> (sc->sc_ngpiopins + pin)) & 1;
373 1.1 christos }
374 1.1 christos
375 1.1 christos Static void
376 1.1 christos ar5008_gpio_write(struct athn_softc *sc, int pin, int set)
377 1.1 christos {
378 1.1 christos uint32_t reg;
379 1.1 christos
380 1.1 christos KASSERT(pin < sc->sc_ngpiopins);
381 1.1 christos
382 1.1 christos if (sc->sc_flags & ATHN_FLAG_USB)
383 1.1 christos set = !set; /* AR9271/AR7010 is reversed. */
384 1.1 christos
385 1.1 christos if ((sc->sc_flags & ATHN_FLAG_USB) && !AR_SREV_9271(sc)) {
386 1.1 christos /* Special case for AR7010. */
387 1.1 christos reg = AR_READ(sc, AR7010_GPIO_OUT);
388 1.1 christos if (set)
389 1.1 christos reg |= 1 << pin;
390 1.1 christos else
391 1.1 christos reg &= ~(1 << pin);
392 1.1 christos AR_WRITE(sc, AR7010_GPIO_OUT, reg);
393 1.1 christos }
394 1.1 christos else {
395 1.1 christos reg = AR_READ(sc, AR_GPIO_IN_OUT);
396 1.1 christos if (set)
397 1.1 christos reg |= 1 << pin;
398 1.1 christos else
399 1.1 christos reg &= ~(1 << pin);
400 1.1 christos AR_WRITE(sc, AR_GPIO_IN_OUT, reg);
401 1.1 christos }
402 1.1 christos AR_WRITE_BARRIER(sc);
403 1.1 christos }
404 1.1 christos
405 1.1 christos Static void
406 1.1 christos ar5008_gpio_config_input(struct athn_softc *sc, int pin)
407 1.1 christos {
408 1.1 christos uint32_t reg;
409 1.1 christos
410 1.1 christos if ((sc->sc_flags & ATHN_FLAG_USB) && !AR_SREV_9271(sc)) {
411 1.1 christos /* Special case for AR7010. */
412 1.1 christos AR_SETBITS(sc, AR7010_GPIO_OE, 1 << pin);
413 1.1 christos }
414 1.1 christos else {
415 1.1 christos reg = AR_READ(sc, AR_GPIO_OE_OUT);
416 1.1 christos reg &= ~(AR_GPIO_OE_OUT_DRV_M << (pin * 2));
417 1.1 christos reg |= AR_GPIO_OE_OUT_DRV_NO << (pin * 2);
418 1.1 christos AR_WRITE(sc, AR_GPIO_OE_OUT, reg);
419 1.1 christos }
420 1.1 christos AR_WRITE_BARRIER(sc);
421 1.1 christos }
422 1.1 christos
423 1.1 christos Static void
424 1.1 christos ar5008_gpio_config_output(struct athn_softc *sc, int pin, int type)
425 1.1 christos {
426 1.1 christos uint32_t reg;
427 1.1 christos int mux, off;
428 1.1 christos
429 1.1 christos if ((sc->sc_flags & ATHN_FLAG_USB) && !AR_SREV_9271(sc)) {
430 1.1 christos /* Special case for AR7010. */
431 1.1 christos AR_CLRBITS(sc, AR7010_GPIO_OE, 1 << pin);
432 1.1 christos AR_WRITE_BARRIER(sc);
433 1.1 christos return;
434 1.1 christos }
435 1.1 christos mux = pin / 6;
436 1.1 christos off = pin % 6;
437 1.1 christos
438 1.1 christos reg = AR_READ(sc, AR_GPIO_OUTPUT_MUX(mux));
439 1.1 christos if (!AR_SREV_9280_20_OR_LATER(sc) && mux == 0)
440 1.1 christos reg = (reg & ~0x1f0) | (reg & 0x1f0) << 1;
441 1.1 christos reg &= ~(0x1f << (off * 5));
442 1.1 christos reg |= (type & 0x1f) << (off * 5);
443 1.1 christos AR_WRITE(sc, AR_GPIO_OUTPUT_MUX(mux), reg);
444 1.1 christos
445 1.1 christos reg = AR_READ(sc, AR_GPIO_OE_OUT);
446 1.1 christos reg &= ~(AR_GPIO_OE_OUT_DRV_M << (pin * 2));
447 1.1 christos reg |= AR_GPIO_OE_OUT_DRV_ALL << (pin * 2);
448 1.1 christos AR_WRITE(sc, AR_GPIO_OE_OUT, reg);
449 1.1 christos AR_WRITE_BARRIER(sc);
450 1.1 christos }
451 1.1 christos
452 1.1 christos Static void
453 1.1 christos ar5008_rfsilent_init(struct athn_softc *sc)
454 1.1 christos {
455 1.1 christos uint32_t reg;
456 1.1 christos
457 1.1 christos /* Configure hardware radio switch. */
458 1.1 christos AR_SETBITS(sc, AR_GPIO_INPUT_EN_VAL, AR_GPIO_INPUT_EN_VAL_RFSILENT_BB);
459 1.1 christos reg = AR_READ(sc, AR_GPIO_INPUT_MUX2);
460 1.1 christos reg = RW(reg, AR_GPIO_INPUT_MUX2_RFSILENT, 0);
461 1.1 christos AR_WRITE(sc, AR_GPIO_INPUT_MUX2, reg);
462 1.1 christos ar5008_gpio_config_input(sc, sc->sc_rfsilent_pin);
463 1.1 christos AR_SETBITS(sc, AR_PHY_TEST, AR_PHY_TEST_RFSILENT_BB);
464 1.1 christos if (!(sc->sc_flags & ATHN_FLAG_RFSILENT_REVERSED)) {
465 1.1 christos AR_SETBITS(sc, AR_GPIO_INTR_POL,
466 1.1 christos AR_GPIO_INTR_POL_PIN(sc->sc_rfsilent_pin));
467 1.1 christos }
468 1.1 christos AR_WRITE_BARRIER(sc);
469 1.1 christos }
470 1.1 christos
471 1.1 christos Static int
472 1.1 christos ar5008_dma_alloc(struct athn_softc *sc)
473 1.1 christos {
474 1.1 christos int error;
475 1.1 christos
476 1.1 christos error = ar5008_tx_alloc(sc);
477 1.1 christos if (error != 0)
478 1.1 christos return error;
479 1.1 christos
480 1.1 christos error = ar5008_rx_alloc(sc);
481 1.1 christos if (error != 0)
482 1.1 christos return error;
483 1.1 christos
484 1.1 christos return 0;
485 1.1 christos }
486 1.1 christos
487 1.1 christos Static void
488 1.1 christos ar5008_dma_free(struct athn_softc *sc)
489 1.1 christos {
490 1.1 christos
491 1.1 christos ar5008_tx_free(sc);
492 1.1 christos ar5008_rx_free(sc);
493 1.1 christos }
494 1.1 christos
495 1.1 christos Static int
496 1.1 christos ar5008_tx_alloc(struct athn_softc *sc)
497 1.1 christos {
498 1.1 christos struct athn_tx_buf *bf;
499 1.1 christos bus_size_t size;
500 1.1 christos int error, nsegs, i;
501 1.1 christos
502 1.1 christos /*
503 1.1 christos * Allocate a pool of Tx descriptors shared between all Tx queues.
504 1.1 christos */
505 1.1 christos size = ATHN_NTXBUFS * AR5008_MAX_SCATTER * sizeof(struct ar_tx_desc);
506 1.1 christos
507 1.1 christos error = bus_dmamap_create(sc->sc_dmat, size, 1, size, 0,
508 1.1 christos BUS_DMA_NOWAIT, &sc->sc_map);
509 1.1 christos if (error != 0)
510 1.1 christos goto fail;
511 1.1 christos
512 1.1 christos error = bus_dmamem_alloc(sc->sc_dmat, size, 4, 0, &sc->sc_seg, 1,
513 1.1 christos // XXX &nsegs, BUS_DMA_NOWAIT | BUS_DMA_ZERO);
514 1.1 christos &nsegs, BUS_DMA_NOWAIT);
515 1.1 christos if (error != 0)
516 1.1 christos goto fail;
517 1.1 christos
518 1.1 christos error = bus_dmamem_map(sc->sc_dmat, &sc->sc_seg, 1, size,
519 1.1 christos (void **)&sc->sc_descs, BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
520 1.1 christos if (error != 0)
521 1.1 christos goto fail;
522 1.1 christos
523 1.7 matt error = bus_dmamap_load(sc->sc_dmat, sc->sc_map, sc->sc_descs,
524 1.7 matt size, NULL, BUS_DMA_NOWAIT);
525 1.1 christos if (error != 0)
526 1.1 christos goto fail;
527 1.1 christos
528 1.1 christos SIMPLEQ_INIT(&sc->sc_txbufs);
529 1.1 christos for (i = 0; i < ATHN_NTXBUFS; i++) {
530 1.1 christos bf = &sc->sc_txpool[i];
531 1.1 christos
532 1.1 christos error = bus_dmamap_create(sc->sc_dmat, ATHN_TXBUFSZ,
533 1.1 christos AR5008_MAX_SCATTER, ATHN_TXBUFSZ, 0, BUS_DMA_NOWAIT,
534 1.1 christos &bf->bf_map);
535 1.1 christos if (error != 0) {
536 1.6 christos aprint_error_dev(sc->sc_dev,
537 1.6 christos "could not create Tx buf DMA map\n");
538 1.1 christos goto fail;
539 1.1 christos }
540 1.1 christos
541 1.1 christos bf->bf_descs =
542 1.1 christos &((struct ar_tx_desc *)sc->sc_descs)[i * AR5008_MAX_SCATTER];
543 1.1 christos bf->bf_daddr = sc->sc_map->dm_segs[0].ds_addr +
544 1.1 christos i * AR5008_MAX_SCATTER * sizeof(struct ar_tx_desc);
545 1.1 christos
546 1.1 christos SIMPLEQ_INSERT_TAIL(&sc->sc_txbufs, bf, bf_list);
547 1.1 christos }
548 1.1 christos return 0;
549 1.1 christos fail:
550 1.1 christos ar5008_tx_free(sc);
551 1.1 christos return error;
552 1.1 christos }
553 1.1 christos
554 1.1 christos Static void
555 1.1 christos ar5008_tx_free(struct athn_softc *sc)
556 1.1 christos {
557 1.1 christos struct athn_tx_buf *bf;
558 1.1 christos int i;
559 1.1 christos
560 1.1 christos for (i = 0; i < ATHN_NTXBUFS; i++) {
561 1.1 christos bf = &sc->sc_txpool[i];
562 1.1 christos
563 1.1 christos if (bf->bf_map != NULL)
564 1.1 christos bus_dmamap_destroy(sc->sc_dmat, bf->bf_map);
565 1.1 christos }
566 1.1 christos /* Free Tx descriptors. */
567 1.1 christos if (sc->sc_map != NULL) {
568 1.1 christos if (sc->sc_descs != NULL) {
569 1.1 christos bus_dmamap_unload(sc->sc_dmat, sc->sc_map);
570 1.1 christos bus_dmamem_unmap(sc->sc_dmat, (void *)sc->sc_descs,
571 1.1 christos ATHN_NTXBUFS * AR5008_MAX_SCATTER *
572 1.1 christos sizeof(struct ar_tx_desc));
573 1.1 christos bus_dmamem_free(sc->sc_dmat, &sc->sc_seg, 1);
574 1.1 christos }
575 1.1 christos bus_dmamap_destroy(sc->sc_dmat, sc->sc_map);
576 1.1 christos }
577 1.1 christos }
578 1.1 christos
579 1.1 christos Static int
580 1.1 christos ar5008_rx_alloc(struct athn_softc *sc)
581 1.1 christos {
582 1.1 christos struct athn_rxq *rxq = &sc->sc_rxq[0];
583 1.1 christos struct athn_rx_buf *bf;
584 1.1 christos struct ar_rx_desc *ds;
585 1.1 christos bus_size_t size;
586 1.1 christos int error, nsegs, i;
587 1.1 christos
588 1.1 christos rxq->bf = malloc(ATHN_NRXBUFS * sizeof(*bf), M_DEVBUF,
589 1.1 christos M_NOWAIT | M_ZERO);
590 1.1 christos if (rxq->bf == NULL)
591 1.1 christos return ENOMEM;
592 1.1 christos
593 1.1 christos size = ATHN_NRXBUFS * sizeof(struct ar_rx_desc);
594 1.1 christos
595 1.1 christos error = bus_dmamap_create(sc->sc_dmat, size, 1, size, 0,
596 1.1 christos BUS_DMA_NOWAIT, &rxq->map);
597 1.1 christos if (error != 0)
598 1.1 christos goto fail;
599 1.1 christos
600 1.1 christos error = bus_dmamem_alloc(sc->sc_dmat, size, 0, 0, &rxq->seg, 1,
601 1.1 christos // &nsegs, BUS_DMA_NOWAIT | BUS_DMA_ZERO);
602 1.1 christos &nsegs, BUS_DMA_NOWAIT);
603 1.1 christos if (error != 0)
604 1.1 christos goto fail;
605 1.1 christos
606 1.1 christos error = bus_dmamem_map(sc->sc_dmat, &rxq->seg, 1, size,
607 1.1 christos (void **)&rxq->descs, BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
608 1.1 christos if (error != 0)
609 1.1 christos goto fail;
610 1.1 christos
611 1.8 matt error = bus_dmamap_load(sc->sc_dmat, rxq->map, rxq->descs,
612 1.7 matt size, NULL, BUS_DMA_NOWAIT);
613 1.1 christos if (error != 0)
614 1.1 christos goto fail;
615 1.1 christos
616 1.1 christos for (i = 0; i < ATHN_NRXBUFS; i++) {
617 1.1 christos bf = &rxq->bf[i];
618 1.1 christos ds = &((struct ar_rx_desc *)rxq->descs)[i];
619 1.1 christos
620 1.1 christos error = bus_dmamap_create(sc->sc_dmat, ATHN_RXBUFSZ, 1,
621 1.1 christos ATHN_RXBUFSZ, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
622 1.1 christos &bf->bf_map);
623 1.1 christos if (error != 0) {
624 1.6 christos aprint_error_dev(sc->sc_dev,
625 1.6 christos " could not create Rx buf DMA map\n");
626 1.1 christos goto fail;
627 1.1 christos }
628 1.1 christos /*
629 1.1 christos * Assumes MCLGETI returns cache-line-size aligned buffers.
630 1.1 christos * XXX: does ours?
631 1.1 christos */
632 1.1 christos bf->bf_m = MCLGETI(NULL, M_DONTWAIT, NULL, ATHN_RXBUFSZ);
633 1.1 christos if (bf->bf_m == NULL) {
634 1.6 christos aprint_error_dev(sc->sc_dev,
635 1.6 christos "could not allocate Rx mbuf\n");
636 1.1 christos error = ENOBUFS;
637 1.1 christos goto fail;
638 1.1 christos }
639 1.1 christos
640 1.1 christos error = bus_dmamap_load(sc->sc_dmat, bf->bf_map,
641 1.1 christos mtod(bf->bf_m, void *), ATHN_RXBUFSZ, NULL,
642 1.1 christos BUS_DMA_NOWAIT | BUS_DMA_READ);
643 1.1 christos if (error != 0) {
644 1.6 christos aprint_error_dev(sc->sc_dev,
645 1.6 christos "could not DMA map Rx buffer\n");
646 1.1 christos goto fail;
647 1.1 christos }
648 1.1 christos
649 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, ATHN_RXBUFSZ,
650 1.1 christos BUS_DMASYNC_PREREAD);
651 1.1 christos
652 1.1 christos bf->bf_desc = ds;
653 1.1 christos bf->bf_daddr = rxq->map->dm_segs[0].ds_addr +
654 1.1 christos i * sizeof(struct ar_rx_desc);
655 1.1 christos }
656 1.1 christos return 0;
657 1.1 christos fail:
658 1.1 christos ar5008_rx_free(sc);
659 1.1 christos return error;
660 1.1 christos }
661 1.1 christos
662 1.1 christos Static void
663 1.1 christos ar5008_rx_free(struct athn_softc *sc)
664 1.1 christos {
665 1.1 christos struct athn_rxq *rxq = &sc->sc_rxq[0];
666 1.1 christos struct athn_rx_buf *bf;
667 1.1 christos int i;
668 1.1 christos
669 1.1 christos if (rxq->bf == NULL)
670 1.1 christos return;
671 1.1 christos for (i = 0; i < ATHN_NRXBUFS; i++) {
672 1.1 christos bf = &rxq->bf[i];
673 1.1 christos
674 1.1 christos if (bf->bf_map != NULL)
675 1.1 christos bus_dmamap_destroy(sc->sc_dmat, bf->bf_map);
676 1.1 christos if (bf->bf_m != NULL)
677 1.1 christos m_freem(bf->bf_m);
678 1.1 christos }
679 1.1 christos free(rxq->bf, M_DEVBUF);
680 1.1 christos
681 1.1 christos /* Free Rx descriptors. */
682 1.1 christos if (rxq->map != NULL) {
683 1.1 christos if (rxq->descs != NULL) {
684 1.1 christos bus_dmamap_unload(sc->sc_dmat, rxq->map);
685 1.1 christos bus_dmamem_unmap(sc->sc_dmat, (void *)rxq->descs,
686 1.1 christos ATHN_NRXBUFS * sizeof(struct ar_rx_desc));
687 1.1 christos bus_dmamem_free(sc->sc_dmat, &rxq->seg, 1);
688 1.1 christos }
689 1.1 christos bus_dmamap_destroy(sc->sc_dmat, rxq->map);
690 1.1 christos }
691 1.1 christos }
692 1.1 christos
693 1.1 christos Static void
694 1.1 christos ar5008_rx_enable(struct athn_softc *sc)
695 1.1 christos {
696 1.1 christos struct athn_rxq *rxq = &sc->sc_rxq[0];
697 1.1 christos struct athn_rx_buf *bf;
698 1.1 christos struct ar_rx_desc *ds;
699 1.1 christos int i;
700 1.1 christos
701 1.1 christos /* Setup and link Rx descriptors. */
702 1.1 christos SIMPLEQ_INIT(&rxq->head);
703 1.1 christos rxq->lastds = NULL;
704 1.1 christos for (i = 0; i < ATHN_NRXBUFS; i++) {
705 1.1 christos bf = &rxq->bf[i];
706 1.1 christos ds = bf->bf_desc;
707 1.1 christos
708 1.1 christos memset(ds, 0, sizeof(*ds));
709 1.1 christos ds->ds_data = bf->bf_map->dm_segs[0].ds_addr;
710 1.1 christos ds->ds_ctl1 = SM(AR_RXC1_BUF_LEN, ATHN_RXBUFSZ);
711 1.1 christos
712 1.1 christos if (rxq->lastds != NULL) {
713 1.1 christos ((struct ar_rx_desc *)rxq->lastds)->ds_link =
714 1.1 christos bf->bf_daddr;
715 1.1 christos }
716 1.1 christos SIMPLEQ_INSERT_TAIL(&rxq->head, bf, bf_list);
717 1.1 christos rxq->lastds = ds;
718 1.1 christos }
719 1.1 christos bus_dmamap_sync(sc->sc_dmat, rxq->map, 0, rxq->map->dm_mapsize,
720 1.1 christos BUS_DMASYNC_PREREAD);
721 1.1 christos
722 1.1 christos /* Enable Rx. */
723 1.1 christos AR_WRITE(sc, AR_RXDP, SIMPLEQ_FIRST(&rxq->head)->bf_daddr);
724 1.1 christos AR_WRITE(sc, AR_CR, AR_CR_RXE);
725 1.1 christos AR_WRITE_BARRIER(sc);
726 1.1 christos }
727 1.1 christos
728 1.1 christos Static void
729 1.1 christos ar5008_rx_radiotap(struct athn_softc *sc, struct mbuf *m,
730 1.1 christos struct ar_rx_desc *ds)
731 1.1 christos {
732 1.1 christos struct athn_rx_radiotap_header *tap = &sc->sc_rxtap;
733 1.1 christos struct ieee80211com *ic = &sc->sc_ic;
734 1.1 christos uint64_t tsf;
735 1.1 christos uint32_t tstamp;
736 1.1 christos uint8_t rate;
737 1.1 christos
738 1.1 christos /* Extend the 15-bit timestamp from Rx descriptor to 64-bit TSF. */
739 1.1 christos tstamp = ds->ds_status2;
740 1.1 christos tsf = AR_READ(sc, AR_TSF_U32);
741 1.1 christos tsf = tsf << 32 | AR_READ(sc, AR_TSF_L32);
742 1.1 christos if ((tsf & 0x7fff) < tstamp)
743 1.1 christos tsf -= 0x8000;
744 1.1 christos tsf = (tsf & ~0x7fff) | tstamp;
745 1.1 christos
746 1.1 christos tap->wr_flags = IEEE80211_RADIOTAP_F_FCS;
747 1.1 christos tap->wr_tsft = htole64(tsf);
748 1.1 christos tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
749 1.1 christos tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
750 1.1 christos tap->wr_dbm_antsignal = MS(ds->ds_status4, AR_RXS4_RSSI_COMBINED);
751 1.1 christos /* XXX noise. */
752 1.1 christos tap->wr_antenna = MS(ds->ds_status3, AR_RXS3_ANTENNA);
753 1.1 christos tap->wr_rate = 0; /* In case it can't be found below. */
754 1.1 christos if (AR_SREV_5416_20_OR_LATER(sc))
755 1.1 christos rate = MS(ds->ds_status0, AR_RXS0_RATE);
756 1.1 christos else
757 1.1 christos rate = MS(ds->ds_status3, AR_RXS3_RATE);
758 1.1 christos if (rate & 0x80) { /* HT. */
759 1.1 christos /* Bit 7 set means HT MCS instead of rate. */
760 1.1 christos tap->wr_rate = rate;
761 1.1 christos if (!(ds->ds_status3 & AR_RXS3_GI))
762 1.1 christos tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTGI;
763 1.1 christos
764 1.1 christos }
765 1.1 christos else if (rate & 0x10) { /* CCK. */
766 1.1 christos if (rate & 0x04)
767 1.1 christos tap->wr_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
768 1.1 christos switch (rate & ~0x14) {
769 1.1 christos case 0xb: tap->wr_rate = 2; break;
770 1.1 christos case 0xa: tap->wr_rate = 4; break;
771 1.1 christos case 0x9: tap->wr_rate = 11; break;
772 1.1 christos case 0x8: tap->wr_rate = 22; break;
773 1.1 christos }
774 1.1 christos }
775 1.1 christos else { /* OFDM. */
776 1.1 christos switch (rate) {
777 1.1 christos case 0xb: tap->wr_rate = 12; break;
778 1.1 christos case 0xf: tap->wr_rate = 18; break;
779 1.1 christos case 0xa: tap->wr_rate = 24; break;
780 1.1 christos case 0xe: tap->wr_rate = 36; break;
781 1.1 christos case 0x9: tap->wr_rate = 48; break;
782 1.1 christos case 0xd: tap->wr_rate = 72; break;
783 1.1 christos case 0x8: tap->wr_rate = 96; break;
784 1.1 christos case 0xc: tap->wr_rate = 108; break;
785 1.1 christos }
786 1.1 christos }
787 1.15 msaitoh bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m, BPF_D_IN);
788 1.1 christos }
789 1.1 christos
790 1.1 christos static __inline int
791 1.1 christos ar5008_rx_process(struct athn_softc *sc)
792 1.1 christos {
793 1.1 christos struct ieee80211com *ic = &sc->sc_ic;
794 1.1 christos struct ifnet *ifp = &sc->sc_if;
795 1.1 christos struct athn_rxq *rxq = &sc->sc_rxq[0];
796 1.1 christos struct athn_rx_buf *bf, *nbf;
797 1.1 christos struct ar_rx_desc *ds;
798 1.1 christos struct ieee80211_frame *wh;
799 1.1 christos struct ieee80211_node *ni;
800 1.1 christos struct mbuf *m, *m1;
801 1.1 christos u_int32_t rstamp;
802 1.12 nonaka int error, len, rssi, s;
803 1.1 christos
804 1.1 christos bf = SIMPLEQ_FIRST(&rxq->head);
805 1.1 christos if (__predict_false(bf == NULL)) { /* Should not happen. */
806 1.6 christos aprint_error_dev(sc->sc_dev, "Rx queue is empty!\n");
807 1.1 christos return ENOENT;
808 1.1 christos }
809 1.1 christos ds = bf->bf_desc;
810 1.1 christos
811 1.1 christos if (!(ds->ds_status8 & AR_RXS8_DONE)) {
812 1.1 christos /*
813 1.1 christos * On some parts, the status words can get corrupted
814 1.1 christos * (including the "done" bit), so we check the next
815 1.1 christos * descriptor "done" bit. If it is set, it is a good
816 1.1 christos * indication that the status words are corrupted, so
817 1.1 christos * we skip this descriptor and drop the frame.
818 1.1 christos */
819 1.1 christos nbf = SIMPLEQ_NEXT(bf, bf_list);
820 1.1 christos if (nbf != NULL &&
821 1.1 christos (((struct ar_rx_desc *)nbf->bf_desc)->ds_status8 &
822 1.1 christos AR_RXS8_DONE)) {
823 1.1 christos DPRINTFN(DBG_RX, sc,
824 1.1 christos "corrupted descriptor status=0x%x\n",
825 1.1 christos ds->ds_status8);
826 1.1 christos /* HW will not "move" RXDP in this case, so do it. */
827 1.1 christos AR_WRITE(sc, AR_RXDP, nbf->bf_daddr);
828 1.1 christos AR_WRITE_BARRIER(sc);
829 1.1 christos ifp->if_ierrors++;
830 1.1 christos goto skip;
831 1.1 christos }
832 1.1 christos return EBUSY;
833 1.1 christos }
834 1.1 christos
835 1.1 christos if (__predict_false(ds->ds_status1 & AR_RXS1_MORE)) {
836 1.1 christos /* Drop frames that span multiple Rx descriptors. */
837 1.1 christos DPRINTFN(DBG_RX, sc, "dropping split frame\n");
838 1.1 christos ifp->if_ierrors++;
839 1.1 christos goto skip;
840 1.1 christos }
841 1.1 christos if (!(ds->ds_status8 & AR_RXS8_FRAME_OK)) {
842 1.1 christos if (ds->ds_status8 & AR_RXS8_CRC_ERR)
843 1.1 christos DPRINTFN(DBG_RX, sc, "CRC error\n");
844 1.1 christos else if (ds->ds_status8 & AR_RXS8_PHY_ERR)
845 1.1 christos DPRINTFN(DBG_RX, sc, "PHY error=0x%x\n",
846 1.1 christos MS(ds->ds_status8, AR_RXS8_PHY_ERR_CODE));
847 1.1 christos else if (ds->ds_status8 & AR_RXS8_DECRYPT_CRC_ERR)
848 1.1 christos DPRINTFN(DBG_RX, sc, "Decryption CRC error\n");
849 1.1 christos else if (ds->ds_status8 & AR_RXS8_MICHAEL_ERR) {
850 1.1 christos DPRINTFN(DBG_RX, sc, "Michael MIC failure\n");
851 1.1 christos
852 1.1 christos len = MS(ds->ds_status1, AR_RXS1_DATA_LEN);
853 1.1 christos m = bf->bf_m;
854 1.11 ozaki m_set_rcvif(m, ifp);
855 1.1 christos m->m_pkthdr.len = m->m_len = len;
856 1.1 christos wh = mtod(m, struct ieee80211_frame *);
857 1.1 christos
858 1.1 christos /* Report Michael MIC failures to net80211. */
859 1.1 christos ieee80211_notify_michael_failure(ic, wh, 0 /* XXX: keyix */);
860 1.1 christos }
861 1.1 christos ifp->if_ierrors++;
862 1.1 christos goto skip;
863 1.1 christos }
864 1.1 christos
865 1.1 christos len = MS(ds->ds_status1, AR_RXS1_DATA_LEN);
866 1.1 christos if (__predict_false(len < (int)IEEE80211_MIN_LEN || len > ATHN_RXBUFSZ)) {
867 1.1 christos DPRINTFN(DBG_RX, sc, "corrupted descriptor length=%d\n", len);
868 1.1 christos ifp->if_ierrors++;
869 1.1 christos goto skip;
870 1.1 christos }
871 1.1 christos
872 1.1 christos /* Allocate a new Rx buffer. */
873 1.1 christos m1 = MCLGETI(NULL, M_DONTWAIT, NULL, ATHN_RXBUFSZ);
874 1.1 christos if (__predict_false(m1 == NULL)) {
875 1.1 christos ic->ic_stats.is_rx_nobuf++;
876 1.1 christos ifp->if_ierrors++;
877 1.1 christos goto skip;
878 1.1 christos }
879 1.1 christos
880 1.1 christos /* Sync and unmap the old Rx buffer. */
881 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, ATHN_RXBUFSZ,
882 1.1 christos BUS_DMASYNC_POSTREAD);
883 1.1 christos bus_dmamap_unload(sc->sc_dmat, bf->bf_map);
884 1.1 christos
885 1.1 christos /* Map the new Rx buffer. */
886 1.1 christos error = bus_dmamap_load(sc->sc_dmat, bf->bf_map, mtod(m1, void *),
887 1.1 christos ATHN_RXBUFSZ, NULL, BUS_DMA_NOWAIT | BUS_DMA_READ);
888 1.1 christos if (__predict_false(error != 0)) {
889 1.1 christos m_freem(m1);
890 1.1 christos
891 1.1 christos /* Remap the old Rx buffer or panic. */
892 1.1 christos error = bus_dmamap_load(sc->sc_dmat, bf->bf_map,
893 1.1 christos mtod(bf->bf_m, void *), ATHN_RXBUFSZ, NULL,
894 1.1 christos BUS_DMA_NOWAIT | BUS_DMA_READ);
895 1.1 christos KASSERT(error != 0);
896 1.1 christos ifp->if_ierrors++;
897 1.1 christos goto skip;
898 1.1 christos }
899 1.1 christos
900 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, ATHN_RXBUFSZ,
901 1.1 christos BUS_DMASYNC_PREREAD);
902 1.1 christos
903 1.1 christos /* Write physical address of new Rx buffer. */
904 1.1 christos ds->ds_data = bf->bf_map->dm_segs[0].ds_addr;
905 1.1 christos
906 1.1 christos m = bf->bf_m;
907 1.1 christos bf->bf_m = m1;
908 1.1 christos
909 1.1 christos /* Finalize mbuf. */
910 1.11 ozaki m_set_rcvif(m, ifp);
911 1.1 christos m->m_pkthdr.len = m->m_len = len;
912 1.1 christos
913 1.12 nonaka s = splnet();
914 1.12 nonaka
915 1.1 christos /* Grab a reference to the source node. */
916 1.1 christos wh = mtod(m, struct ieee80211_frame *);
917 1.1 christos ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
918 1.1 christos
919 1.1 christos /* Remove any HW padding after the 802.11 header. */
920 1.1 christos if (!(wh->i_fc[0] & IEEE80211_FC0_TYPE_CTL)) {
921 1.1 christos u_int hdrlen = ieee80211_anyhdrsize(wh);
922 1.1 christos if (hdrlen & 3) {
923 1.14 maxv memmove((uint8_t *)wh + 2, wh, hdrlen);
924 1.1 christos m_adj(m, 2);
925 1.1 christos }
926 1.1 christos }
927 1.1 christos if (__predict_false(sc->sc_drvbpf != NULL))
928 1.1 christos ar5008_rx_radiotap(sc, m, ds);
929 1.1 christos
930 1.1 christos /* Trim 802.11 FCS after radiotap. */
931 1.1 christos m_adj(m, -IEEE80211_CRC_LEN);
932 1.1 christos
933 1.1 christos /* Send the frame to the 802.11 layer. */
934 1.1 christos rssi = MS(ds->ds_status4, AR_RXS4_RSSI_COMBINED);
935 1.1 christos rstamp = ds->ds_status2;
936 1.1 christos ieee80211_input(ic, m, ni, rssi, rstamp);
937 1.1 christos
938 1.1 christos /* Node is no longer needed. */
939 1.1 christos ieee80211_free_node(ni);
940 1.1 christos
941 1.12 nonaka splx(s);
942 1.12 nonaka
943 1.1 christos skip:
944 1.1 christos /* Unlink this descriptor from head. */
945 1.1 christos SIMPLEQ_REMOVE_HEAD(&rxq->head, bf_list);
946 1.1 christos memset(&ds->ds_status0, 0, 36); /* XXX Really needed? */
947 1.1 christos ds->ds_status8 &= ~AR_RXS8_DONE;
948 1.1 christos ds->ds_link = 0;
949 1.1 christos
950 1.1 christos /* Re-use this descriptor and link it to tail. */
951 1.1 christos if (__predict_true(!SIMPLEQ_EMPTY(&rxq->head)))
952 1.1 christos ((struct ar_rx_desc *)rxq->lastds)->ds_link = bf->bf_daddr;
953 1.1 christos else
954 1.1 christos AR_WRITE(sc, AR_RXDP, bf->bf_daddr);
955 1.1 christos SIMPLEQ_INSERT_TAIL(&rxq->head, bf, bf_list);
956 1.1 christos rxq->lastds = ds;
957 1.1 christos
958 1.1 christos /* Re-enable Rx. */
959 1.1 christos AR_WRITE(sc, AR_CR, AR_CR_RXE);
960 1.1 christos AR_WRITE_BARRIER(sc);
961 1.1 christos return 0;
962 1.1 christos }
963 1.1 christos
964 1.1 christos Static void
965 1.1 christos ar5008_rx_intr(struct athn_softc *sc)
966 1.1 christos {
967 1.1 christos
968 1.1 christos while (ar5008_rx_process(sc) == 0)
969 1.1 christos continue;
970 1.1 christos }
971 1.1 christos
972 1.1 christos Static int
973 1.1 christos ar5008_tx_process(struct athn_softc *sc, int qid)
974 1.1 christos {
975 1.1 christos struct ifnet *ifp = &sc->sc_if;
976 1.1 christos struct athn_txq *txq = &sc->sc_txq[qid];
977 1.1 christos struct athn_node *an;
978 1.1 christos struct athn_tx_buf *bf;
979 1.1 christos struct ar_tx_desc *ds;
980 1.1 christos uint8_t failcnt;
981 1.1 christos
982 1.1 christos bf = SIMPLEQ_FIRST(&txq->head);
983 1.1 christos if (bf == NULL)
984 1.1 christos return ENOENT;
985 1.1 christos /* Get descriptor of last DMA segment. */
986 1.1 christos ds = &((struct ar_tx_desc *)bf->bf_descs)[bf->bf_map->dm_nsegs - 1];
987 1.1 christos
988 1.1 christos if (!(ds->ds_status9 & AR_TXS9_DONE))
989 1.1 christos return EBUSY;
990 1.1 christos
991 1.1 christos SIMPLEQ_REMOVE_HEAD(&txq->head, bf_list);
992 1.1 christos ifp->if_opackets++;
993 1.1 christos
994 1.1 christos sc->sc_tx_timer = 0;
995 1.1 christos
996 1.1 christos if (ds->ds_status1 & AR_TXS1_EXCESSIVE_RETRIES)
997 1.1 christos ifp->if_oerrors++;
998 1.1 christos
999 1.1 christos if (ds->ds_status1 & AR_TXS1_UNDERRUN)
1000 1.1 christos athn_inc_tx_trigger_level(sc);
1001 1.1 christos
1002 1.1 christos an = (struct athn_node *)bf->bf_ni;
1003 1.1 christos /*
1004 1.1 christos * NB: the data fail count contains the number of un-acked tries
1005 1.1 christos * for the final series used. We must add the number of tries for
1006 1.1 christos * each series that was fully processed.
1007 1.1 christos */
1008 1.1 christos failcnt = MS(ds->ds_status1, AR_TXS1_DATA_FAIL_CNT);
1009 1.1 christos /* NB: Assume two tries per series. */
1010 1.1 christos failcnt += MS(ds->ds_status9, AR_TXS9_FINAL_IDX) * 2;
1011 1.1 christos
1012 1.1 christos /* Update rate control statistics. */
1013 1.1 christos an->amn.amn_txcnt++;
1014 1.1 christos if (failcnt > 0)
1015 1.1 christos an->amn.amn_retrycnt++;
1016 1.1 christos
1017 1.1 christos DPRINTFN(DBG_TX, sc, "Tx done qid=%d status1=%d fail count=%d\n",
1018 1.1 christos qid, ds->ds_status1, failcnt);
1019 1.1 christos
1020 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, bf->bf_map->dm_mapsize,
1021 1.1 christos BUS_DMASYNC_POSTWRITE);
1022 1.1 christos bus_dmamap_unload(sc->sc_dmat, bf->bf_map);
1023 1.1 christos
1024 1.1 christos m_freem(bf->bf_m);
1025 1.1 christos bf->bf_m = NULL;
1026 1.1 christos ieee80211_free_node(bf->bf_ni);
1027 1.1 christos bf->bf_ni = NULL;
1028 1.1 christos
1029 1.1 christos /* Link Tx buffer back to global free list. */
1030 1.1 christos SIMPLEQ_INSERT_TAIL(&sc->sc_txbufs, bf, bf_list);
1031 1.1 christos return 0;
1032 1.1 christos }
1033 1.1 christos
1034 1.1 christos Static void
1035 1.1 christos ar5008_tx_intr(struct athn_softc *sc)
1036 1.1 christos {
1037 1.1 christos struct ifnet *ifp = &sc->sc_if;
1038 1.1 christos uint16_t mask = 0;
1039 1.1 christos uint32_t reg;
1040 1.12 nonaka int qid, s;
1041 1.12 nonaka
1042 1.12 nonaka s = splnet();
1043 1.1 christos
1044 1.1 christos reg = AR_READ(sc, AR_ISR_S0_S);
1045 1.1 christos mask |= MS(reg, AR_ISR_S0_QCU_TXOK);
1046 1.1 christos mask |= MS(reg, AR_ISR_S0_QCU_TXDESC);
1047 1.1 christos
1048 1.1 christos reg = AR_READ(sc, AR_ISR_S1_S);
1049 1.1 christos mask |= MS(reg, AR_ISR_S1_QCU_TXERR);
1050 1.1 christos mask |= MS(reg, AR_ISR_S1_QCU_TXEOL);
1051 1.1 christos
1052 1.1 christos DPRINTFN(DBG_TX, sc, "Tx interrupt mask=0x%x\n", mask);
1053 1.1 christos for (qid = 0; mask != 0; mask >>= 1, qid++) {
1054 1.1 christos if (mask & 1)
1055 1.1 christos while (ar5008_tx_process(sc, qid) == 0);
1056 1.1 christos }
1057 1.1 christos if (!SIMPLEQ_EMPTY(&sc->sc_txbufs)) {
1058 1.1 christos ifp->if_flags &= ~IFF_OACTIVE;
1059 1.13 ozaki ifp->if_start(ifp); /* in softint */
1060 1.1 christos }
1061 1.12 nonaka
1062 1.12 nonaka splx(s);
1063 1.1 christos }
1064 1.1 christos
1065 1.1 christos #ifndef IEEE80211_STA_ONLY
1066 1.1 christos /*
1067 1.1 christos * Process Software Beacon Alert interrupts.
1068 1.1 christos */
1069 1.1 christos Static int
1070 1.1 christos ar5008_swba_intr(struct athn_softc *sc)
1071 1.1 christos {
1072 1.1 christos struct ieee80211com *ic = &sc->sc_ic;
1073 1.1 christos struct ifnet *ifp = &sc->sc_if;
1074 1.1 christos struct ieee80211_node *ni = ic->ic_bss;
1075 1.1 christos struct athn_tx_buf *bf = sc->sc_bcnbuf;
1076 1.1 christos struct ieee80211_frame *wh;
1077 1.1 christos struct ieee80211_beacon_offsets bo;
1078 1.1 christos struct ar_tx_desc *ds;
1079 1.1 christos struct mbuf *m;
1080 1.1 christos uint8_t ridx, hwrate;
1081 1.1 christos int error, totlen;
1082 1.1 christos
1083 1.1 christos #if notyet
1084 1.1 christos if (ic->ic_tim_mcast_pending &&
1085 1.1 christos IF_IS_EMPTY(&ni->ni_savedq) &&
1086 1.1 christos SIMPLEQ_EMPTY(&sc->sc_txq[ATHN_QID_CAB].head))
1087 1.1 christos ic->ic_tim_mcast_pending = 0;
1088 1.1 christos #endif
1089 1.1 christos if (ic->ic_dtim_count == 0)
1090 1.1 christos ic->ic_dtim_count = ic->ic_dtim_period - 1;
1091 1.1 christos else
1092 1.1 christos ic->ic_dtim_count--;
1093 1.1 christos
1094 1.1 christos /* Make sure previous beacon has been sent. */
1095 1.1 christos if (athn_tx_pending(sc, ATHN_QID_BEACON)) {
1096 1.1 christos DPRINTFN(DBG_INTR, sc, "beacon stuck\n");
1097 1.1 christos return EBUSY;
1098 1.1 christos }
1099 1.1 christos /* Get new beacon. */
1100 1.1 christos m = ieee80211_beacon_alloc(ic, ic->ic_bss, &bo);
1101 1.1 christos if (__predict_false(m == NULL))
1102 1.1 christos return ENOBUFS;
1103 1.1 christos /* Assign sequence number. */
1104 1.1 christos /* XXX: use non-QoS tid? */
1105 1.1 christos wh = mtod(m, struct ieee80211_frame *);
1106 1.1 christos *(uint16_t *)&wh->i_seq[0] =
1107 1.1 christos htole16(ic->ic_bss->ni_txseqs[0] << IEEE80211_SEQ_SEQ_SHIFT);
1108 1.1 christos ic->ic_bss->ni_txseqs[0]++;
1109 1.1 christos
1110 1.1 christos /* Unmap and free old beacon if any. */
1111 1.1 christos if (__predict_true(bf->bf_m != NULL)) {
1112 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0,
1113 1.1 christos bf->bf_map->dm_mapsize, BUS_DMASYNC_POSTWRITE);
1114 1.1 christos bus_dmamap_unload(sc->sc_dmat, bf->bf_map);
1115 1.1 christos m_freem(bf->bf_m);
1116 1.1 christos bf->bf_m = NULL;
1117 1.1 christos }
1118 1.1 christos /* DMA map new beacon. */
1119 1.1 christos error = bus_dmamap_load_mbuf(sc->sc_dmat, bf->bf_map, m,
1120 1.1 christos BUS_DMA_NOWAIT | BUS_DMA_WRITE);
1121 1.1 christos if (__predict_false(error != 0)) {
1122 1.1 christos m_freem(m);
1123 1.1 christos return error;
1124 1.1 christos }
1125 1.1 christos bf->bf_m = m;
1126 1.1 christos
1127 1.1 christos /* Setup Tx descriptor (simplified ar5008_tx()). */
1128 1.1 christos ds = bf->bf_descs;
1129 1.1 christos memset(ds, 0, sizeof(*ds));
1130 1.1 christos
1131 1.1 christos totlen = m->m_pkthdr.len + IEEE80211_CRC_LEN;
1132 1.1 christos ds->ds_ctl0 = SM(AR_TXC0_FRAME_LEN, totlen);
1133 1.1 christos ds->ds_ctl0 |= SM(AR_TXC0_XMIT_POWER, AR_MAX_RATE_POWER);
1134 1.1 christos ds->ds_ctl1 = SM(AR_TXC1_FRAME_TYPE, AR_FRAME_TYPE_BEACON);
1135 1.1 christos ds->ds_ctl1 |= AR_TXC1_NO_ACK;
1136 1.1 christos ds->ds_ctl6 = SM(AR_TXC6_ENCR_TYPE, AR_ENCR_TYPE_CLEAR);
1137 1.1 christos
1138 1.1 christos /* Write number of tries. */
1139 1.1 christos ds->ds_ctl2 = SM(AR_TXC2_XMIT_DATA_TRIES0, 1);
1140 1.1 christos
1141 1.1 christos /* Write Tx rate. */
1142 1.1 christos ridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
1143 1.1 christos ATHN_RIDX_OFDM6 : ATHN_RIDX_CCK1;
1144 1.1 christos hwrate = athn_rates[ridx].hwrate;
1145 1.1 christos ds->ds_ctl3 = SM(AR_TXC3_XMIT_RATE0, hwrate);
1146 1.1 christos
1147 1.1 christos /* Write Tx chains. */
1148 1.1 christos ds->ds_ctl7 = SM(AR_TXC7_CHAIN_SEL0, sc->sc_txchainmask);
1149 1.1 christos
1150 1.1 christos ds->ds_data = bf->bf_map->dm_segs[0].ds_addr;
1151 1.1 christos /* Segment length must be a multiple of 4. */
1152 1.1 christos ds->ds_ctl1 |= SM(AR_TXC1_BUF_LEN,
1153 1.1 christos (bf->bf_map->dm_segs[0].ds_len + 3) & ~3);
1154 1.1 christos
1155 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, bf->bf_map->dm_mapsize,
1156 1.1 christos BUS_DMASYNC_PREWRITE);
1157 1.1 christos
1158 1.1 christos /* Stop Tx DMA before putting the new beacon on the queue. */
1159 1.1 christos athn_stop_tx_dma(sc, ATHN_QID_BEACON);
1160 1.1 christos
1161 1.1 christos AR_WRITE(sc, AR_QTXDP(ATHN_QID_BEACON), bf->bf_daddr);
1162 1.1 christos
1163 1.1 christos for(;;) {
1164 1.1 christos if (SIMPLEQ_EMPTY(&sc->sc_txbufs))
1165 1.1 christos break;
1166 1.1 christos
1167 1.1 christos IF_DEQUEUE(&ni->ni_savedq, m);
1168 1.1 christos if (m == NULL)
1169 1.1 christos break;
1170 1.1 christos if (!IF_IS_EMPTY(&ni->ni_savedq)) {
1171 1.1 christos /* more queued frames, set the more data bit */
1172 1.1 christos wh = mtod(m, struct ieee80211_frame *);
1173 1.1 christos wh->i_fc[1] |= IEEE80211_FC1_MORE_DATA;
1174 1.1 christos }
1175 1.1 christos
1176 1.1 christos if (sc->sc_ops.tx(sc, m, ni, ATHN_TXFLAG_CAB) != 0) {
1177 1.1 christos ieee80211_free_node(ni);
1178 1.1 christos ifp->if_oerrors++;
1179 1.1 christos break;
1180 1.1 christos }
1181 1.1 christos }
1182 1.1 christos
1183 1.1 christos /* Kick Tx. */
1184 1.1 christos AR_WRITE(sc, AR_Q_TXE, 1 << ATHN_QID_BEACON);
1185 1.1 christos AR_WRITE_BARRIER(sc);
1186 1.1 christos return 0;
1187 1.1 christos }
1188 1.1 christos #endif
1189 1.1 christos
1190 1.12 nonaka static int
1191 1.12 nonaka ar5008_get_intr_status(struct athn_softc *sc, uint32_t *intrp, uint32_t *syncp)
1192 1.1 christos {
1193 1.12 nonaka uint32_t intr, sync;
1194 1.1 christos
1195 1.1 christos /* Get pending interrupts. */
1196 1.1 christos intr = AR_READ(sc, AR_INTR_ASYNC_CAUSE);
1197 1.1 christos if (!(intr & AR_INTR_MAC_IRQ) || intr == AR_INTR_SPURIOUS) {
1198 1.1 christos intr = AR_READ(sc, AR_INTR_SYNC_CAUSE);
1199 1.1 christos if (intr == AR_INTR_SPURIOUS || (intr & sc->sc_isync) == 0)
1200 1.1 christos return 0; /* Not for us. */
1201 1.1 christos }
1202 1.1 christos
1203 1.1 christos if ((AR_READ(sc, AR_INTR_ASYNC_CAUSE) & AR_INTR_MAC_IRQ) &&
1204 1.1 christos (AR_READ(sc, AR_RTC_STATUS) & AR_RTC_STATUS_M) == AR_RTC_STATUS_ON)
1205 1.1 christos intr = AR_READ(sc, AR_ISR);
1206 1.1 christos else
1207 1.1 christos intr = 0;
1208 1.1 christos sync = AR_READ(sc, AR_INTR_SYNC_CAUSE) & sc->sc_isync;
1209 1.1 christos if (intr == 0 && sync == 0)
1210 1.1 christos return 0; /* Not for us. */
1211 1.1 christos
1212 1.12 nonaka *intrp = intr;
1213 1.12 nonaka *syncp = sync;
1214 1.12 nonaka return 1;
1215 1.12 nonaka }
1216 1.12 nonaka
1217 1.12 nonaka
1218 1.12 nonaka Static int
1219 1.12 nonaka ar5008_intr_status(struct athn_softc *sc)
1220 1.12 nonaka {
1221 1.12 nonaka uint32_t intr, sync;
1222 1.12 nonaka
1223 1.12 nonaka return ar5008_get_intr_status(sc, &intr, &sync);
1224 1.12 nonaka }
1225 1.12 nonaka
1226 1.12 nonaka Static int
1227 1.12 nonaka ar5008_intr(struct athn_softc *sc)
1228 1.12 nonaka {
1229 1.12 nonaka uint32_t intr, intr5, sync;
1230 1.12 nonaka #ifndef IEEE80211_STA_ONLY
1231 1.12 nonaka int s;
1232 1.12 nonaka #endif
1233 1.12 nonaka
1234 1.12 nonaka if (!ar5008_get_intr_status(sc, &intr, &sync))
1235 1.12 nonaka return 0;
1236 1.12 nonaka
1237 1.1 christos if (intr != 0) {
1238 1.1 christos if (intr & AR_ISR_BCNMISC) {
1239 1.4 christos uint32_t intr2 = AR_READ(sc, AR_ISR_S2);
1240 1.1 christos #if notyet
1241 1.1 christos if (intr2 & AR_ISR_S2_TIM)
1242 1.1 christos /* TBD */;
1243 1.1 christos if (intr2 & AR_ISR_S2_TSFOOR)
1244 1.1 christos /* TBD */;
1245 1.4 christos #else
1246 1.4 christos __USE(intr2);
1247 1.1 christos #endif
1248 1.1 christos }
1249 1.1 christos intr = AR_READ(sc, AR_ISR_RAC);
1250 1.1 christos if (intr == AR_INTR_SPURIOUS)
1251 1.1 christos return 1;
1252 1.1 christos
1253 1.1 christos #ifndef IEEE80211_STA_ONLY
1254 1.12 nonaka if (intr & AR_ISR_SWBA) {
1255 1.12 nonaka s = splnet();
1256 1.1 christos ar5008_swba_intr(sc);
1257 1.12 nonaka splx(s);
1258 1.12 nonaka }
1259 1.1 christos #endif
1260 1.1 christos if (intr & (AR_ISR_RXMINTR | AR_ISR_RXINTM))
1261 1.1 christos ar5008_rx_intr(sc);
1262 1.1 christos if (intr & (AR_ISR_RXOK | AR_ISR_RXERR | AR_ISR_RXORN))
1263 1.1 christos ar5008_rx_intr(sc);
1264 1.1 christos
1265 1.1 christos if (intr & (AR_ISR_TXOK | AR_ISR_TXDESC |
1266 1.1 christos AR_ISR_TXERR | AR_ISR_TXEOL))
1267 1.1 christos ar5008_tx_intr(sc);
1268 1.1 christos
1269 1.1 christos intr5 = AR_READ(sc, AR_ISR_S5_S);
1270 1.1 christos if (intr & AR_ISR_GENTMR) {
1271 1.1 christos if (intr5 & AR_ISR_GENTMR) {
1272 1.1 christos DPRINTFN(DBG_INTR, sc,
1273 1.1 christos "GENTMR trigger=%d thresh=%d\n",
1274 1.1 christos MS(intr5, AR_ISR_S5_GENTIMER_TRIG),
1275 1.1 christos MS(intr5, AR_ISR_S5_GENTIMER_THRESH));
1276 1.1 christos }
1277 1.1 christos }
1278 1.1 christos #if notyet
1279 1.1 christos if (intr5 & AR_ISR_S5_TIM_TIMER) {
1280 1.1 christos /* TBD */;
1281 1.1 christos }
1282 1.1 christos #endif
1283 1.1 christos }
1284 1.1 christos if (sync != 0) {
1285 1.1 christos #if notyet
1286 1.1 christos if (sync &
1287 1.1 christos (AR_INTR_SYNC_HOST1_FATAL | AR_INTR_SYNC_HOST1_PERR)) {
1288 1.1 christos /* TBD */;
1289 1.1 christos }
1290 1.1 christos #endif
1291 1.1 christos if (sync & AR_INTR_SYNC_RADM_CPL_TIMEOUT) {
1292 1.1 christos AR_WRITE(sc, AR_RC, AR_RC_HOSTIF);
1293 1.1 christos AR_WRITE(sc, AR_RC, 0);
1294 1.1 christos }
1295 1.1 christos
1296 1.1 christos if ((sc->sc_flags & ATHN_FLAG_RFSILENT) &&
1297 1.1 christos (sync & AR_INTR_SYNC_GPIO_PIN(sc->sc_rfsilent_pin))) {
1298 1.9 jmcneill AR_WRITE(sc, AR_INTR_SYNC_ENABLE, 0);
1299 1.9 jmcneill (void)AR_READ(sc, AR_INTR_SYNC_ENABLE);
1300 1.3 martin pmf_event_inject(sc->sc_dev, PMFE_RADIO_OFF);
1301 1.1 christos }
1302 1.1 christos
1303 1.1 christos AR_WRITE(sc, AR_INTR_SYNC_CAUSE, sync);
1304 1.1 christos (void)AR_READ(sc, AR_INTR_SYNC_CAUSE);
1305 1.1 christos }
1306 1.1 christos return 1;
1307 1.1 christos }
1308 1.1 christos
1309 1.1 christos Static int
1310 1.1 christos ar5008_tx(struct athn_softc *sc, struct mbuf *m, struct ieee80211_node *ni,
1311 1.1 christos int txflags)
1312 1.1 christos {
1313 1.1 christos struct ieee80211com *ic = &sc->sc_ic;
1314 1.1 christos struct ieee80211_key *k = NULL;
1315 1.1 christos struct ieee80211_frame *wh;
1316 1.1 christos struct athn_series series[4];
1317 1.1 christos struct ar_tx_desc *ds, *lastds;
1318 1.1 christos struct athn_txq *txq;
1319 1.1 christos struct athn_tx_buf *bf;
1320 1.1 christos struct athn_node *an = (void *)ni;
1321 1.1 christos struct mbuf *m1;
1322 1.1 christos uint16_t qos;
1323 1.1 christos uint8_t txpower, type, encrtype, ridx[4];
1324 1.1 christos int i, error, totlen, hasqos, qid;
1325 1.1 christos
1326 1.1 christos /* Grab a Tx buffer from our global free list. */
1327 1.1 christos bf = SIMPLEQ_FIRST(&sc->sc_txbufs);
1328 1.1 christos KASSERT(bf != NULL);
1329 1.1 christos
1330 1.1 christos /* Map 802.11 frame type to hardware frame type. */
1331 1.1 christos wh = mtod(m, struct ieee80211_frame *);
1332 1.1 christos if ((wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) ==
1333 1.1 christos IEEE80211_FC0_TYPE_MGT) {
1334 1.1 christos /* NB: Beacons do not use ar5008_tx(). */
1335 1.1 christos if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
1336 1.1 christos IEEE80211_FC0_SUBTYPE_PROBE_RESP)
1337 1.1 christos type = AR_FRAME_TYPE_PROBE_RESP;
1338 1.1 christos else if ((wh->i_fc[0] & IEEE80211_FC0_SUBTYPE_MASK) ==
1339 1.1 christos IEEE80211_FC0_SUBTYPE_ATIM)
1340 1.1 christos type = AR_FRAME_TYPE_ATIM;
1341 1.1 christos else
1342 1.1 christos type = AR_FRAME_TYPE_NORMAL;
1343 1.1 christos }
1344 1.1 christos else if ((wh->i_fc[0] &
1345 1.1 christos (IEEE80211_FC0_TYPE_MASK | IEEE80211_FC0_SUBTYPE_MASK)) ==
1346 1.1 christos (IEEE80211_FC0_TYPE_CTL | IEEE80211_FC0_SUBTYPE_PS_POLL)) {
1347 1.1 christos type = AR_FRAME_TYPE_PSPOLL;
1348 1.1 christos }
1349 1.1 christos else
1350 1.1 christos type = AR_FRAME_TYPE_NORMAL;
1351 1.1 christos
1352 1.1 christos if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
1353 1.1 christos k = ieee80211_crypto_encap(ic, ni, m);
1354 1.1 christos if (k == NULL)
1355 1.1 christos return ENOBUFS;
1356 1.1 christos
1357 1.1 christos /* packet header may have moved, reset our local pointer */
1358 1.1 christos wh = mtod(m, struct ieee80211_frame *);
1359 1.1 christos }
1360 1.1 christos
1361 1.1 christos /* XXX 2-byte padding for QoS and 4-addr headers. */
1362 1.1 christos
1363 1.1 christos /* Select the HW Tx queue to use for this frame. */
1364 1.1 christos if ((hasqos = ieee80211_has_qos(wh))) {
1365 1.1 christos #ifdef notyet_edca
1366 1.1 christos uint8_t tid;
1367 1.1 christos
1368 1.1 christos qos = ieee80211_get_qos(wh);
1369 1.1 christos tid = qos & IEEE80211_QOS_TID;
1370 1.1 christos qid = athn_ac2qid[ieee80211_up_to_ac(ic, tid)];
1371 1.1 christos #else
1372 1.1 christos qos = ieee80211_get_qos(wh);
1373 1.1 christos qid = ATHN_QID_AC_BE;
1374 1.1 christos #endif /* notyet_edca */
1375 1.1 christos }
1376 1.1 christos else if (type == AR_FRAME_TYPE_PSPOLL) {
1377 1.1 christos qos = 0;
1378 1.1 christos qid = ATHN_QID_PSPOLL;
1379 1.1 christos }
1380 1.1 christos else if (txflags & ATHN_TXFLAG_CAB) {
1381 1.1 christos qos = 0;
1382 1.1 christos qid = ATHN_QID_CAB;
1383 1.1 christos }
1384 1.1 christos else {
1385 1.1 christos qos = 0;
1386 1.1 christos qid = ATHN_QID_AC_BE;
1387 1.1 christos }
1388 1.1 christos txq = &sc->sc_txq[qid];
1389 1.1 christos
1390 1.1 christos /* Select the transmit rates to use for this frame. */
1391 1.1 christos if (IEEE80211_IS_MULTICAST(wh->i_addr1) ||
1392 1.1 christos (wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK) !=
1393 1.1 christos IEEE80211_FC0_TYPE_DATA) {
1394 1.1 christos /* Use lowest rate for all tries. */
1395 1.1 christos ridx[0] = ridx[1] = ridx[2] = ridx[3] =
1396 1.1 christos (ic->ic_curmode == IEEE80211_MODE_11A) ?
1397 1.1 christos ATHN_RIDX_OFDM6 : ATHN_RIDX_CCK1;
1398 1.1 christos }
1399 1.1 christos else if (ic->ic_fixed_rate != -1) {
1400 1.1 christos /* Use same fixed rate for all tries. */
1401 1.1 christos ridx[0] = ridx[1] = ridx[2] = ridx[3] =
1402 1.1 christos sc->sc_fixed_ridx;
1403 1.1 christos }
1404 1.1 christos else {
1405 1.1 christos int txrate = ni->ni_txrate;
1406 1.1 christos /* Use fallback table of the node. */
1407 1.1 christos for (i = 0; i < 4; i++) {
1408 1.1 christos ridx[i] = an->ridx[txrate];
1409 1.1 christos txrate = an->fallback[txrate];
1410 1.1 christos }
1411 1.1 christos }
1412 1.1 christos
1413 1.1 christos if (__predict_false(sc->sc_drvbpf != NULL)) {
1414 1.1 christos struct athn_tx_radiotap_header *tap = &sc->sc_txtap;
1415 1.1 christos
1416 1.1 christos tap->wt_flags = 0;
1417 1.1 christos /* Use initial transmit rate. */
1418 1.1 christos tap->wt_rate = athn_rates[ridx[0]].rate;
1419 1.1 christos tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
1420 1.1 christos tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
1421 1.1 christos // XXX tap->wt_hwqueue = qid;
1422 1.1 christos if (ridx[0] != ATHN_RIDX_CCK1 &&
1423 1.1 christos (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
1424 1.1 christos tap->wt_flags |= IEEE80211_RADIOTAP_F_SHORTPRE;
1425 1.1 christos
1426 1.15 msaitoh bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m, BPF_D_OUT);
1427 1.1 christos }
1428 1.1 christos
1429 1.1 christos /* DMA map mbuf. */
1430 1.1 christos error = bus_dmamap_load_mbuf(sc->sc_dmat, bf->bf_map, m,
1431 1.1 christos BUS_DMA_NOWAIT | BUS_DMA_WRITE);
1432 1.1 christos if (__predict_false(error != 0)) {
1433 1.1 christos if (error != EFBIG) {
1434 1.6 christos aprint_error_dev(sc->sc_dev,
1435 1.6 christos "can't map mbuf (error %d)\n", error);
1436 1.1 christos m_freem(m);
1437 1.1 christos return error;
1438 1.1 christos }
1439 1.1 christos /*
1440 1.1 christos * DMA mapping requires too many DMA segments; linearize
1441 1.1 christos * mbuf in kernel virtual address space and retry.
1442 1.1 christos */
1443 1.1 christos MGETHDR(m1, M_DONTWAIT, MT_DATA);
1444 1.1 christos if (m1 == NULL) {
1445 1.1 christos m_freem(m);
1446 1.1 christos return ENOBUFS;
1447 1.1 christos }
1448 1.1 christos if (m->m_pkthdr.len > (int)MHLEN) {
1449 1.1 christos MCLGET(m1, M_DONTWAIT);
1450 1.1 christos if (!(m1->m_flags & M_EXT)) {
1451 1.1 christos m_freem(m);
1452 1.1 christos m_freem(m1);
1453 1.1 christos return ENOBUFS;
1454 1.1 christos }
1455 1.1 christos }
1456 1.1 christos m_copydata(m, 0, m->m_pkthdr.len, mtod(m1, void *));
1457 1.1 christos m1->m_pkthdr.len = m1->m_len = m->m_pkthdr.len;
1458 1.1 christos m_freem(m);
1459 1.1 christos m = m1;
1460 1.1 christos
1461 1.1 christos error = bus_dmamap_load_mbuf(sc->sc_dmat, bf->bf_map, m,
1462 1.1 christos BUS_DMA_NOWAIT | BUS_DMA_WRITE);
1463 1.1 christos if (error != 0) {
1464 1.6 christos aprint_error_dev(sc->sc_dev,
1465 1.6 christos "can't map mbuf (error %d)\n", error);
1466 1.1 christos m_freem(m);
1467 1.1 christos return error;
1468 1.1 christos }
1469 1.1 christos }
1470 1.1 christos bf->bf_m = m;
1471 1.1 christos bf->bf_ni = ni;
1472 1.1 christos bf->bf_txflags = txflags;
1473 1.1 christos
1474 1.1 christos wh = mtod(m, struct ieee80211_frame *);
1475 1.1 christos
1476 1.1 christos totlen = m->m_pkthdr.len + IEEE80211_CRC_LEN;
1477 1.1 christos
1478 1.1 christos /* Clear all Tx descriptors that we will use. */
1479 1.1 christos memset(bf->bf_descs, 0, bf->bf_map->dm_nsegs * sizeof(*ds));
1480 1.1 christos
1481 1.1 christos /* Setup first Tx descriptor. */
1482 1.1 christos ds = bf->bf_descs;
1483 1.1 christos
1484 1.1 christos ds->ds_ctl0 = AR_TXC0_INTR_REQ | AR_TXC0_CLR_DEST_MASK;
1485 1.1 christos txpower = AR_MAX_RATE_POWER; /* Get from per-rate registers. */
1486 1.1 christos ds->ds_ctl0 |= SM(AR_TXC0_XMIT_POWER, txpower);
1487 1.1 christos
1488 1.1 christos ds->ds_ctl1 = SM(AR_TXC1_FRAME_TYPE, type);
1489 1.1 christos
1490 1.1 christos if (IEEE80211_IS_MULTICAST(wh->i_addr1) ||
1491 1.1 christos (hasqos && (qos & IEEE80211_QOS_ACKPOLICY_MASK) ==
1492 1.1 christos IEEE80211_QOS_ACKPOLICY_NOACK))
1493 1.1 christos ds->ds_ctl1 |= AR_TXC1_NO_ACK;
1494 1.1 christos #if notyet
1495 1.1 christos if (0 && k != NULL) {
1496 1.1 christos uintptr_t entry;
1497 1.1 christos
1498 1.1 christos /*
1499 1.1 christos * Map 802.11 cipher to hardware encryption type and
1500 1.1 christos * compute MIC+ICV overhead.
1501 1.1 christos */
1502 1.1 christos totlen += k->wk_keylen;
1503 1.1 christos switch (k->wk_cipher->ic_cipher) {
1504 1.1 christos case IEEE80211_CIPHER_WEP:
1505 1.1 christos encrtype = AR_ENCR_TYPE_WEP;
1506 1.1 christos break;
1507 1.1 christos case IEEE80211_CIPHER_TKIP:
1508 1.1 christos encrtype = AR_ENCR_TYPE_TKIP;
1509 1.1 christos break;
1510 1.1 christos case IEEE80211_CIPHER_AES_OCB:
1511 1.1 christos case IEEE80211_CIPHER_AES_CCM:
1512 1.1 christos encrtype = AR_ENCR_TYPE_AES;
1513 1.1 christos break;
1514 1.1 christos default:
1515 1.1 christos panic("unsupported cipher");
1516 1.1 christos }
1517 1.1 christos /*
1518 1.1 christos * NB: The key cache entry index is stored in the key
1519 1.1 christos * private field when the key is installed.
1520 1.1 christos */
1521 1.1 christos entry = (uintptr_t)k->k_priv;
1522 1.1 christos ds->ds_ctl1 |= SM(AR_TXC1_DEST_IDX, entry);
1523 1.1 christos ds->ds_ctl0 |= AR_TXC0_DEST_IDX_VALID;
1524 1.1 christos }
1525 1.1 christos else
1526 1.1 christos #endif
1527 1.1 christos encrtype = AR_ENCR_TYPE_CLEAR;
1528 1.1 christos ds->ds_ctl6 = SM(AR_TXC6_ENCR_TYPE, encrtype);
1529 1.1 christos
1530 1.1 christos /* Check if frame must be protected using RTS/CTS or CTS-to-self. */
1531 1.1 christos if (!IEEE80211_IS_MULTICAST(wh->i_addr1)) {
1532 1.1 christos /* NB: Group frames are sent using CCK in 802.11b/g. */
1533 1.1 christos if (totlen > ic->ic_rtsthreshold) {
1534 1.1 christos ds->ds_ctl0 |= AR_TXC0_RTS_ENABLE;
1535 1.1 christos }
1536 1.1 christos else if ((ic->ic_flags & IEEE80211_F_USEPROT) &&
1537 1.1 christos athn_rates[ridx[0]].phy == IEEE80211_T_OFDM) {
1538 1.1 christos if (ic->ic_protmode == IEEE80211_PROT_RTSCTS)
1539 1.1 christos ds->ds_ctl0 |= AR_TXC0_RTS_ENABLE;
1540 1.1 christos else if (ic->ic_protmode == IEEE80211_PROT_CTSONLY)
1541 1.1 christos ds->ds_ctl0 |= AR_TXC0_CTS_ENABLE;
1542 1.1 christos }
1543 1.1 christos }
1544 1.1 christos if (ds->ds_ctl0 & (AR_TXC0_RTS_ENABLE | AR_TXC0_CTS_ENABLE)) {
1545 1.1 christos /* Disable multi-rate retries when protection is used. */
1546 1.1 christos ridx[1] = ridx[2] = ridx[3] = ridx[0];
1547 1.1 christos }
1548 1.1 christos /* Setup multi-rate retries. */
1549 1.1 christos for (i = 0; i < 4; i++) {
1550 1.1 christos series[i].hwrate = athn_rates[ridx[i]].hwrate;
1551 1.1 christos if (athn_rates[ridx[i]].phy == IEEE80211_T_DS &&
1552 1.1 christos ridx[i] != ATHN_RIDX_CCK1 &&
1553 1.1 christos (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
1554 1.1 christos series[i].hwrate |= 0x04;
1555 1.1 christos series[i].dur = 0;
1556 1.1 christos }
1557 1.1 christos if (!(ds->ds_ctl1 & AR_TXC1_NO_ACK)) {
1558 1.1 christos /* Compute duration for each series. */
1559 1.1 christos for (i = 0; i < 4; i++) {
1560 1.1 christos series[i].dur = athn_txtime(sc, IEEE80211_ACK_LEN,
1561 1.1 christos athn_rates[ridx[i]].rspridx, ic->ic_flags);
1562 1.1 christos }
1563 1.1 christos }
1564 1.1 christos
1565 1.1 christos /* Write number of tries for each series. */
1566 1.1 christos ds->ds_ctl2 =
1567 1.1 christos SM(AR_TXC2_XMIT_DATA_TRIES0, 2) |
1568 1.1 christos SM(AR_TXC2_XMIT_DATA_TRIES1, 2) |
1569 1.1 christos SM(AR_TXC2_XMIT_DATA_TRIES2, 2) |
1570 1.1 christos SM(AR_TXC2_XMIT_DATA_TRIES3, 4);
1571 1.1 christos
1572 1.1 christos /* Tell HW to update duration field in 802.11 header. */
1573 1.1 christos if (type != AR_FRAME_TYPE_PSPOLL)
1574 1.1 christos ds->ds_ctl2 |= AR_TXC2_DUR_UPDATE_ENA;
1575 1.1 christos
1576 1.1 christos /* Write Tx rate for each series. */
1577 1.1 christos ds->ds_ctl3 =
1578 1.1 christos SM(AR_TXC3_XMIT_RATE0, series[0].hwrate) |
1579 1.1 christos SM(AR_TXC3_XMIT_RATE1, series[1].hwrate) |
1580 1.1 christos SM(AR_TXC3_XMIT_RATE2, series[2].hwrate) |
1581 1.1 christos SM(AR_TXC3_XMIT_RATE3, series[3].hwrate);
1582 1.1 christos
1583 1.1 christos /* Write duration for each series. */
1584 1.1 christos ds->ds_ctl4 =
1585 1.1 christos SM(AR_TXC4_PACKET_DUR0, series[0].dur) |
1586 1.1 christos SM(AR_TXC4_PACKET_DUR1, series[1].dur);
1587 1.1 christos ds->ds_ctl5 =
1588 1.1 christos SM(AR_TXC5_PACKET_DUR2, series[2].dur) |
1589 1.1 christos SM(AR_TXC5_PACKET_DUR3, series[3].dur);
1590 1.1 christos
1591 1.1 christos /* Use the same Tx chains for all tries. */
1592 1.1 christos ds->ds_ctl7 =
1593 1.1 christos SM(AR_TXC7_CHAIN_SEL0, sc->sc_txchainmask) |
1594 1.1 christos SM(AR_TXC7_CHAIN_SEL1, sc->sc_txchainmask) |
1595 1.1 christos SM(AR_TXC7_CHAIN_SEL2, sc->sc_txchainmask) |
1596 1.1 christos SM(AR_TXC7_CHAIN_SEL3, sc->sc_txchainmask);
1597 1.1 christos #ifdef notyet
1598 1.1 christos #ifndef IEEE80211_NO_HT
1599 1.1 christos /* Use the same short GI setting for all tries. */
1600 1.1 christos if (ic->ic_flags & IEEE80211_F_SHGI)
1601 1.1 christos ds->ds_ctl7 |= AR_TXC7_GI0123;
1602 1.1 christos /* Use the same channel width for all tries. */
1603 1.1 christos if (ic->ic_flags & IEEE80211_F_CBW40)
1604 1.1 christos ds->ds_ctl7 |= AR_TXC7_2040_0123;
1605 1.1 christos #endif
1606 1.1 christos #endif
1607 1.1 christos
1608 1.1 christos if (ds->ds_ctl0 & (AR_TXC0_RTS_ENABLE | AR_TXC0_CTS_ENABLE)) {
1609 1.1 christos uint8_t protridx, hwrate;
1610 1.1 christos uint16_t dur = 0;
1611 1.1 christos
1612 1.1 christos /* Use the same protection mode for all tries. */
1613 1.1 christos if (ds->ds_ctl0 & AR_TXC0_RTS_ENABLE) {
1614 1.1 christos ds->ds_ctl4 |= AR_TXC4_RTSCTS_QUAL01;
1615 1.1 christos ds->ds_ctl5 |= AR_TXC5_RTSCTS_QUAL23;
1616 1.1 christos }
1617 1.1 christos /* Select protection rate (suboptimal but ok). */
1618 1.1 christos protridx = (ic->ic_curmode == IEEE80211_MODE_11A) ?
1619 1.1 christos ATHN_RIDX_OFDM6 : ATHN_RIDX_CCK2;
1620 1.1 christos if (ds->ds_ctl0 & AR_TXC0_RTS_ENABLE) {
1621 1.1 christos /* Account for CTS duration. */
1622 1.1 christos dur += athn_txtime(sc, IEEE80211_ACK_LEN,
1623 1.1 christos athn_rates[protridx].rspridx, ic->ic_flags);
1624 1.1 christos }
1625 1.1 christos dur += athn_txtime(sc, totlen, ridx[0], ic->ic_flags);
1626 1.1 christos if (!(ds->ds_ctl1 & AR_TXC1_NO_ACK)) {
1627 1.1 christos /* Account for ACK duration. */
1628 1.1 christos dur += athn_txtime(sc, IEEE80211_ACK_LEN,
1629 1.1 christos athn_rates[ridx[0]].rspridx, ic->ic_flags);
1630 1.1 christos }
1631 1.1 christos /* Write protection frame duration and rate. */
1632 1.1 christos ds->ds_ctl2 |= SM(AR_TXC2_BURST_DUR, dur);
1633 1.1 christos hwrate = athn_rates[protridx].hwrate;
1634 1.1 christos if (protridx == ATHN_RIDX_CCK2 &&
1635 1.1 christos (ic->ic_flags & IEEE80211_F_SHPREAMBLE))
1636 1.1 christos hwrate |= 0x04;
1637 1.1 christos ds->ds_ctl7 |= SM(AR_TXC7_RTSCTS_RATE, hwrate);
1638 1.1 christos }
1639 1.1 christos
1640 1.1 christos /* Finalize first Tx descriptor and fill others (if any). */
1641 1.1 christos ds->ds_ctl0 |= SM(AR_TXC0_FRAME_LEN, totlen);
1642 1.1 christos
1643 1.1 christos lastds = NULL; /* XXX: gcc */
1644 1.1 christos for (i = 0; i < bf->bf_map->dm_nsegs; i++, ds++) {
1645 1.1 christos ds->ds_data = bf->bf_map->dm_segs[i].ds_addr;
1646 1.1 christos ds->ds_ctl1 |= SM(AR_TXC1_BUF_LEN,
1647 1.1 christos bf->bf_map->dm_segs[i].ds_len);
1648 1.1 christos
1649 1.1 christos if (i != bf->bf_map->dm_nsegs - 1)
1650 1.1 christos ds->ds_ctl1 |= AR_TXC1_MORE;
1651 1.1 christos ds->ds_link = 0;
1652 1.1 christos
1653 1.1 christos /* Chain Tx descriptor. */
1654 1.1 christos if (i != 0)
1655 1.1 christos lastds->ds_link = bf->bf_daddr + i * sizeof(*ds);
1656 1.1 christos lastds = ds;
1657 1.1 christos }
1658 1.1 christos bus_dmamap_sync(sc->sc_dmat, bf->bf_map, 0, bf->bf_map->dm_mapsize,
1659 1.1 christos BUS_DMASYNC_PREWRITE);
1660 1.1 christos
1661 1.1 christos if (!SIMPLEQ_EMPTY(&txq->head))
1662 1.1 christos ((struct ar_tx_desc *)txq->lastds)->ds_link = bf->bf_daddr;
1663 1.1 christos else
1664 1.1 christos AR_WRITE(sc, AR_QTXDP(qid), bf->bf_daddr);
1665 1.1 christos txq->lastds = lastds;
1666 1.1 christos SIMPLEQ_REMOVE_HEAD(&sc->sc_txbufs, bf_list);
1667 1.1 christos SIMPLEQ_INSERT_TAIL(&txq->head, bf, bf_list);
1668 1.1 christos
1669 1.1 christos ds = bf->bf_descs;
1670 1.1 christos DPRINTFN(DBG_TX, sc,
1671 1.1 christos "Tx qid=%d nsegs=%d ctl0=0x%x ctl1=0x%x ctl3=0x%x\n",
1672 1.1 christos qid, bf->bf_map->dm_nsegs, ds->ds_ctl0, ds->ds_ctl1, ds->ds_ctl3);
1673 1.1 christos
1674 1.1 christos /* Kick Tx. */
1675 1.1 christos AR_WRITE(sc, AR_Q_TXE, 1 << qid);
1676 1.1 christos AR_WRITE_BARRIER(sc);
1677 1.1 christos return 0;
1678 1.1 christos }
1679 1.1 christos
1680 1.1 christos Static void
1681 1.1 christos ar5008_set_rf_mode(struct athn_softc *sc, struct ieee80211_channel *c)
1682 1.1 christos {
1683 1.1 christos uint32_t reg;
1684 1.1 christos
1685 1.1 christos reg = IEEE80211_IS_CHAN_2GHZ(c) ?
1686 1.1 christos AR_PHY_MODE_DYNAMIC : AR_PHY_MODE_OFDM;
1687 1.1 christos if (!AR_SREV_9280_10_OR_LATER(sc)) {
1688 1.1 christos reg |= IEEE80211_IS_CHAN_2GHZ(c) ?
1689 1.1 christos AR_PHY_MODE_RF2GHZ : AR_PHY_MODE_RF5GHZ;
1690 1.1 christos }
1691 1.1 christos else if (IEEE80211_IS_CHAN_5GHZ(c) &&
1692 1.1 christos (sc->sc_flags & ATHN_FLAG_FAST_PLL_CLOCK)) {
1693 1.1 christos reg |= AR_PHY_MODE_DYNAMIC | AR_PHY_MODE_DYN_CCK_DISABLE;
1694 1.1 christos }
1695 1.1 christos AR_WRITE(sc, AR_PHY_MODE, reg);
1696 1.1 christos AR_WRITE_BARRIER(sc);
1697 1.1 christos }
1698 1.1 christos
1699 1.1 christos static __inline uint32_t
1700 1.1 christos ar5008_synth_delay(struct athn_softc *sc)
1701 1.1 christos {
1702 1.5 skrll uint32_t synth_delay;
1703 1.1 christos
1704 1.5 skrll synth_delay = MS(AR_READ(sc, AR_PHY_RX_DELAY), AR_PHY_RX_DELAY_DELAY);
1705 1.1 christos if (sc->sc_ic.ic_curmode == IEEE80211_MODE_11B)
1706 1.5 skrll synth_delay = (synth_delay * 4) / 22;
1707 1.1 christos else
1708 1.5 skrll synth_delay = synth_delay / 10; /* in 100ns steps */
1709 1.5 skrll return synth_delay;
1710 1.1 christos }
1711 1.1 christos
1712 1.1 christos Static int
1713 1.1 christos ar5008_rf_bus_request(struct athn_softc *sc)
1714 1.1 christos {
1715 1.1 christos int ntries;
1716 1.1 christos
1717 1.1 christos /* Request RF Bus grant. */
1718 1.1 christos AR_WRITE(sc, AR_PHY_RFBUS_REQ, AR_PHY_RFBUS_REQ_EN);
1719 1.1 christos for (ntries = 0; ntries < 10000; ntries++) {
1720 1.1 christos if (AR_READ(sc, AR_PHY_RFBUS_GRANT) & AR_PHY_RFBUS_GRANT_EN)
1721 1.1 christos return 0;
1722 1.1 christos DELAY(10);
1723 1.1 christos }
1724 1.1 christos DPRINTFN(DBG_RF, sc, "could not kill baseband Rx");
1725 1.1 christos return ETIMEDOUT;
1726 1.1 christos }
1727 1.1 christos
1728 1.1 christos Static void
1729 1.1 christos ar5008_rf_bus_release(struct athn_softc *sc)
1730 1.1 christos {
1731 1.1 christos
1732 1.1 christos /* Wait for the synthesizer to settle. */
1733 1.1 christos DELAY(AR_BASE_PHY_ACTIVE_DELAY + ar5008_synth_delay(sc));
1734 1.1 christos
1735 1.1 christos /* Release the RF Bus grant. */
1736 1.1 christos AR_WRITE(sc, AR_PHY_RFBUS_REQ, 0);
1737 1.1 christos AR_WRITE_BARRIER(sc);
1738 1.1 christos }
1739 1.1 christos
1740 1.1 christos Static void
1741 1.1 christos ar5008_set_phy(struct athn_softc *sc, struct ieee80211_channel *c,
1742 1.1 christos struct ieee80211_channel *extc)
1743 1.1 christos {
1744 1.1 christos uint32_t phy;
1745 1.1 christos
1746 1.1 christos if (AR_SREV_9285_10_OR_LATER(sc))
1747 1.1 christos phy = AR_READ(sc, AR_PHY_TURBO) & AR_PHY_FC_ENABLE_DAC_FIFO;
1748 1.1 christos else
1749 1.1 christos phy = 0;
1750 1.1 christos phy |= AR_PHY_FC_HT_EN | AR_PHY_FC_SHORT_GI_40 |
1751 1.1 christos AR_PHY_FC_SINGLE_HT_LTF1 | AR_PHY_FC_WALSH;
1752 1.1 christos #ifndef IEEE80211_NO_HT
1753 1.1 christos if (extc != NULL) {
1754 1.1 christos phy |= AR_PHY_FC_DYN2040_EN;
1755 1.1 christos if (extc > c) /* XXX */
1756 1.1 christos phy |= AR_PHY_FC_DYN2040_PRI_CH;
1757 1.1 christos }
1758 1.1 christos #endif
1759 1.1 christos AR_WRITE(sc, AR_PHY_TURBO, phy);
1760 1.1 christos
1761 1.1 christos AR_WRITE(sc, AR_2040_MODE,
1762 1.1 christos (extc != NULL) ? AR_2040_JOINED_RX_CLEAR : 0);
1763 1.1 christos
1764 1.1 christos /* Set global transmit timeout. */
1765 1.1 christos AR_WRITE(sc, AR_GTXTO, SM(AR_GTXTO_TIMEOUT_LIMIT, 25));
1766 1.1 christos /* Set carrier sense timeout. */
1767 1.1 christos AR_WRITE(sc, AR_CST, SM(AR_CST_TIMEOUT_LIMIT, 15));
1768 1.1 christos AR_WRITE_BARRIER(sc);
1769 1.1 christos }
1770 1.1 christos
1771 1.1 christos Static void
1772 1.1 christos ar5008_set_delta_slope(struct athn_softc *sc, struct ieee80211_channel *c,
1773 1.1 christos struct ieee80211_channel *extc)
1774 1.1 christos {
1775 1.1 christos uint32_t coeff, exp, man, reg;
1776 1.1 christos
1777 1.1 christos /* Set Delta Slope (exponent and mantissa). */
1778 1.1 christos coeff = (100 << 24) / c->ic_freq;
1779 1.1 christos athn_get_delta_slope(coeff, &exp, &man);
1780 1.1 christos DPRINTFN(DBG_RX, sc, "delta slope coeff exp=%u man=%u\n", exp, man);
1781 1.1 christos
1782 1.1 christos reg = AR_READ(sc, AR_PHY_TIMING3);
1783 1.1 christos reg = RW(reg, AR_PHY_TIMING3_DSC_EXP, exp);
1784 1.1 christos reg = RW(reg, AR_PHY_TIMING3_DSC_MAN, man);
1785 1.1 christos AR_WRITE(sc, AR_PHY_TIMING3, reg);
1786 1.1 christos
1787 1.1 christos /* For Short GI, coeff is 9/10 that of normal coeff. */
1788 1.1 christos coeff = (9 * coeff) / 10;
1789 1.1 christos athn_get_delta_slope(coeff, &exp, &man);
1790 1.1 christos DPRINTFN(DBG_RX, sc, "delta slope coeff exp=%u man=%u\n", exp, man);
1791 1.1 christos
1792 1.1 christos reg = AR_READ(sc, AR_PHY_HALFGI);
1793 1.1 christos reg = RW(reg, AR_PHY_HALFGI_DSC_EXP, exp);
1794 1.1 christos reg = RW(reg, AR_PHY_HALFGI_DSC_MAN, man);
1795 1.1 christos AR_WRITE(sc, AR_PHY_HALFGI, reg);
1796 1.1 christos AR_WRITE_BARRIER(sc);
1797 1.1 christos }
1798 1.1 christos
1799 1.1 christos Static void
1800 1.1 christos ar5008_enable_antenna_diversity(struct athn_softc *sc)
1801 1.1 christos {
1802 1.1 christos
1803 1.1 christos AR_SETBITS(sc, AR_PHY_CCK_DETECT,
1804 1.1 christos AR_PHY_CCK_DETECT_BB_ENABLE_ANT_FAST_DIV);
1805 1.1 christos AR_WRITE_BARRIER(sc);
1806 1.1 christos }
1807 1.1 christos
1808 1.1 christos Static void
1809 1.1 christos ar5008_init_baseband(struct athn_softc *sc)
1810 1.1 christos {
1811 1.1 christos uint32_t synth_delay;
1812 1.1 christos
1813 1.1 christos synth_delay = ar5008_synth_delay(sc);
1814 1.1 christos /* Activate the PHY (includes baseband activate and synthesizer on). */
1815 1.1 christos AR_WRITE(sc, AR_PHY_ACTIVE, AR_PHY_ACTIVE_EN);
1816 1.1 christos AR_WRITE_BARRIER(sc);
1817 1.1 christos DELAY(AR_BASE_PHY_ACTIVE_DELAY + synth_delay);
1818 1.1 christos }
1819 1.1 christos
1820 1.1 christos Static void
1821 1.1 christos ar5008_disable_phy(struct athn_softc *sc)
1822 1.1 christos {
1823 1.1 christos
1824 1.1 christos AR_WRITE(sc, AR_PHY_ACTIVE, AR_PHY_ACTIVE_DIS);
1825 1.1 christos AR_WRITE_BARRIER(sc);
1826 1.1 christos }
1827 1.1 christos
1828 1.1 christos Static void
1829 1.1 christos ar5008_init_chains(struct athn_softc *sc)
1830 1.1 christos {
1831 1.1 christos
1832 1.1 christos if (sc->sc_rxchainmask == 0x5 || sc->sc_txchainmask == 0x5)
1833 1.1 christos AR_SETBITS(sc, AR_PHY_ANALOG_SWAP, AR_PHY_SWAP_ALT_CHAIN);
1834 1.1 christos
1835 1.1 christos /* Setup chain masks. */
1836 1.1 christos if (sc->sc_mac_ver <= AR_SREV_VERSION_9160 &&
1837 1.1 christos (sc->sc_rxchainmask == 0x3 || sc->sc_rxchainmask == 0x5)) {
1838 1.1 christos AR_WRITE(sc, AR_PHY_RX_CHAINMASK, 0x7);
1839 1.1 christos AR_WRITE(sc, AR_PHY_CAL_CHAINMASK, 0x7);
1840 1.1 christos }
1841 1.1 christos else {
1842 1.1 christos AR_WRITE(sc, AR_PHY_RX_CHAINMASK, sc->sc_rxchainmask);
1843 1.1 christos AR_WRITE(sc, AR_PHY_CAL_CHAINMASK, sc->sc_rxchainmask);
1844 1.1 christos }
1845 1.1 christos AR_WRITE(sc, AR_SELFGEN_MASK, sc->sc_txchainmask);
1846 1.1 christos AR_WRITE_BARRIER(sc);
1847 1.1 christos }
1848 1.1 christos
1849 1.1 christos Static void
1850 1.1 christos ar5008_set_rxchains(struct athn_softc *sc)
1851 1.1 christos {
1852 1.1 christos
1853 1.1 christos if (sc->sc_rxchainmask == 0x3 || sc->sc_rxchainmask == 0x5) {
1854 1.1 christos AR_WRITE(sc, AR_PHY_RX_CHAINMASK, sc->sc_rxchainmask);
1855 1.1 christos AR_WRITE(sc, AR_PHY_CAL_CHAINMASK, sc->sc_rxchainmask);
1856 1.1 christos AR_WRITE_BARRIER(sc);
1857 1.1 christos }
1858 1.1 christos }
1859 1.1 christos
1860 1.1 christos #ifdef notused
1861 1.1 christos Static void
1862 1.1 christos ar5008_read_noisefloor(struct athn_softc *sc, int16_t *nf, int16_t *nf_ext)
1863 1.1 christos {
1864 1.1 christos /* Sign-extends 9-bit value (assumes upper bits are zeroes). */
1865 1.1 christos #define SIGN_EXT(v) (((v) ^ 0x100) - 0x100)
1866 1.1 christos uint32_t reg;
1867 1.1 christos int i;
1868 1.1 christos
1869 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
1870 1.1 christos reg = AR_READ(sc, AR_PHY_CCA(i));
1871 1.1 christos if (AR_SREV_9280_10_OR_LATER(sc))
1872 1.1 christos nf[i] = MS(reg, AR9280_PHY_MINCCA_PWR);
1873 1.1 christos else
1874 1.1 christos nf[i] = MS(reg, AR_PHY_MINCCA_PWR);
1875 1.1 christos nf[i] = SIGN_EXT(nf[i]);
1876 1.1 christos
1877 1.1 christos reg = AR_READ(sc, AR_PHY_EXT_CCA(i));
1878 1.1 christos if (AR_SREV_9280_10_OR_LATER(sc))
1879 1.1 christos nf_ext[i] = MS(reg, AR9280_PHY_EXT_MINCCA_PWR);
1880 1.1 christos else
1881 1.1 christos nf_ext[i] = MS(reg, AR_PHY_EXT_MINCCA_PWR);
1882 1.1 christos nf_ext[i] = SIGN_EXT(nf_ext[i]);
1883 1.1 christos }
1884 1.1 christos #undef SIGN_EXT
1885 1.1 christos }
1886 1.1 christos #endif /* notused */
1887 1.1 christos
1888 1.1 christos #ifdef notused
1889 1.1 christos Static void
1890 1.1 christos ar5008_write_noisefloor(struct athn_softc *sc, int16_t *nf, int16_t *nf_ext)
1891 1.1 christos {
1892 1.1 christos uint32_t reg;
1893 1.1 christos int i;
1894 1.1 christos
1895 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
1896 1.1 christos reg = AR_READ(sc, AR_PHY_CCA(i));
1897 1.1 christos reg = RW(reg, AR_PHY_MAXCCA_PWR, nf[i]);
1898 1.1 christos AR_WRITE(sc, AR_PHY_CCA(i), reg);
1899 1.1 christos
1900 1.1 christos reg = AR_READ(sc, AR_PHY_EXT_CCA(i));
1901 1.1 christos reg = RW(reg, AR_PHY_EXT_MAXCCA_PWR, nf_ext[i]);
1902 1.1 christos AR_WRITE(sc, AR_PHY_EXT_CCA(i), reg);
1903 1.1 christos }
1904 1.1 christos AR_WRITE_BARRIER(sc);
1905 1.1 christos }
1906 1.1 christos #endif /* notused */
1907 1.1 christos
1908 1.1 christos #ifdef notused
1909 1.1 christos Static void
1910 1.1 christos ar5008_get_noisefloor(struct athn_softc *sc, struct ieee80211_channel *c)
1911 1.1 christos {
1912 1.1 christos int16_t nf[AR_MAX_CHAINS], nf_ext[AR_MAX_CHAINS];
1913 1.1 christos int i;
1914 1.1 christos
1915 1.1 christos if (AR_READ(sc, AR_PHY_AGC_CONTROL) & AR_PHY_AGC_CONTROL_NF) {
1916 1.1 christos /* Noisefloor calibration not finished. */
1917 1.1 christos return;
1918 1.1 christos }
1919 1.1 christos /* Noisefloor calibration is finished. */
1920 1.1 christos ar5008_read_noisefloor(sc, nf, nf_ext);
1921 1.1 christos
1922 1.1 christos /* Update noisefloor history. */
1923 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
1924 1.1 christos sc->sc_nf_hist[sc->sc_nf_hist_cur].nf[i] = nf[i];
1925 1.1 christos sc->sc_nf_hist[sc->sc_nf_hist_cur].nf_ext[i] = nf_ext[i];
1926 1.1 christos }
1927 1.1 christos if (++sc->sc_nf_hist_cur >= ATHN_NF_CAL_HIST_MAX)
1928 1.1 christos sc->sc_nf_hist_cur = 0;
1929 1.1 christos }
1930 1.1 christos #endif /* notused */
1931 1.1 christos
1932 1.1 christos #ifdef notused
1933 1.1 christos Static void
1934 1.1 christos ar5008_bb_load_noisefloor(struct athn_softc *sc)
1935 1.1 christos {
1936 1.1 christos int16_t nf[AR_MAX_CHAINS], nf_ext[AR_MAX_CHAINS];
1937 1.1 christos int i, ntries;
1938 1.1 christos
1939 1.1 christos /* Write filtered noisefloor values. */
1940 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
1941 1.1 christos nf[i] = sc->sc_nf_priv[i] * 2;
1942 1.1 christos nf_ext[i] = sc->sc_nf_ext_priv[i] * 2;
1943 1.1 christos }
1944 1.1 christos ar5008_write_noisefloor(sc, nf, nf_ext);
1945 1.1 christos
1946 1.1 christos /* Load filtered noisefloor values into baseband. */
1947 1.1 christos AR_CLRBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF);
1948 1.1 christos AR_CLRBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF);
1949 1.1 christos AR_SETBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF);
1950 1.1 christos /* Wait for load to complete. */
1951 1.1 christos for (ntries = 0; ntries < 1000; ntries++) {
1952 1.1 christos if (!(AR_READ(sc, AR_PHY_AGC_CONTROL) & AR_PHY_AGC_CONTROL_NF))
1953 1.1 christos break;
1954 1.1 christos DELAY(50);
1955 1.1 christos }
1956 1.1 christos if (ntries == 1000) {
1957 1.1 christos DPRINTFN(DBG_RF, sc, "failed to load noisefloor values\n");
1958 1.1 christos return;
1959 1.1 christos }
1960 1.1 christos
1961 1.1 christos /* Restore noisefloor values to initial (max) values. */
1962 1.1 christos for (i = 0; i < AR_MAX_CHAINS; i++)
1963 1.1 christos nf[i] = nf_ext[i] = -50 * 2;
1964 1.1 christos ar5008_write_noisefloor(sc, nf, nf_ext);
1965 1.1 christos }
1966 1.1 christos #endif /* notused */
1967 1.1 christos
1968 1.1 christos #ifdef notused
1969 1.1 christos Static void
1970 1.1 christos ar5008_noisefloor_calib(struct athn_softc *sc)
1971 1.1 christos {
1972 1.1 christos
1973 1.1 christos AR_SETBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_ENABLE_NF);
1974 1.1 christos AR_SETBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NO_UPDATE_NF);
1975 1.1 christos AR_SETBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF);
1976 1.1 christos AR_WRITE_BARRIER(sc);
1977 1.1 christos }
1978 1.1 christos #endif /* notused */
1979 1.1 christos
1980 1.1 christos Static void
1981 1.1 christos ar5008_do_noisefloor_calib(struct athn_softc *sc)
1982 1.1 christos {
1983 1.1 christos
1984 1.1 christos AR_SETBITS(sc, AR_PHY_AGC_CONTROL, AR_PHY_AGC_CONTROL_NF);
1985 1.1 christos AR_WRITE_BARRIER(sc);
1986 1.1 christos }
1987 1.1 christos
1988 1.1 christos Static void
1989 1.1 christos ar5008_do_calib(struct athn_softc *sc)
1990 1.1 christos {
1991 1.1 christos uint32_t mode, reg;
1992 1.1 christos int log;
1993 1.1 christos
1994 1.1 christos reg = AR_READ(sc, AR_PHY_TIMING_CTRL4_0);
1995 1.1 christos log = AR_SREV_9280_10_OR_LATER(sc) ? 10 : 2;
1996 1.1 christos reg = RW(reg, AR_PHY_TIMING_CTRL4_IQCAL_LOG_COUNT_MAX, log);
1997 1.1 christos AR_WRITE(sc, AR_PHY_TIMING_CTRL4_0, reg);
1998 1.1 christos
1999 1.1 christos if (sc->sc_cur_calib_mask & ATHN_CAL_ADC_GAIN)
2000 1.1 christos mode = AR_PHY_CALMODE_ADC_GAIN;
2001 1.1 christos else if (sc->sc_cur_calib_mask & ATHN_CAL_ADC_DC)
2002 1.1 christos mode = AR_PHY_CALMODE_ADC_DC_PER;
2003 1.1 christos else /* ATHN_CAL_IQ */
2004 1.1 christos mode = AR_PHY_CALMODE_IQ;
2005 1.1 christos AR_WRITE(sc, AR_PHY_CALMODE, mode);
2006 1.1 christos
2007 1.1 christos DPRINTFN(DBG_RF, sc, "starting calibration mode=0x%x\n", mode);
2008 1.1 christos AR_SETBITS(sc, AR_PHY_TIMING_CTRL4_0, AR_PHY_TIMING_CTRL4_DO_CAL);
2009 1.1 christos AR_WRITE_BARRIER(sc);
2010 1.1 christos }
2011 1.1 christos
2012 1.1 christos Static void
2013 1.1 christos ar5008_next_calib(struct athn_softc *sc)
2014 1.1 christos {
2015 1.1 christos
2016 1.1 christos /* Check if we have any calibration in progress. */
2017 1.1 christos if (sc->sc_cur_calib_mask != 0) {
2018 1.1 christos if (!(AR_READ(sc, AR_PHY_TIMING_CTRL4_0) &
2019 1.1 christos AR_PHY_TIMING_CTRL4_DO_CAL)) {
2020 1.1 christos /* Calibration completed for current sample. */
2021 1.1 christos if (sc->sc_cur_calib_mask & ATHN_CAL_ADC_GAIN)
2022 1.1 christos ar5008_calib_adc_gain(sc);
2023 1.1 christos else if (sc->sc_cur_calib_mask & ATHN_CAL_ADC_DC)
2024 1.1 christos ar5008_calib_adc_dc_off(sc);
2025 1.1 christos else /* ATHN_CAL_IQ */
2026 1.1 christos ar5008_calib_iq(sc);
2027 1.1 christos }
2028 1.1 christos }
2029 1.1 christos }
2030 1.1 christos
2031 1.1 christos Static void
2032 1.1 christos ar5008_calib_iq(struct athn_softc *sc)
2033 1.1 christos {
2034 1.1 christos struct athn_iq_cal *cal;
2035 1.1 christos uint32_t reg, i_coff_denom, q_coff_denom;
2036 1.1 christos int32_t i_coff, q_coff;
2037 1.1 christos int i, iq_corr_neg;
2038 1.1 christos
2039 1.1 christos for (i = 0; i < AR_MAX_CHAINS; i++) {
2040 1.1 christos cal = &sc->sc_calib.iq[i];
2041 1.1 christos
2042 1.1 christos /* Accumulate IQ calibration measures (clear on read). */
2043 1.1 christos cal->pwr_meas_i += AR_READ(sc, AR_PHY_CAL_MEAS_0(i));
2044 1.1 christos cal->pwr_meas_q += AR_READ(sc, AR_PHY_CAL_MEAS_1(i));
2045 1.1 christos cal->iq_corr_meas +=
2046 1.1 christos (int32_t)AR_READ(sc, AR_PHY_CAL_MEAS_2(i));
2047 1.1 christos }
2048 1.1 christos if (!AR_SREV_9280_10_OR_LATER(sc) &&
2049 1.1 christos ++sc->sc_calib.nsamples < AR_CAL_SAMPLES) {
2050 1.1 christos /* Not enough samples accumulated, continue. */
2051 1.1 christos ar5008_do_calib(sc);
2052 1.1 christos return;
2053 1.1 christos }
2054 1.1 christos
2055 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
2056 1.1 christos cal = &sc->sc_calib.iq[i];
2057 1.1 christos
2058 1.1 christos if (cal->pwr_meas_q == 0)
2059 1.1 christos continue;
2060 1.1 christos
2061 1.10 christos if ((iq_corr_neg = cal->iq_corr_meas) < 0)
2062 1.1 christos cal->iq_corr_meas = -cal->iq_corr_meas;
2063 1.1 christos
2064 1.1 christos i_coff_denom =
2065 1.1 christos (cal->pwr_meas_i / 2 + cal->pwr_meas_q / 2) / 128;
2066 1.1 christos q_coff_denom = cal->pwr_meas_q / 64;
2067 1.1 christos
2068 1.1 christos if (i_coff_denom == 0 || q_coff_denom == 0)
2069 1.1 christos continue; /* Prevents division by zero. */
2070 1.1 christos
2071 1.1 christos i_coff = cal->iq_corr_meas / i_coff_denom;
2072 1.1 christos q_coff = (cal->pwr_meas_i / q_coff_denom) - 64;
2073 1.1 christos
2074 1.1 christos /* Negate i_coff if iq_corr_meas is positive. */
2075 1.1 christos if (!iq_corr_neg)
2076 1.1 christos i_coff = 0x40 - (i_coff & 0x3f);
2077 1.1 christos if (q_coff > 15)
2078 1.1 christos q_coff = 15;
2079 1.1 christos else if (q_coff <= -16)
2080 1.1 christos q_coff = -16; /* XXX Linux has a bug here? */
2081 1.1 christos
2082 1.1 christos DPRINTFN(DBG_RF, sc, "IQ calibration for chain %d\n", i);
2083 1.1 christos reg = AR_READ(sc, AR_PHY_TIMING_CTRL4(i));
2084 1.1 christos reg = RW(reg, AR_PHY_TIMING_CTRL4_IQCORR_Q_I_COFF, i_coff);
2085 1.1 christos reg = RW(reg, AR_PHY_TIMING_CTRL4_IQCORR_Q_Q_COFF, q_coff);
2086 1.1 christos AR_WRITE(sc, AR_PHY_TIMING_CTRL4(i), reg);
2087 1.1 christos }
2088 1.1 christos
2089 1.1 christos /* Apply new settings. */
2090 1.1 christos AR_SETBITS(sc, AR_PHY_TIMING_CTRL4_0,
2091 1.1 christos AR_PHY_TIMING_CTRL4_IQCORR_ENABLE);
2092 1.1 christos AR_WRITE_BARRIER(sc);
2093 1.1 christos
2094 1.1 christos /* IQ calibration done. */
2095 1.1 christos sc->sc_cur_calib_mask &= ~ATHN_CAL_IQ;
2096 1.1 christos memset(&sc->sc_calib, 0, sizeof(sc->sc_calib));
2097 1.1 christos }
2098 1.1 christos
2099 1.1 christos Static void
2100 1.1 christos ar5008_calib_adc_gain(struct athn_softc *sc)
2101 1.1 christos {
2102 1.1 christos struct athn_adc_cal *cal;
2103 1.1 christos uint32_t reg, gain_mismatch_i, gain_mismatch_q;
2104 1.1 christos int i;
2105 1.1 christos
2106 1.1 christos for (i = 0; i < AR_MAX_CHAINS; i++) {
2107 1.1 christos cal = &sc->sc_calib.adc_gain[i];
2108 1.1 christos
2109 1.1 christos /* Accumulate ADC gain measures (clear on read). */
2110 1.1 christos cal->pwr_meas_odd_i += AR_READ(sc, AR_PHY_CAL_MEAS_0(i));
2111 1.1 christos cal->pwr_meas_even_i += AR_READ(sc, AR_PHY_CAL_MEAS_1(i));
2112 1.1 christos cal->pwr_meas_odd_q += AR_READ(sc, AR_PHY_CAL_MEAS_2(i));
2113 1.1 christos cal->pwr_meas_even_q += AR_READ(sc, AR_PHY_CAL_MEAS_3(i));
2114 1.1 christos }
2115 1.1 christos if (!AR_SREV_9280_10_OR_LATER(sc) &&
2116 1.1 christos ++sc->sc_calib.nsamples < AR_CAL_SAMPLES) {
2117 1.1 christos /* Not enough samples accumulated, continue. */
2118 1.1 christos ar5008_do_calib(sc);
2119 1.1 christos return;
2120 1.1 christos }
2121 1.1 christos
2122 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
2123 1.1 christos cal = &sc->sc_calib.adc_gain[i];
2124 1.1 christos
2125 1.1 christos if (cal->pwr_meas_odd_i == 0 || cal->pwr_meas_even_q == 0)
2126 1.1 christos continue; /* Prevents division by zero. */
2127 1.1 christos
2128 1.1 christos gain_mismatch_i =
2129 1.1 christos (cal->pwr_meas_even_i * 32) / cal->pwr_meas_odd_i;
2130 1.1 christos gain_mismatch_q =
2131 1.1 christos (cal->pwr_meas_odd_q * 32) / cal->pwr_meas_even_q;
2132 1.1 christos
2133 1.1 christos DPRINTFN(DBG_RF, sc, "ADC gain calibration for chain %d\n", i);
2134 1.1 christos reg = AR_READ(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(i));
2135 1.1 christos reg = RW(reg, AR_PHY_NEW_ADC_DC_GAIN_IGAIN, gain_mismatch_i);
2136 1.1 christos reg = RW(reg, AR_PHY_NEW_ADC_DC_GAIN_QGAIN, gain_mismatch_q);
2137 1.1 christos AR_WRITE(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(i), reg);
2138 1.1 christos }
2139 1.1 christos
2140 1.1 christos /* Apply new settings. */
2141 1.1 christos AR_SETBITS(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(0),
2142 1.1 christos AR_PHY_NEW_ADC_GAIN_CORR_ENABLE);
2143 1.1 christos AR_WRITE_BARRIER(sc);
2144 1.1 christos
2145 1.1 christos /* ADC gain calibration done. */
2146 1.1 christos sc->sc_cur_calib_mask &= ~ATHN_CAL_ADC_GAIN;
2147 1.1 christos memset(&sc->sc_calib, 0, sizeof(sc->sc_calib));
2148 1.1 christos }
2149 1.1 christos
2150 1.1 christos Static void
2151 1.1 christos ar5008_calib_adc_dc_off(struct athn_softc *sc)
2152 1.1 christos {
2153 1.1 christos struct athn_adc_cal *cal;
2154 1.1 christos int32_t dc_offset_mismatch_i, dc_offset_mismatch_q;
2155 1.1 christos uint32_t reg;
2156 1.1 christos int count, i;
2157 1.1 christos
2158 1.1 christos for (i = 0; i < AR_MAX_CHAINS; i++) {
2159 1.1 christos cal = &sc->sc_calib.adc_dc_offset[i];
2160 1.1 christos
2161 1.1 christos /* Accumulate ADC DC offset measures (clear on read). */
2162 1.1 christos cal->pwr_meas_odd_i += AR_READ(sc, AR_PHY_CAL_MEAS_0(i));
2163 1.1 christos cal->pwr_meas_even_i += AR_READ(sc, AR_PHY_CAL_MEAS_1(i));
2164 1.1 christos cal->pwr_meas_odd_q += AR_READ(sc, AR_PHY_CAL_MEAS_2(i));
2165 1.1 christos cal->pwr_meas_even_q += AR_READ(sc, AR_PHY_CAL_MEAS_3(i));
2166 1.1 christos }
2167 1.1 christos if (!AR_SREV_9280_10_OR_LATER(sc) &&
2168 1.1 christos ++sc->sc_calib.nsamples < AR_CAL_SAMPLES) {
2169 1.1 christos /* Not enough samples accumulated, continue. */
2170 1.1 christos ar5008_do_calib(sc);
2171 1.1 christos return;
2172 1.1 christos }
2173 1.1 christos
2174 1.1 christos if (AR_SREV_9280_10_OR_LATER(sc))
2175 1.1 christos count = (1 << (10 + 5));
2176 1.1 christos else
2177 1.1 christos count = (1 << ( 2 + 5)) * AR_CAL_SAMPLES;
2178 1.1 christos for (i = 0; i < sc->sc_nrxchains; i++) {
2179 1.1 christos cal = &sc->sc_calib.adc_dc_offset[i];
2180 1.1 christos
2181 1.1 christos dc_offset_mismatch_i =
2182 1.1 christos (cal->pwr_meas_even_i - cal->pwr_meas_odd_i * 2) / count;
2183 1.1 christos dc_offset_mismatch_q =
2184 1.1 christos (cal->pwr_meas_odd_q - cal->pwr_meas_even_q * 2) / count;
2185 1.1 christos
2186 1.1 christos DPRINTFN(DBG_RF, sc, "ADC DC offset calibration for chain %d\n", i);
2187 1.1 christos reg = AR_READ(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(i));
2188 1.1 christos reg = RW(reg, AR_PHY_NEW_ADC_DC_GAIN_QDC,
2189 1.1 christos dc_offset_mismatch_q);
2190 1.1 christos reg = RW(reg, AR_PHY_NEW_ADC_DC_GAIN_IDC,
2191 1.1 christos dc_offset_mismatch_i);
2192 1.1 christos AR_WRITE(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(i), reg);
2193 1.1 christos }
2194 1.1 christos
2195 1.1 christos /* Apply new settings. */
2196 1.1 christos AR_SETBITS(sc, AR_PHY_NEW_ADC_DC_GAIN_CORR(0),
2197 1.1 christos AR_PHY_NEW_ADC_DC_OFFSET_CORR_ENABLE);
2198 1.1 christos AR_WRITE_BARRIER(sc);
2199 1.1 christos
2200 1.1 christos /* ADC DC offset calibration done. */
2201 1.1 christos sc->sc_cur_calib_mask &= ~ATHN_CAL_ADC_DC;
2202 1.1 christos memset(&sc->sc_calib, 0, sizeof(sc->sc_calib));
2203 1.1 christos }
2204 1.1 christos
2205 1.1 christos PUBLIC void
2206 1.1 christos ar5008_write_txpower(struct athn_softc *sc, int16_t power[ATHN_POWER_COUNT])
2207 1.1 christos {
2208 1.1 christos
2209 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE1,
2210 1.1 christos (power[ATHN_POWER_OFDM18 ] & 0x3f) << 24 |
2211 1.1 christos (power[ATHN_POWER_OFDM12 ] & 0x3f) << 16 |
2212 1.1 christos (power[ATHN_POWER_OFDM9 ] & 0x3f) << 8 |
2213 1.1 christos (power[ATHN_POWER_OFDM6 ] & 0x3f));
2214 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE2,
2215 1.1 christos (power[ATHN_POWER_OFDM54 ] & 0x3f) << 24 |
2216 1.1 christos (power[ATHN_POWER_OFDM48 ] & 0x3f) << 16 |
2217 1.1 christos (power[ATHN_POWER_OFDM36 ] & 0x3f) << 8 |
2218 1.1 christos (power[ATHN_POWER_OFDM24 ] & 0x3f));
2219 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE3,
2220 1.1 christos (power[ATHN_POWER_CCK2_SP ] & 0x3f) << 24 |
2221 1.1 christos (power[ATHN_POWER_CCK2_LP ] & 0x3f) << 16 |
2222 1.1 christos (power[ATHN_POWER_XR ] & 0x3f) << 8 |
2223 1.1 christos (power[ATHN_POWER_CCK1_LP ] & 0x3f));
2224 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE4,
2225 1.1 christos (power[ATHN_POWER_CCK11_SP] & 0x3f) << 24 |
2226 1.1 christos (power[ATHN_POWER_CCK11_LP] & 0x3f) << 16 |
2227 1.1 christos (power[ATHN_POWER_CCK55_SP] & 0x3f) << 8 |
2228 1.1 christos (power[ATHN_POWER_CCK55_LP] & 0x3f));
2229 1.1 christos #ifndef IEEE80211_NO_HT
2230 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE5,
2231 1.1 christos (power[ATHN_POWER_HT20(3) ] & 0x3f) << 24 |
2232 1.1 christos (power[ATHN_POWER_HT20(2) ] & 0x3f) << 16 |
2233 1.1 christos (power[ATHN_POWER_HT20(1) ] & 0x3f) << 8 |
2234 1.1 christos (power[ATHN_POWER_HT20(0) ] & 0x3f));
2235 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE6,
2236 1.1 christos (power[ATHN_POWER_HT20(7) ] & 0x3f) << 24 |
2237 1.1 christos (power[ATHN_POWER_HT20(6) ] & 0x3f) << 16 |
2238 1.1 christos (power[ATHN_POWER_HT20(5) ] & 0x3f) << 8 |
2239 1.1 christos (power[ATHN_POWER_HT20(4) ] & 0x3f));
2240 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE7,
2241 1.1 christos (power[ATHN_POWER_HT40(3) ] & 0x3f) << 24 |
2242 1.1 christos (power[ATHN_POWER_HT40(2) ] & 0x3f) << 16 |
2243 1.1 christos (power[ATHN_POWER_HT40(1) ] & 0x3f) << 8 |
2244 1.1 christos (power[ATHN_POWER_HT40(0) ] & 0x3f));
2245 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE8,
2246 1.1 christos (power[ATHN_POWER_HT40(7) ] & 0x3f) << 24 |
2247 1.1 christos (power[ATHN_POWER_HT40(6) ] & 0x3f) << 16 |
2248 1.1 christos (power[ATHN_POWER_HT40(5) ] & 0x3f) << 8 |
2249 1.1 christos (power[ATHN_POWER_HT40(4) ] & 0x3f));
2250 1.1 christos AR_WRITE(sc, AR_PHY_POWER_TX_RATE9,
2251 1.1 christos (power[ATHN_POWER_OFDM_EXT] & 0x3f) << 24 |
2252 1.1 christos (power[ATHN_POWER_CCK_EXT ] & 0x3f) << 16 |
2253 1.1 christos (power[ATHN_POWER_OFDM_DUP] & 0x3f) << 8 |
2254 1.1 christos (power[ATHN_POWER_CCK_DUP ] & 0x3f));
2255 1.1 christos #endif
2256 1.1 christos AR_WRITE_BARRIER(sc);
2257 1.1 christos }
2258 1.1 christos
2259 1.1 christos PUBLIC void
2260 1.1 christos ar5008_set_viterbi_mask(struct athn_softc *sc, int bin)
2261 1.1 christos {
2262 1.1 christos uint32_t mask[4], reg;
2263 1.1 christos uint8_t m[62], p[62]; /* XXX use bit arrays? */
2264 1.1 christos int i, bit, cur;
2265 1.1 christos
2266 1.1 christos /* Compute pilot mask. */
2267 1.1 christos cur = -6000;
2268 1.1 christos for (i = 0; i < 4; i++) {
2269 1.1 christos mask[i] = 0;
2270 1.1 christos for (bit = 0; bit < 30; bit++) {
2271 1.1 christos if (abs(cur - bin) < 100)
2272 1.1 christos mask[i] |= 1 << bit;
2273 1.1 christos cur += 100;
2274 1.1 christos }
2275 1.1 christos if (cur == 0) /* Skip entry "0". */
2276 1.1 christos cur = 100;
2277 1.1 christos }
2278 1.1 christos /* Write entries from -6000 to -3100. */
2279 1.1 christos AR_WRITE(sc, AR_PHY_TIMING7, mask[0]);
2280 1.1 christos AR_WRITE(sc, AR_PHY_TIMING9, mask[0]);
2281 1.1 christos /* Write entries from -3000 to -100. */
2282 1.1 christos AR_WRITE(sc, AR_PHY_TIMING8, mask[1]);
2283 1.1 christos AR_WRITE(sc, AR_PHY_TIMING10, mask[1]);
2284 1.1 christos /* Write entries from 100 to 3000. */
2285 1.1 christos AR_WRITE(sc, AR_PHY_PILOT_MASK_01_30, mask[2]);
2286 1.1 christos AR_WRITE(sc, AR_PHY_CHANNEL_MASK_01_30, mask[2]);
2287 1.1 christos /* Write entries from 3100 to 6000. */
2288 1.1 christos AR_WRITE(sc, AR_PHY_PILOT_MASK_31_60, mask[3]);
2289 1.1 christos AR_WRITE(sc, AR_PHY_CHANNEL_MASK_31_60, mask[3]);
2290 1.1 christos
2291 1.1 christos /* Compute viterbi mask. */
2292 1.1 christos for (cur = 6100; cur >= 0; cur -= 100)
2293 1.1 christos p[+cur / 100] = abs(cur - bin) < 75;
2294 1.1 christos for (cur = -100; cur >= -6100; cur -= 100)
2295 1.1 christos m[-cur / 100] = abs(cur - bin) < 75;
2296 1.1 christos
2297 1.1 christos /* Write viterbi mask (XXX needs to be reworked). */
2298 1.1 christos reg =
2299 1.1 christos m[46] << 30 | m[47] << 28 | m[48] << 26 | m[49] << 24 |
2300 1.1 christos m[50] << 22 | m[51] << 20 | m[52] << 18 | m[53] << 16 |
2301 1.1 christos m[54] << 14 | m[55] << 12 | m[56] << 10 | m[57] << 8 |
2302 1.1 christos m[58] << 6 | m[59] << 4 | m[60] << 2 | m[61] << 0;
2303 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK_1, reg);
2304 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_M_46_61, reg);
2305 1.1 christos
2306 1.1 christos /* XXX m[48] should be m[38] ? */
2307 1.1 christos reg = m[31] << 28 | m[32] << 26 | m[33] << 24 |
2308 1.1 christos m[34] << 22 | m[35] << 20 | m[36] << 18 | m[37] << 16 |
2309 1.1 christos m[48] << 14 | m[39] << 12 | m[40] << 10 | m[41] << 8 |
2310 1.1 christos m[42] << 6 | m[43] << 4 | m[44] << 2 | m[45] << 0;
2311 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK_2, reg);
2312 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_M_31_45, reg);
2313 1.1 christos
2314 1.1 christos /* XXX This one is weird too. */
2315 1.1 christos reg =
2316 1.1 christos m[16] << 30 | m[16] << 28 | m[18] << 26 | m[18] << 24 |
2317 1.1 christos m[20] << 22 | m[20] << 20 | m[22] << 18 | m[22] << 16 |
2318 1.1 christos m[24] << 14 | m[24] << 12 | m[25] << 10 | m[26] << 8 |
2319 1.1 christos m[27] << 6 | m[28] << 4 | m[29] << 2 | m[30] << 0;
2320 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK_3, reg);
2321 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_M_16_30, reg);
2322 1.1 christos
2323 1.1 christos reg =
2324 1.1 christos m[ 0] << 30 | m[ 1] << 28 | m[ 2] << 26 | m[ 3] << 24 |
2325 1.1 christos m[ 4] << 22 | m[ 5] << 20 | m[ 6] << 18 | m[ 7] << 16 |
2326 1.1 christos m[ 8] << 14 | m[ 9] << 12 | m[10] << 10 | m[11] << 8 |
2327 1.1 christos m[12] << 6 | m[13] << 4 | m[14] << 2 | m[15] << 0;
2328 1.1 christos AR_WRITE(sc, AR_PHY_MASK_CTL, reg);
2329 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_M_00_15, reg);
2330 1.1 christos
2331 1.1 christos reg = p[15] << 28 | p[14] << 26 | p[13] << 24 |
2332 1.1 christos p[12] << 22 | p[11] << 20 | p[10] << 18 | p[ 9] << 16 |
2333 1.1 christos p[ 8] << 14 | p[ 7] << 12 | p[ 6] << 10 | p[ 5] << 8 |
2334 1.1 christos p[ 4] << 6 | p[ 3] << 4 | p[ 2] << 2 | p[ 1] << 0;
2335 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK2_1, reg);
2336 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_P_15_01, reg);
2337 1.1 christos
2338 1.1 christos reg = p[30] << 28 | p[29] << 26 | p[28] << 24 |
2339 1.1 christos p[27] << 22 | p[26] << 20 | p[25] << 18 | p[24] << 16 |
2340 1.1 christos p[23] << 14 | p[22] << 12 | p[21] << 10 | p[20] << 8 |
2341 1.1 christos p[19] << 6 | p[18] << 4 | p[17] << 2 | p[16] << 0;
2342 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK2_2, reg);
2343 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_P_30_16, reg);
2344 1.1 christos
2345 1.1 christos reg = p[45] << 28 | p[44] << 26 | p[43] << 24 |
2346 1.1 christos p[42] << 22 | p[41] << 20 | p[40] << 18 | p[39] << 16 |
2347 1.1 christos p[38] << 14 | p[37] << 12 | p[36] << 10 | p[35] << 8 |
2348 1.1 christos p[34] << 6 | p[33] << 4 | p[32] << 2 | p[31] << 0;
2349 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK2_3, reg);
2350 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_P_45_31, reg);
2351 1.1 christos
2352 1.1 christos reg =
2353 1.1 christos p[61] << 30 | p[60] << 28 | p[59] << 26 | p[58] << 24 |
2354 1.1 christos p[57] << 22 | p[56] << 20 | p[55] << 18 | p[54] << 16 |
2355 1.1 christos p[53] << 14 | p[52] << 12 | p[51] << 10 | p[50] << 8 |
2356 1.1 christos p[49] << 6 | p[48] << 4 | p[47] << 2 | p[46] << 0;
2357 1.1 christos AR_WRITE(sc, AR_PHY_BIN_MASK2_4, reg);
2358 1.1 christos AR_WRITE(sc, AR_PHY_VIT_MASK2_P_61_46, reg);
2359 1.1 christos AR_WRITE_BARRIER(sc);
2360 1.1 christos }
2361 1.1 christos
2362 1.1 christos Static void
2363 1.1 christos ar5008_hw_init(struct athn_softc *sc, struct ieee80211_channel *c,
2364 1.1 christos struct ieee80211_channel *extc)
2365 1.1 christos {
2366 1.1 christos struct athn_ops *ops = &sc->sc_ops;
2367 1.1 christos const struct athn_ini *ini = sc->sc_ini;
2368 1.1 christos const uint32_t *pvals;
2369 1.1 christos uint32_t reg;
2370 1.1 christos int i;
2371 1.1 christos
2372 1.1 christos AR_WRITE(sc, AR_PHY(0), 0x00000007);
2373 1.1 christos AR_WRITE(sc, AR_PHY_ADC_SERIAL_CTL, AR_PHY_SEL_EXTERNAL_RADIO);
2374 1.1 christos
2375 1.1 christos if (!AR_SINGLE_CHIP(sc))
2376 1.1 christos ar5416_reset_addac(sc, c);
2377 1.1 christos
2378 1.1 christos AR_WRITE(sc, AR_PHY_ADC_SERIAL_CTL, AR_PHY_SEL_INTERNAL_ADDAC);
2379 1.1 christos
2380 1.1 christos /* First initialization step (depends on channel band/bandwidth). */
2381 1.1 christos #ifndef IEEE80211_NO_HT
2382 1.1 christos if (extc != NULL) {
2383 1.1 christos if (IEEE80211_IS_CHAN_2GHZ(c))
2384 1.1 christos pvals = ini->vals_2g40;
2385 1.1 christos else
2386 1.1 christos pvals = ini->vals_5g40;
2387 1.1 christos }
2388 1.1 christos else
2389 1.1 christos #endif
2390 1.1 christos {
2391 1.1 christos if (IEEE80211_IS_CHAN_2GHZ(c))
2392 1.1 christos pvals = ini->vals_2g20;
2393 1.1 christos else
2394 1.1 christos pvals = ini->vals_5g20;
2395 1.1 christos }
2396 1.1 christos DPRINTFN(DBG_INIT, sc, "writing modal init vals\n");
2397 1.1 christos for (i = 0; i < ini->nregs; i++) {
2398 1.1 christos uint32_t val = pvals[i];
2399 1.1 christos
2400 1.1 christos /* Fix AR_AN_TOP2 initialization value if required. */
2401 1.1 christos if (ini->regs[i] == AR_AN_TOP2 &&
2402 1.1 christos (sc->sc_flags & ATHN_FLAG_AN_TOP2_FIXUP))
2403 1.1 christos val &= ~AR_AN_TOP2_PWDCLKIND;
2404 1.1 christos AR_WRITE(sc, ini->regs[i], val);
2405 1.1 christos if (AR_IS_ANALOG_REG(ini->regs[i])) {
2406 1.1 christos AR_WRITE_BARRIER(sc);
2407 1.1 christos DELAY(100);
2408 1.1 christos }
2409 1.1 christos if ((i & 0x1f) == 0)
2410 1.1 christos DELAY(1);
2411 1.1 christos }
2412 1.1 christos AR_WRITE_BARRIER(sc);
2413 1.1 christos
2414 1.1 christos if (sc->sc_rx_gain != NULL)
2415 1.1 christos ar9280_reset_rx_gain(sc, c);
2416 1.1 christos if (sc->sc_tx_gain != NULL)
2417 1.1 christos ar9280_reset_tx_gain(sc, c);
2418 1.1 christos
2419 1.1 christos if (AR_SREV_9271_10(sc)) {
2420 1.1 christos AR_WRITE(sc, AR_PHY(68), 0x30002311);
2421 1.1 christos AR_WRITE(sc, AR_PHY_RF_CTL3, 0x0a020001);
2422 1.1 christos }
2423 1.1 christos AR_WRITE_BARRIER(sc);
2424 1.1 christos
2425 1.1 christos /* Second initialization step (common to all channels). */
2426 1.1 christos DPRINTFN(DBG_INIT, sc, "writing common init vals\n");
2427 1.1 christos for (i = 0; i < ini->ncmregs; i++) {
2428 1.1 christos AR_WRITE(sc, ini->cmregs[i], ini->cmvals[i]);
2429 1.1 christos if (AR_IS_ANALOG_REG(ini->cmregs[i])) {
2430 1.1 christos AR_WRITE_BARRIER(sc);
2431 1.1 christos DELAY(100);
2432 1.1 christos }
2433 1.1 christos if ((i & 0x1f) == 0)
2434 1.1 christos DELAY(1);
2435 1.1 christos }
2436 1.1 christos AR_WRITE_BARRIER(sc);
2437 1.1 christos
2438 1.1 christos if (!AR_SINGLE_CHIP(sc))
2439 1.1 christos ar5416_reset_bb_gain(sc, c);
2440 1.1 christos
2441 1.1 christos if (IEEE80211_IS_CHAN_5GHZ(c) &&
2442 1.1 christos (sc->sc_flags & ATHN_FLAG_FAST_PLL_CLOCK)) {
2443 1.1 christos /* Update modal values for fast PLL clock. */
2444 1.1 christos #ifndef IEEE80211_NO_HT
2445 1.1 christos if (extc != NULL)
2446 1.1 christos pvals = ini->fastvals_5g40;
2447 1.1 christos else
2448 1.1 christos #endif
2449 1.1 christos pvals = ini->fastvals_5g20;
2450 1.1 christos DPRINTFN(DBG_INIT, sc, "writing fast pll clock init vals\n");
2451 1.1 christos for (i = 0; i < ini->nfastregs; i++) {
2452 1.1 christos AR_WRITE(sc, ini->fastregs[i], pvals[i]);
2453 1.1 christos if (AR_IS_ANALOG_REG(ini->fastregs[i])) {
2454 1.1 christos AR_WRITE_BARRIER(sc);
2455 1.1 christos DELAY(100);
2456 1.1 christos }
2457 1.1 christos if ((i & 0x1f) == 0)
2458 1.1 christos DELAY(1);
2459 1.1 christos }
2460 1.1 christos }
2461 1.1 christos
2462 1.1 christos /*
2463 1.1 christos * Set the RX_ABORT and RX_DIS bits to prevent frames with corrupted
2464 1.1 christos * descriptor status.
2465 1.1 christos */
2466 1.1 christos AR_SETBITS(sc, AR_DIAG_SW, AR_DIAG_RX_DIS | AR_DIAG_RX_ABORT);
2467 1.1 christos
2468 1.1 christos /* Hardware workarounds for occasional Rx data corruption. */
2469 1.1 christos if (AR_SREV_9280_10_OR_LATER(sc)) {
2470 1.1 christos reg = AR_READ(sc, AR_PCU_MISC_MODE2);
2471 1.1 christos if (!AR_SREV_9271(sc))
2472 1.1 christos reg &= ~AR_PCU_MISC_MODE2_HWWAR1;
2473 1.1 christos if (AR_SREV_9287_10_OR_LATER(sc))
2474 1.1 christos reg &= ~AR_PCU_MISC_MODE2_HWWAR2;
2475 1.1 christos AR_WRITE(sc, AR_PCU_MISC_MODE2, reg);
2476 1.1 christos
2477 1.1 christos }
2478 1.1 christos else if (AR_SREV_5416_20_OR_LATER(sc)) {
2479 1.1 christos /* Disable baseband clock gating. */
2480 1.1 christos AR_WRITE(sc, AR_PHY(651), 0x11);
2481 1.1 christos
2482 1.1 christos if (AR_SREV_9160(sc)) {
2483 1.1 christos /* Disable RIFS search to fix baseband hang. */
2484 1.1 christos AR_CLRBITS(sc, AR_PHY_HEAVY_CLIP_FACTOR_RIFS,
2485 1.1 christos AR_PHY_RIFS_INIT_DELAY_M);
2486 1.1 christos }
2487 1.1 christos }
2488 1.1 christos AR_WRITE_BARRIER(sc);
2489 1.1 christos
2490 1.1 christos ar5008_set_phy(sc, c, extc);
2491 1.1 christos ar5008_init_chains(sc);
2492 1.1 christos
2493 1.1 christos if (sc->sc_flags & ATHN_FLAG_OLPC) {
2494 1.1 christos extern int ticks;
2495 1.1 christos sc->sc_olpc_ticks = ticks;
2496 1.1 christos ops->olpc_init(sc);
2497 1.1 christos }
2498 1.1 christos
2499 1.1 christos ops->set_txpower(sc, c, extc);
2500 1.1 christos
2501 1.1 christos if (!AR_SINGLE_CHIP(sc))
2502 1.1 christos ar5416_rf_reset(sc, c);
2503 1.1 christos }
2504 1.1 christos
2505 1.1 christos Static uint8_t
2506 1.1 christos ar5008_get_vpd(uint8_t pwr, const uint8_t *pwrPdg, const uint8_t *vpdPdg,
2507 1.1 christos int nicepts)
2508 1.1 christos {
2509 1.1 christos uint8_t vpd;
2510 1.1 christos int i, lo, hi;
2511 1.1 christos
2512 1.1 christos for (i = 0; i < nicepts; i++)
2513 1.1 christos if (pwrPdg[i] > pwr)
2514 1.1 christos break;
2515 1.1 christos hi = i;
2516 1.1 christos lo = hi - 1;
2517 1.1 christos if (lo == -1)
2518 1.1 christos lo = hi;
2519 1.1 christos else if (hi == nicepts)
2520 1.1 christos hi = lo;
2521 1.1 christos
2522 1.1 christos vpd = athn_interpolate(pwr, pwrPdg[lo], vpdPdg[lo],
2523 1.1 christos pwrPdg[hi], vpdPdg[hi]);
2524 1.1 christos return vpd;
2525 1.1 christos }
2526 1.1 christos
2527 1.1 christos PUBLIC void
2528 1.1 christos ar5008_get_pdadcs(struct athn_softc *sc, uint8_t fbin,
2529 1.1 christos struct athn_pier *lopier, struct athn_pier *hipier, int nxpdgains,
2530 1.1 christos int nicepts, uint8_t overlap, uint8_t *boundaries, uint8_t *pdadcs)
2531 1.1 christos {
2532 1.1 christos #define DB(x) ((x) / 2) /* Convert half dB to dB. */
2533 1.1 christos uint8_t minpwr[AR_PD_GAINS_IN_MASK], maxpwr[AR_PD_GAINS_IN_MASK];
2534 1.1 christos uint8_t vpd[AR_MAX_PWR_RANGE_IN_HALF_DB], pwr;
2535 1.1 christos uint8_t lovpd, hivpd, boundary;
2536 1.1 christos int16_t ss, delta, vpdstep, val;
2537 1.1 christos int i, j, npdadcs, nvpds, maxidx, tgtidx;
2538 1.1 christos
2539 1.1 christos /* Compute min and max power in half dB for each pdGain. */
2540 1.1 christos for (i = 0; i < nxpdgains; i++) {
2541 1.1 christos minpwr[i] = MAX(lopier->pwr[i][0], hipier->pwr[i][0]);
2542 1.1 christos maxpwr[i] = MIN(lopier->pwr[i][nicepts - 1],
2543 1.1 christos hipier->pwr[i][nicepts - 1]);
2544 1.1 christos }
2545 1.1 christos
2546 1.1 christos /* Fill phase domain analog-to-digital converter (PDADC) table. */
2547 1.1 christos npdadcs = 0;
2548 1.1 christos for (i = 0; i < nxpdgains; i++) {
2549 1.1 christos if (i != nxpdgains - 1)
2550 1.1 christos boundaries[i] = DB(maxpwr[i] + minpwr[i + 1]) / 2;
2551 1.1 christos else
2552 1.1 christos boundaries[i] = DB(maxpwr[i]);
2553 1.1 christos if (boundaries[i] > AR_MAX_RATE_POWER)
2554 1.1 christos boundaries[i] = AR_MAX_RATE_POWER;
2555 1.1 christos
2556 1.1 christos if (i == 0 && !AR_SREV_5416_20_OR_LATER(sc)) {
2557 1.1 christos /* Fix the gain delta (AR5416 1.0 only). */
2558 1.1 christos delta = boundaries[0] - 23;
2559 1.1 christos boundaries[0] = 23;
2560 1.1 christos }
2561 1.1 christos else
2562 1.1 christos delta = 0;
2563 1.1 christos
2564 1.1 christos /* Find starting index for this pdGain. */
2565 1.1 christos if (i != 0) {
2566 1.1 christos ss = boundaries[i - 1] - DB(minpwr[i]) -
2567 1.1 christos overlap + 1 + delta;
2568 1.1 christos }
2569 1.1 christos else if (AR_SREV_9280_10_OR_LATER(sc))
2570 1.1 christos ss = -DB(minpwr[i]);
2571 1.1 christos else
2572 1.1 christos ss = 0;
2573 1.1 christos
2574 1.1 christos /* Compute Vpd table for this pdGain. */
2575 1.1 christos nvpds = DB(maxpwr[i] - minpwr[i]) + 1;
2576 1.1 christos memset(vpd, 0, sizeof(vpd));
2577 1.1 christos pwr = minpwr[i];
2578 1.1 christos for (j = 0; j < nvpds; j++) {
2579 1.1 christos /* Get lower and higher Vpd. */
2580 1.1 christos lovpd = ar5008_get_vpd(pwr, lopier->pwr[i],
2581 1.1 christos lopier->vpd[i], nicepts);
2582 1.1 christos hivpd = ar5008_get_vpd(pwr, hipier->pwr[i],
2583 1.1 christos hipier->vpd[i], nicepts);
2584 1.1 christos
2585 1.1 christos /* Interpolate the final Vpd. */
2586 1.1 christos vpd[j] = athn_interpolate(fbin,
2587 1.1 christos lopier->fbin, lovpd, hipier->fbin, hivpd);
2588 1.1 christos
2589 1.1 christos pwr += 2; /* In half dB. */
2590 1.1 christos }
2591 1.1 christos
2592 1.1 christos /* Extrapolate data for ss < 0. */
2593 1.1 christos if (vpd[1] > vpd[0])
2594 1.1 christos vpdstep = vpd[1] - vpd[0];
2595 1.1 christos else
2596 1.1 christos vpdstep = 1;
2597 1.1 christos while (ss < 0 && npdadcs < AR_NUM_PDADC_VALUES - 1) {
2598 1.1 christos val = vpd[0] + ss * vpdstep;
2599 1.1 christos pdadcs[npdadcs++] = MAX(val, 0);
2600 1.1 christos ss++;
2601 1.1 christos }
2602 1.1 christos
2603 1.1 christos tgtidx = boundaries[i] + overlap - DB(minpwr[i]);
2604 1.1 christos maxidx = MIN(tgtidx, nvpds);
2605 1.1 christos while (ss < maxidx && npdadcs < AR_NUM_PDADC_VALUES - 1)
2606 1.1 christos pdadcs[npdadcs++] = vpd[ss++];
2607 1.1 christos
2608 1.1 christos if (tgtidx < maxidx)
2609 1.1 christos continue;
2610 1.1 christos
2611 1.1 christos /* Extrapolate data for maxidx <= ss <= tgtidx. */
2612 1.1 christos if (vpd[nvpds - 1] > vpd[nvpds - 2])
2613 1.1 christos vpdstep = vpd[nvpds - 1] - vpd[nvpds - 2];
2614 1.1 christos else
2615 1.1 christos vpdstep = 1;
2616 1.1 christos while (ss <= tgtidx && npdadcs < AR_NUM_PDADC_VALUES - 1) {
2617 1.1 christos val = vpd[nvpds - 1] + (ss - maxidx + 1) * vpdstep;
2618 1.1 christos pdadcs[npdadcs++] = MIN(val, 255);
2619 1.1 christos ss++;
2620 1.1 christos }
2621 1.1 christos }
2622 1.1 christos
2623 1.1 christos /* Fill remaining PDADC and boundaries entries. */
2624 1.1 christos if (AR_SREV_9285(sc))
2625 1.1 christos boundary = AR9285_PD_GAIN_BOUNDARY_DEFAULT;
2626 1.1 christos else /* Fill with latest. */
2627 1.1 christos boundary = boundaries[nxpdgains - 1];
2628 1.1 christos
2629 1.1 christos for (; nxpdgains < AR_PD_GAINS_IN_MASK; nxpdgains++)
2630 1.1 christos boundaries[nxpdgains] = boundary;
2631 1.1 christos
2632 1.1 christos for (; npdadcs < AR_NUM_PDADC_VALUES; npdadcs++)
2633 1.1 christos pdadcs[npdadcs] = pdadcs[npdadcs - 1];
2634 1.1 christos #undef DB
2635 1.1 christos }
2636 1.1 christos
2637 1.1 christos PUBLIC void
2638 1.1 christos ar5008_get_lg_tpow(struct athn_softc *sc, struct ieee80211_channel *c,
2639 1.1 christos uint8_t ctl, const struct ar_cal_target_power_leg *tgt, int nchans,
2640 1.1 christos uint8_t tpow[4])
2641 1.1 christos {
2642 1.1 christos uint8_t fbin;
2643 1.1 christos int i, lo, hi;
2644 1.1 christos
2645 1.1 christos /* Find interval (lower and upper indices). */
2646 1.1 christos fbin = athn_chan2fbin(c);
2647 1.1 christos for (i = 0; i < nchans; i++) {
2648 1.1 christos if (tgt[i].bChannel == AR_BCHAN_UNUSED ||
2649 1.1 christos tgt[i].bChannel > fbin)
2650 1.1 christos break;
2651 1.1 christos }
2652 1.1 christos hi = i;
2653 1.1 christos lo = hi - 1;
2654 1.1 christos if (lo == -1)
2655 1.1 christos lo = hi;
2656 1.1 christos else if (hi == nchans || tgt[hi].bChannel == AR_BCHAN_UNUSED)
2657 1.1 christos hi = lo;
2658 1.1 christos
2659 1.1 christos /* Interpolate values. */
2660 1.1 christos for (i = 0; i < 4; i++) {
2661 1.1 christos tpow[i] = athn_interpolate(fbin,
2662 1.1 christos tgt[lo].bChannel, tgt[lo].tPow2x[i],
2663 1.1 christos tgt[hi].bChannel, tgt[hi].tPow2x[i]);
2664 1.1 christos }
2665 1.1 christos /* XXX Apply conformance testing limit. */
2666 1.1 christos }
2667 1.1 christos
2668 1.1 christos #ifndef IEEE80211_NO_HT
2669 1.1 christos PUBLIC void
2670 1.1 christos ar5008_get_ht_tpow(struct athn_softc *sc, struct ieee80211_channel *c,
2671 1.1 christos uint8_t ctl, const struct ar_cal_target_power_ht *tgt, int nchans,
2672 1.1 christos uint8_t tpow[8])
2673 1.1 christos {
2674 1.1 christos uint8_t fbin;
2675 1.1 christos int i, lo, hi;
2676 1.1 christos
2677 1.1 christos /* Find interval (lower and upper indices). */
2678 1.1 christos fbin = athn_chan2fbin(c);
2679 1.1 christos for (i = 0; i < nchans; i++) {
2680 1.1 christos if (tgt[i].bChannel == AR_BCHAN_UNUSED ||
2681 1.1 christos tgt[i].bChannel > fbin)
2682 1.1 christos break;
2683 1.1 christos }
2684 1.1 christos hi = i;
2685 1.1 christos lo = hi - 1;
2686 1.1 christos if (lo == -1)
2687 1.1 christos lo = hi;
2688 1.1 christos else if (hi == nchans || tgt[hi].bChannel == AR_BCHAN_UNUSED)
2689 1.1 christos hi = lo;
2690 1.1 christos
2691 1.1 christos /* Interpolate values. */
2692 1.1 christos for (i = 0; i < 8; i++) {
2693 1.1 christos tpow[i] = athn_interpolate(fbin,
2694 1.1 christos tgt[lo].bChannel, tgt[lo].tPow2x[i],
2695 1.1 christos tgt[hi].bChannel, tgt[hi].tPow2x[i]);
2696 1.1 christos }
2697 1.1 christos /* XXX Apply conformance testing limit. */
2698 1.1 christos }
2699 1.1 christos #endif
2700 1.1 christos
2701 1.1 christos /*
2702 1.1 christos * Adaptive noise immunity.
2703 1.1 christos */
2704 1.1 christos Static void
2705 1.1 christos ar5008_set_noise_immunity_level(struct athn_softc *sc, int level)
2706 1.1 christos {
2707 1.1 christos int high = level == 4;
2708 1.1 christos uint32_t reg;
2709 1.1 christos
2710 1.1 christos reg = AR_READ(sc, AR_PHY_DESIRED_SZ);
2711 1.1 christos reg = RW(reg, AR_PHY_DESIRED_SZ_TOT_DES, high ? -62 : -55);
2712 1.1 christos AR_WRITE(sc, AR_PHY_DESIRED_SZ, reg);
2713 1.1 christos
2714 1.1 christos reg = AR_READ(sc, AR_PHY_AGC_CTL1);
2715 1.1 christos reg = RW(reg, AR_PHY_AGC_CTL1_COARSE_LOW, high ? -70 : -64);
2716 1.1 christos reg = RW(reg, AR_PHY_AGC_CTL1_COARSE_HIGH, high ? -12 : -14);
2717 1.1 christos AR_WRITE(sc, AR_PHY_AGC_CTL1, reg);
2718 1.1 christos
2719 1.1 christos reg = AR_READ(sc, AR_PHY_FIND_SIG);
2720 1.1 christos reg = RW(reg, AR_PHY_FIND_SIG_FIRPWR, high ? -80 : -78);
2721 1.1 christos AR_WRITE(sc, AR_PHY_FIND_SIG, reg);
2722 1.1 christos
2723 1.1 christos AR_WRITE_BARRIER(sc);
2724 1.1 christos }
2725 1.1 christos
2726 1.1 christos Static void
2727 1.1 christos ar5008_enable_ofdm_weak_signal(struct athn_softc *sc)
2728 1.1 christos {
2729 1.1 christos uint32_t reg;
2730 1.1 christos
2731 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR_LOW);
2732 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M1_THRESH_LOW, 50);
2733 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M2_THRESH_LOW, 40);
2734 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M2COUNT_THR_LOW, 48);
2735 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR_LOW, reg);
2736 1.1 christos
2737 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR);
2738 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M1_THRESH, 77);
2739 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M2_THRESH, 64);
2740 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M2COUNT_THR, 16);
2741 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR, reg);
2742 1.1 christos
2743 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR_EXT);
2744 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M1_THRESH_LOW, 50);
2745 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M2_THRESH_LOW, 40);
2746 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M1_THRESH, 77);
2747 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M2_THRESH, 64);
2748 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR_EXT, reg);
2749 1.1 christos
2750 1.1 christos AR_SETBITS(sc, AR_PHY_SFCORR_LOW,
2751 1.1 christos AR_PHY_SFCORR_LOW_USE_SELF_CORR_LOW);
2752 1.1 christos AR_WRITE_BARRIER(sc);
2753 1.1 christos }
2754 1.1 christos
2755 1.1 christos Static void
2756 1.1 christos ar5008_disable_ofdm_weak_signal(struct athn_softc *sc)
2757 1.1 christos {
2758 1.1 christos uint32_t reg;
2759 1.1 christos
2760 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR_LOW);
2761 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M1_THRESH_LOW, 127);
2762 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M2_THRESH_LOW, 127);
2763 1.1 christos reg = RW(reg, AR_PHY_SFCORR_LOW_M2COUNT_THR_LOW, 63);
2764 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR_LOW, reg);
2765 1.1 christos
2766 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR);
2767 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M1_THRESH, 127);
2768 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M2_THRESH, 127);
2769 1.1 christos reg = RW(reg, AR_PHY_SFCORR_M2COUNT_THR, 31);
2770 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR, reg);
2771 1.1 christos
2772 1.1 christos reg = AR_READ(sc, AR_PHY_SFCORR_EXT);
2773 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M1_THRESH_LOW, 127);
2774 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M2_THRESH_LOW, 127);
2775 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M1_THRESH, 127);
2776 1.1 christos reg = RW(reg, AR_PHY_SFCORR_EXT_M2_THRESH, 127);
2777 1.1 christos AR_WRITE(sc, AR_PHY_SFCORR_EXT, reg);
2778 1.1 christos
2779 1.1 christos AR_CLRBITS(sc, AR_PHY_SFCORR_LOW,
2780 1.1 christos AR_PHY_SFCORR_LOW_USE_SELF_CORR_LOW);
2781 1.1 christos AR_WRITE_BARRIER(sc);
2782 1.1 christos }
2783 1.1 christos
2784 1.1 christos Static void
2785 1.1 christos ar5008_set_cck_weak_signal(struct athn_softc *sc, int high)
2786 1.1 christos {
2787 1.1 christos uint32_t reg;
2788 1.1 christos
2789 1.1 christos reg = AR_READ(sc, AR_PHY_CCK_DETECT);
2790 1.1 christos reg = RW(reg, AR_PHY_CCK_DETECT_WEAK_SIG_THR_CCK, high ? 6 : 8);
2791 1.1 christos AR_WRITE(sc, AR_PHY_CCK_DETECT, reg);
2792 1.1 christos AR_WRITE_BARRIER(sc);
2793 1.1 christos }
2794 1.1 christos
2795 1.1 christos Static void
2796 1.1 christos ar5008_set_firstep_level(struct athn_softc *sc, int level)
2797 1.1 christos {
2798 1.1 christos uint32_t reg;
2799 1.1 christos
2800 1.1 christos reg = AR_READ(sc, AR_PHY_FIND_SIG);
2801 1.1 christos reg = RW(reg, AR_PHY_FIND_SIG_FIRSTEP, level * 4);
2802 1.1 christos AR_WRITE(sc, AR_PHY_FIND_SIG, reg);
2803 1.1 christos AR_WRITE_BARRIER(sc);
2804 1.1 christos }
2805 1.1 christos
2806 1.1 christos Static void
2807 1.1 christos ar5008_set_spur_immunity_level(struct athn_softc *sc, int level)
2808 1.1 christos {
2809 1.1 christos uint32_t reg;
2810 1.1 christos
2811 1.1 christos reg = AR_READ(sc, AR_PHY_TIMING5);
2812 1.1 christos reg = RW(reg, AR_PHY_TIMING5_CYCPWR_THR1, (level + 1) * 2);
2813 1.1 christos AR_WRITE(sc, AR_PHY_TIMING5, reg);
2814 1.1 christos AR_WRITE_BARRIER(sc);
2815 1.1 christos }
2816