if_urtwn.c revision 1.59.2.5 1 1.59.2.5 phil /* $NetBSD: if_urtwn.c,v 1.59.2.5 2018/08/03 19:47:25 phil Exp $ */
2 1.37 christos /* $OpenBSD: if_urtwn.c,v 1.42 2015/02/10 23:25:46 mpi Exp $ */
3 1.1 nonaka
4 1.1 nonaka /*-
5 1.1 nonaka * Copyright (c) 2010 Damien Bergamini <damien.bergamini (at) free.fr>
6 1.32 nonaka * Copyright (c) 2014 Kevin Lo <kevlo (at) FreeBSD.org>
7 1.49 nat * Copyright (c) 2016 Nathanial Sloss <nathanialsloss (at) yahoo.com.au>
8 1.1 nonaka *
9 1.1 nonaka * Permission to use, copy, modify, and distribute this software for any
10 1.1 nonaka * purpose with or without fee is hereby granted, provided that the above
11 1.1 nonaka * copyright notice and this permission notice appear in all copies.
12 1.1 nonaka *
13 1.1 nonaka * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
14 1.1 nonaka * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
15 1.1 nonaka * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
16 1.1 nonaka * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
17 1.1 nonaka * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
18 1.1 nonaka * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
19 1.1 nonaka * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20 1.1 nonaka */
21 1.1 nonaka
22 1.59.2.4 phil /* Some code taken from FreeBSD dev/usb/wlan/if_urtw.c with copyright */
23 1.59.2.4 phil /*-
24 1.59.2.4 phil * Copyright (c) 2008 Weongyo Jeong <weongyo (at) FreeBSD.org>
25 1.59.2.4 phil *
26 1.59.2.4 phil * Permission to use, copy, modify, and distribute this software for any
27 1.59.2.4 phil * purpose with or without fee is hereby granted, provided that the above
28 1.59.2.4 phil * copyright notice and this permission notice appear in all copies.
29 1.59.2.4 phil *
30 1.59.2.4 phil * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
31 1.59.2.4 phil * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
32 1.59.2.4 phil * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
33 1.59.2.4 phil * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
34 1.59.2.4 phil * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
35 1.59.2.4 phil * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
36 1.59.2.4 phil * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
37 1.59.2.4 phil */
38 1.59.2.4 phil
39 1.8 christos /*-
40 1.49 nat * Driver for Realtek RTL8188CE-VAU/RTL8188CUS/RTL8188EU/RTL8188RU/RTL8192CU
41 1.49 nat * RTL8192EU.
42 1.1 nonaka */
43 1.1 nonaka
44 1.1 nonaka #include <sys/cdefs.h>
45 1.59.2.5 phil __KERNEL_RCSID(0, "$NetBSD: if_urtwn.c,v 1.59.2.5 2018/08/03 19:47:25 phil Exp $");
46 1.11 jmcneill
47 1.11 jmcneill #ifdef _KERNEL_OPT
48 1.11 jmcneill #include "opt_inet.h"
49 1.51 skrll #include "opt_usb.h"
50 1.11 jmcneill #endif
51 1.1 nonaka
52 1.1 nonaka #include <sys/param.h>
53 1.1 nonaka #include <sys/sockio.h>
54 1.1 nonaka #include <sys/sysctl.h>
55 1.1 nonaka #include <sys/mbuf.h>
56 1.1 nonaka #include <sys/kernel.h>
57 1.59.2.2 phil #include <sys/kmem.h>
58 1.1 nonaka #include <sys/socket.h>
59 1.1 nonaka #include <sys/systm.h>
60 1.1 nonaka #include <sys/module.h>
61 1.1 nonaka #include <sys/conf.h>
62 1.1 nonaka #include <sys/device.h>
63 1.1 nonaka
64 1.1 nonaka #include <sys/bus.h>
65 1.1 nonaka #include <machine/endian.h>
66 1.1 nonaka #include <sys/intr.h>
67 1.1 nonaka
68 1.1 nonaka #include <net/bpf.h>
69 1.1 nonaka #include <net/if.h>
70 1.1 nonaka #include <net/if_arp.h>
71 1.1 nonaka #include <net/if_dl.h>
72 1.1 nonaka #include <net/if_ether.h>
73 1.1 nonaka #include <net/if_media.h>
74 1.1 nonaka #include <net/if_types.h>
75 1.1 nonaka
76 1.1 nonaka #include <netinet/in.h>
77 1.1 nonaka #include <netinet/in_systm.h>
78 1.1 nonaka #include <netinet/in_var.h>
79 1.1 nonaka #include <netinet/ip.h>
80 1.11 jmcneill #include <netinet/if_inarp.h>
81 1.1 nonaka
82 1.1 nonaka #include <net80211/ieee80211_netbsd.h>
83 1.1 nonaka #include <net80211/ieee80211_var.h>
84 1.1 nonaka #include <net80211/ieee80211_radiotap.h>
85 1.1 nonaka
86 1.1 nonaka #include <dev/firmload.h>
87 1.1 nonaka
88 1.1 nonaka #include <dev/usb/usb.h>
89 1.1 nonaka #include <dev/usb/usbdi.h>
90 1.1 nonaka #include <dev/usb/usbdivar.h>
91 1.1 nonaka #include <dev/usb/usbdi_util.h>
92 1.1 nonaka #include <dev/usb/usbdevs.h>
93 1.1 nonaka
94 1.1 nonaka #include <dev/usb/if_urtwnreg.h>
95 1.1 nonaka #include <dev/usb/if_urtwnvar.h>
96 1.1 nonaka #include <dev/usb/if_urtwn_data.h>
97 1.1 nonaka
98 1.12 christos /*
99 1.12 christos * The sc_write_mtx locking is to prevent sequences of writes from
100 1.12 christos * being intermingled with each other. I don't know if this is really
101 1.12 christos * needed. I have added it just to be on the safe side.
102 1.12 christos */
103 1.12 christos
104 1.1 nonaka #ifdef URTWN_DEBUG
105 1.1 nonaka #define DBG_INIT __BIT(0)
106 1.1 nonaka #define DBG_FN __BIT(1)
107 1.1 nonaka #define DBG_TX __BIT(2)
108 1.1 nonaka #define DBG_RX __BIT(3)
109 1.1 nonaka #define DBG_STM __BIT(4)
110 1.1 nonaka #define DBG_RF __BIT(5)
111 1.1 nonaka #define DBG_REG __BIT(6)
112 1.1 nonaka #define DBG_ALL 0xffffffffU
113 1.59.2.2 phil /* NNN Reset urtwn_debug to 0 when done debugging. */
114 1.59.2.5 phil u_int urtwn_debug = DBG_FN;
115 1.1 nonaka #define DPRINTFN(n, s) \
116 1.1 nonaka do { if (urtwn_debug & (n)) printf s; } while (/*CONSTCOND*/0)
117 1.1 nonaka #else
118 1.1 nonaka #define DPRINTFN(n, s)
119 1.1 nonaka #endif
120 1.1 nonaka
121 1.38 christos #define URTWN_DEV(v,p) { { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }, 0 }
122 1.32 nonaka #define URTWN_RTL8188E_DEV(v,p) \
123 1.38 christos { { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }, FLAG_RTL8188E }
124 1.49 nat #define URTWN_RTL8192EU_DEV(v,p) \
125 1.49 nat { { USB_VENDOR_##v, USB_PRODUCT_##v##_##p }, FLAG_RTL8192E }
126 1.32 nonaka static const struct urtwn_dev {
127 1.32 nonaka struct usb_devno dev;
128 1.32 nonaka uint32_t flags;
129 1.32 nonaka #define FLAG_RTL8188E __BIT(0)
130 1.49 nat #define FLAG_RTL8192E __BIT(1)
131 1.32 nonaka } urtwn_devs[] = {
132 1.32 nonaka URTWN_DEV(ABOCOM, RTL8188CU_1),
133 1.32 nonaka URTWN_DEV(ABOCOM, RTL8188CU_2),
134 1.32 nonaka URTWN_DEV(ABOCOM, RTL8192CU),
135 1.32 nonaka URTWN_DEV(ASUSTEK, RTL8192CU),
136 1.37 christos URTWN_DEV(ASUSTEK, RTL8192CU_3),
137 1.33 nonaka URTWN_DEV(ASUSTEK, USBN10NANO),
138 1.37 christos URTWN_DEV(ASUSTEK, RTL8192CU_3),
139 1.32 nonaka URTWN_DEV(AZUREWAVE, RTL8188CE_1),
140 1.32 nonaka URTWN_DEV(AZUREWAVE, RTL8188CE_2),
141 1.32 nonaka URTWN_DEV(AZUREWAVE, RTL8188CU),
142 1.37 christos URTWN_DEV(BELKIN, F7D2102),
143 1.32 nonaka URTWN_DEV(BELKIN, RTL8188CU),
144 1.37 christos URTWN_DEV(BELKIN, RTL8188CUS),
145 1.32 nonaka URTWN_DEV(BELKIN, RTL8192CU),
146 1.37 christos URTWN_DEV(BELKIN, RTL8192CU_1),
147 1.37 christos URTWN_DEV(BELKIN, RTL8192CU_2),
148 1.32 nonaka URTWN_DEV(CHICONY, RTL8188CUS_1),
149 1.32 nonaka URTWN_DEV(CHICONY, RTL8188CUS_2),
150 1.32 nonaka URTWN_DEV(CHICONY, RTL8188CUS_3),
151 1.32 nonaka URTWN_DEV(CHICONY, RTL8188CUS_4),
152 1.32 nonaka URTWN_DEV(CHICONY, RTL8188CUS_5),
153 1.37 christos URTWN_DEV(CHICONY, RTL8188CUS_6),
154 1.37 christos URTWN_DEV(COMPARE, RTL8192CU),
155 1.32 nonaka URTWN_DEV(COREGA, RTL8192CU),
156 1.37 christos URTWN_DEV(DLINK, DWA131B),
157 1.32 nonaka URTWN_DEV(DLINK, RTL8188CU),
158 1.32 nonaka URTWN_DEV(DLINK, RTL8192CU_1),
159 1.32 nonaka URTWN_DEV(DLINK, RTL8192CU_2),
160 1.32 nonaka URTWN_DEV(DLINK, RTL8192CU_3),
161 1.37 christos URTWN_DEV(DLINK, RTL8192CU_4),
162 1.32 nonaka URTWN_DEV(EDIMAX, RTL8188CU),
163 1.32 nonaka URTWN_DEV(EDIMAX, RTL8192CU),
164 1.32 nonaka URTWN_DEV(FEIXUN, RTL8188CU),
165 1.32 nonaka URTWN_DEV(FEIXUN, RTL8192CU),
166 1.32 nonaka URTWN_DEV(GUILLEMOT, HWNUP150),
167 1.37 christos URTWN_DEV(GUILLEMOT, RTL8192CU),
168 1.32 nonaka URTWN_DEV(HAWKING, RTL8192CU),
169 1.37 christos URTWN_DEV(HAWKING, RTL8192CU_2),
170 1.32 nonaka URTWN_DEV(HP3, RTL8188CU),
171 1.37 christos URTWN_DEV(IODATA, WNG150UM),
172 1.37 christos URTWN_DEV(IODATA, RTL8192CU),
173 1.32 nonaka URTWN_DEV(NETGEAR, WNA1000M),
174 1.32 nonaka URTWN_DEV(NETGEAR, RTL8192CU),
175 1.32 nonaka URTWN_DEV(NETGEAR4, RTL8188CU),
176 1.32 nonaka URTWN_DEV(NOVATECH, RTL8188CU),
177 1.32 nonaka URTWN_DEV(PLANEX2, RTL8188CU_1),
178 1.32 nonaka URTWN_DEV(PLANEX2, RTL8188CU_2),
179 1.32 nonaka URTWN_DEV(PLANEX2, RTL8192CU),
180 1.32 nonaka URTWN_DEV(PLANEX2, RTL8188CU_3),
181 1.32 nonaka URTWN_DEV(PLANEX2, RTL8188CU_4),
182 1.32 nonaka URTWN_DEV(PLANEX2, RTL8188CUS),
183 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CE_0),
184 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CE_1),
185 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CTV),
186 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CU_0),
187 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CU_1),
188 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CU_2),
189 1.39 leot URTWN_DEV(REALTEK, RTL8188CU_3),
190 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CU_COMBO),
191 1.32 nonaka URTWN_DEV(REALTEK, RTL8188CUS),
192 1.32 nonaka URTWN_DEV(REALTEK, RTL8188RU),
193 1.32 nonaka URTWN_DEV(REALTEK, RTL8188RU_2),
194 1.37 christos URTWN_DEV(REALTEK, RTL8188RU_3),
195 1.32 nonaka URTWN_DEV(REALTEK, RTL8191CU),
196 1.32 nonaka URTWN_DEV(REALTEK, RTL8192CE),
197 1.32 nonaka URTWN_DEV(REALTEK, RTL8192CU),
198 1.32 nonaka URTWN_DEV(SITECOMEU, RTL8188CU),
199 1.32 nonaka URTWN_DEV(SITECOMEU, RTL8188CU_2),
200 1.32 nonaka URTWN_DEV(SITECOMEU, RTL8192CU),
201 1.32 nonaka URTWN_DEV(SITECOMEU, RTL8192CUR2),
202 1.37 christos URTWN_DEV(TPLINK, RTL8192CU),
203 1.32 nonaka URTWN_DEV(TRENDNET, RTL8188CU),
204 1.32 nonaka URTWN_DEV(TRENDNET, RTL8192CU),
205 1.32 nonaka URTWN_DEV(ZYXEL, RTL8192CU),
206 1.32 nonaka
207 1.32 nonaka /* URTWN_RTL8188E */
208 1.46 christos URTWN_RTL8188E_DEV(DLINK, DWA125D1),
209 1.34 nonaka URTWN_RTL8188E_DEV(ELECOM, WDC150SU2M),
210 1.32 nonaka URTWN_RTL8188E_DEV(REALTEK, RTL8188ETV),
211 1.32 nonaka URTWN_RTL8188E_DEV(REALTEK, RTL8188EU),
212 1.50 mlelstv URTWN_RTL8188E_DEV(ABOCOM, RTL8188EU),
213 1.53 jnemeth URTWN_RTL8188E_DEV(TPLINK, RTL8188EU),
214 1.52 skrll
215 1.49 nat /* URTWN_RTL8192EU */
216 1.49 nat URTWN_RTL8192EU_DEV(REALTEK, RTL8192EU),
217 1.54 khorben URTWN_RTL8192EU_DEV(TPLINK, RTL8192EU),
218 1.1 nonaka };
219 1.32 nonaka #undef URTWN_DEV
220 1.32 nonaka #undef URTWN_RTL8188E_DEV
221 1.49 nat #undef URTWN_RTL8192EU_DEV
222 1.1 nonaka
223 1.59.2.4 phil /* urtwn data */
224 1.59.2.4 phil static const uint8_t urtwn_chan_2ghz[] =
225 1.59.2.4 phil { 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14 };
226 1.59.2.4 phil
227 1.59.2.4 phil
228 1.1 nonaka static int urtwn_match(device_t, cfdata_t, void *);
229 1.1 nonaka static void urtwn_attach(device_t, device_t, void *);
230 1.1 nonaka static int urtwn_detach(device_t, int);
231 1.1 nonaka static int urtwn_activate(device_t, enum devact);
232 1.1 nonaka
233 1.1 nonaka CFATTACH_DECL_NEW(urtwn, sizeof(struct urtwn_softc), urtwn_match,
234 1.1 nonaka urtwn_attach, urtwn_detach, urtwn_activate);
235 1.1 nonaka
236 1.1 nonaka static int urtwn_open_pipes(struct urtwn_softc *);
237 1.1 nonaka static void urtwn_close_pipes(struct urtwn_softc *);
238 1.1 nonaka static int urtwn_alloc_rx_list(struct urtwn_softc *);
239 1.1 nonaka static void urtwn_free_rx_list(struct urtwn_softc *);
240 1.1 nonaka static int urtwn_alloc_tx_list(struct urtwn_softc *);
241 1.1 nonaka static void urtwn_free_tx_list(struct urtwn_softc *);
242 1.1 nonaka static void urtwn_task(void *);
243 1.1 nonaka static void urtwn_do_async(struct urtwn_softc *,
244 1.1 nonaka void (*)(struct urtwn_softc *, void *), void *, int);
245 1.1 nonaka static void urtwn_wait_async(struct urtwn_softc *);
246 1.1 nonaka static int urtwn_write_region_1(struct urtwn_softc *, uint16_t, uint8_t *,
247 1.1 nonaka int);
248 1.12 christos static void urtwn_write_1(struct urtwn_softc *, uint16_t, uint8_t);
249 1.12 christos static void urtwn_write_2(struct urtwn_softc *, uint16_t, uint16_t);
250 1.12 christos static void urtwn_write_4(struct urtwn_softc *, uint16_t, uint32_t);
251 1.12 christos static int urtwn_write_region(struct urtwn_softc *, uint16_t, uint8_t *,
252 1.12 christos int);
253 1.1 nonaka static int urtwn_read_region_1(struct urtwn_softc *, uint16_t, uint8_t *,
254 1.1 nonaka int);
255 1.12 christos static uint8_t urtwn_read_1(struct urtwn_softc *, uint16_t);
256 1.12 christos static uint16_t urtwn_read_2(struct urtwn_softc *, uint16_t);
257 1.12 christos static uint32_t urtwn_read_4(struct urtwn_softc *, uint16_t);
258 1.1 nonaka static int urtwn_fw_cmd(struct urtwn_softc *, uint8_t, const void *, int);
259 1.32 nonaka static void urtwn_r92c_rf_write(struct urtwn_softc *, int, uint8_t,
260 1.32 nonaka uint32_t);
261 1.32 nonaka static void urtwn_r88e_rf_write(struct urtwn_softc *, int, uint8_t,
262 1.32 nonaka uint32_t);
263 1.49 nat static void urtwn_r92e_rf_write(struct urtwn_softc *, int, uint8_t,
264 1.49 nat uint32_t);
265 1.1 nonaka static uint32_t urtwn_rf_read(struct urtwn_softc *, int, uint8_t);
266 1.1 nonaka static int urtwn_llt_write(struct urtwn_softc *, uint32_t, uint32_t);
267 1.1 nonaka static uint8_t urtwn_efuse_read_1(struct urtwn_softc *, uint16_t);
268 1.1 nonaka static void urtwn_efuse_read(struct urtwn_softc *);
269 1.32 nonaka static void urtwn_efuse_switch_power(struct urtwn_softc *);
270 1.1 nonaka static int urtwn_read_chipid(struct urtwn_softc *);
271 1.12 christos #ifdef URTWN_DEBUG
272 1.12 christos static void urtwn_dump_rom(struct urtwn_softc *, struct r92c_rom *);
273 1.12 christos #endif
274 1.1 nonaka static void urtwn_read_rom(struct urtwn_softc *);
275 1.32 nonaka static void urtwn_r88e_read_rom(struct urtwn_softc *);
276 1.1 nonaka static int urtwn_media_change(struct ifnet *);
277 1.59.2.4 phil static int urtwn_ra_init(struct ieee80211vap *);
278 1.12 christos static int urtwn_get_nettype(struct urtwn_softc *);
279 1.12 christos static void urtwn_set_nettype0_msr(struct urtwn_softc *, uint8_t);
280 1.1 nonaka static void urtwn_tsf_sync_enable(struct urtwn_softc *);
281 1.1 nonaka static void urtwn_set_led(struct urtwn_softc *, int, int);
282 1.1 nonaka static void urtwn_calib_to(void *);
283 1.1 nonaka static void urtwn_calib_to_cb(struct urtwn_softc *, void *);
284 1.1 nonaka static void urtwn_next_scan(void *);
285 1.59.2.2 phil static int urtwn_newstate(struct ieee80211vap *, enum ieee80211_state,
286 1.1 nonaka int);
287 1.59.2.5 phil //static void urtwn_newstate_cb(struct urtwn_softc *, void *);
288 1.1 nonaka static int urtwn_wme_update(struct ieee80211com *);
289 1.1 nonaka static void urtwn_wme_update_cb(struct urtwn_softc *, void *);
290 1.1 nonaka static void urtwn_update_avgrssi(struct urtwn_softc *, int, int8_t);
291 1.1 nonaka static int8_t urtwn_get_rssi(struct urtwn_softc *, int, void *);
292 1.32 nonaka static int8_t urtwn_r88e_get_rssi(struct urtwn_softc *, int, void *);
293 1.1 nonaka static void urtwn_rx_frame(struct urtwn_softc *, uint8_t *, int);
294 1.42 skrll static void urtwn_rxeof(struct usbd_xfer *, void *, usbd_status);
295 1.42 skrll static void urtwn_txeof(struct usbd_xfer *, void *, usbd_status);
296 1.1 nonaka static int urtwn_tx(struct urtwn_softc *, struct mbuf *,
297 1.12 christos struct ieee80211_node *, struct urtwn_tx_data *);
298 1.42 skrll static struct urtwn_tx_data *
299 1.42 skrll urtwn_get_tx_data(struct urtwn_softc *, size_t);
300 1.1 nonaka static void urtwn_start(struct ifnet *);
301 1.1 nonaka static void urtwn_watchdog(struct ifnet *);
302 1.32 nonaka static int urtwn_r92c_power_on(struct urtwn_softc *);
303 1.49 nat static int urtwn_r92e_power_on(struct urtwn_softc *);
304 1.32 nonaka static int urtwn_r88e_power_on(struct urtwn_softc *);
305 1.1 nonaka static int urtwn_llt_init(struct urtwn_softc *);
306 1.1 nonaka static void urtwn_fw_reset(struct urtwn_softc *);
307 1.32 nonaka static void urtwn_r88e_fw_reset(struct urtwn_softc *);
308 1.1 nonaka static int urtwn_fw_loadpage(struct urtwn_softc *, int, uint8_t *, int);
309 1.1 nonaka static int urtwn_load_firmware(struct urtwn_softc *);
310 1.32 nonaka static int urtwn_r92c_dma_init(struct urtwn_softc *);
311 1.32 nonaka static int urtwn_r88e_dma_init(struct urtwn_softc *);
312 1.1 nonaka static void urtwn_mac_init(struct urtwn_softc *);
313 1.1 nonaka static void urtwn_bb_init(struct urtwn_softc *);
314 1.1 nonaka static void urtwn_rf_init(struct urtwn_softc *);
315 1.1 nonaka static void urtwn_cam_init(struct urtwn_softc *);
316 1.1 nonaka static void urtwn_pa_bias_init(struct urtwn_softc *);
317 1.1 nonaka static void urtwn_rxfilter_init(struct urtwn_softc *);
318 1.1 nonaka static void urtwn_edca_init(struct urtwn_softc *);
319 1.1 nonaka static void urtwn_write_txpower(struct urtwn_softc *, int, uint16_t[]);
320 1.22 christos static void urtwn_get_txpower(struct urtwn_softc *, size_t, u_int, u_int,
321 1.1 nonaka uint16_t[]);
322 1.32 nonaka static void urtwn_r88e_get_txpower(struct urtwn_softc *, size_t, u_int,
323 1.32 nonaka u_int, uint16_t[]);
324 1.1 nonaka static void urtwn_set_txpower(struct urtwn_softc *, u_int, u_int);
325 1.1 nonaka static void urtwn_set_chan(struct urtwn_softc *, struct ieee80211_channel *,
326 1.1 nonaka u_int);
327 1.1 nonaka static void urtwn_iq_calib(struct urtwn_softc *, bool);
328 1.1 nonaka static void urtwn_lc_calib(struct urtwn_softc *);
329 1.1 nonaka static void urtwn_temp_calib(struct urtwn_softc *);
330 1.1 nonaka static int urtwn_init(struct ifnet *);
331 1.1 nonaka static void urtwn_stop(struct ifnet *, int);
332 1.59.2.2 phil static int urtwn_reset(struct ieee80211vap *, u_long);
333 1.1 nonaka static void urtwn_chip_stop(struct urtwn_softc *);
334 1.26 christos static void urtwn_newassoc(struct ieee80211_node *, int);
335 1.49 nat static void urtwn_delay_ms(struct urtwn_softc *, int ms);
336 1.59.2.3 phil /* Functions for wifi refresh */
337 1.59.2.2 phil static struct ieee80211vap *
338 1.59.2.2 phil urtwn_vap_create(struct ieee80211com *,
339 1.59.2.2 phil const char [IFNAMSIZ], int, enum ieee80211_opmode, int,
340 1.59.2.2 phil const uint8_t [IEEE80211_ADDR_LEN],
341 1.59.2.2 phil const uint8_t [IEEE80211_ADDR_LEN]);
342 1.59.2.2 phil static void urtwn_vap_delete(struct ieee80211vap *);
343 1.59.2.2 phil static int urtwn_ioctl(struct ifnet *, u_long, void *);
344 1.59.2.3 phil static void urtwn_parent(struct ieee80211com *);
345 1.59.2.3 phil static void urtwn_scan_start(struct ieee80211com *);
346 1.59.2.3 phil static void urtwn_scan_end(struct ieee80211com *);
347 1.59.2.3 phil static void urtwn_set_channel(struct ieee80211com *);
348 1.59.2.3 phil static int urtwn_transmit(struct ieee80211com *, struct mbuf *);
349 1.59.2.5 phil static int urtwn_send_mgmt(struct ieee80211_node *, int, int);
350 1.59.2.3 phil static int urtwn_raw_xmit(struct ieee80211_node *, struct mbuf *,
351 1.59.2.3 phil const struct ieee80211_bpf_params *);
352 1.59.2.4 phil static void urtwn_getradiocaps(struct ieee80211com *, int, int *,
353 1.59.2.4 phil struct ieee80211_channel []);
354 1.1 nonaka
355 1.1 nonaka /* Aliases. */
356 1.1 nonaka #define urtwn_bb_write urtwn_write_4
357 1.1 nonaka #define urtwn_bb_read urtwn_read_4
358 1.1 nonaka
359 1.32 nonaka #define urtwn_lookup(d,v,p) ((const struct urtwn_dev *)usb_lookup(d,v,p))
360 1.32 nonaka
361 1.48 nat static const uint16_t addaReg[] = {
362 1.48 nat R92C_FPGA0_XCD_SWITCHCTL, R92C_BLUETOOTH, R92C_RX_WAIT_CCA,
363 1.48 nat R92C_TX_CCK_RFON, R92C_TX_CCK_BBON, R92C_TX_OFDM_RFON,
364 1.48 nat R92C_TX_OFDM_BBON, R92C_TX_TO_RX, R92C_TX_TO_TX, R92C_RX_CCK,
365 1.48 nat R92C_RX_OFDM, R92C_RX_WAIT_RIFS, R92C_RX_TO_RX,
366 1.48 nat R92C_STANDBY, R92C_SLEEP, R92C_PMPD_ANAEN
367 1.48 nat };
368 1.48 nat
369 1.1 nonaka static int
370 1.1 nonaka urtwn_match(device_t parent, cfdata_t match, void *aux)
371 1.1 nonaka {
372 1.1 nonaka struct usb_attach_arg *uaa = aux;
373 1.1 nonaka
374 1.49 nat return urtwn_lookup(urtwn_devs, uaa->uaa_vendor, uaa->uaa_product) !=
375 1.49 nat NULL ? UMATCH_VENDOR_PRODUCT : UMATCH_NONE;
376 1.1 nonaka }
377 1.1 nonaka
378 1.1 nonaka static void
379 1.1 nonaka urtwn_attach(device_t parent, device_t self, void *aux)
380 1.1 nonaka {
381 1.1 nonaka struct urtwn_softc *sc = device_private(self);
382 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
383 1.1 nonaka struct usb_attach_arg *uaa = aux;
384 1.1 nonaka char *devinfop;
385 1.32 nonaka const struct urtwn_dev *dev;
386 1.47 nat usb_device_request_t req;
387 1.59.2.5 phil // NNN loop below size_t i;
388 1.22 christos int error;
389 1.1 nonaka
390 1.1 nonaka sc->sc_dev = self;
391 1.42 skrll sc->sc_udev = uaa->uaa_device;
392 1.1 nonaka
393 1.59.2.3 phil /* Name the ic. */
394 1.59.2.3 phil ic->ic_name = "urtwn";
395 1.59.2.3 phil
396 1.32 nonaka sc->chip = 0;
397 1.42 skrll dev = urtwn_lookup(urtwn_devs, uaa->uaa_vendor, uaa->uaa_product);
398 1.32 nonaka if (dev != NULL && ISSET(dev->flags, FLAG_RTL8188E))
399 1.32 nonaka SET(sc->chip, URTWN_CHIP_88E);
400 1.49 nat if (dev != NULL && ISSET(dev->flags, FLAG_RTL8192E))
401 1.49 nat SET(sc->chip, URTWN_CHIP_92EU);
402 1.32 nonaka
403 1.1 nonaka aprint_naive("\n");
404 1.1 nonaka aprint_normal("\n");
405 1.1 nonaka
406 1.12 christos DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
407 1.12 christos
408 1.1 nonaka devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
409 1.1 nonaka aprint_normal_dev(self, "%s\n", devinfop);
410 1.1 nonaka usbd_devinfo_free(devinfop);
411 1.1 nonaka
412 1.47 nat req.bmRequestType = UT_WRITE_DEVICE;
413 1.47 nat req.bRequest = UR_SET_FEATURE;
414 1.47 nat USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
415 1.47 nat USETW(req.wIndex, UHF_PORT_SUSPEND);
416 1.47 nat USETW(req.wLength, 0);
417 1.47 nat
418 1.47 nat (void) usbd_do_request(sc->sc_udev, &req, 0);
419 1.47 nat
420 1.1 nonaka mutex_init(&sc->sc_task_mtx, MUTEX_DEFAULT, IPL_NET);
421 1.59.2.4 phil mutex_init(&sc->sc_tx_mtx, MUTEX_DEFAULT, IPL_SOFTNET);
422 1.59.2.4 phil mutex_init(&sc->sc_rx_mtx, MUTEX_DEFAULT, IPL_SOFTNET);
423 1.1 nonaka mutex_init(&sc->sc_fwcmd_mtx, MUTEX_DEFAULT, IPL_NONE);
424 1.12 christos mutex_init(&sc->sc_write_mtx, MUTEX_DEFAULT, IPL_NONE);
425 1.1 nonaka
426 1.18 jmcneill usb_init_task(&sc->sc_task, urtwn_task, sc, 0);
427 1.1 nonaka
428 1.59.2.1 phil /* NNN make these callouts use a vap ... in vap create??? */
429 1.1 nonaka callout_init(&sc->sc_scan_to, 0);
430 1.1 nonaka callout_setfunc(&sc->sc_scan_to, urtwn_next_scan, sc);
431 1.1 nonaka callout_init(&sc->sc_calib_to, 0);
432 1.1 nonaka callout_setfunc(&sc->sc_calib_to, urtwn_calib_to, sc);
433 1.1 nonaka
434 1.6 skrll error = usbd_set_config_no(sc->sc_udev, 1, 0);
435 1.6 skrll if (error != 0) {
436 1.6 skrll aprint_error_dev(self, "failed to set configuration"
437 1.6 skrll ", err=%s\n", usbd_errstr(error));
438 1.1 nonaka goto fail;
439 1.1 nonaka }
440 1.1 nonaka
441 1.1 nonaka /* Get the first interface handle. */
442 1.1 nonaka error = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface);
443 1.1 nonaka if (error != 0) {
444 1.1 nonaka aprint_error_dev(self, "could not get interface handle\n");
445 1.1 nonaka goto fail;
446 1.1 nonaka }
447 1.1 nonaka
448 1.1 nonaka error = urtwn_read_chipid(sc);
449 1.1 nonaka if (error != 0) {
450 1.1 nonaka aprint_error_dev(self, "unsupported test chip\n");
451 1.1 nonaka goto fail;
452 1.1 nonaka }
453 1.1 nonaka
454 1.1 nonaka /* Determine number of Tx/Rx chains. */
455 1.1 nonaka if (sc->chip & URTWN_CHIP_92C) {
456 1.1 nonaka sc->ntxchains = (sc->chip & URTWN_CHIP_92C_1T2R) ? 1 : 2;
457 1.1 nonaka sc->nrxchains = 2;
458 1.49 nat } else if (sc->chip & URTWN_CHIP_92EU) {
459 1.49 nat sc->ntxchains = 2;
460 1.49 nat sc->nrxchains = 2;
461 1.1 nonaka } else {
462 1.1 nonaka sc->ntxchains = 1;
463 1.1 nonaka sc->nrxchains = 1;
464 1.1 nonaka }
465 1.32 nonaka
466 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
467 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
468 1.32 nonaka urtwn_r88e_read_rom(sc);
469 1.32 nonaka else
470 1.32 nonaka urtwn_read_rom(sc);
471 1.1 nonaka
472 1.22 christos aprint_normal_dev(self, "MAC/BB RTL%s, RF 6052 %zdT%zdR, address %s\n",
473 1.49 nat (sc->chip & URTWN_CHIP_92EU) ? "8192EU" :
474 1.1 nonaka (sc->chip & URTWN_CHIP_92C) ? "8192CU" :
475 1.32 nonaka (sc->chip & URTWN_CHIP_88E) ? "8188EU" :
476 1.1 nonaka (sc->board_type == R92C_BOARD_TYPE_HIGHPA) ? "8188RU" :
477 1.1 nonaka (sc->board_type == R92C_BOARD_TYPE_MINICARD) ? "8188CE-VAU" :
478 1.1 nonaka "8188CUS", sc->ntxchains, sc->nrxchains,
479 1.59.2.1 phil ether_sprintf(ic->ic_macaddr));
480 1.1 nonaka
481 1.1 nonaka error = urtwn_open_pipes(sc);
482 1.1 nonaka if (error != 0) {
483 1.1 nonaka aprint_error_dev(sc->sc_dev, "could not open pipes\n");
484 1.1 nonaka goto fail;
485 1.1 nonaka }
486 1.1 nonaka aprint_normal_dev(self, "%d rx pipe%s, %d tx pipe%s\n",
487 1.1 nonaka sc->rx_npipe, sc->rx_npipe > 1 ? "s" : "",
488 1.1 nonaka sc->tx_npipe, sc->tx_npipe > 1 ? "s" : "");
489 1.1 nonaka
490 1.1 nonaka /*
491 1.1 nonaka * Setup the 802.11 device.
492 1.1 nonaka */
493 1.59.2.2 phil ic->ic_softc = sc;
494 1.1 nonaka ic->ic_phytype = IEEE80211_T_OFDM; /* Not only, but not used. */
495 1.1 nonaka ic->ic_opmode = IEEE80211_M_STA; /* Default to BSS mode. */
496 1.1 nonaka
497 1.1 nonaka /* Set device capabilities. */
498 1.1 nonaka ic->ic_caps =
499 1.1 nonaka IEEE80211_C_MONITOR | /* Monitor mode supported. */
500 1.26 christos IEEE80211_C_IBSS | /* IBSS mode supported */
501 1.26 christos IEEE80211_C_HOSTAP | /* HostAp mode supported */
502 1.1 nonaka IEEE80211_C_SHPREAMBLE | /* Short preamble supported. */
503 1.1 nonaka IEEE80211_C_SHSLOT | /* Short slot time supported. */
504 1.1 nonaka IEEE80211_C_WME | /* 802.11e */
505 1.1 nonaka IEEE80211_C_WPA; /* 802.11i */
506 1.1 nonaka
507 1.59.2.2 phil ic->ic_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
508 1.59.2.2 phil
509 1.59.2.5 phil #ifdef should_delete_NNN
510 1.1 nonaka /* Set supported .11b and .11g channels (1 through 14). */
511 1.59.2.2 phil ic->ic_nchans = 14; /* NNN ? get this from somewhere? */
512 1.59.2.2 phil for (i = 0; i < 14; i++) {
513 1.1 nonaka ic->ic_channels[i].ic_freq =
514 1.1 nonaka ieee80211_ieee2mhz(i, IEEE80211_CHAN_2GHZ);
515 1.1 nonaka ic->ic_channels[i].ic_flags =
516 1.1 nonaka IEEE80211_CHAN_CCK | IEEE80211_CHAN_OFDM |
517 1.1 nonaka IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ;
518 1.1 nonaka }
519 1.59.2.5 phil #else
520 1.59.2.5 phil urtwn_getradiocaps(ic, IEEE80211_CHAN_MAX, &ic->ic_nchans,
521 1.59.2.5 phil ic->ic_channels);
522 1.59.2.5 phil #endif
523 1.1 nonaka
524 1.1 nonaka ieee80211_ifattach(ic);
525 1.16 jmcneill
526 1.59.2.4 phil /* override default methods NNN Need more here? */
527 1.26 christos ic->ic_newassoc = urtwn_newassoc;
528 1.1 nonaka ic->ic_wme.wme_update = urtwn_wme_update;
529 1.59.2.2 phil ic->ic_vap_create = urtwn_vap_create;
530 1.59.2.2 phil ic->ic_vap_delete = urtwn_vap_delete;
531 1.59.2.3 phil ic->ic_parent = urtwn_parent;
532 1.59.2.3 phil ic->ic_scan_start = urtwn_scan_start;
533 1.59.2.3 phil ic->ic_scan_end = urtwn_scan_end;
534 1.59.2.3 phil ic->ic_set_channel = urtwn_set_channel;
535 1.59.2.3 phil ic->ic_transmit = urtwn_transmit;
536 1.59.2.5 phil // ic->ic_send_mgmt = urtwn_send_mgmt;
537 1.59.2.3 phil ic->ic_raw_xmit = urtwn_raw_xmit;
538 1.59.2.4 phil ic->ic_getradiocaps = urtwn_getradiocaps;
539 1.59.2.3 phil
540 1.1 nonaka
541 1.59.2.5 phil /* How should this get called the first time? Not here? */
542 1.59.2.5 phil // uint8_t bssid[IEEE80211_ADDR_LEN] = {0};
543 1.59.2.1 phil
544 1.59.2.2 phil struct ieee80211vap *vap =
545 1.59.2.2 phil urtwn_vap_create(ic, device_xname(sc->sc_dev),
546 1.59.2.5 phil device_unit(sc->sc_dev), IEEE80211_M_STA,
547 1.59.2.5 phil IEEE80211_CLONE_MACADDR, ic->ic_macaddr, ic->ic_macaddr);
548 1.59.2.2 phil
549 1.59.2.2 phil if (vap == NULL) {
550 1.59.2.2 phil /* Didn't work ... now what! */
551 1.59.2.5 phil printf ("NNN vap_create didn't work ...\n");
552 1.59.2.2 phil ieee80211_ifdetach(ic);
553 1.59.2.2 phil goto fail;
554 1.59.2.2 phil }
555 1.1 nonaka
556 1.59.2.3 phil /* Debug all! NNN */
557 1.59.2.3 phil vap->iv_debug = IEEE80211_MSG_ANY;
558 1.59.2.3 phil
559 1.59.2.2 phil bpf_attach2(vap->iv_ifp, DLT_IEEE802_11_RADIO,
560 1.1 nonaka sizeof(struct ieee80211_frame) + IEEE80211_RADIOTAP_HDRLEN,
561 1.1 nonaka &sc->sc_drvbpf);
562 1.1 nonaka
563 1.1 nonaka sc->sc_rxtap_len = sizeof(sc->sc_rxtapu);
564 1.1 nonaka sc->sc_rxtap.wr_ihdr.it_len = htole16(sc->sc_rxtap_len);
565 1.1 nonaka sc->sc_rxtap.wr_ihdr.it_present = htole32(URTWN_RX_RADIOTAP_PRESENT);
566 1.1 nonaka
567 1.1 nonaka sc->sc_txtap_len = sizeof(sc->sc_txtapu);
568 1.1 nonaka sc->sc_txtap.wt_ihdr.it_len = htole16(sc->sc_txtap_len);
569 1.1 nonaka sc->sc_txtap.wt_ihdr.it_present = htole32(URTWN_TX_RADIOTAP_PRESENT);
570 1.1 nonaka
571 1.1 nonaka ieee80211_announce(ic);
572 1.1 nonaka
573 1.1 nonaka usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev, sc->sc_dev);
574 1.1 nonaka
575 1.30 mrg if (!pmf_device_register(self, NULL, NULL))
576 1.30 mrg aprint_error_dev(self, "couldn't establish power handler\n");
577 1.30 mrg
578 1.1 nonaka SET(sc->sc_flags, URTWN_FLAG_ATTACHED);
579 1.1 nonaka return;
580 1.1 nonaka
581 1.1 nonaka fail:
582 1.1 nonaka sc->sc_dying = 1;
583 1.1 nonaka aprint_error_dev(self, "attach failed\n");
584 1.1 nonaka }
585 1.1 nonaka
586 1.1 nonaka static int
587 1.1 nonaka urtwn_detach(device_t self, int flags)
588 1.1 nonaka {
589 1.1 nonaka struct urtwn_softc *sc = device_private(self);
590 1.1 nonaka int s;
591 1.1 nonaka
592 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
593 1.1 nonaka
594 1.31 christos pmf_device_deregister(self);
595 1.31 christos
596 1.1 nonaka s = splusb();
597 1.1 nonaka
598 1.1 nonaka sc->sc_dying = 1;
599 1.1 nonaka
600 1.1 nonaka callout_stop(&sc->sc_scan_to);
601 1.1 nonaka callout_stop(&sc->sc_calib_to);
602 1.1 nonaka
603 1.1 nonaka if (ISSET(sc->sc_flags, URTWN_FLAG_ATTACHED)) {
604 1.1 nonaka usb_rem_task(sc->sc_udev, &sc->sc_task);
605 1.59.2.4 phil // urtwn_stop(...) ??
606 1.59.2.4 phil // vap_detach(...) ??
607 1.1 nonaka
608 1.1 nonaka ieee80211_ifdetach(&sc->sc_ic);
609 1.1 nonaka
610 1.42 skrll /* Close Tx/Rx pipes. Abort done by urtwn_stop. */
611 1.1 nonaka urtwn_close_pipes(sc);
612 1.1 nonaka }
613 1.1 nonaka
614 1.1 nonaka splx(s);
615 1.1 nonaka
616 1.1 nonaka usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev, sc->sc_dev);
617 1.1 nonaka
618 1.1 nonaka callout_destroy(&sc->sc_scan_to);
619 1.1 nonaka callout_destroy(&sc->sc_calib_to);
620 1.12 christos
621 1.12 christos mutex_destroy(&sc->sc_write_mtx);
622 1.1 nonaka mutex_destroy(&sc->sc_fwcmd_mtx);
623 1.1 nonaka mutex_destroy(&sc->sc_tx_mtx);
624 1.49 nat mutex_destroy(&sc->sc_rx_mtx);
625 1.1 nonaka mutex_destroy(&sc->sc_task_mtx);
626 1.1 nonaka
627 1.42 skrll return 0;
628 1.1 nonaka }
629 1.1 nonaka
630 1.1 nonaka static int
631 1.1 nonaka urtwn_activate(device_t self, enum devact act)
632 1.1 nonaka {
633 1.1 nonaka struct urtwn_softc *sc = device_private(self);
634 1.1 nonaka
635 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
636 1.1 nonaka
637 1.1 nonaka switch (act) {
638 1.1 nonaka case DVACT_DEACTIVATE:
639 1.59.2.2 phil if_deactivate(TAILQ_FIRST(&(sc->sc_ic.ic_vaps))->iv_ifp);
640 1.59.2.2 phil
641 1.42 skrll return 0;
642 1.1 nonaka default:
643 1.42 skrll return EOPNOTSUPP;
644 1.1 nonaka }
645 1.1 nonaka }
646 1.1 nonaka
647 1.1 nonaka static int
648 1.1 nonaka urtwn_open_pipes(struct urtwn_softc *sc)
649 1.1 nonaka {
650 1.1 nonaka /* Bulk-out endpoints addresses (from highest to lowest prio). */
651 1.55 skrll static uint8_t epaddr[R92C_MAX_EPOUT];
652 1.55 skrll static uint8_t rxepaddr[R92C_MAX_EPIN];
653 1.1 nonaka usb_interface_descriptor_t *id;
654 1.1 nonaka usb_endpoint_descriptor_t *ed;
655 1.49 nat size_t i, ntx = 0, nrx = 0;
656 1.22 christos int error;
657 1.1 nonaka
658 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
659 1.1 nonaka
660 1.1 nonaka /* Determine the number of bulk-out pipes. */
661 1.1 nonaka id = usbd_get_interface_descriptor(sc->sc_iface);
662 1.1 nonaka for (i = 0; i < id->bNumEndpoints; i++) {
663 1.1 nonaka ed = usbd_interface2endpoint_descriptor(sc->sc_iface, i);
664 1.55 skrll if (ed == NULL || UE_GET_XFERTYPE(ed->bmAttributes) != UE_BULK) {
665 1.55 skrll continue;
666 1.55 skrll }
667 1.55 skrll if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT) {
668 1.55 skrll if (ntx < sizeof(epaddr))
669 1.55 skrll epaddr[ntx] = ed->bEndpointAddress;
670 1.1 nonaka ntx++;
671 1.49 nat }
672 1.55 skrll if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) {
673 1.55 skrll if (nrx < sizeof(rxepaddr))
674 1.55 skrll rxepaddr[nrx] = ed->bEndpointAddress;
675 1.49 nat nrx++;
676 1.49 nat }
677 1.1 nonaka }
678 1.55 skrll if (nrx == 0 || nrx > R92C_MAX_EPIN) {
679 1.55 skrll aprint_error_dev(sc->sc_dev,
680 1.55 skrll "%zd: invalid number of Rx bulk pipes\n", nrx);
681 1.55 skrll return EIO;
682 1.55 skrll }
683 1.1 nonaka if (ntx == 0 || ntx > R92C_MAX_EPOUT) {
684 1.1 nonaka aprint_error_dev(sc->sc_dev,
685 1.22 christos "%zd: invalid number of Tx bulk pipes\n", ntx);
686 1.42 skrll return EIO;
687 1.1 nonaka }
688 1.55 skrll DPRINTFN(DBG_INIT, ("%s: %s: found %zd/%zd bulk-in/out pipes\n",
689 1.55 skrll device_xname(sc->sc_dev), __func__, nrx, ntx));
690 1.49 nat sc->rx_npipe = nrx;
691 1.1 nonaka sc->tx_npipe = ntx;
692 1.1 nonaka
693 1.1 nonaka /* Open bulk-in pipe at address 0x81. */
694 1.49 nat for (i = 0; i < nrx; i++) {
695 1.49 nat error = usbd_open_pipe(sc->sc_iface, rxepaddr[i],
696 1.49 nat USBD_EXCLUSIVE_USE, &sc->rx_pipe[i]);
697 1.49 nat if (error != 0) {
698 1.49 nat aprint_error_dev(sc->sc_dev,
699 1.49 nat "could not open Rx bulk pipe 0x%02x: %d\n",
700 1.49 nat rxepaddr[i], error);
701 1.49 nat goto fail;
702 1.49 nat }
703 1.1 nonaka }
704 1.1 nonaka
705 1.1 nonaka /* Open bulk-out pipes (up to 3). */
706 1.1 nonaka for (i = 0; i < ntx; i++) {
707 1.1 nonaka error = usbd_open_pipe(sc->sc_iface, epaddr[i],
708 1.1 nonaka USBD_EXCLUSIVE_USE, &sc->tx_pipe[i]);
709 1.1 nonaka if (error != 0) {
710 1.1 nonaka aprint_error_dev(sc->sc_dev,
711 1.12 christos "could not open Tx bulk pipe 0x%02x: %d\n",
712 1.12 christos epaddr[i], error);
713 1.1 nonaka goto fail;
714 1.1 nonaka }
715 1.1 nonaka }
716 1.1 nonaka
717 1.1 nonaka /* Map 802.11 access categories to USB pipes. */
718 1.1 nonaka sc->ac2idx[WME_AC_BK] =
719 1.1 nonaka sc->ac2idx[WME_AC_BE] = (ntx == 3) ? 2 : ((ntx == 2) ? 1 : 0);
720 1.1 nonaka sc->ac2idx[WME_AC_VI] = (ntx == 3) ? 1 : 0;
721 1.1 nonaka sc->ac2idx[WME_AC_VO] = 0; /* Always use highest prio. */
722 1.1 nonaka
723 1.1 nonaka fail:
724 1.1 nonaka if (error != 0)
725 1.1 nonaka urtwn_close_pipes(sc);
726 1.42 skrll return error;
727 1.1 nonaka }
728 1.1 nonaka
729 1.1 nonaka static void
730 1.1 nonaka urtwn_close_pipes(struct urtwn_softc *sc)
731 1.1 nonaka {
732 1.42 skrll struct usbd_pipe *pipe;
733 1.22 christos size_t i;
734 1.1 nonaka
735 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
736 1.1 nonaka
737 1.49 nat /* Close Rx pipes. */
738 1.22 christos CTASSERT(sizeof(pipe) == sizeof(void *));
739 1.49 nat for (i = 0; i < sc->rx_npipe; i++) {
740 1.49 nat pipe = atomic_swap_ptr(&sc->rx_pipe[i], NULL);
741 1.49 nat if (pipe != NULL) {
742 1.49 nat usbd_close_pipe(pipe);
743 1.49 nat }
744 1.1 nonaka }
745 1.49 nat
746 1.1 nonaka /* Close Tx pipes. */
747 1.49 nat for (i = 0; i < sc->tx_npipe; i++) {
748 1.22 christos pipe = atomic_swap_ptr(&sc->tx_pipe[i], NULL);
749 1.22 christos if (pipe != NULL) {
750 1.22 christos usbd_close_pipe(pipe);
751 1.22 christos }
752 1.1 nonaka }
753 1.1 nonaka }
754 1.1 nonaka
755 1.1 nonaka static int
756 1.1 nonaka urtwn_alloc_rx_list(struct urtwn_softc *sc)
757 1.1 nonaka {
758 1.1 nonaka struct urtwn_rx_data *data;
759 1.22 christos size_t i;
760 1.22 christos int error = 0;
761 1.1 nonaka
762 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
763 1.1 nonaka
764 1.49 nat for (size_t j = 0; j < sc->rx_npipe; j++) {
765 1.49 nat TAILQ_INIT(&sc->rx_free_list[j]);
766 1.49 nat for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
767 1.49 nat data = &sc->rx_data[j][i];
768 1.1 nonaka
769 1.49 nat data->sc = sc; /* Backpointer for callbacks. */
770 1.1 nonaka
771 1.49 nat error = usbd_create_xfer(sc->rx_pipe[j], URTWN_RXBUFSZ,
772 1.56 skrll 0, 0, &data->xfer);
773 1.49 nat if (error) {
774 1.49 nat aprint_error_dev(sc->sc_dev,
775 1.49 nat "could not allocate xfer\n");
776 1.49 nat break;
777 1.49 nat }
778 1.49 nat
779 1.49 nat data->buf = usbd_get_buffer(data->xfer);
780 1.49 nat TAILQ_INSERT_TAIL(&sc->rx_free_list[j], data, next);
781 1.1 nonaka }
782 1.1 nonaka }
783 1.1 nonaka if (error != 0)
784 1.1 nonaka urtwn_free_rx_list(sc);
785 1.42 skrll return error;
786 1.1 nonaka }
787 1.1 nonaka
788 1.1 nonaka static void
789 1.1 nonaka urtwn_free_rx_list(struct urtwn_softc *sc)
790 1.1 nonaka {
791 1.42 skrll struct usbd_xfer *xfer;
792 1.22 christos size_t i;
793 1.1 nonaka
794 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
795 1.1 nonaka
796 1.1 nonaka /* NB: Caller must abort pipe first. */
797 1.49 nat for (size_t j = 0; j < sc->rx_npipe; j++) {
798 1.49 nat for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
799 1.49 nat CTASSERT(sizeof(xfer) == sizeof(void *));
800 1.49 nat xfer = atomic_swap_ptr(&sc->rx_data[j][i].xfer, NULL);
801 1.49 nat if (xfer != NULL)
802 1.49 nat usbd_destroy_xfer(xfer);
803 1.49 nat }
804 1.1 nonaka }
805 1.1 nonaka }
806 1.1 nonaka
807 1.1 nonaka static int
808 1.1 nonaka urtwn_alloc_tx_list(struct urtwn_softc *sc)
809 1.1 nonaka {
810 1.1 nonaka struct urtwn_tx_data *data;
811 1.22 christos size_t i;
812 1.22 christos int error = 0;
813 1.1 nonaka
814 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
815 1.1 nonaka
816 1.12 christos mutex_enter(&sc->sc_tx_mtx);
817 1.42 skrll for (size_t j = 0; j < sc->tx_npipe; j++) {
818 1.42 skrll TAILQ_INIT(&sc->tx_free_list[j]);
819 1.42 skrll for (i = 0; i < URTWN_TX_LIST_COUNT; i++) {
820 1.42 skrll data = &sc->tx_data[j][i];
821 1.42 skrll
822 1.42 skrll data->sc = sc; /* Backpointer for callbacks. */
823 1.42 skrll data->pidx = j;
824 1.42 skrll
825 1.42 skrll error = usbd_create_xfer(sc->tx_pipe[j],
826 1.42 skrll URTWN_TXBUFSZ, USBD_FORCE_SHORT_XFER, 0,
827 1.42 skrll &data->xfer);
828 1.42 skrll if (error) {
829 1.42 skrll aprint_error_dev(sc->sc_dev,
830 1.42 skrll "could not allocate xfer\n");
831 1.42 skrll goto fail;
832 1.42 skrll }
833 1.1 nonaka
834 1.42 skrll data->buf = usbd_get_buffer(data->xfer);
835 1.1 nonaka
836 1.42 skrll /* Append this Tx buffer to our free list. */
837 1.42 skrll TAILQ_INSERT_TAIL(&sc->tx_free_list[j], data, next);
838 1.1 nonaka }
839 1.1 nonaka }
840 1.12 christos mutex_exit(&sc->sc_tx_mtx);
841 1.42 skrll return 0;
842 1.1 nonaka
843 1.1 nonaka fail:
844 1.1 nonaka urtwn_free_tx_list(sc);
845 1.12 christos mutex_exit(&sc->sc_tx_mtx);
846 1.42 skrll return error;
847 1.1 nonaka }
848 1.1 nonaka
849 1.1 nonaka static void
850 1.1 nonaka urtwn_free_tx_list(struct urtwn_softc *sc)
851 1.1 nonaka {
852 1.42 skrll struct usbd_xfer *xfer;
853 1.22 christos size_t i;
854 1.1 nonaka
855 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
856 1.1 nonaka
857 1.1 nonaka /* NB: Caller must abort pipe first. */
858 1.42 skrll for (size_t j = 0; j < sc->tx_npipe; j++) {
859 1.42 skrll for (i = 0; i < URTWN_TX_LIST_COUNT; i++) {
860 1.42 skrll CTASSERT(sizeof(xfer) == sizeof(void *));
861 1.42 skrll xfer = atomic_swap_ptr(&sc->tx_data[j][i].xfer, NULL);
862 1.42 skrll if (xfer != NULL)
863 1.42 skrll usbd_destroy_xfer(xfer);
864 1.42 skrll }
865 1.1 nonaka }
866 1.1 nonaka }
867 1.1 nonaka
868 1.1 nonaka static void
869 1.1 nonaka urtwn_task(void *arg)
870 1.1 nonaka {
871 1.1 nonaka struct urtwn_softc *sc = arg;
872 1.1 nonaka struct urtwn_host_cmd_ring *ring = &sc->cmdq;
873 1.1 nonaka struct urtwn_host_cmd *cmd;
874 1.1 nonaka int s;
875 1.1 nonaka
876 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
877 1.1 nonaka
878 1.1 nonaka /* Process host commands. */
879 1.1 nonaka s = splusb();
880 1.1 nonaka mutex_spin_enter(&sc->sc_task_mtx);
881 1.1 nonaka while (ring->next != ring->cur) {
882 1.1 nonaka cmd = &ring->cmd[ring->next];
883 1.1 nonaka mutex_spin_exit(&sc->sc_task_mtx);
884 1.1 nonaka splx(s);
885 1.16 jmcneill /* Invoke callback with kernel lock held. */
886 1.1 nonaka cmd->cb(sc, cmd->data);
887 1.1 nonaka s = splusb();
888 1.1 nonaka mutex_spin_enter(&sc->sc_task_mtx);
889 1.1 nonaka ring->queued--;
890 1.1 nonaka ring->next = (ring->next + 1) % URTWN_HOST_CMD_RING_COUNT;
891 1.1 nonaka }
892 1.1 nonaka mutex_spin_exit(&sc->sc_task_mtx);
893 1.1 nonaka wakeup(&sc->cmdq);
894 1.1 nonaka splx(s);
895 1.1 nonaka }
896 1.1 nonaka
897 1.1 nonaka static void
898 1.59.2.1 phil urtwn_do_async(struct urtwn_softc *sc, void (*cb)(struct urtwn_softc*, void *),
899 1.1 nonaka void *arg, int len)
900 1.1 nonaka {
901 1.1 nonaka struct urtwn_host_cmd_ring *ring = &sc->cmdq;
902 1.1 nonaka struct urtwn_host_cmd *cmd;
903 1.1 nonaka int s;
904 1.1 nonaka
905 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: cb=%p, arg=%p, len=%d\n",
906 1.1 nonaka device_xname(sc->sc_dev), __func__, cb, arg, len));
907 1.1 nonaka
908 1.1 nonaka s = splusb();
909 1.1 nonaka mutex_spin_enter(&sc->sc_task_mtx);
910 1.1 nonaka cmd = &ring->cmd[ring->cur];
911 1.1 nonaka cmd->cb = cb;
912 1.1 nonaka KASSERT(len <= sizeof(cmd->data));
913 1.1 nonaka memcpy(cmd->data, arg, len);
914 1.1 nonaka ring->cur = (ring->cur + 1) % URTWN_HOST_CMD_RING_COUNT;
915 1.1 nonaka
916 1.1 nonaka /* If there is no pending command already, schedule a task. */
917 1.1 nonaka if (!sc->sc_dying && ++ring->queued == 1) {
918 1.1 nonaka mutex_spin_exit(&sc->sc_task_mtx);
919 1.1 nonaka usb_add_task(sc->sc_udev, &sc->sc_task, USB_TASKQ_DRIVER);
920 1.1 nonaka } else
921 1.1 nonaka mutex_spin_exit(&sc->sc_task_mtx);
922 1.1 nonaka splx(s);
923 1.1 nonaka }
924 1.1 nonaka
925 1.1 nonaka static void
926 1.1 nonaka urtwn_wait_async(struct urtwn_softc *sc)
927 1.1 nonaka {
928 1.1 nonaka
929 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
930 1.1 nonaka
931 1.1 nonaka /* Wait for all queued asynchronous commands to complete. */
932 1.1 nonaka while (sc->cmdq.queued > 0)
933 1.1 nonaka tsleep(&sc->cmdq, 0, "endtask", 0);
934 1.1 nonaka }
935 1.1 nonaka
936 1.1 nonaka static int
937 1.1 nonaka urtwn_write_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
938 1.1 nonaka int len)
939 1.1 nonaka {
940 1.1 nonaka usb_device_request_t req;
941 1.1 nonaka usbd_status error;
942 1.1 nonaka
943 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
944 1.12 christos
945 1.1 nonaka req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
946 1.1 nonaka req.bRequest = R92C_REQ_REGS;
947 1.1 nonaka USETW(req.wValue, addr);
948 1.1 nonaka USETW(req.wIndex, 0);
949 1.1 nonaka USETW(req.wLength, len);
950 1.1 nonaka error = usbd_do_request(sc->sc_udev, &req, buf);
951 1.1 nonaka if (error != USBD_NORMAL_COMPLETION) {
952 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: error=%d: addr=0x%x, len=%d\n",
953 1.1 nonaka device_xname(sc->sc_dev), __func__, error, addr, len));
954 1.1 nonaka }
955 1.42 skrll return error;
956 1.1 nonaka }
957 1.1 nonaka
958 1.1 nonaka static void
959 1.1 nonaka urtwn_write_1(struct urtwn_softc *sc, uint16_t addr, uint8_t val)
960 1.1 nonaka {
961 1.1 nonaka
962 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
963 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
964 1.1 nonaka
965 1.1 nonaka urtwn_write_region_1(sc, addr, &val, 1);
966 1.1 nonaka }
967 1.1 nonaka
968 1.1 nonaka static void
969 1.1 nonaka urtwn_write_2(struct urtwn_softc *sc, uint16_t addr, uint16_t val)
970 1.1 nonaka {
971 1.1 nonaka uint8_t buf[2];
972 1.1 nonaka
973 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
974 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
975 1.1 nonaka
976 1.1 nonaka buf[0] = (uint8_t)val;
977 1.1 nonaka buf[1] = (uint8_t)(val >> 8);
978 1.1 nonaka urtwn_write_region_1(sc, addr, buf, 2);
979 1.1 nonaka }
980 1.1 nonaka
981 1.1 nonaka static void
982 1.1 nonaka urtwn_write_4(struct urtwn_softc *sc, uint16_t addr, uint32_t val)
983 1.1 nonaka {
984 1.1 nonaka uint8_t buf[4];
985 1.1 nonaka
986 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
987 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
988 1.1 nonaka
989 1.1 nonaka buf[0] = (uint8_t)val;
990 1.1 nonaka buf[1] = (uint8_t)(val >> 8);
991 1.1 nonaka buf[2] = (uint8_t)(val >> 16);
992 1.1 nonaka buf[3] = (uint8_t)(val >> 24);
993 1.1 nonaka urtwn_write_region_1(sc, addr, buf, 4);
994 1.1 nonaka }
995 1.1 nonaka
996 1.1 nonaka static int
997 1.1 nonaka urtwn_write_region(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf, int len)
998 1.1 nonaka {
999 1.1 nonaka
1000 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, len=0x%x\n",
1001 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, len));
1002 1.1 nonaka
1003 1.1 nonaka return urtwn_write_region_1(sc, addr, buf, len);
1004 1.1 nonaka }
1005 1.1 nonaka
1006 1.1 nonaka static int
1007 1.1 nonaka urtwn_read_region_1(struct urtwn_softc *sc, uint16_t addr, uint8_t *buf,
1008 1.1 nonaka int len)
1009 1.1 nonaka {
1010 1.1 nonaka usb_device_request_t req;
1011 1.1 nonaka usbd_status error;
1012 1.1 nonaka
1013 1.1 nonaka req.bmRequestType = UT_READ_VENDOR_DEVICE;
1014 1.1 nonaka req.bRequest = R92C_REQ_REGS;
1015 1.1 nonaka USETW(req.wValue, addr);
1016 1.1 nonaka USETW(req.wIndex, 0);
1017 1.1 nonaka USETW(req.wLength, len);
1018 1.1 nonaka error = usbd_do_request(sc->sc_udev, &req, buf);
1019 1.1 nonaka if (error != USBD_NORMAL_COMPLETION) {
1020 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: error=%d: addr=0x%x, len=%d\n",
1021 1.1 nonaka device_xname(sc->sc_dev), __func__, error, addr, len));
1022 1.1 nonaka }
1023 1.42 skrll return error;
1024 1.1 nonaka }
1025 1.1 nonaka
1026 1.1 nonaka static uint8_t
1027 1.1 nonaka urtwn_read_1(struct urtwn_softc *sc, uint16_t addr)
1028 1.1 nonaka {
1029 1.1 nonaka uint8_t val;
1030 1.1 nonaka
1031 1.1 nonaka if (urtwn_read_region_1(sc, addr, &val, 1) != USBD_NORMAL_COMPLETION)
1032 1.42 skrll return 0xff;
1033 1.1 nonaka
1034 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
1035 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
1036 1.42 skrll return val;
1037 1.1 nonaka }
1038 1.1 nonaka
1039 1.1 nonaka static uint16_t
1040 1.1 nonaka urtwn_read_2(struct urtwn_softc *sc, uint16_t addr)
1041 1.1 nonaka {
1042 1.1 nonaka uint8_t buf[2];
1043 1.1 nonaka uint16_t val;
1044 1.1 nonaka
1045 1.1 nonaka if (urtwn_read_region_1(sc, addr, buf, 2) != USBD_NORMAL_COMPLETION)
1046 1.42 skrll return 0xffff;
1047 1.1 nonaka
1048 1.1 nonaka val = LE_READ_2(&buf[0]);
1049 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
1050 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
1051 1.42 skrll return val;
1052 1.1 nonaka }
1053 1.1 nonaka
1054 1.1 nonaka static uint32_t
1055 1.1 nonaka urtwn_read_4(struct urtwn_softc *sc, uint16_t addr)
1056 1.1 nonaka {
1057 1.1 nonaka uint8_t buf[4];
1058 1.1 nonaka uint32_t val;
1059 1.1 nonaka
1060 1.1 nonaka if (urtwn_read_region_1(sc, addr, buf, 4) != USBD_NORMAL_COMPLETION)
1061 1.42 skrll return 0xffffffff;
1062 1.1 nonaka
1063 1.1 nonaka val = LE_READ_4(&buf[0]);
1064 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: addr=0x%x, val=0x%x\n",
1065 1.1 nonaka device_xname(sc->sc_dev), __func__, addr, val));
1066 1.42 skrll return val;
1067 1.1 nonaka }
1068 1.1 nonaka
1069 1.1 nonaka static int
1070 1.1 nonaka urtwn_fw_cmd(struct urtwn_softc *sc, uint8_t id, const void *buf, int len)
1071 1.1 nonaka {
1072 1.1 nonaka struct r92c_fw_cmd cmd;
1073 1.1 nonaka uint8_t *cp;
1074 1.1 nonaka int fwcur;
1075 1.1 nonaka int ntries;
1076 1.1 nonaka
1077 1.1 nonaka DPRINTFN(DBG_REG, ("%s: %s: id=%d, buf=%p, len=%d\n",
1078 1.1 nonaka device_xname(sc->sc_dev), __func__, id, buf, len));
1079 1.1 nonaka
1080 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1081 1.12 christos
1082 1.1 nonaka mutex_enter(&sc->sc_fwcmd_mtx);
1083 1.1 nonaka fwcur = sc->fwcur;
1084 1.1 nonaka sc->fwcur = (sc->fwcur + 1) % R92C_H2C_NBOX;
1085 1.1 nonaka mutex_exit(&sc->sc_fwcmd_mtx);
1086 1.1 nonaka
1087 1.1 nonaka /* Wait for current FW box to be empty. */
1088 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1089 1.1 nonaka if (!(urtwn_read_1(sc, R92C_HMETFR) & (1 << fwcur)))
1090 1.1 nonaka break;
1091 1.49 nat DELAY(10);
1092 1.1 nonaka }
1093 1.1 nonaka if (ntries == 100) {
1094 1.1 nonaka aprint_error_dev(sc->sc_dev,
1095 1.1 nonaka "could not send firmware command %d\n", id);
1096 1.42 skrll return ETIMEDOUT;
1097 1.1 nonaka }
1098 1.1 nonaka
1099 1.1 nonaka memset(&cmd, 0, sizeof(cmd));
1100 1.1 nonaka KASSERT(len <= sizeof(cmd.msg));
1101 1.1 nonaka memcpy(cmd.msg, buf, len);
1102 1.1 nonaka
1103 1.1 nonaka /* Write the first word last since that will trigger the FW. */
1104 1.1 nonaka cp = (uint8_t *)&cmd;
1105 1.49 nat cmd.id = id;
1106 1.1 nonaka if (len >= 4) {
1107 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU)) {
1108 1.49 nat cmd.id |= R92C_CMD_FLAG_EXT;
1109 1.49 nat urtwn_write_region(sc, R92C_HMEBOX_EXT(fwcur),
1110 1.49 nat &cp[1], 2);
1111 1.49 nat urtwn_write_4(sc, R92C_HMEBOX(fwcur),
1112 1.49 nat cp[0] + (cp[3] << 8) + (cp[4] << 16) +
1113 1.49 nat (cp[5] << 24));
1114 1.49 nat } else {
1115 1.49 nat urtwn_write_region(sc, R92E_HMEBOX_EXT(fwcur),
1116 1.49 nat &cp[4], 2);
1117 1.49 nat urtwn_write_4(sc, R92C_HMEBOX(fwcur),
1118 1.49 nat cp[0] + (cp[1] << 8) + (cp[2] << 16) +
1119 1.49 nat (cp[3] << 24));
1120 1.49 nat }
1121 1.1 nonaka } else {
1122 1.1 nonaka urtwn_write_region(sc, R92C_HMEBOX(fwcur), cp, len);
1123 1.1 nonaka }
1124 1.1 nonaka
1125 1.42 skrll return 0;
1126 1.1 nonaka }
1127 1.1 nonaka
1128 1.32 nonaka static __inline void
1129 1.32 nonaka urtwn_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr, uint32_t val)
1130 1.32 nonaka {
1131 1.32 nonaka
1132 1.32 nonaka sc->sc_rf_write(sc, chain, addr, val);
1133 1.32 nonaka }
1134 1.32 nonaka
1135 1.1 nonaka static void
1136 1.32 nonaka urtwn_r92c_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1137 1.32 nonaka uint32_t val)
1138 1.1 nonaka {
1139 1.1 nonaka
1140 1.1 nonaka urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1141 1.1 nonaka SM(R92C_LSSI_PARAM_ADDR, addr) | SM(R92C_LSSI_PARAM_DATA, val));
1142 1.1 nonaka }
1143 1.1 nonaka
1144 1.32 nonaka static void
1145 1.32 nonaka urtwn_r88e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1146 1.32 nonaka uint32_t val)
1147 1.32 nonaka {
1148 1.32 nonaka
1149 1.32 nonaka urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1150 1.32 nonaka SM(R88E_LSSI_PARAM_ADDR, addr) | SM(R92C_LSSI_PARAM_DATA, val));
1151 1.32 nonaka }
1152 1.32 nonaka
1153 1.49 nat static void
1154 1.49 nat urtwn_r92e_rf_write(struct urtwn_softc *sc, int chain, uint8_t addr,
1155 1.49 nat uint32_t val)
1156 1.49 nat {
1157 1.49 nat
1158 1.49 nat urtwn_bb_write(sc, R92C_LSSI_PARAM(chain),
1159 1.49 nat SM(R88E_LSSI_PARAM_ADDR, addr) | SM(R92C_LSSI_PARAM_DATA, val));
1160 1.49 nat }
1161 1.49 nat
1162 1.1 nonaka static uint32_t
1163 1.1 nonaka urtwn_rf_read(struct urtwn_softc *sc, int chain, uint8_t addr)
1164 1.1 nonaka {
1165 1.1 nonaka uint32_t reg[R92C_MAX_CHAINS], val;
1166 1.1 nonaka
1167 1.1 nonaka reg[0] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(0));
1168 1.1 nonaka if (chain != 0) {
1169 1.1 nonaka reg[chain] = urtwn_bb_read(sc, R92C_HSSI_PARAM2(chain));
1170 1.1 nonaka }
1171 1.1 nonaka
1172 1.1 nonaka urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1173 1.1 nonaka reg[0] & ~R92C_HSSI_PARAM2_READ_EDGE);
1174 1.1 nonaka DELAY(1000);
1175 1.1 nonaka
1176 1.1 nonaka urtwn_bb_write(sc, R92C_HSSI_PARAM2(chain),
1177 1.1 nonaka RW(reg[chain], R92C_HSSI_PARAM2_READ_ADDR, addr) |
1178 1.1 nonaka R92C_HSSI_PARAM2_READ_EDGE);
1179 1.1 nonaka DELAY(1000);
1180 1.1 nonaka
1181 1.1 nonaka urtwn_bb_write(sc, R92C_HSSI_PARAM2(0),
1182 1.1 nonaka reg[0] | R92C_HSSI_PARAM2_READ_EDGE);
1183 1.1 nonaka DELAY(1000);
1184 1.1 nonaka
1185 1.1 nonaka if (urtwn_bb_read(sc, R92C_HSSI_PARAM1(chain)) & R92C_HSSI_PARAM1_PI) {
1186 1.1 nonaka val = urtwn_bb_read(sc, R92C_HSPI_READBACK(chain));
1187 1.1 nonaka } else {
1188 1.1 nonaka val = urtwn_bb_read(sc, R92C_LSSI_READBACK(chain));
1189 1.1 nonaka }
1190 1.42 skrll return MS(val, R92C_LSSI_READBACK_DATA);
1191 1.1 nonaka }
1192 1.1 nonaka
1193 1.1 nonaka static int
1194 1.1 nonaka urtwn_llt_write(struct urtwn_softc *sc, uint32_t addr, uint32_t data)
1195 1.1 nonaka {
1196 1.1 nonaka int ntries;
1197 1.1 nonaka
1198 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1199 1.12 christos
1200 1.1 nonaka urtwn_write_4(sc, R92C_LLT_INIT,
1201 1.1 nonaka SM(R92C_LLT_INIT_OP, R92C_LLT_INIT_OP_WRITE) |
1202 1.1 nonaka SM(R92C_LLT_INIT_ADDR, addr) |
1203 1.1 nonaka SM(R92C_LLT_INIT_DATA, data));
1204 1.1 nonaka /* Wait for write operation to complete. */
1205 1.1 nonaka for (ntries = 0; ntries < 20; ntries++) {
1206 1.1 nonaka if (MS(urtwn_read_4(sc, R92C_LLT_INIT), R92C_LLT_INIT_OP) ==
1207 1.1 nonaka R92C_LLT_INIT_OP_NO_ACTIVE) {
1208 1.1 nonaka /* Done */
1209 1.42 skrll return 0;
1210 1.1 nonaka }
1211 1.1 nonaka DELAY(5);
1212 1.1 nonaka }
1213 1.42 skrll return ETIMEDOUT;
1214 1.1 nonaka }
1215 1.1 nonaka
1216 1.1 nonaka static uint8_t
1217 1.1 nonaka urtwn_efuse_read_1(struct urtwn_softc *sc, uint16_t addr)
1218 1.1 nonaka {
1219 1.1 nonaka uint32_t reg;
1220 1.1 nonaka int ntries;
1221 1.1 nonaka
1222 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1223 1.12 christos
1224 1.1 nonaka reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1225 1.1 nonaka reg = RW(reg, R92C_EFUSE_CTRL_ADDR, addr);
1226 1.1 nonaka reg &= ~R92C_EFUSE_CTRL_VALID;
1227 1.1 nonaka urtwn_write_4(sc, R92C_EFUSE_CTRL, reg);
1228 1.1 nonaka
1229 1.1 nonaka /* Wait for read operation to complete. */
1230 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
1231 1.1 nonaka reg = urtwn_read_4(sc, R92C_EFUSE_CTRL);
1232 1.1 nonaka if (reg & R92C_EFUSE_CTRL_VALID) {
1233 1.1 nonaka /* Done */
1234 1.42 skrll return MS(reg, R92C_EFUSE_CTRL_DATA);
1235 1.1 nonaka }
1236 1.1 nonaka DELAY(5);
1237 1.1 nonaka }
1238 1.1 nonaka aprint_error_dev(sc->sc_dev,
1239 1.1 nonaka "could not read efuse byte at address 0x%04x\n", addr);
1240 1.42 skrll return 0xff;
1241 1.1 nonaka }
1242 1.1 nonaka
1243 1.1 nonaka static void
1244 1.1 nonaka urtwn_efuse_read(struct urtwn_softc *sc)
1245 1.1 nonaka {
1246 1.1 nonaka uint8_t *rom = (uint8_t *)&sc->rom;
1247 1.1 nonaka uint32_t reg;
1248 1.1 nonaka uint16_t addr = 0;
1249 1.1 nonaka uint8_t off, msk;
1250 1.22 christos size_t i;
1251 1.1 nonaka
1252 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1253 1.1 nonaka
1254 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1255 1.12 christos
1256 1.32 nonaka urtwn_efuse_switch_power(sc);
1257 1.32 nonaka
1258 1.1 nonaka memset(&sc->rom, 0xff, sizeof(sc->rom));
1259 1.1 nonaka while (addr < 512) {
1260 1.1 nonaka reg = urtwn_efuse_read_1(sc, addr);
1261 1.1 nonaka if (reg == 0xff)
1262 1.1 nonaka break;
1263 1.1 nonaka addr++;
1264 1.1 nonaka off = reg >> 4;
1265 1.1 nonaka msk = reg & 0xf;
1266 1.1 nonaka for (i = 0; i < 4; i++) {
1267 1.1 nonaka if (msk & (1U << i))
1268 1.1 nonaka continue;
1269 1.1 nonaka
1270 1.1 nonaka rom[off * 8 + i * 2 + 0] = urtwn_efuse_read_1(sc, addr);
1271 1.1 nonaka addr++;
1272 1.1 nonaka rom[off * 8 + i * 2 + 1] = urtwn_efuse_read_1(sc, addr);
1273 1.1 nonaka addr++;
1274 1.1 nonaka }
1275 1.1 nonaka }
1276 1.1 nonaka #ifdef URTWN_DEBUG
1277 1.1 nonaka if (urtwn_debug & DBG_INIT) {
1278 1.1 nonaka /* Dump ROM content. */
1279 1.1 nonaka printf("%s: %s", device_xname(sc->sc_dev), __func__);
1280 1.1 nonaka for (i = 0; i < (int)sizeof(sc->rom); i++)
1281 1.1 nonaka printf(":%02x", rom[i]);
1282 1.1 nonaka printf("\n");
1283 1.1 nonaka }
1284 1.1 nonaka #endif
1285 1.1 nonaka }
1286 1.1 nonaka
1287 1.32 nonaka static void
1288 1.32 nonaka urtwn_efuse_switch_power(struct urtwn_softc *sc)
1289 1.32 nonaka {
1290 1.32 nonaka uint32_t reg;
1291 1.32 nonaka
1292 1.32 nonaka reg = urtwn_read_2(sc, R92C_SYS_ISO_CTRL);
1293 1.32 nonaka if (!(reg & R92C_SYS_ISO_CTRL_PWC_EV12V)) {
1294 1.32 nonaka urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
1295 1.32 nonaka reg | R92C_SYS_ISO_CTRL_PWC_EV12V);
1296 1.32 nonaka }
1297 1.32 nonaka reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
1298 1.32 nonaka if (!(reg & R92C_SYS_FUNC_EN_ELDR)) {
1299 1.32 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN,
1300 1.32 nonaka reg | R92C_SYS_FUNC_EN_ELDR);
1301 1.32 nonaka }
1302 1.32 nonaka reg = urtwn_read_2(sc, R92C_SYS_CLKR);
1303 1.32 nonaka if ((reg & (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) !=
1304 1.32 nonaka (R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M)) {
1305 1.32 nonaka urtwn_write_2(sc, R92C_SYS_CLKR,
1306 1.32 nonaka reg | R92C_SYS_CLKR_LOADER_EN | R92C_SYS_CLKR_ANA8M);
1307 1.32 nonaka }
1308 1.32 nonaka }
1309 1.32 nonaka
1310 1.1 nonaka static int
1311 1.1 nonaka urtwn_read_chipid(struct urtwn_softc *sc)
1312 1.1 nonaka {
1313 1.1 nonaka uint32_t reg;
1314 1.1 nonaka
1315 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1316 1.1 nonaka
1317 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
1318 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
1319 1.42 skrll return 0;
1320 1.32 nonaka
1321 1.1 nonaka reg = urtwn_read_4(sc, R92C_SYS_CFG);
1322 1.1 nonaka if (reg & R92C_SYS_CFG_TRP_VAUX_EN) {
1323 1.1 nonaka /* test chip, not supported */
1324 1.42 skrll return EIO;
1325 1.1 nonaka }
1326 1.1 nonaka if (reg & R92C_SYS_CFG_TYPE_92C) {
1327 1.1 nonaka sc->chip |= URTWN_CHIP_92C;
1328 1.1 nonaka /* Check if it is a castrated 8192C. */
1329 1.1 nonaka if (MS(urtwn_read_4(sc, R92C_HPON_FSM),
1330 1.1 nonaka R92C_HPON_FSM_CHIP_BONDING_ID) ==
1331 1.1 nonaka R92C_HPON_FSM_CHIP_BONDING_ID_92C_1T2R) {
1332 1.1 nonaka sc->chip |= URTWN_CHIP_92C_1T2R;
1333 1.1 nonaka }
1334 1.1 nonaka }
1335 1.1 nonaka if (reg & R92C_SYS_CFG_VENDOR_UMC) {
1336 1.1 nonaka sc->chip |= URTWN_CHIP_UMC;
1337 1.1 nonaka if (MS(reg, R92C_SYS_CFG_CHIP_VER_RTL) == 0) {
1338 1.1 nonaka sc->chip |= URTWN_CHIP_UMC_A_CUT;
1339 1.1 nonaka }
1340 1.1 nonaka }
1341 1.42 skrll return 0;
1342 1.1 nonaka }
1343 1.1 nonaka
1344 1.1 nonaka #ifdef URTWN_DEBUG
1345 1.1 nonaka static void
1346 1.1 nonaka urtwn_dump_rom(struct urtwn_softc *sc, struct r92c_rom *rp)
1347 1.1 nonaka {
1348 1.1 nonaka
1349 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1350 1.1 nonaka "id 0x%04x, dbg_sel 0x%x, vid 0x%x, pid 0x%x\n",
1351 1.1 nonaka rp->id, rp->dbg_sel, rp->vid, rp->pid);
1352 1.1 nonaka
1353 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1354 1.1 nonaka "usb_opt 0x%x, ep_setting 0x%x, usb_phy 0x%x\n",
1355 1.1 nonaka rp->usb_opt, rp->ep_setting, rp->usb_phy);
1356 1.1 nonaka
1357 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1358 1.1 nonaka "macaddr %02x:%02x:%02x:%02x:%02x:%02x\n",
1359 1.1 nonaka rp->macaddr[0], rp->macaddr[1],
1360 1.1 nonaka rp->macaddr[2], rp->macaddr[3],
1361 1.1 nonaka rp->macaddr[4], rp->macaddr[5]);
1362 1.1 nonaka
1363 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1364 1.1 nonaka "string %s, subcustomer_id 0x%x\n",
1365 1.1 nonaka rp->string, rp->subcustomer_id);
1366 1.1 nonaka
1367 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1368 1.1 nonaka "cck_tx_pwr c0: %d %d %d, c1: %d %d %d\n",
1369 1.1 nonaka rp->cck_tx_pwr[0][0], rp->cck_tx_pwr[0][1], rp->cck_tx_pwr[0][2],
1370 1.1 nonaka rp->cck_tx_pwr[1][0], rp->cck_tx_pwr[1][1], rp->cck_tx_pwr[1][2]);
1371 1.1 nonaka
1372 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1373 1.1 nonaka "ht40_1s_tx_pwr c0 %d %d %d, c1 %d %d %d\n",
1374 1.1 nonaka rp->ht40_1s_tx_pwr[0][0], rp->ht40_1s_tx_pwr[0][1],
1375 1.1 nonaka rp->ht40_1s_tx_pwr[0][2],
1376 1.1 nonaka rp->ht40_1s_tx_pwr[1][0], rp->ht40_1s_tx_pwr[1][1],
1377 1.1 nonaka rp->ht40_1s_tx_pwr[1][2]);
1378 1.1 nonaka
1379 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1380 1.1 nonaka "ht40_2s_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
1381 1.1 nonaka rp->ht40_2s_tx_pwr_diff[0] & 0xf, rp->ht40_2s_tx_pwr_diff[1] & 0xf,
1382 1.1 nonaka rp->ht40_2s_tx_pwr_diff[2] & 0xf,
1383 1.1 nonaka rp->ht40_2s_tx_pwr_diff[0] >> 4, rp->ht40_2s_tx_pwr_diff[1] & 0xf,
1384 1.1 nonaka rp->ht40_2s_tx_pwr_diff[2] >> 4);
1385 1.1 nonaka
1386 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1387 1.1 nonaka "ht20_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
1388 1.1 nonaka rp->ht20_tx_pwr_diff[0] & 0xf, rp->ht20_tx_pwr_diff[1] & 0xf,
1389 1.1 nonaka rp->ht20_tx_pwr_diff[2] & 0xf,
1390 1.1 nonaka rp->ht20_tx_pwr_diff[0] >> 4, rp->ht20_tx_pwr_diff[1] >> 4,
1391 1.1 nonaka rp->ht20_tx_pwr_diff[2] >> 4);
1392 1.1 nonaka
1393 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1394 1.1 nonaka "ofdm_tx_pwr_diff c0: %d %d %d, c1: %d %d %d\n",
1395 1.1 nonaka rp->ofdm_tx_pwr_diff[0] & 0xf, rp->ofdm_tx_pwr_diff[1] & 0xf,
1396 1.1 nonaka rp->ofdm_tx_pwr_diff[2] & 0xf,
1397 1.1 nonaka rp->ofdm_tx_pwr_diff[0] >> 4, rp->ofdm_tx_pwr_diff[1] >> 4,
1398 1.1 nonaka rp->ofdm_tx_pwr_diff[2] >> 4);
1399 1.1 nonaka
1400 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1401 1.1 nonaka "ht40_max_pwr_offset c0: %d %d %d, c1: %d %d %d\n",
1402 1.1 nonaka rp->ht40_max_pwr[0] & 0xf, rp->ht40_max_pwr[1] & 0xf,
1403 1.1 nonaka rp->ht40_max_pwr[2] & 0xf,
1404 1.1 nonaka rp->ht40_max_pwr[0] >> 4, rp->ht40_max_pwr[1] >> 4,
1405 1.1 nonaka rp->ht40_max_pwr[2] >> 4);
1406 1.1 nonaka
1407 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1408 1.1 nonaka "ht20_max_pwr_offset c0: %d %d %d, c1: %d %d %d\n",
1409 1.1 nonaka rp->ht20_max_pwr[0] & 0xf, rp->ht20_max_pwr[1] & 0xf,
1410 1.1 nonaka rp->ht20_max_pwr[2] & 0xf,
1411 1.1 nonaka rp->ht20_max_pwr[0] >> 4, rp->ht20_max_pwr[1] >> 4,
1412 1.1 nonaka rp->ht20_max_pwr[2] >> 4);
1413 1.1 nonaka
1414 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1415 1.1 nonaka "xtal_calib %d, tssi %d %d, thermal %d\n",
1416 1.1 nonaka rp->xtal_calib, rp->tssi[0], rp->tssi[1], rp->thermal_meter);
1417 1.1 nonaka
1418 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1419 1.1 nonaka "rf_opt1 0x%x, rf_opt2 0x%x, rf_opt3 0x%x, rf_opt4 0x%x\n",
1420 1.1 nonaka rp->rf_opt1, rp->rf_opt2, rp->rf_opt3, rp->rf_opt4);
1421 1.1 nonaka
1422 1.1 nonaka aprint_normal_dev(sc->sc_dev,
1423 1.1 nonaka "channnel_plan %d, version %d customer_id 0x%x\n",
1424 1.1 nonaka rp->channel_plan, rp->version, rp->curstomer_id);
1425 1.1 nonaka }
1426 1.1 nonaka #endif
1427 1.1 nonaka
1428 1.1 nonaka static void
1429 1.1 nonaka urtwn_read_rom(struct urtwn_softc *sc)
1430 1.1 nonaka {
1431 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1432 1.1 nonaka struct r92c_rom *rom = &sc->rom;
1433 1.1 nonaka
1434 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1435 1.1 nonaka
1436 1.12 christos mutex_enter(&sc->sc_write_mtx);
1437 1.12 christos
1438 1.1 nonaka /* Read full ROM image. */
1439 1.1 nonaka urtwn_efuse_read(sc);
1440 1.1 nonaka #ifdef URTWN_DEBUG
1441 1.1 nonaka if (urtwn_debug & DBG_REG)
1442 1.1 nonaka urtwn_dump_rom(sc, rom);
1443 1.1 nonaka #endif
1444 1.1 nonaka
1445 1.1 nonaka /* XXX Weird but this is what the vendor driver does. */
1446 1.1 nonaka sc->pa_setting = urtwn_efuse_read_1(sc, 0x1fa);
1447 1.1 nonaka sc->board_type = MS(rom->rf_opt1, R92C_ROM_RF1_BOARD_TYPE);
1448 1.1 nonaka sc->regulatory = MS(rom->rf_opt1, R92C_ROM_RF1_REGULATORY);
1449 1.1 nonaka
1450 1.1 nonaka DPRINTFN(DBG_INIT,
1451 1.1 nonaka ("%s: %s: PA setting=0x%x, board=0x%x, regulatory=%d\n",
1452 1.1 nonaka device_xname(sc->sc_dev), __func__, sc->pa_setting,
1453 1.1 nonaka sc->board_type, sc->regulatory));
1454 1.1 nonaka
1455 1.59.2.1 phil IEEE80211_ADDR_COPY(ic->ic_macaddr, rom->macaddr);
1456 1.12 christos
1457 1.32 nonaka sc->sc_rf_write = urtwn_r92c_rf_write;
1458 1.32 nonaka sc->sc_power_on = urtwn_r92c_power_on;
1459 1.32 nonaka sc->sc_dma_init = urtwn_r92c_dma_init;
1460 1.32 nonaka
1461 1.32 nonaka mutex_exit(&sc->sc_write_mtx);
1462 1.32 nonaka }
1463 1.32 nonaka
1464 1.32 nonaka static void
1465 1.32 nonaka urtwn_r88e_read_rom(struct urtwn_softc *sc)
1466 1.32 nonaka {
1467 1.32 nonaka struct ieee80211com *ic = &sc->sc_ic;
1468 1.32 nonaka uint8_t *rom = sc->r88e_rom;
1469 1.32 nonaka uint32_t reg;
1470 1.32 nonaka uint16_t addr = 0;
1471 1.32 nonaka uint8_t off, msk, tmp;
1472 1.32 nonaka int i;
1473 1.32 nonaka
1474 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1475 1.32 nonaka
1476 1.32 nonaka mutex_enter(&sc->sc_write_mtx);
1477 1.32 nonaka
1478 1.32 nonaka off = 0;
1479 1.32 nonaka urtwn_efuse_switch_power(sc);
1480 1.32 nonaka
1481 1.32 nonaka /* Read full ROM image. */
1482 1.32 nonaka memset(&sc->r88e_rom, 0xff, sizeof(sc->r88e_rom));
1483 1.49 nat while (addr < 4096) {
1484 1.32 nonaka reg = urtwn_efuse_read_1(sc, addr);
1485 1.32 nonaka if (reg == 0xff)
1486 1.32 nonaka break;
1487 1.32 nonaka addr++;
1488 1.32 nonaka if ((reg & 0x1f) == 0x0f) {
1489 1.32 nonaka tmp = (reg & 0xe0) >> 5;
1490 1.32 nonaka reg = urtwn_efuse_read_1(sc, addr);
1491 1.32 nonaka if ((reg & 0x0f) != 0x0f)
1492 1.32 nonaka off = ((reg & 0xf0) >> 1) | tmp;
1493 1.32 nonaka addr++;
1494 1.32 nonaka } else
1495 1.32 nonaka off = reg >> 4;
1496 1.32 nonaka msk = reg & 0xf;
1497 1.32 nonaka for (i = 0; i < 4; i++) {
1498 1.32 nonaka if (msk & (1 << i))
1499 1.32 nonaka continue;
1500 1.32 nonaka rom[off * 8 + i * 2 + 0] = urtwn_efuse_read_1(sc, addr);
1501 1.32 nonaka addr++;
1502 1.32 nonaka rom[off * 8 + i * 2 + 1] = urtwn_efuse_read_1(sc, addr);
1503 1.32 nonaka addr++;
1504 1.32 nonaka }
1505 1.32 nonaka }
1506 1.32 nonaka #ifdef URTWN_DEBUG
1507 1.32 nonaka if (urtwn_debug & DBG_REG) {
1508 1.32 nonaka }
1509 1.32 nonaka #endif
1510 1.32 nonaka
1511 1.32 nonaka addr = 0x10;
1512 1.32 nonaka for (i = 0; i < 6; i++)
1513 1.32 nonaka sc->cck_tx_pwr[i] = sc->r88e_rom[addr++];
1514 1.32 nonaka for (i = 0; i < 5; i++)
1515 1.32 nonaka sc->ht40_tx_pwr[i] = sc->r88e_rom[addr++];
1516 1.32 nonaka sc->bw20_tx_pwr_diff = (sc->r88e_rom[addr] & 0xf0) >> 4;
1517 1.32 nonaka if (sc->bw20_tx_pwr_diff & 0x08)
1518 1.32 nonaka sc->bw20_tx_pwr_diff |= 0xf0;
1519 1.32 nonaka sc->ofdm_tx_pwr_diff = (sc->r88e_rom[addr] & 0xf);
1520 1.32 nonaka if (sc->ofdm_tx_pwr_diff & 0x08)
1521 1.32 nonaka sc->ofdm_tx_pwr_diff |= 0xf0;
1522 1.32 nonaka sc->regulatory = MS(sc->r88e_rom[0xc1], R92C_ROM_RF1_REGULATORY);
1523 1.32 nonaka
1524 1.59.2.1 phil IEEE80211_ADDR_COPY(ic->ic_macaddr, &sc->r88e_rom[0xd7]);
1525 1.32 nonaka
1526 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
1527 1.49 nat sc->sc_power_on = urtwn_r92e_power_on;
1528 1.49 nat sc->sc_rf_write = urtwn_r92e_rf_write;
1529 1.49 nat } else {
1530 1.49 nat sc->sc_power_on = urtwn_r88e_power_on;
1531 1.49 nat sc->sc_rf_write = urtwn_r88e_rf_write;
1532 1.49 nat }
1533 1.32 nonaka sc->sc_dma_init = urtwn_r88e_dma_init;
1534 1.32 nonaka
1535 1.12 christos mutex_exit(&sc->sc_write_mtx);
1536 1.1 nonaka }
1537 1.1 nonaka
1538 1.59.2.5 phil /* NNN Do we need to do something with this? */
1539 1.59.2.5 phil
1540 1.59.2.1 phil static __unused int
1541 1.1 nonaka urtwn_media_change(struct ifnet *ifp)
1542 1.1 nonaka {
1543 1.1 nonaka #ifdef URTWN_DEBUG
1544 1.59.2.3 phil struct ieee80211vap *vap = ifp->if_softc;
1545 1.59.2.3 phil struct urtwn_softc *sc = vap->iv_ic->ic_softc;
1546 1.1 nonaka #endif
1547 1.1 nonaka int error;
1548 1.1 nonaka
1549 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1550 1.1 nonaka
1551 1.1 nonaka if ((error = ieee80211_media_change(ifp)) != ENETRESET)
1552 1.42 skrll return error;
1553 1.1 nonaka
1554 1.1 nonaka if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
1555 1.1 nonaka (IFF_UP | IFF_RUNNING)) {
1556 1.1 nonaka urtwn_init(ifp);
1557 1.1 nonaka }
1558 1.42 skrll return 0;
1559 1.1 nonaka }
1560 1.1 nonaka
1561 1.1 nonaka /*
1562 1.1 nonaka * Initialize rate adaptation in firmware.
1563 1.1 nonaka */
1564 1.1 nonaka static int
1565 1.59.2.4 phil urtwn_ra_init(struct ieee80211vap *vap)
1566 1.1 nonaka {
1567 1.1 nonaka static const uint8_t map[] = {
1568 1.1 nonaka 2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108
1569 1.1 nonaka };
1570 1.59.2.4 phil struct ieee80211com *ic = vap->iv_ic;
1571 1.59.2.4 phil struct urtwn_softc *sc = ic->ic_softc;
1572 1.59.2.4 phil struct ieee80211_node *ni = vap->iv_bss;
1573 1.1 nonaka struct ieee80211_rateset *rs = &ni->ni_rates;
1574 1.59.2.4 phil
1575 1.1 nonaka struct r92c_fw_cmd_macid_cfg cmd;
1576 1.1 nonaka uint32_t rates, basicrates;
1577 1.49 nat uint32_t mask, rrsr_mask, rrsr_rate;
1578 1.1 nonaka uint8_t mode;
1579 1.22 christos size_t maxrate, maxbasicrate, i, j;
1580 1.22 christos int error;
1581 1.1 nonaka
1582 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1583 1.1 nonaka
1584 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1585 1.12 christos
1586 1.1 nonaka /* Get normal and basic rates mask. */
1587 1.49 nat rates = basicrates = 1;
1588 1.1 nonaka maxrate = maxbasicrate = 0;
1589 1.1 nonaka for (i = 0; i < rs->rs_nrates; i++) {
1590 1.1 nonaka /* Convert 802.11 rate to HW rate index. */
1591 1.22 christos for (j = 0; j < __arraycount(map); j++) {
1592 1.1 nonaka if ((rs->rs_rates[i] & IEEE80211_RATE_VAL) == map[j]) {
1593 1.1 nonaka break;
1594 1.1 nonaka }
1595 1.1 nonaka }
1596 1.1 nonaka if (j == __arraycount(map)) {
1597 1.1 nonaka /* Unknown rate, skip. */
1598 1.1 nonaka continue;
1599 1.1 nonaka }
1600 1.1 nonaka
1601 1.1 nonaka rates |= 1U << j;
1602 1.1 nonaka if (j > maxrate) {
1603 1.1 nonaka maxrate = j;
1604 1.1 nonaka }
1605 1.1 nonaka
1606 1.1 nonaka if (rs->rs_rates[i] & IEEE80211_RATE_BASIC) {
1607 1.1 nonaka basicrates |= 1U << j;
1608 1.1 nonaka if (j > maxbasicrate) {
1609 1.1 nonaka maxbasicrate = j;
1610 1.1 nonaka }
1611 1.1 nonaka }
1612 1.1 nonaka }
1613 1.1 nonaka if (ic->ic_curmode == IEEE80211_MODE_11B) {
1614 1.1 nonaka mode = R92C_RAID_11B;
1615 1.1 nonaka } else {
1616 1.1 nonaka mode = R92C_RAID_11BG;
1617 1.1 nonaka }
1618 1.1 nonaka DPRINTFN(DBG_INIT, ("%s: %s: mode=0x%x rates=0x%x, basicrates=0x%x, "
1619 1.22 christos "maxrate=%zx, maxbasicrate=%zx\n",
1620 1.1 nonaka device_xname(sc->sc_dev), __func__, mode, rates, basicrates,
1621 1.1 nonaka maxrate, maxbasicrate));
1622 1.49 nat
1623 1.59.2.4 phil if (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE) {
1624 1.49 nat maxbasicrate |= R92C_RATE_SHORTGI;
1625 1.49 nat maxrate |= R92C_RATE_SHORTGI;
1626 1.59.2.4 phil }
1627 1.1 nonaka
1628 1.1 nonaka /* Set rates mask for group addressed frames. */
1629 1.1 nonaka cmd.macid = URTWN_MACID_BC | URTWN_MACID_VALID;
1630 1.59.2.4 phil if (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)
1631 1.49 nat cmd.macid |= URTWN_MACID_SHORTGI;
1632 1.49 nat
1633 1.1 nonaka mask = (mode << 28) | basicrates;
1634 1.1 nonaka cmd.mask[0] = (uint8_t)mask;
1635 1.1 nonaka cmd.mask[1] = (uint8_t)(mask >> 8);
1636 1.1 nonaka cmd.mask[2] = (uint8_t)(mask >> 16);
1637 1.1 nonaka cmd.mask[3] = (uint8_t)(mask >> 24);
1638 1.1 nonaka error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
1639 1.1 nonaka if (error != 0) {
1640 1.1 nonaka aprint_error_dev(sc->sc_dev,
1641 1.1 nonaka "could not add broadcast station\n");
1642 1.42 skrll return error;
1643 1.1 nonaka }
1644 1.1 nonaka /* Set initial MRR rate. */
1645 1.22 christos DPRINTFN(DBG_INIT, ("%s: %s: maxbasicrate=%zd\n",
1646 1.1 nonaka device_xname(sc->sc_dev), __func__, maxbasicrate));
1647 1.1 nonaka urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BC), maxbasicrate);
1648 1.1 nonaka
1649 1.1 nonaka /* Set rates mask for unicast frames. */
1650 1.1 nonaka cmd.macid = URTWN_MACID_BSS | URTWN_MACID_VALID;
1651 1.59.2.4 phil if (ni->ni_capinfo & IEEE80211_CAPINFO_SHORT_PREAMBLE)
1652 1.49 nat cmd.macid |= URTWN_MACID_SHORTGI;
1653 1.49 nat
1654 1.1 nonaka mask = (mode << 28) | rates;
1655 1.1 nonaka cmd.mask[0] = (uint8_t)mask;
1656 1.1 nonaka cmd.mask[1] = (uint8_t)(mask >> 8);
1657 1.1 nonaka cmd.mask[2] = (uint8_t)(mask >> 16);
1658 1.1 nonaka cmd.mask[3] = (uint8_t)(mask >> 24);
1659 1.1 nonaka error = urtwn_fw_cmd(sc, R92C_CMD_MACID_CONFIG, &cmd, sizeof(cmd));
1660 1.1 nonaka if (error != 0) {
1661 1.1 nonaka aprint_error_dev(sc->sc_dev, "could not add BSS station\n");
1662 1.42 skrll return error;
1663 1.1 nonaka }
1664 1.1 nonaka /* Set initial MRR rate. */
1665 1.22 christos DPRINTFN(DBG_INIT, ("%s: %s: maxrate=%zd\n", device_xname(sc->sc_dev),
1666 1.1 nonaka __func__, maxrate));
1667 1.1 nonaka urtwn_write_1(sc, R92C_INIDATA_RATE_SEL(URTWN_MACID_BSS), maxrate);
1668 1.1 nonaka
1669 1.59.2.1 phil #if notyet
1670 1.59.2.1 phil /* NNN appears to have no fixed rate anywhere. */
1671 1.49 nat rrsr_rate = ic->ic_fixed_rate;
1672 1.49 nat if (rrsr_rate == -1)
1673 1.59.2.1 phil #endif
1674 1.49 nat rrsr_rate = 11;
1675 1.49 nat
1676 1.49 nat rrsr_mask = 0xffff >> (15 - rrsr_rate);
1677 1.49 nat urtwn_write_2(sc, R92C_RRSR, rrsr_mask);
1678 1.49 nat
1679 1.59.2.1 phil #if notyet
1680 1.1 nonaka /* Indicate highest supported rate. */
1681 1.1 nonaka ni->ni_txrate = rs->rs_nrates - 1;
1682 1.59.2.1 phil #endif
1683 1.42 skrll return 0;
1684 1.1 nonaka }
1685 1.1 nonaka
1686 1.1 nonaka static int
1687 1.1 nonaka urtwn_get_nettype(struct urtwn_softc *sc)
1688 1.1 nonaka {
1689 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1690 1.1 nonaka int type;
1691 1.1 nonaka
1692 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1693 1.1 nonaka
1694 1.1 nonaka switch (ic->ic_opmode) {
1695 1.1 nonaka case IEEE80211_M_STA:
1696 1.1 nonaka type = R92C_CR_NETTYPE_INFRA;
1697 1.1 nonaka break;
1698 1.1 nonaka
1699 1.1 nonaka case IEEE80211_M_IBSS:
1700 1.1 nonaka type = R92C_CR_NETTYPE_ADHOC;
1701 1.1 nonaka break;
1702 1.1 nonaka
1703 1.1 nonaka default:
1704 1.1 nonaka type = R92C_CR_NETTYPE_NOLINK;
1705 1.1 nonaka break;
1706 1.1 nonaka }
1707 1.1 nonaka
1708 1.42 skrll return type;
1709 1.1 nonaka }
1710 1.1 nonaka
1711 1.1 nonaka static void
1712 1.1 nonaka urtwn_set_nettype0_msr(struct urtwn_softc *sc, uint8_t type)
1713 1.1 nonaka {
1714 1.1 nonaka uint8_t reg;
1715 1.1 nonaka
1716 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: type=%d\n", device_xname(sc->sc_dev),
1717 1.1 nonaka __func__, type));
1718 1.1 nonaka
1719 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1720 1.12 christos
1721 1.1 nonaka reg = urtwn_read_1(sc, R92C_CR + 2) & 0x0c;
1722 1.1 nonaka urtwn_write_1(sc, R92C_CR + 2, reg | type);
1723 1.1 nonaka }
1724 1.1 nonaka
1725 1.1 nonaka static void
1726 1.1 nonaka urtwn_tsf_sync_enable(struct urtwn_softc *sc)
1727 1.1 nonaka {
1728 1.59.2.4 phil struct ieee80211vap *vap = TAILQ_FIRST(&sc->sc_ic.ic_vaps);
1729 1.59.2.4 phil struct ieee80211_node *ni = vap->iv_bss;
1730 1.1 nonaka uint64_t tsf;
1731 1.1 nonaka
1732 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1733 1.1 nonaka
1734 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1735 1.12 christos
1736 1.1 nonaka /* Enable TSF synchronization. */
1737 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
1738 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_DIS_TSF_UDT0);
1739 1.1 nonaka
1740 1.1 nonaka /* Correct TSF */
1741 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
1742 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) & ~R92C_BCN_CTRL_EN_BCN);
1743 1.1 nonaka
1744 1.1 nonaka /* Set initial TSF. */
1745 1.1 nonaka tsf = ni->ni_tstamp.tsf;
1746 1.1 nonaka tsf = le64toh(tsf);
1747 1.1 nonaka tsf = tsf - (tsf % (ni->ni_intval * IEEE80211_DUR_TU));
1748 1.1 nonaka tsf -= IEEE80211_DUR_TU;
1749 1.1 nonaka urtwn_write_4(sc, R92C_TSFTR + 0, (uint32_t)tsf);
1750 1.1 nonaka urtwn_write_4(sc, R92C_TSFTR + 4, (uint32_t)(tsf >> 32));
1751 1.1 nonaka
1752 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
1753 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) | R92C_BCN_CTRL_EN_BCN);
1754 1.1 nonaka }
1755 1.1 nonaka
1756 1.1 nonaka static void
1757 1.1 nonaka urtwn_set_led(struct urtwn_softc *sc, int led, int on)
1758 1.1 nonaka {
1759 1.1 nonaka uint8_t reg;
1760 1.1 nonaka
1761 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: led=%d, on=%d\n", device_xname(sc->sc_dev),
1762 1.1 nonaka __func__, led, on));
1763 1.1 nonaka
1764 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
1765 1.12 christos
1766 1.1 nonaka if (led == URTWN_LED_LINK) {
1767 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
1768 1.49 nat urtwn_write_1(sc, 0x64, urtwn_read_1(sc, 0x64) & 0xfe);
1769 1.49 nat reg = urtwn_read_1(sc, R92C_LEDCFG1) & R92E_LEDSON;
1770 1.49 nat urtwn_write_1(sc, R92C_LEDCFG1, reg |
1771 1.49 nat (R92C_LEDCFG0_DIS << 1));
1772 1.49 nat if (on) {
1773 1.49 nat reg = urtwn_read_1(sc, R92C_LEDCFG1) &
1774 1.49 nat R92E_LEDSON;
1775 1.49 nat urtwn_write_1(sc, R92C_LEDCFG1, reg);
1776 1.49 nat }
1777 1.49 nat } else if (ISSET(sc->chip, URTWN_CHIP_88E)) {
1778 1.32 nonaka reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0xf0;
1779 1.32 nonaka urtwn_write_1(sc, R92C_LEDCFG2, reg | 0x60);
1780 1.32 nonaka if (!on) {
1781 1.32 nonaka reg = urtwn_read_1(sc, R92C_LEDCFG2) & 0x90;
1782 1.32 nonaka urtwn_write_1(sc, R92C_LEDCFG2,
1783 1.32 nonaka reg | R92C_LEDCFG0_DIS);
1784 1.32 nonaka reg = urtwn_read_1(sc, R92C_MAC_PINMUX_CFG);
1785 1.32 nonaka urtwn_write_1(sc, R92C_MAC_PINMUX_CFG,
1786 1.32 nonaka reg & 0xfe);
1787 1.32 nonaka }
1788 1.32 nonaka } else {
1789 1.32 nonaka reg = urtwn_read_1(sc, R92C_LEDCFG0) & 0x70;
1790 1.32 nonaka if (!on) {
1791 1.32 nonaka reg |= R92C_LEDCFG0_DIS;
1792 1.32 nonaka }
1793 1.32 nonaka urtwn_write_1(sc, R92C_LEDCFG0, reg);
1794 1.1 nonaka }
1795 1.1 nonaka sc->ledlink = on; /* Save LED state. */
1796 1.1 nonaka }
1797 1.1 nonaka }
1798 1.1 nonaka
1799 1.1 nonaka static void
1800 1.1 nonaka urtwn_calib_to(void *arg)
1801 1.1 nonaka {
1802 1.1 nonaka struct urtwn_softc *sc = arg;
1803 1.59.2.1 phil struct ieee80211vap *vap = TAILQ_FIRST(&(sc->sc_ic.ic_vaps));
1804 1.1 nonaka
1805 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1806 1.1 nonaka
1807 1.1 nonaka if (sc->sc_dying)
1808 1.1 nonaka return;
1809 1.1 nonaka
1810 1.1 nonaka /* Do it in a process context. */
1811 1.59.2.1 phil urtwn_do_async(sc, urtwn_calib_to_cb, vap, sizeof(struct ieee80211vap *));
1812 1.1 nonaka }
1813 1.1 nonaka
1814 1.1 nonaka /* ARGSUSED */
1815 1.1 nonaka static void
1816 1.1 nonaka urtwn_calib_to_cb(struct urtwn_softc *sc, void *arg)
1817 1.1 nonaka {
1818 1.59.2.1 phil struct ieee80211vap *vap = arg;
1819 1.1 nonaka struct r92c_fw_cmd_rssi cmd;
1820 1.49 nat struct r92e_fw_cmd_rssi cmde;
1821 1.1 nonaka
1822 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1823 1.1 nonaka
1824 1.59.2.1 phil if (vap->iv_state != IEEE80211_S_RUN)
1825 1.1 nonaka goto restart_timer;
1826 1.1 nonaka
1827 1.12 christos mutex_enter(&sc->sc_write_mtx);
1828 1.1 nonaka if (sc->avg_pwdb != -1) {
1829 1.1 nonaka /* Indicate Rx signal strength to FW for rate adaptation. */
1830 1.1 nonaka memset(&cmd, 0, sizeof(cmd));
1831 1.49 nat memset(&cmde, 0, sizeof(cmde));
1832 1.1 nonaka cmd.macid = 0; /* BSS. */
1833 1.49 nat cmde.macid = 0; /* BSS. */
1834 1.1 nonaka cmd.pwdb = sc->avg_pwdb;
1835 1.49 nat cmde.pwdb = sc->avg_pwdb;
1836 1.1 nonaka DPRINTFN(DBG_RF, ("%s: %s: sending RSSI command avg=%d\n",
1837 1.1 nonaka device_xname(sc->sc_dev), __func__, sc->avg_pwdb));
1838 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU)) {
1839 1.49 nat urtwn_fw_cmd(sc, R92C_CMD_RSSI_SETTING, &cmd,
1840 1.49 nat sizeof(cmd));
1841 1.49 nat } else {
1842 1.49 nat urtwn_fw_cmd(sc, R92E_CMD_RSSI_REPORT, &cmde,
1843 1.49 nat sizeof(cmde));
1844 1.49 nat }
1845 1.1 nonaka }
1846 1.1 nonaka
1847 1.1 nonaka /* Do temperature compensation. */
1848 1.1 nonaka urtwn_temp_calib(sc);
1849 1.12 christos mutex_exit(&sc->sc_write_mtx);
1850 1.1 nonaka
1851 1.1 nonaka restart_timer:
1852 1.1 nonaka if (!sc->sc_dying) {
1853 1.1 nonaka /* Restart calibration timer. */
1854 1.1 nonaka callout_schedule(&sc->sc_calib_to, hz);
1855 1.1 nonaka }
1856 1.1 nonaka }
1857 1.1 nonaka
1858 1.1 nonaka static void
1859 1.1 nonaka urtwn_next_scan(void *arg)
1860 1.1 nonaka {
1861 1.59.2.5 phil printf ("NNN urtwn_next_scan called....\n");
1862 1.59.2.1 phil #ifdef notyet
1863 1.1 nonaka struct urtwn_softc *sc = arg;
1864 1.16 jmcneill int s;
1865 1.1 nonaka
1866 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
1867 1.1 nonaka
1868 1.1 nonaka if (sc->sc_dying)
1869 1.1 nonaka return;
1870 1.1 nonaka
1871 1.16 jmcneill s = splnet();
1872 1.1 nonaka if (sc->sc_ic.ic_state == IEEE80211_S_SCAN)
1873 1.1 nonaka ieee80211_next_scan(&sc->sc_ic);
1874 1.16 jmcneill splx(s);
1875 1.59.2.1 phil #endif
1876 1.1 nonaka }
1877 1.1 nonaka
1878 1.26 christos static void
1879 1.26 christos urtwn_newassoc(struct ieee80211_node *ni, int isnew)
1880 1.26 christos {
1881 1.26 christos DPRINTFN(DBG_FN, ("%s: new node %s\n", __func__,
1882 1.26 christos ether_sprintf(ni->ni_macaddr)));
1883 1.59.2.5 phil
1884 1.26 christos /* start with lowest Tx rate */
1885 1.26 christos ni->ni_txrate = 0;
1886 1.26 christos }
1887 1.26 christos
1888 1.59.2.4 phil #if OLDSTUFF
1889 1.59.2.4 phil static int
1890 1.59.2.2 phil urtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
1891 1.1 nonaka {
1892 1.59.2.2 phil struct urtwn_softc *sc = vap->iv_ic->ic_softc;
1893 1.1 nonaka struct urtwn_cmd_newstate cmd;
1894 1.1 nonaka
1895 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: nstate=%s(%d), arg=%d\n",
1896 1.1 nonaka device_xname(sc->sc_dev), __func__,
1897 1.1 nonaka ieee80211_state_name[nstate], nstate, arg));
1898 1.1 nonaka
1899 1.1 nonaka callout_stop(&sc->sc_scan_to);
1900 1.1 nonaka callout_stop(&sc->sc_calib_to);
1901 1.1 nonaka
1902 1.1 nonaka /* Do it in a process context. */
1903 1.1 nonaka cmd.state = nstate;
1904 1.1 nonaka cmd.arg = arg;
1905 1.1 nonaka urtwn_do_async(sc, urtwn_newstate_cb, &cmd, sizeof(cmd));
1906 1.42 skrll return 0;
1907 1.1 nonaka }
1908 1.1 nonaka
1909 1.1 nonaka static void
1910 1.1 nonaka urtwn_newstate_cb(struct urtwn_softc *sc, void *arg)
1911 1.1 nonaka {
1912 1.59.2.1 phil struct ieee80211vap *vap = TAILQ_FIRST(&(sc->sc_ic.ic_vaps));
1913 1.1 nonaka struct urtwn_cmd_newstate *cmd = arg;
1914 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
1915 1.1 nonaka struct ieee80211_node *ni;
1916 1.59.2.1 phil enum ieee80211_state ostate = vap->iv_state;
1917 1.1 nonaka enum ieee80211_state nstate = cmd->state;
1918 1.1 nonaka uint32_t reg;
1919 1.26 christos uint8_t sifs_time, msr;
1920 1.1 nonaka int s;
1921 1.1 nonaka
1922 1.1 nonaka DPRINTFN(DBG_FN|DBG_STM, ("%s: %s: %s(%d)->%s(%d)\n",
1923 1.1 nonaka device_xname(sc->sc_dev), __func__,
1924 1.1 nonaka ieee80211_state_name[ostate], ostate,
1925 1.1 nonaka ieee80211_state_name[nstate], nstate));
1926 1.1 nonaka
1927 1.1 nonaka s = splnet();
1928 1.12 christos mutex_enter(&sc->sc_write_mtx);
1929 1.12 christos
1930 1.12 christos callout_stop(&sc->sc_scan_to);
1931 1.12 christos callout_stop(&sc->sc_calib_to);
1932 1.1 nonaka
1933 1.1 nonaka switch (ostate) {
1934 1.1 nonaka case IEEE80211_S_INIT:
1935 1.1 nonaka break;
1936 1.1 nonaka
1937 1.1 nonaka case IEEE80211_S_SCAN:
1938 1.1 nonaka if (nstate != IEEE80211_S_SCAN) {
1939 1.1 nonaka /*
1940 1.1 nonaka * End of scanning
1941 1.1 nonaka */
1942 1.1 nonaka /* flush 4-AC Queue after site_survey */
1943 1.1 nonaka urtwn_write_1(sc, R92C_TXPAUSE, 0x0);
1944 1.1 nonaka
1945 1.1 nonaka /* Allow Rx from our BSSID only. */
1946 1.1 nonaka urtwn_write_4(sc, R92C_RCR,
1947 1.1 nonaka urtwn_read_4(sc, R92C_RCR) |
1948 1.1 nonaka R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
1949 1.1 nonaka }
1950 1.1 nonaka break;
1951 1.7 christos
1952 1.1 nonaka case IEEE80211_S_AUTH:
1953 1.1 nonaka case IEEE80211_S_ASSOC:
1954 1.1 nonaka break;
1955 1.1 nonaka
1956 1.1 nonaka case IEEE80211_S_RUN:
1957 1.1 nonaka /* Turn link LED off. */
1958 1.1 nonaka urtwn_set_led(sc, URTWN_LED_LINK, 0);
1959 1.1 nonaka
1960 1.1 nonaka /* Set media status to 'No Link'. */
1961 1.1 nonaka urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
1962 1.1 nonaka
1963 1.1 nonaka /* Stop Rx of data frames. */
1964 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
1965 1.1 nonaka
1966 1.1 nonaka /* Reset TSF. */
1967 1.1 nonaka urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03);
1968 1.1 nonaka
1969 1.1 nonaka /* Disable TSF synchronization. */
1970 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
1971 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) |
1972 1.1 nonaka R92C_BCN_CTRL_DIS_TSF_UDT0);
1973 1.1 nonaka
1974 1.1 nonaka /* Back to 20MHz mode */
1975 1.14 jmcneill urtwn_set_chan(sc, ic->ic_curchan,
1976 1.1 nonaka IEEE80211_HTINFO_2NDCHAN_NONE);
1977 1.1 nonaka
1978 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_IBSS ||
1979 1.1 nonaka ic->ic_opmode == IEEE80211_M_HOSTAP) {
1980 1.1 nonaka /* Stop BCN */
1981 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
1982 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) &
1983 1.1 nonaka ~(R92C_BCN_CTRL_EN_BCN | R92C_BCN_CTRL_TXBCN_RPT));
1984 1.1 nonaka }
1985 1.1 nonaka
1986 1.1 nonaka /* Reset EDCA parameters. */
1987 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
1988 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
1989 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
1990 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
1991 1.1 nonaka
1992 1.1 nonaka /* flush all cam entries */
1993 1.1 nonaka urtwn_cam_init(sc);
1994 1.1 nonaka break;
1995 1.59.2.1 phil case IEEE80211_S_CAC:
1996 1.59.2.1 phil case IEEE80211_S_CSA:
1997 1.59.2.1 phil case IEEE80211_S_SLEEP:
1998 1.59.2.3 phil printf ("URTWN UNKNOWN oSTATE: %d\n", ostate);
1999 1.59.2.1 phil /* NNN what do we do in these states? XXX */
2000 1.59.2.1 phil break;
2001 1.1 nonaka }
2002 1.1 nonaka
2003 1.1 nonaka switch (nstate) {
2004 1.1 nonaka case IEEE80211_S_INIT:
2005 1.1 nonaka /* Turn link LED off. */
2006 1.1 nonaka urtwn_set_led(sc, URTWN_LED_LINK, 0);
2007 1.1 nonaka break;
2008 1.1 nonaka
2009 1.1 nonaka case IEEE80211_S_SCAN:
2010 1.1 nonaka if (ostate != IEEE80211_S_SCAN) {
2011 1.1 nonaka /*
2012 1.1 nonaka * Begin of scanning
2013 1.1 nonaka */
2014 1.1 nonaka
2015 1.1 nonaka /* Set gain for scanning. */
2016 1.1 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
2017 1.1 nonaka reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
2018 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
2019 1.1 nonaka
2020 1.32 nonaka if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
2021 1.32 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
2022 1.32 nonaka reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
2023 1.32 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
2024 1.32 nonaka }
2025 1.1 nonaka
2026 1.1 nonaka /* Set media status to 'No Link'. */
2027 1.1 nonaka urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2028 1.1 nonaka
2029 1.1 nonaka /* Allow Rx from any BSSID. */
2030 1.1 nonaka urtwn_write_4(sc, R92C_RCR,
2031 1.1 nonaka urtwn_read_4(sc, R92C_RCR) &
2032 1.1 nonaka ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2033 1.1 nonaka
2034 1.1 nonaka /* Stop Rx of data frames. */
2035 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2036 1.1 nonaka
2037 1.1 nonaka /* Disable update TSF */
2038 1.1 nonaka urtwn_write_1(sc, R92C_BCN_CTRL,
2039 1.1 nonaka urtwn_read_1(sc, R92C_BCN_CTRL) |
2040 1.1 nonaka R92C_BCN_CTRL_DIS_TSF_UDT0);
2041 1.1 nonaka }
2042 1.1 nonaka
2043 1.1 nonaka /* Make link LED blink during scan. */
2044 1.1 nonaka urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
2045 1.1 nonaka
2046 1.1 nonaka /* Pause AC Tx queues. */
2047 1.1 nonaka urtwn_write_1(sc, R92C_TXPAUSE,
2048 1.1 nonaka urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f);
2049 1.1 nonaka
2050 1.1 nonaka urtwn_set_chan(sc, ic->ic_curchan,
2051 1.1 nonaka IEEE80211_HTINFO_2NDCHAN_NONE);
2052 1.1 nonaka
2053 1.1 nonaka /* Start periodic scan. */
2054 1.1 nonaka if (!sc->sc_dying)
2055 1.1 nonaka callout_schedule(&sc->sc_scan_to, hz / 5);
2056 1.1 nonaka break;
2057 1.1 nonaka
2058 1.1 nonaka case IEEE80211_S_AUTH:
2059 1.1 nonaka /* Set initial gain under link. */
2060 1.1 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
2061 1.1 nonaka reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
2062 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
2063 1.1 nonaka
2064 1.32 nonaka if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
2065 1.32 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
2066 1.32 nonaka reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
2067 1.32 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
2068 1.32 nonaka }
2069 1.1 nonaka
2070 1.1 nonaka /* Set media status to 'No Link'. */
2071 1.1 nonaka urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2072 1.1 nonaka
2073 1.1 nonaka /* Allow Rx from any BSSID. */
2074 1.1 nonaka urtwn_write_4(sc, R92C_RCR,
2075 1.1 nonaka urtwn_read_4(sc, R92C_RCR) &
2076 1.1 nonaka ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2077 1.1 nonaka
2078 1.1 nonaka urtwn_set_chan(sc, ic->ic_curchan,
2079 1.1 nonaka IEEE80211_HTINFO_2NDCHAN_NONE);
2080 1.1 nonaka break;
2081 1.1 nonaka
2082 1.1 nonaka case IEEE80211_S_ASSOC:
2083 1.1 nonaka break;
2084 1.1 nonaka
2085 1.59.2.5 phil case IEEE80211_S_RUN:
2086 1.59.2.1 phil ni = vap->iv_bss;
2087 1.1 nonaka
2088 1.1 nonaka /* XXX: Set 20MHz mode */
2089 1.1 nonaka urtwn_set_chan(sc, ic->ic_curchan,
2090 1.1 nonaka IEEE80211_HTINFO_2NDCHAN_NONE);
2091 1.1 nonaka
2092 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_MONITOR) {
2093 1.1 nonaka /* Back to 20MHz mode */
2094 1.13 jmcneill urtwn_set_chan(sc, ic->ic_curchan,
2095 1.1 nonaka IEEE80211_HTINFO_2NDCHAN_NONE);
2096 1.1 nonaka
2097 1.19 christos /* Set media status to 'No Link'. */
2098 1.19 christos urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2099 1.19 christos
2100 1.1 nonaka /* Enable Rx of data frames. */
2101 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2102 1.1 nonaka
2103 1.19 christos /* Allow Rx from any BSSID. */
2104 1.19 christos urtwn_write_4(sc, R92C_RCR,
2105 1.19 christos urtwn_read_4(sc, R92C_RCR) &
2106 1.19 christos ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2107 1.19 christos
2108 1.19 christos /* Accept Rx data/control/management frames */
2109 1.19 christos urtwn_write_4(sc, R92C_RCR,
2110 1.19 christos urtwn_read_4(sc, R92C_RCR) |
2111 1.19 christos R92C_RCR_ADF | R92C_RCR_ACF | R92C_RCR_AMF);
2112 1.19 christos
2113 1.1 nonaka /* Turn link LED on. */
2114 1.1 nonaka urtwn_set_led(sc, URTWN_LED_LINK, 1);
2115 1.1 nonaka break;
2116 1.1 nonaka }
2117 1.1 nonaka
2118 1.1 nonaka /* Set media status to 'Associated'. */
2119 1.1 nonaka urtwn_set_nettype0_msr(sc, urtwn_get_nettype(sc));
2120 1.1 nonaka
2121 1.1 nonaka /* Set BSSID. */
2122 1.1 nonaka urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0]));
2123 1.1 nonaka urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4]));
2124 1.1 nonaka
2125 1.1 nonaka if (ic->ic_curmode == IEEE80211_MODE_11B) {
2126 1.1 nonaka urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
2127 1.1 nonaka } else {
2128 1.1 nonaka /* 802.11b/g */
2129 1.1 nonaka urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
2130 1.1 nonaka }
2131 1.1 nonaka
2132 1.1 nonaka /* Enable Rx of data frames. */
2133 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2134 1.1 nonaka
2135 1.1 nonaka /* Set beacon interval. */
2136 1.1 nonaka urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
2137 1.1 nonaka
2138 1.28 christos msr = urtwn_read_1(sc, R92C_MSR);
2139 1.29 christos msr &= R92C_MSR_MASK;
2140 1.26 christos switch (ic->ic_opmode) {
2141 1.26 christos case IEEE80211_M_STA:
2142 1.1 nonaka /* Allow Rx from our BSSID only. */
2143 1.1 nonaka urtwn_write_4(sc, R92C_RCR,
2144 1.1 nonaka urtwn_read_4(sc, R92C_RCR) |
2145 1.1 nonaka R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
2146 1.1 nonaka
2147 1.1 nonaka /* Enable TSF synchronization. */
2148 1.1 nonaka urtwn_tsf_sync_enable(sc);
2149 1.27 nonaka
2150 1.28 christos msr |= R92C_MSR_INFRA;
2151 1.27 nonaka break;
2152 1.26 christos case IEEE80211_M_HOSTAP:
2153 1.28 christos urtwn_write_2(sc, R92C_BCNTCFG, 0x000f);
2154 1.26 christos
2155 1.28 christos /* Allow Rx from any BSSID. */
2156 1.28 christos urtwn_write_4(sc, R92C_RCR,
2157 1.28 christos urtwn_read_4(sc, R92C_RCR) &
2158 1.28 christos ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2159 1.28 christos
2160 1.28 christos /* Reset TSF timer to zero. */
2161 1.28 christos reg = urtwn_read_4(sc, R92C_TCR);
2162 1.28 christos reg &= ~0x01;
2163 1.28 christos urtwn_write_4(sc, R92C_TCR, reg);
2164 1.28 christos reg |= 0x01;
2165 1.28 christos urtwn_write_4(sc, R92C_TCR, reg);
2166 1.27 nonaka
2167 1.28 christos msr |= R92C_MSR_AP;
2168 1.26 christos break;
2169 1.29 christos default:
2170 1.29 christos msr |= R92C_MSR_ADHOC;
2171 1.29 christos break;
2172 1.28 christos }
2173 1.28 christos urtwn_write_1(sc, R92C_MSR, msr);
2174 1.1 nonaka
2175 1.1 nonaka sifs_time = 10;
2176 1.1 nonaka urtwn_write_1(sc, R92C_SIFS_CCK + 1, sifs_time);
2177 1.1 nonaka urtwn_write_1(sc, R92C_SIFS_OFDM + 1, sifs_time);
2178 1.1 nonaka urtwn_write_1(sc, R92C_SPEC_SIFS + 1, sifs_time);
2179 1.1 nonaka urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, sifs_time);
2180 1.1 nonaka urtwn_write_1(sc, R92C_R2T_SIFS + 1, sifs_time);
2181 1.1 nonaka urtwn_write_1(sc, R92C_T2T_SIFS + 1, sifs_time);
2182 1.1 nonaka
2183 1.57 dholland /* Initialize rate adaptation. */
2184 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
2185 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
2186 1.32 nonaka ni->ni_txrate = ni->ni_rates.rs_nrates - 1;
2187 1.32 nonaka else
2188 1.59.2.4 phil urtwn_ra_init(vap);
2189 1.1 nonaka
2190 1.1 nonaka /* Turn link LED on. */
2191 1.1 nonaka urtwn_set_led(sc, URTWN_LED_LINK, 1);
2192 1.1 nonaka
2193 1.1 nonaka /* Reset average RSSI. */
2194 1.1 nonaka sc->avg_pwdb = -1;
2195 1.1 nonaka
2196 1.1 nonaka /* Reset temperature calibration state machine. */
2197 1.1 nonaka sc->thcal_state = 0;
2198 1.1 nonaka sc->thcal_lctemp = 0;
2199 1.1 nonaka
2200 1.1 nonaka /* Start periodic calibration. */
2201 1.1 nonaka if (!sc->sc_dying)
2202 1.1 nonaka callout_schedule(&sc->sc_calib_to, hz);
2203 1.1 nonaka break;
2204 1.59.2.1 phil case IEEE80211_S_CAC:
2205 1.59.2.1 phil case IEEE80211_S_CSA:
2206 1.59.2.1 phil case IEEE80211_S_SLEEP:
2207 1.59.2.1 phil /* NNN what do we do in these states? XXX */
2208 1.59.2.3 phil printf ("URTWN UNKNOWN nSTATE: %d\n", nstate);
2209 1.59.2.1 phil break;
2210 1.1 nonaka }
2211 1.59.2.4 phil /* newstate functions expect the ic to be locked. */
2212 1.59.2.4 phil IEEE80211_LOCK(ic);
2213 1.59.2.2 phil (*sc->sc_newstate)(vap, nstate, cmd->arg);
2214 1.59.2.4 phil IEEE80211_UNLOCK(ic);
2215 1.59.2.4 phil
2216 1.59.2.4 phil mutex_exit(&sc->sc_write_mtx);
2217 1.59.2.4 phil splx(s);
2218 1.59.2.4 phil }
2219 1.59.2.4 phil #endif
2220 1.59.2.4 phil
2221 1.59.2.5 phil static int
2222 1.59.2.4 phil urtwn_newstate(struct ieee80211vap *vap, enum ieee80211_state nstate, int arg)
2223 1.59.2.4 phil {
2224 1.59.2.4 phil struct urtwn_softc *sc = vap->iv_ic->ic_softc;
2225 1.59.2.4 phil struct ieee80211com *ic = &sc->sc_ic;
2226 1.59.2.4 phil struct ieee80211_node *ni;
2227 1.59.2.4 phil enum ieee80211_state ostate = vap->iv_state;
2228 1.59.2.4 phil uint32_t reg;
2229 1.59.2.4 phil uint8_t sifs_time, msr;
2230 1.59.2.4 phil int s;
2231 1.59.2.4 phil int error;
2232 1.59.2.4 phil
2233 1.59.2.4 phil DPRINTFN(DBG_FN|DBG_STM, ("%s: %s: %s(%d)->%s(%d)\n",
2234 1.59.2.4 phil device_xname(sc->sc_dev), __func__,
2235 1.59.2.4 phil ieee80211_state_name[ostate], ostate,
2236 1.59.2.4 phil ieee80211_state_name[nstate], nstate));
2237 1.59.2.4 phil
2238 1.59.2.4 phil s = splnet();
2239 1.59.2.4 phil mutex_enter(&sc->sc_write_mtx);
2240 1.59.2.4 phil
2241 1.59.2.4 phil callout_stop(&sc->sc_scan_to);
2242 1.59.2.4 phil callout_stop(&sc->sc_calib_to);
2243 1.59.2.4 phil
2244 1.59.2.4 phil switch (ostate) {
2245 1.59.2.4 phil case IEEE80211_S_INIT:
2246 1.59.2.4 phil break;
2247 1.59.2.4 phil
2248 1.59.2.4 phil case IEEE80211_S_SCAN:
2249 1.59.2.4 phil if (nstate != IEEE80211_S_SCAN) {
2250 1.59.2.4 phil /*
2251 1.59.2.4 phil * End of scanning
2252 1.59.2.4 phil */
2253 1.59.2.4 phil /* flush 4-AC Queue after site_survey */
2254 1.59.2.4 phil urtwn_write_1(sc, R92C_TXPAUSE, 0x0);
2255 1.59.2.4 phil
2256 1.59.2.4 phil /* Allow Rx from our BSSID only. */
2257 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2258 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) |
2259 1.59.2.4 phil R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
2260 1.59.2.4 phil }
2261 1.59.2.4 phil break;
2262 1.59.2.4 phil
2263 1.59.2.4 phil case IEEE80211_S_AUTH:
2264 1.59.2.4 phil case IEEE80211_S_ASSOC:
2265 1.59.2.4 phil break;
2266 1.59.2.4 phil
2267 1.59.2.4 phil case IEEE80211_S_RUN:
2268 1.59.2.4 phil /* Turn link LED off. */
2269 1.59.2.4 phil urtwn_set_led(sc, URTWN_LED_LINK, 0);
2270 1.59.2.4 phil
2271 1.59.2.4 phil /* Set media status to 'No Link'. */
2272 1.59.2.4 phil urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2273 1.59.2.4 phil
2274 1.59.2.4 phil /* Stop Rx of data frames. */
2275 1.59.2.4 phil urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2276 1.59.2.4 phil
2277 1.59.2.4 phil /* Reset TSF. */
2278 1.59.2.4 phil urtwn_write_1(sc, R92C_DUAL_TSF_RST, 0x03);
2279 1.59.2.4 phil
2280 1.59.2.4 phil /* Disable TSF synchronization. */
2281 1.59.2.4 phil urtwn_write_1(sc, R92C_BCN_CTRL,
2282 1.59.2.4 phil urtwn_read_1(sc, R92C_BCN_CTRL) |
2283 1.59.2.4 phil R92C_BCN_CTRL_DIS_TSF_UDT0);
2284 1.59.2.4 phil
2285 1.59.2.4 phil /* Back to 20MHz mode */
2286 1.59.2.4 phil urtwn_set_chan(sc, ic->ic_curchan,
2287 1.59.2.4 phil IEEE80211_HTINFO_2NDCHAN_NONE);
2288 1.59.2.4 phil
2289 1.59.2.4 phil if (ic->ic_opmode == IEEE80211_M_IBSS ||
2290 1.59.2.4 phil ic->ic_opmode == IEEE80211_M_HOSTAP) {
2291 1.59.2.4 phil /* Stop BCN */
2292 1.59.2.4 phil urtwn_write_1(sc, R92C_BCN_CTRL,
2293 1.59.2.4 phil urtwn_read_1(sc, R92C_BCN_CTRL) &
2294 1.59.2.4 phil ~(R92C_BCN_CTRL_EN_BCN | R92C_BCN_CTRL_TXBCN_RPT));
2295 1.59.2.4 phil }
2296 1.59.2.4 phil
2297 1.59.2.4 phil /* Reset EDCA parameters. */
2298 1.59.2.4 phil urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002f3217);
2299 1.59.2.4 phil urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005e4317);
2300 1.59.2.4 phil urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x00105320);
2301 1.59.2.4 phil urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a444);
2302 1.59.2.4 phil
2303 1.59.2.4 phil /* flush all cam entries */
2304 1.59.2.4 phil urtwn_cam_init(sc);
2305 1.59.2.4 phil break;
2306 1.59.2.4 phil case IEEE80211_S_CAC:
2307 1.59.2.4 phil case IEEE80211_S_CSA:
2308 1.59.2.4 phil case IEEE80211_S_SLEEP:
2309 1.59.2.4 phil printf ("URTWN UNKNOWN oSTATE: %d\n", ostate);
2310 1.59.2.4 phil /* NNN what do we do in these states? XXX */
2311 1.59.2.4 phil break;
2312 1.59.2.4 phil }
2313 1.59.2.4 phil
2314 1.59.2.4 phil switch (nstate) {
2315 1.59.2.4 phil case IEEE80211_S_INIT:
2316 1.59.2.4 phil /* Turn link LED off. */
2317 1.59.2.4 phil urtwn_set_led(sc, URTWN_LED_LINK, 0);
2318 1.59.2.4 phil break;
2319 1.59.2.4 phil
2320 1.59.2.4 phil case IEEE80211_S_SCAN:
2321 1.59.2.4 phil if (ostate != IEEE80211_S_SCAN) {
2322 1.59.2.4 phil /*
2323 1.59.2.4 phil * Begin of scanning
2324 1.59.2.4 phil */
2325 1.59.2.4 phil
2326 1.59.2.4 phil /* Set gain for scanning. */
2327 1.59.2.4 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
2328 1.59.2.4 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
2329 1.59.2.4 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
2330 1.59.2.4 phil
2331 1.59.2.4 phil if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
2332 1.59.2.4 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
2333 1.59.2.4 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
2334 1.59.2.4 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
2335 1.59.2.4 phil }
2336 1.59.2.4 phil
2337 1.59.2.4 phil /* Set media status to 'No Link'. */
2338 1.59.2.4 phil urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2339 1.59.2.4 phil
2340 1.59.2.4 phil /* Allow Rx from any BSSID. */
2341 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2342 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) &
2343 1.59.2.4 phil ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2344 1.59.2.4 phil
2345 1.59.2.4 phil /* Stop Rx of data frames. */
2346 1.59.2.4 phil urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
2347 1.59.2.4 phil
2348 1.59.2.4 phil /* Disable update TSF */
2349 1.59.2.4 phil urtwn_write_1(sc, R92C_BCN_CTRL,
2350 1.59.2.4 phil urtwn_read_1(sc, R92C_BCN_CTRL) |
2351 1.59.2.4 phil R92C_BCN_CTRL_DIS_TSF_UDT0);
2352 1.59.2.4 phil }
2353 1.59.2.4 phil
2354 1.59.2.4 phil /* Make link LED blink during scan. */
2355 1.59.2.4 phil urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
2356 1.59.2.4 phil
2357 1.59.2.4 phil /* Pause AC Tx queues. */
2358 1.59.2.4 phil urtwn_write_1(sc, R92C_TXPAUSE,
2359 1.59.2.4 phil urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f);
2360 1.59.2.4 phil
2361 1.59.2.4 phil urtwn_set_chan(sc, ic->ic_curchan,
2362 1.59.2.4 phil IEEE80211_HTINFO_2NDCHAN_NONE);
2363 1.59.2.4 phil
2364 1.59.2.4 phil /* Start periodic scan. */
2365 1.59.2.4 phil if (!sc->sc_dying)
2366 1.59.2.4 phil callout_schedule(&sc->sc_scan_to, hz / 5);
2367 1.59.2.4 phil break;
2368 1.59.2.4 phil
2369 1.59.2.4 phil case IEEE80211_S_AUTH:
2370 1.59.2.4 phil /* Set initial gain under link. */
2371 1.59.2.4 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
2372 1.59.2.4 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
2373 1.59.2.4 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
2374 1.59.2.4 phil
2375 1.59.2.4 phil if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
2376 1.59.2.4 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
2377 1.59.2.4 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x32);
2378 1.59.2.4 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
2379 1.59.2.4 phil }
2380 1.59.2.4 phil
2381 1.59.2.4 phil /* Set media status to 'No Link'. */
2382 1.59.2.4 phil urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2383 1.59.2.4 phil
2384 1.59.2.4 phil /* Allow Rx from any BSSID. */
2385 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2386 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) &
2387 1.59.2.4 phil ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2388 1.59.2.4 phil
2389 1.59.2.4 phil urtwn_set_chan(sc, ic->ic_curchan,
2390 1.59.2.4 phil IEEE80211_HTINFO_2NDCHAN_NONE);
2391 1.59.2.4 phil break;
2392 1.59.2.4 phil
2393 1.59.2.4 phil case IEEE80211_S_ASSOC:
2394 1.59.2.4 phil break;
2395 1.59.2.4 phil
2396 1.59.2.4 phil case IEEE80211_S_RUN:
2397 1.59.2.4 phil ni = vap->iv_bss;
2398 1.59.2.4 phil
2399 1.59.2.4 phil /* XXX: Set 20MHz mode */
2400 1.59.2.4 phil urtwn_set_chan(sc, ic->ic_curchan,
2401 1.59.2.4 phil IEEE80211_HTINFO_2NDCHAN_NONE);
2402 1.59.2.4 phil
2403 1.59.2.4 phil if (ic->ic_opmode == IEEE80211_M_MONITOR) {
2404 1.59.2.4 phil /* Back to 20MHz mode */
2405 1.59.2.4 phil urtwn_set_chan(sc, ic->ic_curchan,
2406 1.59.2.4 phil IEEE80211_HTINFO_2NDCHAN_NONE);
2407 1.59.2.4 phil
2408 1.59.2.4 phil /* Set media status to 'No Link'. */
2409 1.59.2.4 phil urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
2410 1.59.2.4 phil
2411 1.59.2.4 phil /* Enable Rx of data frames. */
2412 1.59.2.4 phil urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2413 1.59.2.4 phil
2414 1.59.2.4 phil /* Allow Rx from any BSSID. */
2415 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2416 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) &
2417 1.59.2.4 phil ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2418 1.59.2.4 phil
2419 1.59.2.4 phil /* Accept Rx data/control/management frames */
2420 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2421 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) |
2422 1.59.2.4 phil R92C_RCR_ADF | R92C_RCR_ACF | R92C_RCR_AMF);
2423 1.59.2.4 phil
2424 1.59.2.4 phil /* Turn link LED on. */
2425 1.59.2.4 phil urtwn_set_led(sc, URTWN_LED_LINK, 1);
2426 1.59.2.4 phil break;
2427 1.59.2.4 phil }
2428 1.59.2.4 phil
2429 1.59.2.4 phil /* Set media status to 'Associated'. */
2430 1.59.2.4 phil urtwn_set_nettype0_msr(sc, urtwn_get_nettype(sc));
2431 1.59.2.4 phil
2432 1.59.2.4 phil /* Set BSSID. */
2433 1.59.2.4 phil urtwn_write_4(sc, R92C_BSSID + 0, LE_READ_4(&ni->ni_bssid[0]));
2434 1.59.2.4 phil urtwn_write_4(sc, R92C_BSSID + 4, LE_READ_2(&ni->ni_bssid[4]));
2435 1.59.2.4 phil
2436 1.59.2.4 phil if (ic->ic_curmode == IEEE80211_MODE_11B) {
2437 1.59.2.4 phil urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 0);
2438 1.59.2.4 phil } else {
2439 1.59.2.4 phil /* 802.11b/g */
2440 1.59.2.4 phil urtwn_write_1(sc, R92C_INIRTS_RATE_SEL, 3);
2441 1.59.2.4 phil }
2442 1.59.2.4 phil
2443 1.59.2.4 phil /* Enable Rx of data frames. */
2444 1.59.2.4 phil urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
2445 1.59.2.4 phil
2446 1.59.2.4 phil /* Set beacon interval. */
2447 1.59.2.4 phil urtwn_write_2(sc, R92C_BCN_INTERVAL, ni->ni_intval);
2448 1.59.2.4 phil
2449 1.59.2.4 phil msr = urtwn_read_1(sc, R92C_MSR);
2450 1.59.2.4 phil msr &= R92C_MSR_MASK;
2451 1.59.2.4 phil switch (ic->ic_opmode) {
2452 1.59.2.4 phil case IEEE80211_M_STA:
2453 1.59.2.4 phil /* Allow Rx from our BSSID only. */
2454 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2455 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) |
2456 1.59.2.4 phil R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
2457 1.59.2.4 phil
2458 1.59.2.4 phil /* Enable TSF synchronization. */
2459 1.59.2.4 phil urtwn_tsf_sync_enable(sc);
2460 1.59.2.4 phil
2461 1.59.2.4 phil msr |= R92C_MSR_INFRA;
2462 1.59.2.4 phil break;
2463 1.59.2.4 phil case IEEE80211_M_HOSTAP:
2464 1.59.2.4 phil urtwn_write_2(sc, R92C_BCNTCFG, 0x000f);
2465 1.1 nonaka
2466 1.59.2.4 phil /* Allow Rx from any BSSID. */
2467 1.59.2.4 phil urtwn_write_4(sc, R92C_RCR,
2468 1.59.2.4 phil urtwn_read_4(sc, R92C_RCR) &
2469 1.59.2.4 phil ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
2470 1.59.2.4 phil
2471 1.59.2.4 phil /* Reset TSF timer to zero. */
2472 1.59.2.4 phil reg = urtwn_read_4(sc, R92C_TCR);
2473 1.59.2.4 phil reg &= ~0x01;
2474 1.59.2.4 phil urtwn_write_4(sc, R92C_TCR, reg);
2475 1.59.2.4 phil reg |= 0x01;
2476 1.59.2.4 phil urtwn_write_4(sc, R92C_TCR, reg);
2477 1.59.2.4 phil
2478 1.59.2.4 phil msr |= R92C_MSR_AP;
2479 1.59.2.4 phil break;
2480 1.59.2.4 phil default:
2481 1.59.2.4 phil msr |= R92C_MSR_ADHOC;
2482 1.59.2.4 phil break;
2483 1.59.2.4 phil }
2484 1.59.2.4 phil urtwn_write_1(sc, R92C_MSR, msr);
2485 1.59.2.4 phil
2486 1.59.2.4 phil sifs_time = 10;
2487 1.59.2.4 phil urtwn_write_1(sc, R92C_SIFS_CCK + 1, sifs_time);
2488 1.59.2.4 phil urtwn_write_1(sc, R92C_SIFS_OFDM + 1, sifs_time);
2489 1.59.2.4 phil urtwn_write_1(sc, R92C_SPEC_SIFS + 1, sifs_time);
2490 1.59.2.4 phil urtwn_write_1(sc, R92C_MAC_SPEC_SIFS + 1, sifs_time);
2491 1.59.2.4 phil urtwn_write_1(sc, R92C_R2T_SIFS + 1, sifs_time);
2492 1.59.2.4 phil urtwn_write_1(sc, R92C_T2T_SIFS + 1, sifs_time);
2493 1.59.2.4 phil
2494 1.59.2.4 phil /* Initialize rate adaptation. */
2495 1.59.2.4 phil if (ISSET(sc->chip, URTWN_CHIP_88E) ||
2496 1.59.2.4 phil ISSET(sc->chip, URTWN_CHIP_92EU))
2497 1.59.2.4 phil ni->ni_txrate = ni->ni_rates.rs_nrates - 1;
2498 1.59.2.4 phil else
2499 1.59.2.4 phil urtwn_ra_init(vap);
2500 1.59.2.4 phil
2501 1.59.2.4 phil /* Turn link LED on. */
2502 1.59.2.4 phil urtwn_set_led(sc, URTWN_LED_LINK, 1);
2503 1.59.2.4 phil
2504 1.59.2.4 phil /* Reset average RSSI. */
2505 1.59.2.4 phil sc->avg_pwdb = -1;
2506 1.59.2.4 phil
2507 1.59.2.4 phil /* Reset temperature calibration state machine. */
2508 1.59.2.4 phil sc->thcal_state = 0;
2509 1.59.2.4 phil sc->thcal_lctemp = 0;
2510 1.59.2.4 phil
2511 1.59.2.4 phil /* Start periodic calibration. */
2512 1.59.2.4 phil if (!sc->sc_dying)
2513 1.59.2.4 phil callout_schedule(&sc->sc_calib_to, hz);
2514 1.59.2.4 phil break;
2515 1.59.2.4 phil case IEEE80211_S_CAC:
2516 1.59.2.4 phil case IEEE80211_S_CSA:
2517 1.59.2.4 phil case IEEE80211_S_SLEEP:
2518 1.59.2.4 phil /* NNN what do we do in these states? XXX */
2519 1.59.2.4 phil printf ("URTWN UNKNOWN nSTATE: %d\n", nstate);
2520 1.59.2.4 phil break;
2521 1.59.2.4 phil }
2522 1.12 christos mutex_exit(&sc->sc_write_mtx);
2523 1.59.2.4 phil
2524 1.59.2.4 phil /* newstate functions expect the ic to be locked. */
2525 1.59.2.4 phil error = (*sc->sc_newstate)(vap, nstate, arg);
2526 1.59.2.4 phil
2527 1.1 nonaka splx(s);
2528 1.59.2.4 phil return error;
2529 1.1 nonaka }
2530 1.1 nonaka
2531 1.1 nonaka static int
2532 1.1 nonaka urtwn_wme_update(struct ieee80211com *ic)
2533 1.1 nonaka {
2534 1.59.2.1 phil struct urtwn_softc *sc = ic->ic_softc;
2535 1.1 nonaka
2536 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
2537 1.1 nonaka
2538 1.1 nonaka /* don't override default WME values if WME is not actually enabled */
2539 1.1 nonaka if (!(ic->ic_flags & IEEE80211_F_WME))
2540 1.42 skrll return 0;
2541 1.1 nonaka
2542 1.1 nonaka /* Do it in a process context. */
2543 1.1 nonaka urtwn_do_async(sc, urtwn_wme_update_cb, NULL, 0);
2544 1.42 skrll return 0;
2545 1.1 nonaka }
2546 1.1 nonaka
2547 1.1 nonaka static void
2548 1.1 nonaka urtwn_wme_update_cb(struct urtwn_softc *sc, void *arg)
2549 1.1 nonaka {
2550 1.1 nonaka static const uint16_t ac2reg[WME_NUM_AC] = {
2551 1.1 nonaka R92C_EDCA_BE_PARAM,
2552 1.1 nonaka R92C_EDCA_BK_PARAM,
2553 1.1 nonaka R92C_EDCA_VI_PARAM,
2554 1.1 nonaka R92C_EDCA_VO_PARAM
2555 1.1 nonaka };
2556 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2557 1.1 nonaka const struct wmeParams *wmep;
2558 1.1 nonaka int ac, aifs, slottime;
2559 1.1 nonaka int s;
2560 1.1 nonaka
2561 1.1 nonaka DPRINTFN(DBG_FN|DBG_STM, ("%s: %s\n", device_xname(sc->sc_dev),
2562 1.1 nonaka __func__));
2563 1.1 nonaka
2564 1.1 nonaka s = splnet();
2565 1.12 christos mutex_enter(&sc->sc_write_mtx);
2566 1.1 nonaka slottime = (ic->ic_flags & IEEE80211_F_SHSLOT) ? 9 : 20;
2567 1.1 nonaka for (ac = 0; ac < WME_NUM_AC; ac++) {
2568 1.1 nonaka wmep = &ic->ic_wme.wme_chanParams.cap_wmeParams[ac];
2569 1.1 nonaka /* AIFS[AC] = AIFSN[AC] * aSlotTime + aSIFSTime. */
2570 1.1 nonaka aifs = wmep->wmep_aifsn * slottime + 10;
2571 1.1 nonaka urtwn_write_4(sc, ac2reg[ac],
2572 1.1 nonaka SM(R92C_EDCA_PARAM_TXOP, wmep->wmep_txopLimit) |
2573 1.1 nonaka SM(R92C_EDCA_PARAM_ECWMIN, wmep->wmep_logcwmin) |
2574 1.1 nonaka SM(R92C_EDCA_PARAM_ECWMAX, wmep->wmep_logcwmax) |
2575 1.1 nonaka SM(R92C_EDCA_PARAM_AIFS, aifs));
2576 1.1 nonaka }
2577 1.12 christos mutex_exit(&sc->sc_write_mtx);
2578 1.1 nonaka splx(s);
2579 1.1 nonaka }
2580 1.1 nonaka
2581 1.1 nonaka static void
2582 1.1 nonaka urtwn_update_avgrssi(struct urtwn_softc *sc, int rate, int8_t rssi)
2583 1.1 nonaka {
2584 1.1 nonaka int pwdb;
2585 1.1 nonaka
2586 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: rate=%d, rsst=%d\n",
2587 1.1 nonaka device_xname(sc->sc_dev), __func__, rate, rssi));
2588 1.1 nonaka
2589 1.1 nonaka /* Convert antenna signal to percentage. */
2590 1.1 nonaka if (rssi <= -100 || rssi >= 20)
2591 1.1 nonaka pwdb = 0;
2592 1.1 nonaka else if (rssi >= 0)
2593 1.1 nonaka pwdb = 100;
2594 1.1 nonaka else
2595 1.1 nonaka pwdb = 100 + rssi;
2596 1.32 nonaka if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
2597 1.32 nonaka if (rate <= 3) {
2598 1.32 nonaka /* CCK gain is smaller than OFDM/MCS gain. */
2599 1.32 nonaka pwdb += 6;
2600 1.32 nonaka if (pwdb > 100)
2601 1.32 nonaka pwdb = 100;
2602 1.32 nonaka if (pwdb <= 14)
2603 1.32 nonaka pwdb -= 4;
2604 1.32 nonaka else if (pwdb <= 26)
2605 1.32 nonaka pwdb -= 8;
2606 1.32 nonaka else if (pwdb <= 34)
2607 1.32 nonaka pwdb -= 6;
2608 1.32 nonaka else if (pwdb <= 42)
2609 1.32 nonaka pwdb -= 2;
2610 1.32 nonaka }
2611 1.1 nonaka }
2612 1.1 nonaka if (sc->avg_pwdb == -1) /* Init. */
2613 1.1 nonaka sc->avg_pwdb = pwdb;
2614 1.1 nonaka else if (sc->avg_pwdb < pwdb)
2615 1.1 nonaka sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20) + 1;
2616 1.1 nonaka else
2617 1.1 nonaka sc->avg_pwdb = ((sc->avg_pwdb * 19 + pwdb) / 20);
2618 1.1 nonaka
2619 1.12 christos DPRINTFN(DBG_RF, ("%s: %s: rate=%d rssi=%d PWDB=%d EMA=%d\n",
2620 1.12 christos device_xname(sc->sc_dev), __func__,
2621 1.12 christos rate, rssi, pwdb, sc->avg_pwdb));
2622 1.1 nonaka }
2623 1.1 nonaka
2624 1.1 nonaka static int8_t
2625 1.1 nonaka urtwn_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2626 1.1 nonaka {
2627 1.1 nonaka static const int8_t cckoff[] = { 16, -12, -26, -46 };
2628 1.1 nonaka struct r92c_rx_phystat *phy;
2629 1.1 nonaka struct r92c_rx_cck *cck;
2630 1.1 nonaka uint8_t rpt;
2631 1.1 nonaka int8_t rssi;
2632 1.1 nonaka
2633 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: rate=%d\n", device_xname(sc->sc_dev),
2634 1.1 nonaka __func__, rate));
2635 1.1 nonaka
2636 1.1 nonaka if (rate <= 3) {
2637 1.1 nonaka cck = (struct r92c_rx_cck *)physt;
2638 1.1 nonaka if (ISSET(sc->sc_flags, URTWN_FLAG_CCK_HIPWR)) {
2639 1.1 nonaka rpt = (cck->agc_rpt >> 5) & 0x3;
2640 1.1 nonaka rssi = (cck->agc_rpt & 0x1f) << 1;
2641 1.1 nonaka } else {
2642 1.1 nonaka rpt = (cck->agc_rpt >> 6) & 0x3;
2643 1.1 nonaka rssi = cck->agc_rpt & 0x3e;
2644 1.1 nonaka }
2645 1.1 nonaka rssi = cckoff[rpt] - rssi;
2646 1.1 nonaka } else { /* OFDM/HT. */
2647 1.1 nonaka phy = (struct r92c_rx_phystat *)physt;
2648 1.1 nonaka rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2649 1.1 nonaka }
2650 1.42 skrll return rssi;
2651 1.1 nonaka }
2652 1.1 nonaka
2653 1.32 nonaka static int8_t
2654 1.32 nonaka urtwn_r88e_get_rssi(struct urtwn_softc *sc, int rate, void *physt)
2655 1.32 nonaka {
2656 1.32 nonaka struct r92c_rx_phystat *phy;
2657 1.32 nonaka struct r88e_rx_cck *cck;
2658 1.32 nonaka uint8_t cck_agc_rpt, lna_idx, vga_idx;
2659 1.32 nonaka int8_t rssi;
2660 1.32 nonaka
2661 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s: rate=%d\n", device_xname(sc->sc_dev),
2662 1.32 nonaka __func__, rate));
2663 1.32 nonaka
2664 1.32 nonaka rssi = 0;
2665 1.32 nonaka if (rate <= 3) {
2666 1.32 nonaka cck = (struct r88e_rx_cck *)physt;
2667 1.32 nonaka cck_agc_rpt = cck->agc_rpt;
2668 1.32 nonaka lna_idx = (cck_agc_rpt & 0xe0) >> 5;
2669 1.32 nonaka vga_idx = cck_agc_rpt & 0x1f;
2670 1.32 nonaka switch (lna_idx) {
2671 1.32 nonaka case 7:
2672 1.32 nonaka if (vga_idx <= 27)
2673 1.32 nonaka rssi = -100 + 2* (27 - vga_idx);
2674 1.32 nonaka else
2675 1.32 nonaka rssi = -100;
2676 1.32 nonaka break;
2677 1.32 nonaka case 6:
2678 1.32 nonaka rssi = -48 + 2 * (2 - vga_idx);
2679 1.32 nonaka break;
2680 1.32 nonaka case 5:
2681 1.32 nonaka rssi = -42 + 2 * (7 - vga_idx);
2682 1.32 nonaka break;
2683 1.32 nonaka case 4:
2684 1.32 nonaka rssi = -36 + 2 * (7 - vga_idx);
2685 1.32 nonaka break;
2686 1.32 nonaka case 3:
2687 1.32 nonaka rssi = -24 + 2 * (7 - vga_idx);
2688 1.32 nonaka break;
2689 1.32 nonaka case 2:
2690 1.32 nonaka rssi = -12 + 2 * (5 - vga_idx);
2691 1.32 nonaka break;
2692 1.32 nonaka case 1:
2693 1.32 nonaka rssi = 8 - (2 * vga_idx);
2694 1.32 nonaka break;
2695 1.32 nonaka case 0:
2696 1.32 nonaka rssi = 14 - (2 * vga_idx);
2697 1.32 nonaka break;
2698 1.32 nonaka }
2699 1.32 nonaka rssi += 6;
2700 1.32 nonaka } else { /* OFDM/HT. */
2701 1.32 nonaka phy = (struct r92c_rx_phystat *)physt;
2702 1.32 nonaka rssi = ((le32toh(phy->phydw1) >> 1) & 0x7f) - 110;
2703 1.32 nonaka }
2704 1.42 skrll return rssi;
2705 1.32 nonaka }
2706 1.32 nonaka
2707 1.1 nonaka static void
2708 1.1 nonaka urtwn_rx_frame(struct urtwn_softc *sc, uint8_t *buf, int pktlen)
2709 1.1 nonaka {
2710 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2711 1.59.2.1 phil struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
2712 1.59.2.1 phil struct ifnet *ifp = vap->iv_ifp;
2713 1.1 nonaka struct ieee80211_frame *wh;
2714 1.1 nonaka struct ieee80211_node *ni;
2715 1.1 nonaka struct r92c_rx_stat *stat;
2716 1.1 nonaka uint32_t rxdw0, rxdw3;
2717 1.1 nonaka struct mbuf *m;
2718 1.1 nonaka uint8_t rate;
2719 1.1 nonaka int8_t rssi = 0;
2720 1.1 nonaka int s, infosz;
2721 1.1 nonaka
2722 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: buf=%p, pktlen=%d\n",
2723 1.1 nonaka device_xname(sc->sc_dev), __func__, buf, pktlen));
2724 1.1 nonaka
2725 1.1 nonaka stat = (struct r92c_rx_stat *)buf;
2726 1.1 nonaka rxdw0 = le32toh(stat->rxdw0);
2727 1.1 nonaka rxdw3 = le32toh(stat->rxdw3);
2728 1.1 nonaka
2729 1.1 nonaka if (__predict_false(rxdw0 & (R92C_RXDW0_CRCERR | R92C_RXDW0_ICVERR))) {
2730 1.1 nonaka /*
2731 1.1 nonaka * This should not happen since we setup our Rx filter
2732 1.1 nonaka * to not receive these frames.
2733 1.1 nonaka */
2734 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: CRC error\n",
2735 1.1 nonaka device_xname(sc->sc_dev), __func__));
2736 1.1 nonaka ifp->if_ierrors++;
2737 1.1 nonaka return;
2738 1.1 nonaka }
2739 1.59.2.4 phil
2740 1.19 christos /*
2741 1.19 christos * XXX: This will drop most control packets. Do we really
2742 1.19 christos * want this in IEEE80211_M_MONITOR mode?
2743 1.19 christos */
2744 1.22 christos // if (__predict_false(pktlen < (int)sizeof(*wh))) {
2745 1.22 christos if (__predict_false(pktlen < (int)sizeof(struct ieee80211_frame_ack))) {
2746 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: packet too short %d\n",
2747 1.1 nonaka device_xname(sc->sc_dev), __func__, pktlen));
2748 1.59.2.1 phil vap->iv_stats.is_rx_tooshort++;
2749 1.1 nonaka ifp->if_ierrors++;
2750 1.1 nonaka return;
2751 1.1 nonaka }
2752 1.1 nonaka if (__predict_false(pktlen > MCLBYTES)) {
2753 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: packet too big %d\n",
2754 1.1 nonaka device_xname(sc->sc_dev), __func__, pktlen));
2755 1.1 nonaka ifp->if_ierrors++;
2756 1.1 nonaka return;
2757 1.1 nonaka }
2758 1.1 nonaka
2759 1.1 nonaka rate = MS(rxdw3, R92C_RXDW3_RATE);
2760 1.1 nonaka infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
2761 1.1 nonaka
2762 1.1 nonaka /* Get RSSI from PHY status descriptor if present. */
2763 1.1 nonaka if (infosz != 0 && (rxdw0 & R92C_RXDW0_PHYST)) {
2764 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92C))
2765 1.32 nonaka rssi = urtwn_r88e_get_rssi(sc, rate, &stat[1]);
2766 1.32 nonaka else
2767 1.32 nonaka rssi = urtwn_get_rssi(sc, rate, &stat[1]);
2768 1.1 nonaka /* Update our average RSSI. */
2769 1.1 nonaka urtwn_update_avgrssi(sc, rate, rssi);
2770 1.1 nonaka }
2771 1.1 nonaka
2772 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: Rx frame len=%d rate=%d infosz=%d rssi=%d\n",
2773 1.1 nonaka device_xname(sc->sc_dev), __func__, pktlen, rate, infosz, rssi));
2774 1.1 nonaka
2775 1.1 nonaka MGETHDR(m, M_DONTWAIT, MT_DATA);
2776 1.1 nonaka if (__predict_false(m == NULL)) {
2777 1.1 nonaka aprint_error_dev(sc->sc_dev, "couldn't allocate rx mbuf\n");
2778 1.59.2.1 phil vap->iv_stats.is_rx_nobuf++;
2779 1.1 nonaka ifp->if_ierrors++;
2780 1.1 nonaka return;
2781 1.1 nonaka }
2782 1.1 nonaka if (pktlen > (int)MHLEN) {
2783 1.1 nonaka MCLGET(m, M_DONTWAIT);
2784 1.1 nonaka if (__predict_false(!(m->m_flags & M_EXT))) {
2785 1.1 nonaka aprint_error_dev(sc->sc_dev,
2786 1.1 nonaka "couldn't allocate rx mbuf cluster\n");
2787 1.1 nonaka m_freem(m);
2788 1.59.2.1 phil vap->iv_stats.is_rx_nobuf++;
2789 1.1 nonaka ifp->if_ierrors++;
2790 1.1 nonaka return;
2791 1.1 nonaka }
2792 1.1 nonaka }
2793 1.1 nonaka
2794 1.1 nonaka /* Finalize mbuf. */
2795 1.45 ozaki m_set_rcvif(m, ifp);
2796 1.1 nonaka wh = (struct ieee80211_frame *)((uint8_t *)&stat[1] + infosz);
2797 1.1 nonaka memcpy(mtod(m, uint8_t *), wh, pktlen);
2798 1.1 nonaka m->m_pkthdr.len = m->m_len = pktlen;
2799 1.1 nonaka
2800 1.1 nonaka s = splnet();
2801 1.1 nonaka if (__predict_false(sc->sc_drvbpf != NULL)) {
2802 1.1 nonaka struct urtwn_rx_radiotap_header *tap = &sc->sc_rxtap;
2803 1.1 nonaka
2804 1.19 christos tap->wr_flags = 0;
2805 1.1 nonaka if (!(rxdw3 & R92C_RXDW3_HT)) {
2806 1.1 nonaka switch (rate) {
2807 1.1 nonaka /* CCK. */
2808 1.1 nonaka case 0: tap->wr_rate = 2; break;
2809 1.1 nonaka case 1: tap->wr_rate = 4; break;
2810 1.1 nonaka case 2: tap->wr_rate = 11; break;
2811 1.1 nonaka case 3: tap->wr_rate = 22; break;
2812 1.1 nonaka /* OFDM. */
2813 1.1 nonaka case 4: tap->wr_rate = 12; break;
2814 1.1 nonaka case 5: tap->wr_rate = 18; break;
2815 1.1 nonaka case 6: tap->wr_rate = 24; break;
2816 1.1 nonaka case 7: tap->wr_rate = 36; break;
2817 1.1 nonaka case 8: tap->wr_rate = 48; break;
2818 1.1 nonaka case 9: tap->wr_rate = 72; break;
2819 1.1 nonaka case 10: tap->wr_rate = 96; break;
2820 1.1 nonaka case 11: tap->wr_rate = 108; break;
2821 1.1 nonaka }
2822 1.1 nonaka } else if (rate >= 12) { /* MCS0~15. */
2823 1.1 nonaka /* Bit 7 set means HT MCS instead of rate. */
2824 1.1 nonaka tap->wr_rate = 0x80 | (rate - 12);
2825 1.1 nonaka }
2826 1.1 nonaka tap->wr_dbm_antsignal = rssi;
2827 1.13 jmcneill tap->wr_chan_freq = htole16(ic->ic_curchan->ic_freq);
2828 1.13 jmcneill tap->wr_chan_flags = htole16(ic->ic_curchan->ic_flags);
2829 1.1 nonaka
2830 1.59 msaitoh bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_rxtap_len, m, BPF_D_IN);
2831 1.1 nonaka }
2832 1.1 nonaka
2833 1.1 nonaka ni = ieee80211_find_rxnode(ic, (struct ieee80211_frame_min *)wh);
2834 1.1 nonaka
2835 1.59.2.4 phil if (ni != NULL) {
2836 1.59.2.4 phil if (ni->ni_vap != NULL) {
2837 1.1 nonaka
2838 1.59.2.4 phil } else {
2839 1.59.2.4 phil splx(s);
2840 1.59.2.4 phil return;
2841 1.59.2.4 phil }
2842 1.59.2.4 phil /* push the frame up to the 802.11 stack */
2843 1.59.2.5 phil /* NNN Convert rssi to -10 to 110 ? for 802.11 layer */
2844 1.59.2.5 phil ieee80211_input(ni, m, rssi+90, 0);
2845 1.59.2.4 phil
2846 1.59.2.4 phil /* Node is no longer needed. */
2847 1.59.2.4 phil ieee80211_free_node(ni);
2848 1.59.2.4 phil
2849 1.59.2.4 phil } else {
2850 1.59.2.4 phil
2851 1.59.2.4 phil /* No node found ... process differently. */
2852 1.59.2.5 phil (void) ieee80211_input_all(ic, m, rssi+90, 0);
2853 1.59.2.4 phil }
2854 1.1 nonaka
2855 1.1 nonaka splx(s);
2856 1.1 nonaka }
2857 1.1 nonaka
2858 1.1 nonaka static void
2859 1.42 skrll urtwn_rxeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
2860 1.1 nonaka {
2861 1.1 nonaka struct urtwn_rx_data *data = priv;
2862 1.1 nonaka struct urtwn_softc *sc = data->sc;
2863 1.1 nonaka struct r92c_rx_stat *stat;
2864 1.49 nat size_t pidx = data->pidx;
2865 1.1 nonaka uint32_t rxdw0;
2866 1.1 nonaka uint8_t *buf;
2867 1.1 nonaka int len, totlen, pktlen, infosz, npkts;
2868 1.1 nonaka
2869 1.1 nonaka DPRINTFN(DBG_FN|DBG_RX, ("%s: %s: status=%d\n",
2870 1.1 nonaka device_xname(sc->sc_dev), __func__, status));
2871 1.1 nonaka
2872 1.49 nat mutex_enter(&sc->sc_rx_mtx);
2873 1.49 nat TAILQ_REMOVE(&sc->rx_free_list[pidx], data, next);
2874 1.49 nat TAILQ_INSERT_TAIL(&sc->rx_free_list[pidx], data, next);
2875 1.49 nat /* Put this Rx buffer back to our free list. */
2876 1.49 nat mutex_exit(&sc->sc_rx_mtx);
2877 1.49 nat
2878 1.1 nonaka if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
2879 1.1 nonaka if (status == USBD_STALLED)
2880 1.49 nat usbd_clear_endpoint_stall_async(sc->rx_pipe[pidx]);
2881 1.1 nonaka else if (status != USBD_CANCELLED)
2882 1.1 nonaka goto resubmit;
2883 1.1 nonaka return;
2884 1.1 nonaka }
2885 1.1 nonaka usbd_get_xfer_status(xfer, NULL, NULL, &len, NULL);
2886 1.1 nonaka
2887 1.1 nonaka if (__predict_false(len < (int)sizeof(*stat))) {
2888 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: xfer too short %d\n",
2889 1.1 nonaka device_xname(sc->sc_dev), __func__, len));
2890 1.1 nonaka goto resubmit;
2891 1.1 nonaka }
2892 1.1 nonaka buf = data->buf;
2893 1.1 nonaka
2894 1.1 nonaka /* Get the number of encapsulated frames. */
2895 1.1 nonaka stat = (struct r92c_rx_stat *)buf;
2896 1.1 nonaka npkts = MS(le32toh(stat->rxdw2), R92C_RXDW2_PKTCNT);
2897 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: Rx %d frames in one chunk\n",
2898 1.1 nonaka device_xname(sc->sc_dev), __func__, npkts));
2899 1.1 nonaka
2900 1.1 nonaka /* Process all of them. */
2901 1.1 nonaka while (npkts-- > 0) {
2902 1.1 nonaka if (__predict_false(len < (int)sizeof(*stat))) {
2903 1.1 nonaka DPRINTFN(DBG_RX,
2904 1.1 nonaka ("%s: %s: len(%d) is short than header\n",
2905 1.1 nonaka device_xname(sc->sc_dev), __func__, len));
2906 1.1 nonaka break;
2907 1.1 nonaka }
2908 1.1 nonaka stat = (struct r92c_rx_stat *)buf;
2909 1.1 nonaka rxdw0 = le32toh(stat->rxdw0);
2910 1.1 nonaka
2911 1.1 nonaka pktlen = MS(rxdw0, R92C_RXDW0_PKTLEN);
2912 1.1 nonaka if (__predict_false(pktlen == 0)) {
2913 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: pktlen is 0 byte\n",
2914 1.1 nonaka device_xname(sc->sc_dev), __func__));
2915 1.19 christos break;
2916 1.1 nonaka }
2917 1.1 nonaka
2918 1.1 nonaka infosz = MS(rxdw0, R92C_RXDW0_INFOSZ) * 8;
2919 1.1 nonaka
2920 1.1 nonaka /* Make sure everything fits in xfer. */
2921 1.1 nonaka totlen = sizeof(*stat) + infosz + pktlen;
2922 1.1 nonaka if (__predict_false(totlen > len)) {
2923 1.1 nonaka DPRINTFN(DBG_RX, ("%s: %s: pktlen %d(%d+%d+%d) > %d\n",
2924 1.1 nonaka device_xname(sc->sc_dev), __func__, totlen,
2925 1.1 nonaka (int)sizeof(*stat), infosz, pktlen, len));
2926 1.1 nonaka break;
2927 1.1 nonaka }
2928 1.1 nonaka
2929 1.1 nonaka /* Process 802.11 frame. */
2930 1.1 nonaka urtwn_rx_frame(sc, buf, pktlen);
2931 1.1 nonaka
2932 1.1 nonaka /* Next chunk is 128-byte aligned. */
2933 1.1 nonaka totlen = roundup2(totlen, 128);
2934 1.1 nonaka buf += totlen;
2935 1.1 nonaka len -= totlen;
2936 1.1 nonaka }
2937 1.1 nonaka
2938 1.1 nonaka resubmit:
2939 1.1 nonaka /* Setup a new transfer. */
2940 1.42 skrll usbd_setup_xfer(xfer, data, data->buf, URTWN_RXBUFSZ,
2941 1.42 skrll USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT, urtwn_rxeof);
2942 1.1 nonaka (void)usbd_transfer(xfer);
2943 1.1 nonaka }
2944 1.1 nonaka
2945 1.1 nonaka static void
2946 1.42 skrll urtwn_txeof(struct usbd_xfer *xfer, void *priv, usbd_status status)
2947 1.1 nonaka {
2948 1.1 nonaka struct urtwn_tx_data *data = priv;
2949 1.1 nonaka struct urtwn_softc *sc = data->sc;
2950 1.59.2.2 phil struct ifnet *ifp = TAILQ_FIRST(&sc->sc_ic.ic_vaps)->iv_ifp;
2951 1.42 skrll size_t pidx = data->pidx;
2952 1.1 nonaka int s;
2953 1.1 nonaka
2954 1.1 nonaka DPRINTFN(DBG_FN|DBG_TX, ("%s: %s: status=%d\n",
2955 1.1 nonaka device_xname(sc->sc_dev), __func__, status));
2956 1.1 nonaka
2957 1.1 nonaka mutex_enter(&sc->sc_tx_mtx);
2958 1.1 nonaka /* Put this Tx buffer back to our free list. */
2959 1.42 skrll TAILQ_INSERT_TAIL(&sc->tx_free_list[pidx], data, next);
2960 1.1 nonaka mutex_exit(&sc->sc_tx_mtx);
2961 1.1 nonaka
2962 1.16 jmcneill s = splnet();
2963 1.16 jmcneill sc->tx_timer = 0;
2964 1.16 jmcneill ifp->if_flags &= ~IFF_OACTIVE;
2965 1.16 jmcneill
2966 1.1 nonaka if (__predict_false(status != USBD_NORMAL_COMPLETION)) {
2967 1.1 nonaka if (status != USBD_NOT_STARTED && status != USBD_CANCELLED) {
2968 1.42 skrll if (status == USBD_STALLED) {
2969 1.42 skrll struct usbd_pipe *pipe = sc->tx_pipe[pidx];
2970 1.20 christos usbd_clear_endpoint_stall_async(pipe);
2971 1.42 skrll }
2972 1.49 nat printf("ERROR1\n");
2973 1.1 nonaka ifp->if_oerrors++;
2974 1.1 nonaka }
2975 1.16 jmcneill splx(s);
2976 1.1 nonaka return;
2977 1.1 nonaka }
2978 1.1 nonaka
2979 1.21 christos ifp->if_opackets++;
2980 1.16 jmcneill urtwn_start(ifp);
2981 1.49 nat splx(s);
2982 1.1 nonaka
2983 1.1 nonaka }
2984 1.1 nonaka
2985 1.1 nonaka static int
2986 1.12 christos urtwn_tx(struct urtwn_softc *sc, struct mbuf *m, struct ieee80211_node *ni,
2987 1.12 christos struct urtwn_tx_data *data)
2988 1.1 nonaka {
2989 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
2990 1.1 nonaka struct ieee80211_frame *wh;
2991 1.1 nonaka struct ieee80211_key *k = NULL;
2992 1.1 nonaka struct r92c_tx_desc *txd;
2993 1.49 nat size_t i, padsize, xferlen, txd_len;
2994 1.1 nonaka uint16_t seq, sum;
2995 1.42 skrll uint8_t raid, type, tid;
2996 1.22 christos int s, hasqos, error;
2997 1.1 nonaka
2998 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
2999 1.1 nonaka
3000 1.59.2.5 phil KASSERT(sc != NULL); // NNN
3001 1.59.2.5 phil KASSERT(m != NULL);
3002 1.59.2.5 phil KASSERT(ni != NULL);
3003 1.59.2.5 phil KASSERT(data != NULL);
3004 1.59.2.5 phil
3005 1.1 nonaka wh = mtod(m, struct ieee80211_frame *);
3006 1.1 nonaka type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
3007 1.49 nat txd_len = sizeof(*txd);
3008 1.49 nat
3009 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU))
3010 1.49 nat txd_len = 32;
3011 1.1 nonaka
3012 1.59.2.5 phil if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED) {
3013 1.59.2.1 phil k = ieee80211_crypto_encap(ni, m);
3014 1.12 christos if (k == NULL)
3015 1.12 christos return ENOBUFS;
3016 1.12 christos
3017 1.1 nonaka /* packet header may have moved, reset our local pointer */
3018 1.1 nonaka wh = mtod(m, struct ieee80211_frame *);
3019 1.1 nonaka }
3020 1.1 nonaka
3021 1.1 nonaka if (__predict_false(sc->sc_drvbpf != NULL)) {
3022 1.1 nonaka struct urtwn_tx_radiotap_header *tap = &sc->sc_txtap;
3023 1.1 nonaka
3024 1.1 nonaka tap->wt_flags = 0;
3025 1.14 jmcneill tap->wt_chan_freq = htole16(ic->ic_curchan->ic_freq);
3026 1.14 jmcneill tap->wt_chan_flags = htole16(ic->ic_curchan->ic_flags);
3027 1.59.2.5 phil if (wh->i_fc[1] & IEEE80211_FC1_PROTECTED)
3028 1.1 nonaka tap->wt_flags |= IEEE80211_RADIOTAP_F_WEP;
3029 1.1 nonaka
3030 1.19 christos /* XXX: set tap->wt_rate? */
3031 1.19 christos
3032 1.59 msaitoh bpf_mtap2(sc->sc_drvbpf, tap, sc->sc_txtap_len, m, BPF_D_OUT);
3033 1.1 nonaka }
3034 1.1 nonaka
3035 1.42 skrll /* non-qos data frames */
3036 1.42 skrll tid = R92C_TXDW1_QSEL_BE;
3037 1.59.2.1 phil if ((hasqos = IEEE80211_QOS_HAS_SEQ(wh))) {
3038 1.1 nonaka /* data frames in 11n mode */
3039 1.1 nonaka struct ieee80211_qosframe *qwh = (void *)wh;
3040 1.1 nonaka tid = qwh->i_qos[0] & IEEE80211_QOS_TID;
3041 1.1 nonaka } else if (type != IEEE80211_FC0_TYPE_DATA) {
3042 1.42 skrll tid = R92C_TXDW1_QSEL_MGNT;
3043 1.1 nonaka }
3044 1.1 nonaka
3045 1.49 nat if (((txd_len + m->m_pkthdr.len) % 64) == 0) /* XXX: 64 */
3046 1.1 nonaka padsize = 8;
3047 1.1 nonaka else
3048 1.1 nonaka padsize = 0;
3049 1.1 nonaka
3050 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU))
3051 1.49 nat padsize = 0;
3052 1.49 nat
3053 1.1 nonaka /* Fill Tx descriptor. */
3054 1.1 nonaka txd = (struct r92c_tx_desc *)data->buf;
3055 1.59.2.5 phil KASSERT(txd != NULL); // NNN
3056 1.49 nat memset(txd, 0, txd_len + padsize);
3057 1.1 nonaka
3058 1.1 nonaka txd->txdw0 |= htole32(
3059 1.1 nonaka SM(R92C_TXDW0_PKTLEN, m->m_pkthdr.len) |
3060 1.49 nat SM(R92C_TXDW0_OFFSET, txd_len));
3061 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU)) {
3062 1.49 nat txd->txdw0 |= htole32(
3063 1.49 nat R92C_TXDW0_OWN | R92C_TXDW0_FSG | R92C_TXDW0_LSG);
3064 1.49 nat }
3065 1.1 nonaka
3066 1.1 nonaka if (IEEE80211_IS_MULTICAST(wh->i_addr1))
3067 1.1 nonaka txd->txdw0 |= htole32(R92C_TXDW0_BMCAST);
3068 1.1 nonaka
3069 1.1 nonaka /* fix pad field */
3070 1.1 nonaka if (padsize > 0) {
3071 1.22 christos DPRINTFN(DBG_TX, ("%s: %s: padding: size=%zd\n",
3072 1.1 nonaka device_xname(sc->sc_dev), __func__, padsize));
3073 1.1 nonaka txd->txdw1 |= htole32(SM(R92C_TXDW1_PKTOFF, (padsize / 8)));
3074 1.1 nonaka }
3075 1.1 nonaka
3076 1.1 nonaka if (!IEEE80211_IS_MULTICAST(wh->i_addr1) &&
3077 1.1 nonaka type == IEEE80211_FC0_TYPE_DATA) {
3078 1.1 nonaka if (ic->ic_curmode == IEEE80211_MODE_11B)
3079 1.1 nonaka raid = R92C_RAID_11B;
3080 1.1 nonaka else
3081 1.1 nonaka raid = R92C_RAID_11BG;
3082 1.1 nonaka DPRINTFN(DBG_TX,
3083 1.1 nonaka ("%s: %s: data packet: tid=%d, raid=%d\n",
3084 1.1 nonaka device_xname(sc->sc_dev), __func__, tid, raid));
3085 1.1 nonaka
3086 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92C)) {
3087 1.32 nonaka txd->txdw1 |= htole32(
3088 1.32 nonaka SM(R88E_TXDW1_MACID, URTWN_MACID_BSS) |
3089 1.32 nonaka SM(R92C_TXDW1_QSEL, tid) |
3090 1.32 nonaka SM(R92C_TXDW1_RAID, raid) |
3091 1.32 nonaka R92C_TXDW1_AGGBK);
3092 1.32 nonaka } else
3093 1.32 nonaka txd->txdw1 |= htole32(
3094 1.32 nonaka SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) |
3095 1.32 nonaka SM(R92C_TXDW1_QSEL, tid) |
3096 1.32 nonaka SM(R92C_TXDW1_RAID, raid) |
3097 1.32 nonaka R92C_TXDW1_AGGBK);
3098 1.1 nonaka
3099 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E))
3100 1.49 nat txd->txdw2 |= htole32(R88E_TXDW2_AGGBK);
3101 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU))
3102 1.49 nat txd->txdw3 |= htole32(R92E_TXDW3_AGGBK);
3103 1.49 nat
3104 1.1 nonaka if (hasqos) {
3105 1.1 nonaka txd->txdw4 |= htole32(R92C_TXDW4_QOS);
3106 1.1 nonaka }
3107 1.1 nonaka
3108 1.1 nonaka if (ic->ic_flags & IEEE80211_F_USEPROT) {
3109 1.1 nonaka /* for 11g */
3110 1.1 nonaka if (ic->ic_protmode == IEEE80211_PROT_CTSONLY) {
3111 1.1 nonaka txd->txdw4 |= htole32(R92C_TXDW4_CTS2SELF |
3112 1.1 nonaka R92C_TXDW4_HWRTSEN);
3113 1.1 nonaka } else if (ic->ic_protmode == IEEE80211_PROT_RTSCTS) {
3114 1.1 nonaka txd->txdw4 |= htole32(R92C_TXDW4_RTSEN |
3115 1.1 nonaka R92C_TXDW4_HWRTSEN);
3116 1.1 nonaka }
3117 1.1 nonaka }
3118 1.1 nonaka /* Send RTS at OFDM24. */
3119 1.1 nonaka txd->txdw4 |= htole32(SM(R92C_TXDW4_RTSRATE, 8));
3120 1.1 nonaka txd->txdw5 |= htole32(0x0001ff00);
3121 1.1 nonaka /* Send data at OFDM54. */
3122 1.32 nonaka if (ISSET(sc->chip, URTWN_CHIP_88E))
3123 1.32 nonaka txd->txdw5 |= htole32(0x13 & 0x3f);
3124 1.32 nonaka else
3125 1.32 nonaka txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 11));
3126 1.1 nonaka } else if (type == IEEE80211_FC0_TYPE_MGT) {
3127 1.1 nonaka DPRINTFN(DBG_TX, ("%s: %s: mgmt packet\n",
3128 1.1 nonaka device_xname(sc->sc_dev), __func__));
3129 1.1 nonaka txd->txdw1 |= htole32(
3130 1.1 nonaka SM(R92C_TXDW1_MACID, URTWN_MACID_BSS) |
3131 1.1 nonaka SM(R92C_TXDW1_QSEL, R92C_TXDW1_QSEL_MGNT) |
3132 1.1 nonaka SM(R92C_TXDW1_RAID, R92C_RAID_11B));
3133 1.1 nonaka
3134 1.1 nonaka /* Force CCK1. */
3135 1.1 nonaka txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3136 1.1 nonaka /* Use 1Mbps */
3137 1.1 nonaka txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0));
3138 1.1 nonaka } else {
3139 1.1 nonaka /* broadcast or multicast packets */
3140 1.1 nonaka DPRINTFN(DBG_TX, ("%s: %s: bc or mc packet\n",
3141 1.1 nonaka device_xname(sc->sc_dev), __func__));
3142 1.1 nonaka txd->txdw1 |= htole32(
3143 1.1 nonaka SM(R92C_TXDW1_MACID, URTWN_MACID_BC) |
3144 1.1 nonaka SM(R92C_TXDW1_RAID, R92C_RAID_11B));
3145 1.1 nonaka
3146 1.1 nonaka /* Force CCK1. */
3147 1.1 nonaka txd->txdw4 |= htole32(R92C_TXDW4_DRVRATE);
3148 1.1 nonaka /* Use 1Mbps */
3149 1.1 nonaka txd->txdw5 |= htole32(SM(R92C_TXDW5_DATARATE, 0));
3150 1.1 nonaka }
3151 1.1 nonaka /* Set sequence number */
3152 1.1 nonaka seq = LE_READ_2(&wh->i_seq[0]) >> IEEE80211_SEQ_SEQ_SHIFT;
3153 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU)) {
3154 1.49 nat txd->txdseq |= htole16(seq);
3155 1.1 nonaka
3156 1.49 nat if (!hasqos) {
3157 1.49 nat /* Use HW sequence numbering for non-QoS frames. */
3158 1.49 nat txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ);
3159 1.49 nat txd->txdseq |= htole16(R92C_HWSEQ_EN);
3160 1.49 nat }
3161 1.49 nat } else {
3162 1.49 nat txd->txdseq2 |= htole16((seq & R92E_HWSEQ_MASK) <<
3163 1.49 nat R92E_HWSEQ_SHIFT);
3164 1.49 nat if (!hasqos) {
3165 1.49 nat /* Use HW sequence numbering for non-QoS frames. */
3166 1.49 nat txd->txdw4 |= htole32(R92C_TXDW4_HWSEQ);
3167 1.49 nat txd->txdw7 |= htole16(R92C_HWSEQ_EN);
3168 1.49 nat }
3169 1.1 nonaka }
3170 1.1 nonaka
3171 1.1 nonaka /* Compute Tx descriptor checksum. */
3172 1.1 nonaka sum = 0;
3173 1.49 nat for (i = 0; i < R92C_TXDESC_SUMSIZE / 2; i++)
3174 1.1 nonaka sum ^= ((uint16_t *)txd)[i];
3175 1.1 nonaka txd->txdsum = sum; /* NB: already little endian. */
3176 1.1 nonaka
3177 1.49 nat xferlen = txd_len + m->m_pkthdr.len + padsize;
3178 1.49 nat m_copydata(m, 0, m->m_pkthdr.len, (char *)&txd[0] + txd_len + padsize);
3179 1.1 nonaka
3180 1.59.2.5 phil printf ("urtwn_tx just before splnet()\n");
3181 1.59.2.5 phil KASSERT(data != NULL);
3182 1.1 nonaka s = splnet();
3183 1.42 skrll usbd_setup_xfer(data->xfer, data, data->buf, xferlen,
3184 1.42 skrll USBD_FORCE_SHORT_XFER, URTWN_TX_TIMEOUT,
3185 1.1 nonaka urtwn_txeof);
3186 1.1 nonaka error = usbd_transfer(data->xfer);
3187 1.1 nonaka if (__predict_false(error != USBD_NORMAL_COMPLETION &&
3188 1.1 nonaka error != USBD_IN_PROGRESS)) {
3189 1.1 nonaka splx(s);
3190 1.1 nonaka DPRINTFN(DBG_TX, ("%s: %s: transfer failed %d\n",
3191 1.1 nonaka device_xname(sc->sc_dev), __func__, error));
3192 1.12 christos return error;
3193 1.1 nonaka }
3194 1.1 nonaka splx(s);
3195 1.59.2.5 phil printf ("urtwn_tx just before splnet()\n");
3196 1.12 christos return 0;
3197 1.1 nonaka }
3198 1.1 nonaka
3199 1.42 skrll struct urtwn_tx_data *
3200 1.42 skrll urtwn_get_tx_data(struct urtwn_softc *sc, size_t pidx)
3201 1.42 skrll {
3202 1.42 skrll struct urtwn_tx_data *data = NULL;
3203 1.42 skrll
3204 1.59.2.4 phil mutex_enter(&sc->sc_tx_mtx);
3205 1.42 skrll if (!TAILQ_EMPTY(&sc->tx_free_list[pidx])) {
3206 1.42 skrll data = TAILQ_FIRST(&sc->tx_free_list[pidx]);
3207 1.42 skrll TAILQ_REMOVE(&sc->tx_free_list[pidx], data, next);
3208 1.42 skrll }
3209 1.42 skrll mutex_exit(&sc->sc_tx_mtx);
3210 1.42 skrll
3211 1.42 skrll return data;
3212 1.42 skrll }
3213 1.42 skrll
3214 1.1 nonaka static void
3215 1.1 nonaka urtwn_start(struct ifnet *ifp)
3216 1.1 nonaka {
3217 1.59.2.3 phil struct ieee80211vap *vap = ifp->if_softc;
3218 1.59.2.3 phil struct ieee80211com *ic = vap->iv_ic;
3219 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
3220 1.12 christos struct urtwn_tx_data *data;
3221 1.1 nonaka struct ether_header *eh;
3222 1.1 nonaka struct ieee80211_node *ni;
3223 1.1 nonaka struct mbuf *m;
3224 1.1 nonaka
3225 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3226 1.1 nonaka
3227 1.1 nonaka if ((ifp->if_flags & (IFF_RUNNING | IFF_OACTIVE)) != IFF_RUNNING)
3228 1.1 nonaka return;
3229 1.1 nonaka
3230 1.12 christos data = NULL;
3231 1.1 nonaka for (;;) {
3232 1.42 skrll /* Send pending management frames first. */
3233 1.42 skrll IF_POLL(&ic->ic_mgtq, m);
3234 1.42 skrll if (m != NULL) {
3235 1.42 skrll /* Use AC_VO for management frames. */
3236 1.17 jmcneill
3237 1.42 skrll data = urtwn_get_tx_data(sc, sc->ac2idx[WME_AC_VO]);
3238 1.1 nonaka
3239 1.42 skrll if (data == NULL) {
3240 1.42 skrll ifp->if_flags |= IFF_OACTIVE;
3241 1.42 skrll DPRINTFN(DBG_TX, ("%s: empty tx_free_list\n",
3242 1.42 skrll device_xname(sc->sc_dev)));
3243 1.42 skrll return;
3244 1.42 skrll }
3245 1.42 skrll IF_DEQUEUE(&ic->ic_mgtq, m);
3246 1.43 ozaki ni = M_GETCTX(m, struct ieee80211_node *);
3247 1.44 ozaki M_CLEARCTX(m);
3248 1.1 nonaka goto sendit;
3249 1.1 nonaka }
3250 1.59.2.1 phil
3251 1.59.2.1 phil if (vap->iv_state != IEEE80211_S_RUN)
3252 1.1 nonaka break;
3253 1.1 nonaka
3254 1.1 nonaka /* Encapsulate and send data frames. */
3255 1.42 skrll IFQ_POLL(&ifp->if_snd, m);
3256 1.1 nonaka if (m == NULL)
3257 1.1 nonaka break;
3258 1.12 christos
3259 1.42 skrll struct ieee80211_frame *wh = mtod(m, struct ieee80211_frame *);
3260 1.42 skrll uint8_t type = wh->i_fc[0] & IEEE80211_FC0_TYPE_MASK;
3261 1.42 skrll uint8_t qid = WME_AC_BE;
3262 1.59.2.1 phil if (IEEE80211_QOS_HAS_SEQ(wh)) {
3263 1.42 skrll /* data frames in 11n mode */
3264 1.42 skrll struct ieee80211_qosframe *qwh = (void *)wh;
3265 1.42 skrll uint8_t tid = qwh->i_qos[0] & IEEE80211_QOS_TID;
3266 1.42 skrll qid = TID_TO_WME_AC(tid);
3267 1.42 skrll } else if (type != IEEE80211_FC0_TYPE_DATA) {
3268 1.42 skrll qid = WME_AC_VO;
3269 1.42 skrll }
3270 1.42 skrll data = urtwn_get_tx_data(sc, sc->ac2idx[qid]);
3271 1.42 skrll
3272 1.42 skrll if (data == NULL) {
3273 1.42 skrll ifp->if_flags |= IFF_OACTIVE;
3274 1.42 skrll DPRINTFN(DBG_TX, ("%s: empty tx_free_list\n",
3275 1.42 skrll device_xname(sc->sc_dev)));
3276 1.42 skrll return;
3277 1.42 skrll }
3278 1.42 skrll IFQ_DEQUEUE(&ifp->if_snd, m);
3279 1.42 skrll
3280 1.1 nonaka if (m->m_len < (int)sizeof(*eh) &&
3281 1.1 nonaka (m = m_pullup(m, sizeof(*eh))) == NULL) {
3282 1.49 nat printf("ERROR6\n");
3283 1.1 nonaka ifp->if_oerrors++;
3284 1.1 nonaka continue;
3285 1.1 nonaka }
3286 1.1 nonaka eh = mtod(m, struct ether_header *);
3287 1.59.2.1 phil ni = ieee80211_find_txnode(vap, eh->ether_dhost);
3288 1.1 nonaka if (ni == NULL) {
3289 1.1 nonaka m_freem(m);
3290 1.49 nat printf("ERROR5\n");
3291 1.1 nonaka ifp->if_oerrors++;
3292 1.1 nonaka continue;
3293 1.1 nonaka }
3294 1.1 nonaka
3295 1.59 msaitoh bpf_mtap(ifp, m, BPF_D_OUT);
3296 1.1 nonaka
3297 1.59.2.1 phil if ((m = ieee80211_encap(vap, ni, m)) == NULL) {
3298 1.1 nonaka ieee80211_free_node(ni);
3299 1.49 nat printf("ERROR4\n");
3300 1.1 nonaka ifp->if_oerrors++;
3301 1.1 nonaka continue;
3302 1.1 nonaka }
3303 1.1 nonaka sendit:
3304 1.59.2.1 phil bpf_mtap3(vap->iv_rawbpf, m, BPF_D_OUT);
3305 1.1 nonaka
3306 1.12 christos if (urtwn_tx(sc, m, ni, data) != 0) {
3307 1.12 christos m_freem(m);
3308 1.1 nonaka ieee80211_free_node(ni);
3309 1.49 nat printf("ERROR3\n");
3310 1.1 nonaka ifp->if_oerrors++;
3311 1.1 nonaka continue;
3312 1.1 nonaka }
3313 1.12 christos m_freem(m);
3314 1.12 christos ieee80211_free_node(ni);
3315 1.1 nonaka sc->tx_timer = 5;
3316 1.1 nonaka ifp->if_timer = 1;
3317 1.1 nonaka }
3318 1.1 nonaka }
3319 1.1 nonaka
3320 1.1 nonaka static void
3321 1.1 nonaka urtwn_watchdog(struct ifnet *ifp)
3322 1.1 nonaka {
3323 1.59.2.3 phil struct ieee80211vap *vap = ifp->if_softc;
3324 1.59.2.3 phil struct urtwn_softc *sc = vap->iv_ic->ic_softc;
3325 1.1 nonaka
3326 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3327 1.1 nonaka
3328 1.1 nonaka ifp->if_timer = 0;
3329 1.1 nonaka
3330 1.1 nonaka if (sc->tx_timer > 0) {
3331 1.1 nonaka if (--sc->tx_timer == 0) {
3332 1.1 nonaka aprint_error_dev(sc->sc_dev, "device timeout\n");
3333 1.1 nonaka /* urtwn_init(ifp); XXX needs a process context! */
3334 1.49 nat printf("ERROR2\n");
3335 1.1 nonaka ifp->if_oerrors++;
3336 1.1 nonaka return;
3337 1.1 nonaka }
3338 1.1 nonaka ifp->if_timer = 1;
3339 1.1 nonaka }
3340 1.59.2.3 phil // ieee80211_watchdog(&sc->sc_ic);
3341 1.1 nonaka }
3342 1.1 nonaka
3343 1.59.2.2 phil /*
3344 1.59.2.2 phil * Create a VAP node for use with the urtwn driver.
3345 1.59.2.2 phil */
3346 1.59.2.2 phil
3347 1.59.2.2 phil static struct ieee80211vap *
3348 1.59.2.2 phil urtwn_vap_create(struct ieee80211com *ic, const char name[IFNAMSIZ],
3349 1.59.2.2 phil int unit, enum ieee80211_opmode opmode, int flags,
3350 1.59.2.2 phil const uint8_t bssid[IEEE80211_ADDR_LEN],
3351 1.59.2.2 phil const uint8_t macaddr[IEEE80211_ADDR_LEN])
3352 1.59.2.2 phil {
3353 1.59.2.2 phil struct urtwn_softc *sc = ic->ic_softc;
3354 1.59.2.2 phil struct ifnet *ifp;
3355 1.59.2.2 phil struct ieee80211vap *vap;
3356 1.59.2.2 phil
3357 1.59.2.2 phil DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3358 1.59.2.2 phil
3359 1.59.2.2 phil /* Allow only one VAP for the urtwn driver. */
3360 1.59.2.2 phil if (!TAILQ_EMPTY(&ic->ic_vaps))
3361 1.59.2.2 phil return NULL;
3362 1.59.2.2 phil
3363 1.59.2.2 phil /* Allocate the vap and setup. */
3364 1.59.2.2 phil vap = kmem_zalloc(sizeof(struct ieee80211vap), KM_SLEEP);
3365 1.59.2.2 phil if (ieee80211_vap_setup(ic, vap, name, unit, opmode,
3366 1.59.2.2 phil flags | IEEE80211_CLONE_NOBEACONS, bssid) != 0) {
3367 1.59.2.2 phil kmem_free(vap, sizeof(struct ieee80211vap));
3368 1.59.2.2 phil return NULL;
3369 1.59.2.2 phil }
3370 1.59.2.2 phil
3371 1.59.2.2 phil printf ("vap_create: after vap_setup\n");
3372 1.59.2.2 phil
3373 1.59.2.2 phil /* Local setup */
3374 1.59.2.2 phil vap->iv_reset = urtwn_reset;
3375 1.59.2.2 phil
3376 1.59.2.2 phil ifp = vap->iv_ifp;
3377 1.59.2.2 phil ifp->if_init = urtwn_init;
3378 1.59.2.2 phil ifp->if_ioctl = urtwn_ioctl;
3379 1.59.2.2 phil ifp->if_start = urtwn_start;
3380 1.59.2.2 phil ifp->if_watchdog = urtwn_watchdog;
3381 1.59.2.3 phil ifp->if_extflags |= IFEF_MPSAFE;
3382 1.59.2.2 phil IFQ_SET_READY(&ifp->if_snd);
3383 1.59.2.2 phil memcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
3384 1.59.2.2 phil
3385 1.59.2.2 phil /* Override state transition machine. */
3386 1.59.2.5 phil /* NNN --- many possible newstate machines ... issue! */
3387 1.59.2.5 phil sc->sc_newstate = vap->iv_newstate;
3388 1.59.2.5 phil vap->iv_newstate = urtwn_newstate;
3389 1.59.2.2 phil
3390 1.59.2.2 phil /* Finish setup */
3391 1.59.2.2 phil ieee80211_vap_attach(vap, urtwn_media_change,
3392 1.59.2.2 phil ieee80211_media_status, macaddr);
3393 1.59.2.2 phil ic->ic_opmode = opmode;
3394 1.59.2.2 phil
3395 1.59.2.2 phil return vap;
3396 1.59.2.2 phil }
3397 1.59.2.2 phil
3398 1.59.2.2 phil static void
3399 1.59.2.2 phil urtwn_vap_delete(struct ieee80211vap *vap)
3400 1.59.2.2 phil {
3401 1.59.2.2 phil struct ifnet *ifp = vap->iv_ifp;
3402 1.59.2.2 phil struct urtwn_softc *sc __unused =vap->iv_ic->ic_softc;
3403 1.59.2.2 phil
3404 1.59.2.2 phil DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3405 1.59.2.2 phil
3406 1.59.2.2 phil urtwn_stop(ifp, 0);
3407 1.59.2.2 phil ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
3408 1.59.2.2 phil bpf_detach(ifp);
3409 1.59.2.2 phil if_detach(ifp);
3410 1.59.2.2 phil kmem_free(vap, sizeof(struct ieee80211vap));
3411 1.59.2.2 phil }
3412 1.59.2.2 phil
3413 1.59.2.3 phil static void
3414 1.59.2.3 phil urtwn_parent(struct ieee80211com *ic)
3415 1.59.2.3 phil {
3416 1.59.2.3 phil struct urtwn_softc *sc __unused = ic->ic_softc;
3417 1.59.2.3 phil
3418 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3419 1.59.2.3 phil
3420 1.59.2.3 phil /* Not sure what to do here yet. */
3421 1.59.2.3 phil }
3422 1.59.2.3 phil
3423 1.59.2.3 phil static void
3424 1.59.2.3 phil urtwn_scan_start(struct ieee80211com *ic)
3425 1.59.2.3 phil {
3426 1.59.2.5 phil struct urtwn_softc *sc = ic->ic_softc;
3427 1.59.2.5 phil //uint32_t reg;
3428 1.59.2.5 phil //int s;
3429 1.59.2.3 phil
3430 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3431 1.59.2.3 phil
3432 1.59.2.5 phil /*
3433 1.59.2.5 phil * Not sure what to do here yet. Try #1: do what was in the
3434 1.59.2.5 phil * state machine. NNN
3435 1.59.2.5 phil */
3436 1.59.2.5 phil #if NOTWITHSTATEMACHINEOVERRIDE
3437 1.59.2.5 phil /*
3438 1.59.2.5 phil * Begin of scanning
3439 1.59.2.5 phil */
3440 1.59.2.5 phil
3441 1.59.2.5 phil s = splnet();
3442 1.59.2.5 phil mutex_enter(&sc->sc_write_mtx);
3443 1.59.2.5 phil
3444 1.59.2.5 phil /* Set gain for scanning. */
3445 1.59.2.5 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(0));
3446 1.59.2.5 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
3447 1.59.2.5 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), reg);
3448 1.59.2.5 phil
3449 1.59.2.5 phil if (!ISSET(sc->chip, URTWN_CHIP_88E)) {
3450 1.59.2.5 phil reg = urtwn_bb_read(sc, R92C_OFDM0_AGCCORE1(1));
3451 1.59.2.5 phil reg = RW(reg, R92C_OFDM0_AGCCORE1_GAIN, 0x20);
3452 1.59.2.5 phil urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(1), reg);
3453 1.59.2.5 phil }
3454 1.59.2.5 phil
3455 1.59.2.5 phil /* Set media status to 'No Link'. */
3456 1.59.2.5 phil urtwn_set_nettype0_msr(sc, R92C_CR_NETTYPE_NOLINK);
3457 1.59.2.5 phil
3458 1.59.2.5 phil /* Allow Rx from any BSSID. */
3459 1.59.2.5 phil urtwn_write_4(sc, R92C_RCR,
3460 1.59.2.5 phil urtwn_read_4(sc, R92C_RCR) &
3461 1.59.2.5 phil ~(R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN));
3462 1.59.2.5 phil
3463 1.59.2.5 phil /* Stop Rx of data frames. */
3464 1.59.2.5 phil urtwn_write_2(sc, R92C_RXFLTMAP2, 0);
3465 1.59.2.5 phil
3466 1.59.2.5 phil /* Disable update TSF */
3467 1.59.2.5 phil urtwn_write_1(sc, R92C_BCN_CTRL,
3468 1.59.2.5 phil urtwn_read_1(sc, R92C_BCN_CTRL) |
3469 1.59.2.5 phil R92C_BCN_CTRL_DIS_TSF_UDT0);
3470 1.59.2.5 phil
3471 1.59.2.5 phil /* Make link LED blink during scan. */
3472 1.59.2.5 phil urtwn_set_led(sc, URTWN_LED_LINK, !sc->ledlink);
3473 1.59.2.5 phil
3474 1.59.2.5 phil /* Pause AC Tx queues. */
3475 1.59.2.5 phil urtwn_write_1(sc, R92C_TXPAUSE,
3476 1.59.2.5 phil urtwn_read_1(sc, R92C_TXPAUSE) | 0x0f);
3477 1.59.2.5 phil
3478 1.59.2.5 phil urtwn_set_chan(sc, ic->ic_curchan,
3479 1.59.2.5 phil IEEE80211_HTINFO_2NDCHAN_NONE);
3480 1.59.2.5 phil
3481 1.59.2.5 phil mutex_exit(&sc->sc_write_mtx);
3482 1.59.2.5 phil splx(s);
3483 1.59.2.5 phil #endif
3484 1.59.2.3 phil }
3485 1.59.2.3 phil
3486 1.59.2.3 phil static void
3487 1.59.2.3 phil urtwn_scan_end(struct ieee80211com *ic)
3488 1.59.2.3 phil {
3489 1.59.2.5 phil struct urtwn_softc *sc = ic->ic_softc;
3490 1.59.2.3 phil
3491 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3492 1.59.2.3 phil
3493 1.59.2.5 phil #ifdef NOTWITHSTATEMACHINEOVERRIDE
3494 1.59.2.5 phil /*
3495 1.59.2.5 phil * End of scanning
3496 1.59.2.5 phil */
3497 1.59.2.5 phil
3498 1.59.2.5 phil mutex_enter(&sc->sc_write_mtx);
3499 1.59.2.5 phil
3500 1.59.2.5 phil /* flush 4-AC Queue after site_survey */
3501 1.59.2.5 phil urtwn_write_1(sc, R92C_TXPAUSE, 0x0);
3502 1.59.2.5 phil
3503 1.59.2.5 phil /* Allow Rx from our BSSID only. */
3504 1.59.2.5 phil urtwn_write_4(sc, R92C_RCR,
3505 1.59.2.5 phil urtwn_read_4(sc, R92C_RCR) |
3506 1.59.2.5 phil R92C_RCR_CBSSID_DATA | R92C_RCR_CBSSID_BCN);
3507 1.59.2.5 phil
3508 1.59.2.5 phil /* Turn link LED off. */
3509 1.59.2.5 phil urtwn_set_led(sc, URTWN_LED_LINK, 0);
3510 1.59.2.5 phil
3511 1.59.2.5 phil mutex_exit(&sc->sc_write_mtx);
3512 1.59.2.5 phil #endif
3513 1.59.2.3 phil }
3514 1.59.2.3 phil
3515 1.59.2.3 phil static void
3516 1.59.2.3 phil urtwn_set_channel(struct ieee80211com *ic)
3517 1.59.2.3 phil {
3518 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
3519 1.59.2.3 phil
3520 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3521 1.59.2.3 phil
3522 1.59.2.4 phil mutex_enter(&sc->sc_write_mtx);
3523 1.59.2.3 phil urtwn_set_chan(sc, ic->ic_curchan, IEEE80211_HTINFO_2NDCHAN_NONE);
3524 1.59.2.4 phil mutex_exit(&sc->sc_write_mtx);
3525 1.59.2.3 phil }
3526 1.59.2.3 phil
3527 1.59.2.3 phil static int
3528 1.59.2.3 phil urtwn_transmit(struct ieee80211com *ic, struct mbuf *m)
3529 1.59.2.3 phil {
3530 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
3531 1.59.2.4 phil struct ieee80211vap *vap = TAILQ_FIRST(&ic->ic_vaps);
3532 1.59.2.4 phil int s;
3533 1.59.2.4 phil int error;
3534 1.59.2.4 phil size_t pktlen = m->m_pkthdr.len;
3535 1.59.2.4 phil bool mcast = (m->m_flags & M_MCAST) != 0;
3536 1.59.2.3 phil
3537 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3538 1.59.2.3 phil
3539 1.59.2.4 phil s = splnet();
3540 1.59.2.4 phil
3541 1.59.2.4 phil IFQ_ENQUEUE(&vap->iv_ifp->if_snd, m, error);
3542 1.59.2.4 phil if (error != 0) {
3543 1.59.2.4 phil /* mbuf is already freed */
3544 1.59.2.4 phil goto out;
3545 1.59.2.4 phil }
3546 1.59.2.4 phil
3547 1.59.2.4 phil vap->iv_ifp->if_obytes += pktlen;
3548 1.59.2.4 phil if (mcast)
3549 1.59.2.4 phil vap->iv_ifp->if_omcasts++;
3550 1.59.2.4 phil
3551 1.59.2.4 phil if ((vap->iv_ifp->if_flags & IFF_OACTIVE) == 0)
3552 1.59.2.4 phil if_start_lock(vap->iv_ifp);
3553 1.59.2.4 phil out:
3554 1.59.2.4 phil splx(s);
3555 1.59.2.4 phil
3556 1.59.2.4 phil return error;
3557 1.59.2.3 phil }
3558 1.59.2.3 phil
3559 1.59.2.5 phil static __unused int urtwn_send_mgmt(struct ieee80211_node *ni, int type, int arg)
3560 1.59.2.5 phil {
3561 1.59.2.5 phil printf ("urtwn_send_mgmt: type %d, arg %d\n", type, arg);
3562 1.59.2.5 phil return ENOENT;
3563 1.59.2.5 phil }
3564 1.59.2.5 phil
3565 1.59.2.5 phil
3566 1.59.2.5 phil
3567 1.59.2.3 phil static int
3568 1.59.2.3 phil urtwn_raw_xmit(struct ieee80211_node *ni , struct mbuf *m,
3569 1.59.2.3 phil const struct ieee80211_bpf_params *bpfp)
3570 1.59.2.3 phil {
3571 1.59.2.4 phil struct ieee80211vap *vap = ni->ni_vap;
3572 1.59.2.3 phil struct ieee80211com *ic = ni->ni_ic;
3573 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
3574 1.59.2.4 phil struct urtwn_tx_data *data;
3575 1.59.2.4 phil int error;
3576 1.59.2.3 phil
3577 1.59.2.3 phil DPRINTFN(DBG_FN, ("%s: %s\n",device_xname(sc->sc_dev), __func__));
3578 1.59.2.3 phil
3579 1.59.2.5 phil KASSERT(vap != NULL); // NNN need these?
3580 1.59.2.5 phil KASSERT(ic != NULL);
3581 1.59.2.5 phil KASSERT(sc != NULL);
3582 1.59.2.5 phil KASSERT(m != NULL);
3583 1.59.2.5 phil
3584 1.59.2.4 phil data = urtwn_get_tx_data(sc, sc->ac2idx[WME_AC_VO]);
3585 1.59.2.4 phil
3586 1.59.2.4 phil if (data == NULL) {
3587 1.59.2.4 phil vap->iv_ifp->if_flags |= IFF_OACTIVE;
3588 1.59.2.4 phil DPRINTFN(DBG_TX, ("%s: empty tx_free_list\n",
3589 1.59.2.4 phil device_xname(sc->sc_dev)));
3590 1.59.2.4 phil return ENOBUFS;
3591 1.59.2.4 phil }
3592 1.59.2.4 phil
3593 1.59.2.4 phil bpf_mtap3(vap->iv_rawbpf, m, BPF_D_OUT);
3594 1.59.2.4 phil
3595 1.59.2.4 phil error = urtwn_tx(sc, m, ni, data);
3596 1.59.2.4 phil if (error != 0) {
3597 1.59.2.4 phil printf("ERROR3\n");
3598 1.59.2.4 phil vap->iv_ifp->if_oerrors++;
3599 1.59.2.5 phil } else {
3600 1.59.2.5 phil sc->tx_timer = 5;
3601 1.59.2.5 phil vap->iv_ifp->if_timer = 1;
3602 1.59.2.4 phil }
3603 1.59.2.4 phil m_freem(m);
3604 1.59.2.4 phil ieee80211_free_node(ni);
3605 1.59.2.4 phil return error;
3606 1.59.2.4 phil }
3607 1.59.2.4 phil
3608 1.59.2.4 phil static void
3609 1.59.2.4 phil urtwn_getradiocaps(struct ieee80211com *ic,
3610 1.59.2.4 phil int maxchans, int *nchans, struct ieee80211_channel chans[])
3611 1.59.2.4 phil {
3612 1.59.2.4 phil uint8_t bands[IEEE80211_MODE_BYTES];
3613 1.59.2.4 phil
3614 1.59.2.4 phil /*
3615 1.59.2.4 phil * NNN Should be able to do something based on chip if
3616 1.59.2.4 phil * a chip has more bands .... eg. N ... but for the future.
3617 1.59.2.4 phil */
3618 1.59.2.4 phil
3619 1.59.2.4 phil memset(bands, 0, sizeof(bands));
3620 1.59.2.4 phil setbit(bands, IEEE80211_MODE_11B);
3621 1.59.2.4 phil setbit(bands, IEEE80211_MODE_11G);
3622 1.59.2.4 phil ieee80211_add_channel_list_2ghz(chans, maxchans, nchans,
3623 1.59.2.4 phil urtwn_chan_2ghz, nitems(urtwn_chan_2ghz), bands, 0);
3624 1.59.2.3 phil }
3625 1.59.2.3 phil
3626 1.59.2.3 phil
3627 1.1 nonaka static int
3628 1.1 nonaka urtwn_ioctl(struct ifnet *ifp, u_long cmd, void *data)
3629 1.1 nonaka {
3630 1.59.2.2 phil
3631 1.59.2.2 phil struct ieee80211vap *vap = ifp->if_softc;
3632 1.59.2.2 phil struct urtwn_softc *sc __unused = vap->iv_ic->ic_softc;
3633 1.1 nonaka int s, error = 0;
3634 1.1 nonaka
3635 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: cmd=0x%08lx, data=%p\n",
3636 1.1 nonaka device_xname(sc->sc_dev), __func__, cmd, data));
3637 1.1 nonaka
3638 1.1 nonaka s = splnet();
3639 1.1 nonaka
3640 1.1 nonaka switch (cmd) {
3641 1.1 nonaka case SIOCSIFFLAGS:
3642 1.1 nonaka if ((error = ifioctl_common(ifp, cmd, data)) != 0)
3643 1.1 nonaka break;
3644 1.12 christos switch (ifp->if_flags & (IFF_UP | IFF_RUNNING)) {
3645 1.12 christos case IFF_UP | IFF_RUNNING:
3646 1.1 nonaka break;
3647 1.1 nonaka case IFF_UP:
3648 1.1 nonaka urtwn_init(ifp);
3649 1.1 nonaka break;
3650 1.1 nonaka case IFF_RUNNING:
3651 1.1 nonaka urtwn_stop(ifp, 1);
3652 1.1 nonaka break;
3653 1.1 nonaka case 0:
3654 1.1 nonaka break;
3655 1.1 nonaka }
3656 1.1 nonaka break;
3657 1.1 nonaka
3658 1.1 nonaka case SIOCADDMULTI:
3659 1.1 nonaka case SIOCDELMULTI:
3660 1.1 nonaka if ((error = ether_ioctl(ifp, cmd, data)) == ENETRESET) {
3661 1.1 nonaka /* setup multicast filter, etc */
3662 1.1 nonaka error = 0;
3663 1.1 nonaka }
3664 1.1 nonaka break;
3665 1.1 nonaka
3666 1.1 nonaka default:
3667 1.59.2.1 phil error = ieee80211_ioctl(ifp, cmd, data);
3668 1.1 nonaka break;
3669 1.1 nonaka }
3670 1.1 nonaka if (error == ENETRESET) {
3671 1.1 nonaka if ((ifp->if_flags & (IFF_UP | IFF_RUNNING)) ==
3672 1.59.2.1 phil (IFF_UP | IFF_RUNNING) /* && NNN need a vap for next line
3673 1.59.2.1 phil ic->ic_roaming != IEEE80211_ROAMING_MANUAL*/) {
3674 1.1 nonaka urtwn_init(ifp);
3675 1.1 nonaka }
3676 1.1 nonaka error = 0;
3677 1.1 nonaka }
3678 1.1 nonaka
3679 1.1 nonaka splx(s);
3680 1.1 nonaka
3681 1.42 skrll return error;
3682 1.1 nonaka }
3683 1.1 nonaka
3684 1.32 nonaka static __inline int
3685 1.32 nonaka urtwn_power_on(struct urtwn_softc *sc)
3686 1.32 nonaka {
3687 1.32 nonaka
3688 1.32 nonaka return sc->sc_power_on(sc);
3689 1.32 nonaka }
3690 1.32 nonaka
3691 1.1 nonaka static int
3692 1.32 nonaka urtwn_r92c_power_on(struct urtwn_softc *sc)
3693 1.1 nonaka {
3694 1.1 nonaka uint32_t reg;
3695 1.1 nonaka int ntries;
3696 1.1 nonaka
3697 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3698 1.1 nonaka
3699 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
3700 1.12 christos
3701 1.1 nonaka /* Wait for autoload done bit. */
3702 1.1 nonaka for (ntries = 0; ntries < 1000; ntries++) {
3703 1.1 nonaka if (urtwn_read_1(sc, R92C_APS_FSMCO) & R92C_APS_FSMCO_PFM_ALDN)
3704 1.1 nonaka break;
3705 1.1 nonaka DELAY(5);
3706 1.1 nonaka }
3707 1.1 nonaka if (ntries == 1000) {
3708 1.1 nonaka aprint_error_dev(sc->sc_dev,
3709 1.1 nonaka "timeout waiting for chip autoload\n");
3710 1.42 skrll return ETIMEDOUT;
3711 1.1 nonaka }
3712 1.1 nonaka
3713 1.1 nonaka /* Unlock ISO/CLK/Power control register. */
3714 1.1 nonaka urtwn_write_1(sc, R92C_RSV_CTRL, 0);
3715 1.1 nonaka /* Move SPS into PWM mode. */
3716 1.1 nonaka urtwn_write_1(sc, R92C_SPS0_CTRL, 0x2b);
3717 1.49 nat DELAY(5);
3718 1.1 nonaka
3719 1.1 nonaka reg = urtwn_read_1(sc, R92C_LDOV12D_CTRL);
3720 1.1 nonaka if (!(reg & R92C_LDOV12D_CTRL_LDV12_EN)) {
3721 1.1 nonaka urtwn_write_1(sc, R92C_LDOV12D_CTRL,
3722 1.1 nonaka reg | R92C_LDOV12D_CTRL_LDV12_EN);
3723 1.1 nonaka DELAY(100);
3724 1.1 nonaka urtwn_write_1(sc, R92C_SYS_ISO_CTRL,
3725 1.1 nonaka urtwn_read_1(sc, R92C_SYS_ISO_CTRL) &
3726 1.1 nonaka ~R92C_SYS_ISO_CTRL_MD2PP);
3727 1.1 nonaka }
3728 1.1 nonaka
3729 1.1 nonaka /* Auto enable WLAN. */
3730 1.1 nonaka urtwn_write_2(sc, R92C_APS_FSMCO,
3731 1.1 nonaka urtwn_read_2(sc, R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3732 1.1 nonaka for (ntries = 0; ntries < 1000; ntries++) {
3733 1.1 nonaka if (!(urtwn_read_2(sc, R92C_APS_FSMCO) &
3734 1.1 nonaka R92C_APS_FSMCO_APFM_ONMAC))
3735 1.1 nonaka break;
3736 1.49 nat DELAY(100);
3737 1.1 nonaka }
3738 1.1 nonaka if (ntries == 1000) {
3739 1.1 nonaka aprint_error_dev(sc->sc_dev,
3740 1.1 nonaka "timeout waiting for MAC auto ON\n");
3741 1.42 skrll return ETIMEDOUT;
3742 1.1 nonaka }
3743 1.1 nonaka
3744 1.1 nonaka /* Enable radio, GPIO and LED functions. */
3745 1.1 nonaka KASSERT((R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_PDN_EN |
3746 1.1 nonaka R92C_APS_FSMCO_PFM_ALDN) == 0x0812);
3747 1.1 nonaka urtwn_write_2(sc, R92C_APS_FSMCO,
3748 1.1 nonaka R92C_APS_FSMCO_AFSM_HSUS |
3749 1.1 nonaka R92C_APS_FSMCO_PDN_EN |
3750 1.1 nonaka R92C_APS_FSMCO_PFM_ALDN);
3751 1.1 nonaka
3752 1.1 nonaka /* Release RF digital isolation. */
3753 1.1 nonaka urtwn_write_2(sc, R92C_SYS_ISO_CTRL,
3754 1.1 nonaka urtwn_read_2(sc, R92C_SYS_ISO_CTRL) & ~R92C_SYS_ISO_CTRL_DIOR);
3755 1.1 nonaka
3756 1.1 nonaka /* Initialize MAC. */
3757 1.1 nonaka urtwn_write_1(sc, R92C_APSD_CTRL,
3758 1.1 nonaka urtwn_read_1(sc, R92C_APSD_CTRL) & ~R92C_APSD_CTRL_OFF);
3759 1.1 nonaka for (ntries = 0; ntries < 200; ntries++) {
3760 1.1 nonaka if (!(urtwn_read_1(sc, R92C_APSD_CTRL) &
3761 1.1 nonaka R92C_APSD_CTRL_OFF_STATUS))
3762 1.1 nonaka break;
3763 1.1 nonaka DELAY(5);
3764 1.1 nonaka }
3765 1.1 nonaka if (ntries == 200) {
3766 1.1 nonaka aprint_error_dev(sc->sc_dev,
3767 1.1 nonaka "timeout waiting for MAC initialization\n");
3768 1.42 skrll return ETIMEDOUT;
3769 1.1 nonaka }
3770 1.1 nonaka
3771 1.1 nonaka /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3772 1.1 nonaka reg = urtwn_read_2(sc, R92C_CR);
3773 1.1 nonaka reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3774 1.1 nonaka R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3775 1.1 nonaka R92C_CR_SCHEDULE_EN | R92C_CR_MACTXEN | R92C_CR_MACRXEN |
3776 1.1 nonaka R92C_CR_ENSEC;
3777 1.1 nonaka urtwn_write_2(sc, R92C_CR, reg);
3778 1.1 nonaka
3779 1.1 nonaka urtwn_write_1(sc, 0xfe10, 0x19);
3780 1.42 skrll return 0;
3781 1.1 nonaka }
3782 1.1 nonaka
3783 1.1 nonaka static int
3784 1.49 nat urtwn_r92e_power_on(struct urtwn_softc *sc)
3785 1.49 nat {
3786 1.49 nat uint32_t reg;
3787 1.49 nat uint32_t val;
3788 1.49 nat int ntries;
3789 1.49 nat
3790 1.49 nat DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3791 1.49 nat
3792 1.49 nat KASSERT(mutex_owned(&sc->sc_write_mtx));
3793 1.49 nat
3794 1.49 nat /* Enable radio, GPIO and LED functions. */
3795 1.49 nat KASSERT((R92C_APS_FSMCO_AFSM_HSUS | R92C_APS_FSMCO_PDN_EN |
3796 1.49 nat R92C_APS_FSMCO_PFM_ALDN) == 0x0812);
3797 1.49 nat urtwn_write_2(sc, R92C_APS_FSMCO,
3798 1.49 nat R92C_APS_FSMCO_AFSM_HSUS |
3799 1.49 nat R92C_APS_FSMCO_PDN_EN |
3800 1.49 nat R92C_APS_FSMCO_PFM_ALDN);
3801 1.49 nat
3802 1.49 nat if (urtwn_read_4(sc, R92E_SYS_CFG1_8192E) & R92E_SPSLDO_SEL){
3803 1.49 nat /* LDO. */
3804 1.52 skrll urtwn_write_1(sc, R92E_LDO_SWR_CTRL, 0xc3);
3805 1.49 nat }
3806 1.49 nat else {
3807 1.49 nat urtwn_write_2(sc, R92C_SYS_SWR_CTRL2, urtwn_read_2(sc,
3808 1.49 nat R92C_SYS_SWR_CTRL2) & 0xffff);
3809 1.49 nat urtwn_write_1(sc, R92E_LDO_SWR_CTRL, 0x83);
3810 1.49 nat }
3811 1.49 nat
3812 1.49 nat for (ntries = 0; ntries < 2; ntries++) {
3813 1.49 nat urtwn_write_1(sc, R92C_AFE_PLL_CTRL,
3814 1.49 nat urtwn_read_1(sc, R92C_AFE_PLL_CTRL));
3815 1.49 nat urtwn_write_2(sc, R92C_AFE_CTRL4, urtwn_read_2(sc,
3816 1.49 nat R92C_AFE_CTRL4));
3817 1.49 nat }
3818 1.49 nat
3819 1.49 nat /* Reset BB. */
3820 1.49 nat urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3821 1.49 nat urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
3822 1.49 nat R92C_SYS_FUNC_EN_BB_GLB_RST));
3823 1.49 nat
3824 1.49 nat urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 2, urtwn_read_1(sc,
3825 1.49 nat R92C_AFE_XTAL_CTRL + 2) | 0x80);
3826 1.49 nat
3827 1.49 nat /* Disable HWPDN. */
3828 1.49 nat urtwn_write_2(sc, R92C_APS_FSMCO, urtwn_read_2(sc,
3829 1.49 nat R92C_APS_FSMCO) & ~R92C_APS_FSMCO_APDM_HPDN);
3830 1.49 nat
3831 1.49 nat /* Disable WL suspend. */
3832 1.49 nat urtwn_write_2(sc, R92C_APS_FSMCO, urtwn_read_2(sc,
3833 1.49 nat R92C_APS_FSMCO) & ~(R92C_APS_FSMCO_AFSM_PCIE |
3834 1.49 nat R92C_APS_FSMCO_AFSM_HSUS));
3835 1.49 nat
3836 1.49 nat urtwn_write_4(sc, R92C_APS_FSMCO, urtwn_read_4(sc,
3837 1.49 nat R92C_APS_FSMCO) | R92C_APS_FSMCO_RDY_MACON);
3838 1.49 nat urtwn_write_2(sc, R92C_APS_FSMCO, urtwn_read_2(sc,
3839 1.49 nat R92C_APS_FSMCO) | R92C_APS_FSMCO_APFM_ONMAC);
3840 1.49 nat for (ntries = 0; ntries < 10000; ntries++) {
3841 1.49 nat val = urtwn_read_2(sc, R92C_APS_FSMCO) &
3842 1.49 nat R92C_APS_FSMCO_APFM_ONMAC;
3843 1.49 nat if (val == 0x0)
3844 1.49 nat break;
3845 1.49 nat DELAY(10);
3846 1.49 nat }
3847 1.49 nat if (ntries == 10000) {
3848 1.49 nat aprint_error_dev(sc->sc_dev,
3849 1.49 nat "timeout waiting for chip power up\n");
3850 1.49 nat return ETIMEDOUT;
3851 1.49 nat }
3852 1.52 skrll
3853 1.49 nat urtwn_write_2(sc, R92C_CR, 0x00);
3854 1.49 nat reg = urtwn_read_2(sc, R92C_CR);
3855 1.49 nat reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3856 1.49 nat R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3857 1.49 nat R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC;
3858 1.49 nat urtwn_write_2(sc, R92C_CR, reg);
3859 1.49 nat
3860 1.49 nat return 0;
3861 1.49 nat }
3862 1.49 nat
3863 1.49 nat static int
3864 1.32 nonaka urtwn_r88e_power_on(struct urtwn_softc *sc)
3865 1.32 nonaka {
3866 1.32 nonaka uint32_t reg;
3867 1.32 nonaka uint8_t val;
3868 1.32 nonaka int ntries;
3869 1.32 nonaka
3870 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3871 1.32 nonaka
3872 1.32 nonaka KASSERT(mutex_owned(&sc->sc_write_mtx));
3873 1.32 nonaka
3874 1.32 nonaka /* Wait for power ready bit. */
3875 1.32 nonaka for (ntries = 0; ntries < 5000; ntries++) {
3876 1.32 nonaka val = urtwn_read_1(sc, 0x6) & 0x2;
3877 1.32 nonaka if (val == 0x2)
3878 1.32 nonaka break;
3879 1.32 nonaka DELAY(10);
3880 1.32 nonaka }
3881 1.32 nonaka if (ntries == 5000) {
3882 1.32 nonaka aprint_error_dev(sc->sc_dev,
3883 1.32 nonaka "timeout waiting for chip power up\n");
3884 1.42 skrll return ETIMEDOUT;
3885 1.32 nonaka }
3886 1.32 nonaka
3887 1.32 nonaka /* Reset BB. */
3888 1.32 nonaka urtwn_write_1(sc, R92C_SYS_FUNC_EN,
3889 1.32 nonaka urtwn_read_1(sc, R92C_SYS_FUNC_EN) & ~(R92C_SYS_FUNC_EN_BBRSTB |
3890 1.32 nonaka R92C_SYS_FUNC_EN_BB_GLB_RST));
3891 1.32 nonaka
3892 1.32 nonaka urtwn_write_1(sc, 0x26, urtwn_read_1(sc, 0x26) | 0x80);
3893 1.32 nonaka
3894 1.32 nonaka /* Disable HWPDN. */
3895 1.32 nonaka urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) & ~0x80);
3896 1.32 nonaka
3897 1.32 nonaka /* Disable WL suspend. */
3898 1.32 nonaka urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) & ~0x18);
3899 1.32 nonaka
3900 1.32 nonaka urtwn_write_1(sc, 0x5, urtwn_read_1(sc, 0x5) | 0x1);
3901 1.32 nonaka for (ntries = 0; ntries < 5000; ntries++) {
3902 1.32 nonaka if (!(urtwn_read_1(sc, 0x5) & 0x1))
3903 1.32 nonaka break;
3904 1.32 nonaka DELAY(10);
3905 1.32 nonaka }
3906 1.32 nonaka if (ntries == 5000)
3907 1.42 skrll return ETIMEDOUT;
3908 1.32 nonaka
3909 1.32 nonaka /* Enable LDO normal mode. */
3910 1.32 nonaka urtwn_write_1(sc, 0x23, urtwn_read_1(sc, 0x23) & ~0x10);
3911 1.32 nonaka
3912 1.32 nonaka /* Enable MAC DMA/WMAC/SCHEDULE/SEC blocks. */
3913 1.32 nonaka urtwn_write_2(sc, R92C_CR, 0);
3914 1.32 nonaka reg = urtwn_read_2(sc, R92C_CR);
3915 1.32 nonaka reg |= R92C_CR_HCI_TXDMA_EN | R92C_CR_HCI_RXDMA_EN |
3916 1.32 nonaka R92C_CR_TXDMA_EN | R92C_CR_RXDMA_EN | R92C_CR_PROTOCOL_EN |
3917 1.32 nonaka R92C_CR_SCHEDULE_EN | R92C_CR_ENSEC | R92C_CR_CALTMR_EN;
3918 1.32 nonaka urtwn_write_2(sc, R92C_CR, reg);
3919 1.32 nonaka
3920 1.42 skrll return 0;
3921 1.32 nonaka }
3922 1.32 nonaka
3923 1.32 nonaka static int
3924 1.1 nonaka urtwn_llt_init(struct urtwn_softc *sc)
3925 1.1 nonaka {
3926 1.32 nonaka size_t i, page_count, pktbuf_count;
3927 1.49 nat uint32_t val;
3928 1.22 christos int error;
3929 1.1 nonaka
3930 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3931 1.1 nonaka
3932 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
3933 1.12 christos
3934 1.52 skrll if (sc->chip & URTWN_CHIP_88E)
3935 1.49 nat page_count = R88E_TX_PAGE_COUNT;
3936 1.52 skrll else if (sc->chip & URTWN_CHIP_92EU)
3937 1.49 nat page_count = R92E_TX_PAGE_COUNT;
3938 1.49 nat else
3939 1.49 nat page_count = R92C_TX_PAGE_COUNT;
3940 1.49 nat if (sc->chip & URTWN_CHIP_88E)
3941 1.49 nat pktbuf_count = R88E_TXPKTBUF_COUNT;
3942 1.49 nat else if (sc->chip & URTWN_CHIP_92EU)
3943 1.49 nat pktbuf_count = R88E_TXPKTBUF_COUNT;
3944 1.49 nat else
3945 1.49 nat pktbuf_count = R92C_TXPKTBUF_COUNT;
3946 1.49 nat
3947 1.49 nat if (sc->chip & URTWN_CHIP_92EU) {
3948 1.49 nat val = urtwn_read_4(sc, R92E_AUTO_LLT) | R92E_AUTO_LLT_EN;
3949 1.49 nat urtwn_write_4(sc, R92E_AUTO_LLT, val);
3950 1.49 nat DELAY(100);
3951 1.49 nat val = urtwn_read_4(sc, R92E_AUTO_LLT);
3952 1.49 nat if (val & R92E_AUTO_LLT_EN)
3953 1.49 nat return EIO;
3954 1.49 nat return 0;
3955 1.49 nat }
3956 1.32 nonaka
3957 1.32 nonaka /* Reserve pages [0; page_count]. */
3958 1.32 nonaka for (i = 0; i < page_count; i++) {
3959 1.1 nonaka if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3960 1.42 skrll return error;
3961 1.1 nonaka }
3962 1.1 nonaka /* NB: 0xff indicates end-of-list. */
3963 1.1 nonaka if ((error = urtwn_llt_write(sc, i, 0xff)) != 0)
3964 1.42 skrll return error;
3965 1.1 nonaka /*
3966 1.32 nonaka * Use pages [page_count + 1; pktbuf_count - 1]
3967 1.1 nonaka * as ring buffer.
3968 1.1 nonaka */
3969 1.32 nonaka for (++i; i < pktbuf_count - 1; i++) {
3970 1.1 nonaka if ((error = urtwn_llt_write(sc, i, i + 1)) != 0)
3971 1.42 skrll return error;
3972 1.1 nonaka }
3973 1.1 nonaka /* Make the last page point to the beginning of the ring buffer. */
3974 1.32 nonaka error = urtwn_llt_write(sc, i, pktbuf_count + 1);
3975 1.42 skrll return error;
3976 1.1 nonaka }
3977 1.1 nonaka
3978 1.59.2.1 phil static __unused void
3979 1.1 nonaka urtwn_fw_reset(struct urtwn_softc *sc)
3980 1.1 nonaka {
3981 1.1 nonaka uint16_t reg;
3982 1.1 nonaka int ntries;
3983 1.1 nonaka
3984 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
3985 1.1 nonaka
3986 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
3987 1.12 christos
3988 1.1 nonaka /* Tell 8051 to reset itself. */
3989 1.1 nonaka urtwn_write_1(sc, R92C_HMETFR + 3, 0x20);
3990 1.1 nonaka
3991 1.1 nonaka /* Wait until 8051 resets by itself. */
3992 1.1 nonaka for (ntries = 0; ntries < 100; ntries++) {
3993 1.1 nonaka reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
3994 1.1 nonaka if (!(reg & R92C_SYS_FUNC_EN_CPUEN))
3995 1.1 nonaka return;
3996 1.1 nonaka DELAY(50);
3997 1.1 nonaka }
3998 1.1 nonaka /* Force 8051 reset. */
3999 1.32 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4000 1.32 nonaka urtwn_read_2(sc, R92C_SYS_FUNC_EN) & ~R92C_SYS_FUNC_EN_CPUEN);
4001 1.32 nonaka }
4002 1.32 nonaka
4003 1.32 nonaka static void
4004 1.32 nonaka urtwn_r88e_fw_reset(struct urtwn_softc *sc)
4005 1.32 nonaka {
4006 1.32 nonaka uint16_t reg;
4007 1.32 nonaka
4008 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4009 1.32 nonaka
4010 1.32 nonaka KASSERT(mutex_owned(&sc->sc_write_mtx));
4011 1.32 nonaka
4012 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
4013 1.49 nat reg = urtwn_read_2(sc, R92C_RSV_CTRL) & ~R92E_RSV_MIO_EN;
4014 1.49 nat urtwn_write_2(sc,R92C_RSV_CTRL, reg);
4015 1.49 nat }
4016 1.49 nat DELAY(50);
4017 1.49 nat
4018 1.32 nonaka reg = urtwn_read_2(sc, R92C_SYS_FUNC_EN);
4019 1.1 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg & ~R92C_SYS_FUNC_EN_CPUEN);
4020 1.49 nat DELAY(50);
4021 1.49 nat
4022 1.32 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN, reg | R92C_SYS_FUNC_EN_CPUEN);
4023 1.49 nat DELAY(50);
4024 1.49 nat
4025 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
4026 1.49 nat reg = urtwn_read_2(sc, R92C_RSV_CTRL) | R92E_RSV_MIO_EN;
4027 1.49 nat urtwn_write_2(sc,R92C_RSV_CTRL, reg);
4028 1.49 nat }
4029 1.49 nat DELAY(50);
4030 1.49 nat
4031 1.1 nonaka }
4032 1.1 nonaka
4033 1.1 nonaka static int
4034 1.1 nonaka urtwn_fw_loadpage(struct urtwn_softc *sc, int page, uint8_t *buf, int len)
4035 1.1 nonaka {
4036 1.1 nonaka uint32_t reg;
4037 1.1 nonaka int off, mlen, error = 0;
4038 1.1 nonaka
4039 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: page=%d, buf=%p, len=%d\n",
4040 1.1 nonaka device_xname(sc->sc_dev), __func__, page, buf, len));
4041 1.1 nonaka
4042 1.1 nonaka reg = urtwn_read_4(sc, R92C_MCUFWDL);
4043 1.1 nonaka reg = RW(reg, R92C_MCUFWDL_PAGE, page);
4044 1.1 nonaka urtwn_write_4(sc, R92C_MCUFWDL, reg);
4045 1.1 nonaka
4046 1.1 nonaka off = R92C_FW_START_ADDR;
4047 1.1 nonaka while (len > 0) {
4048 1.1 nonaka if (len > 196)
4049 1.1 nonaka mlen = 196;
4050 1.1 nonaka else if (len > 4)
4051 1.1 nonaka mlen = 4;
4052 1.1 nonaka else
4053 1.1 nonaka mlen = 1;
4054 1.1 nonaka error = urtwn_write_region(sc, off, buf, mlen);
4055 1.1 nonaka if (error != 0)
4056 1.1 nonaka break;
4057 1.1 nonaka off += mlen;
4058 1.1 nonaka buf += mlen;
4059 1.1 nonaka len -= mlen;
4060 1.1 nonaka }
4061 1.42 skrll return error;
4062 1.1 nonaka }
4063 1.1 nonaka
4064 1.1 nonaka static int
4065 1.1 nonaka urtwn_load_firmware(struct urtwn_softc *sc)
4066 1.1 nonaka {
4067 1.1 nonaka firmware_handle_t fwh;
4068 1.1 nonaka const struct r92c_fw_hdr *hdr;
4069 1.1 nonaka const char *name;
4070 1.1 nonaka u_char *fw, *ptr;
4071 1.1 nonaka size_t len;
4072 1.1 nonaka uint32_t reg;
4073 1.1 nonaka int mlen, ntries, page, error;
4074 1.1 nonaka
4075 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4076 1.1 nonaka
4077 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4078 1.12 christos
4079 1.1 nonaka /* Read firmware image from the filesystem. */
4080 1.32 nonaka if (ISSET(sc->chip, URTWN_CHIP_88E))
4081 1.32 nonaka name = "rtl8188eufw.bin";
4082 1.49 nat else if (ISSET(sc->chip, URTWN_CHIP_92EU))
4083 1.49 nat name = "rtl8192eefw.bin";
4084 1.32 nonaka else if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
4085 1.1 nonaka URTWN_CHIP_UMC_A_CUT)
4086 1.5 riz name = "rtl8192cfwU.bin";
4087 1.1 nonaka else
4088 1.5 riz name = "rtl8192cfw.bin";
4089 1.5 riz if ((error = firmware_open("if_urtwn", name, &fwh)) != 0) {
4090 1.1 nonaka aprint_error_dev(sc->sc_dev,
4091 1.32 nonaka "failed load firmware of file %s (error %d)\n", name,
4092 1.32 nonaka error);
4093 1.42 skrll return error;
4094 1.1 nonaka }
4095 1.36 jmcneill const size_t fwlen = len = firmware_get_size(fwh);
4096 1.1 nonaka fw = firmware_malloc(len);
4097 1.1 nonaka if (fw == NULL) {
4098 1.1 nonaka aprint_error_dev(sc->sc_dev,
4099 1.1 nonaka "failed to allocate firmware memory\n");
4100 1.1 nonaka firmware_close(fwh);
4101 1.42 skrll return ENOMEM;
4102 1.1 nonaka }
4103 1.1 nonaka error = firmware_read(fwh, 0, fw, len);
4104 1.1 nonaka firmware_close(fwh);
4105 1.1 nonaka if (error != 0) {
4106 1.1 nonaka aprint_error_dev(sc->sc_dev,
4107 1.1 nonaka "failed to read firmware (error %d)\n", error);
4108 1.36 jmcneill firmware_free(fw, fwlen);
4109 1.42 skrll return error;
4110 1.1 nonaka }
4111 1.1 nonaka
4112 1.49 nat len = fwlen;
4113 1.1 nonaka ptr = fw;
4114 1.1 nonaka hdr = (const struct r92c_fw_hdr *)ptr;
4115 1.1 nonaka /* Check if there is a valid FW header and skip it. */
4116 1.1 nonaka if ((le16toh(hdr->signature) >> 4) == 0x88c ||
4117 1.32 nonaka (le16toh(hdr->signature) >> 4) == 0x88e ||
4118 1.49 nat (le16toh(hdr->signature) >> 4) == 0x92e ||
4119 1.1 nonaka (le16toh(hdr->signature) >> 4) == 0x92c) {
4120 1.1 nonaka DPRINTFN(DBG_INIT, ("%s: %s: FW V%d.%d %02d-%02d %02d:%02d\n",
4121 1.1 nonaka device_xname(sc->sc_dev), __func__,
4122 1.1 nonaka le16toh(hdr->version), le16toh(hdr->subversion),
4123 1.1 nonaka hdr->month, hdr->date, hdr->hour, hdr->minute));
4124 1.1 nonaka ptr += sizeof(*hdr);
4125 1.1 nonaka len -= sizeof(*hdr);
4126 1.1 nonaka }
4127 1.1 nonaka
4128 1.32 nonaka if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RAM_DL_SEL) {
4129 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
4130 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
4131 1.32 nonaka urtwn_r88e_fw_reset(sc);
4132 1.32 nonaka else
4133 1.32 nonaka urtwn_fw_reset(sc);
4134 1.1 nonaka }
4135 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
4136 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
4137 1.32 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4138 1.32 nonaka urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
4139 1.32 nonaka R92C_SYS_FUNC_EN_CPUEN);
4140 1.32 nonaka }
4141 1.1 nonaka
4142 1.1 nonaka /* download enabled */
4143 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL,
4144 1.1 nonaka urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_EN);
4145 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL + 2,
4146 1.1 nonaka urtwn_read_1(sc, R92C_MCUFWDL + 2) & ~0x08);
4147 1.1 nonaka
4148 1.32 nonaka /* Reset the FWDL checksum. */
4149 1.32 nonaka urtwn_write_1(sc, R92C_MCUFWDL,
4150 1.52 skrll urtwn_read_1(sc, R92C_MCUFWDL) | R92C_MCUFWDL_CHKSUM_RPT);
4151 1.32 nonaka
4152 1.49 nat DELAY(50);
4153 1.1 nonaka /* download firmware */
4154 1.1 nonaka for (page = 0; len > 0; page++) {
4155 1.1 nonaka mlen = MIN(len, R92C_FW_PAGE_SIZE);
4156 1.1 nonaka error = urtwn_fw_loadpage(sc, page, ptr, mlen);
4157 1.1 nonaka if (error != 0) {
4158 1.1 nonaka aprint_error_dev(sc->sc_dev,
4159 1.1 nonaka "could not load firmware page %d\n", page);
4160 1.1 nonaka goto fail;
4161 1.1 nonaka }
4162 1.1 nonaka ptr += mlen;
4163 1.1 nonaka len -= mlen;
4164 1.1 nonaka }
4165 1.1 nonaka
4166 1.1 nonaka /* download disable */
4167 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL,
4168 1.1 nonaka urtwn_read_1(sc, R92C_MCUFWDL) & ~R92C_MCUFWDL_EN);
4169 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL + 1, 0);
4170 1.1 nonaka
4171 1.1 nonaka /* Wait for checksum report. */
4172 1.1 nonaka for (ntries = 0; ntries < 1000; ntries++) {
4173 1.1 nonaka if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_CHKSUM_RPT)
4174 1.1 nonaka break;
4175 1.1 nonaka DELAY(5);
4176 1.1 nonaka }
4177 1.1 nonaka if (ntries == 1000) {
4178 1.1 nonaka aprint_error_dev(sc->sc_dev,
4179 1.1 nonaka "timeout waiting for checksum report\n");
4180 1.1 nonaka error = ETIMEDOUT;
4181 1.1 nonaka goto fail;
4182 1.1 nonaka }
4183 1.1 nonaka
4184 1.1 nonaka /* Wait for firmware readiness. */
4185 1.1 nonaka reg = urtwn_read_4(sc, R92C_MCUFWDL);
4186 1.1 nonaka reg = (reg & ~R92C_MCUFWDL_WINTINI_RDY) | R92C_MCUFWDL_RDY;
4187 1.1 nonaka urtwn_write_4(sc, R92C_MCUFWDL, reg);
4188 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
4189 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
4190 1.32 nonaka urtwn_r88e_fw_reset(sc);
4191 1.59.2.5 phil for (ntries = 0; ntries < 1500; ntries++) {
4192 1.1 nonaka if (urtwn_read_4(sc, R92C_MCUFWDL) & R92C_MCUFWDL_WINTINI_RDY)
4193 1.1 nonaka break;
4194 1.1 nonaka DELAY(5);
4195 1.1 nonaka }
4196 1.59.2.5 phil if (ntries == 1500) {
4197 1.1 nonaka aprint_error_dev(sc->sc_dev,
4198 1.1 nonaka "timeout waiting for firmware readiness\n");
4199 1.1 nonaka error = ETIMEDOUT;
4200 1.1 nonaka goto fail;
4201 1.1 nonaka }
4202 1.1 nonaka fail:
4203 1.36 jmcneill firmware_free(fw, fwlen);
4204 1.42 skrll return error;
4205 1.1 nonaka }
4206 1.1 nonaka
4207 1.32 nonaka static __inline int
4208 1.32 nonaka urtwn_dma_init(struct urtwn_softc *sc)
4209 1.32 nonaka {
4210 1.32 nonaka
4211 1.32 nonaka return sc->sc_dma_init(sc);
4212 1.32 nonaka }
4213 1.32 nonaka
4214 1.1 nonaka static int
4215 1.32 nonaka urtwn_r92c_dma_init(struct urtwn_softc *sc)
4216 1.1 nonaka {
4217 1.1 nonaka int hashq, hasnq, haslq, nqueues, nqpages, nrempages;
4218 1.1 nonaka uint32_t reg;
4219 1.1 nonaka int error;
4220 1.1 nonaka
4221 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4222 1.1 nonaka
4223 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4224 1.12 christos
4225 1.1 nonaka /* Initialize LLT table. */
4226 1.1 nonaka error = urtwn_llt_init(sc);
4227 1.1 nonaka if (error != 0)
4228 1.42 skrll return error;
4229 1.1 nonaka
4230 1.1 nonaka /* Get Tx queues to USB endpoints mapping. */
4231 1.1 nonaka hashq = hasnq = haslq = 0;
4232 1.1 nonaka reg = urtwn_read_2(sc, R92C_USB_EP + 1);
4233 1.1 nonaka DPRINTFN(DBG_INIT, ("%s: %s: USB endpoints mapping 0x%x\n",
4234 1.1 nonaka device_xname(sc->sc_dev), __func__, reg));
4235 1.1 nonaka if (MS(reg, R92C_USB_EP_HQ) != 0)
4236 1.1 nonaka hashq = 1;
4237 1.1 nonaka if (MS(reg, R92C_USB_EP_NQ) != 0)
4238 1.1 nonaka hasnq = 1;
4239 1.1 nonaka if (MS(reg, R92C_USB_EP_LQ) != 0)
4240 1.1 nonaka haslq = 1;
4241 1.1 nonaka nqueues = hashq + hasnq + haslq;
4242 1.1 nonaka if (nqueues == 0)
4243 1.42 skrll return EIO;
4244 1.1 nonaka /* Get the number of pages for each queue. */
4245 1.1 nonaka nqpages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) / nqueues;
4246 1.1 nonaka /* The remaining pages are assigned to the high priority queue. */
4247 1.1 nonaka nrempages = (R92C_TX_PAGE_COUNT - R92C_PUBQ_NPAGES) % nqueues;
4248 1.1 nonaka
4249 1.1 nonaka /* Set number of pages for normal priority queue. */
4250 1.1 nonaka urtwn_write_1(sc, R92C_RQPN_NPQ, hasnq ? nqpages : 0);
4251 1.1 nonaka urtwn_write_4(sc, R92C_RQPN,
4252 1.1 nonaka /* Set number of pages for public queue. */
4253 1.1 nonaka SM(R92C_RQPN_PUBQ, R92C_PUBQ_NPAGES) |
4254 1.1 nonaka /* Set number of pages for high priority queue. */
4255 1.1 nonaka SM(R92C_RQPN_HPQ, hashq ? nqpages + nrempages : 0) |
4256 1.1 nonaka /* Set number of pages for low priority queue. */
4257 1.1 nonaka SM(R92C_RQPN_LPQ, haslq ? nqpages : 0) |
4258 1.1 nonaka /* Load values. */
4259 1.1 nonaka R92C_RQPN_LD);
4260 1.1 nonaka
4261 1.1 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R92C_TX_PAGE_BOUNDARY);
4262 1.1 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R92C_TX_PAGE_BOUNDARY);
4263 1.1 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R92C_TX_PAGE_BOUNDARY);
4264 1.1 nonaka urtwn_write_1(sc, R92C_TRXFF_BNDY, R92C_TX_PAGE_BOUNDARY);
4265 1.1 nonaka urtwn_write_1(sc, R92C_TDECTRL + 1, R92C_TX_PAGE_BOUNDARY);
4266 1.1 nonaka
4267 1.1 nonaka /* Set queue to USB pipe mapping. */
4268 1.1 nonaka reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
4269 1.1 nonaka reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
4270 1.1 nonaka if (nqueues == 1) {
4271 1.1 nonaka if (hashq) {
4272 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_HQ;
4273 1.1 nonaka } else if (hasnq) {
4274 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_NQ;
4275 1.1 nonaka } else {
4276 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
4277 1.1 nonaka }
4278 1.1 nonaka } else if (nqueues == 2) {
4279 1.1 nonaka /* All 2-endpoints configs have a high priority queue. */
4280 1.1 nonaka if (!hashq) {
4281 1.42 skrll return EIO;
4282 1.1 nonaka }
4283 1.1 nonaka if (hasnq) {
4284 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
4285 1.1 nonaka } else {
4286 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_HQ_LQ;
4287 1.1 nonaka }
4288 1.1 nonaka } else {
4289 1.1 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
4290 1.1 nonaka }
4291 1.1 nonaka urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
4292 1.1 nonaka
4293 1.1 nonaka /* Set Tx/Rx transfer page boundary. */
4294 1.1 nonaka urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x27ff);
4295 1.1 nonaka
4296 1.1 nonaka /* Set Tx/Rx transfer page size. */
4297 1.1 nonaka urtwn_write_1(sc, R92C_PBP,
4298 1.1 nonaka SM(R92C_PBP_PSRX, R92C_PBP_128) | SM(R92C_PBP_PSTX, R92C_PBP_128));
4299 1.42 skrll return 0;
4300 1.1 nonaka }
4301 1.1 nonaka
4302 1.32 nonaka static int
4303 1.32 nonaka urtwn_r88e_dma_init(struct urtwn_softc *sc)
4304 1.32 nonaka {
4305 1.32 nonaka usb_interface_descriptor_t *id;
4306 1.32 nonaka uint32_t reg;
4307 1.32 nonaka int nqueues;
4308 1.32 nonaka int error;
4309 1.32 nonaka
4310 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4311 1.32 nonaka
4312 1.32 nonaka KASSERT(mutex_owned(&sc->sc_write_mtx));
4313 1.32 nonaka
4314 1.32 nonaka /* Initialize LLT table. */
4315 1.32 nonaka error = urtwn_llt_init(sc);
4316 1.32 nonaka if (error != 0)
4317 1.42 skrll return error;
4318 1.32 nonaka
4319 1.32 nonaka /* Get Tx queues to USB endpoints mapping. */
4320 1.32 nonaka id = usbd_get_interface_descriptor(sc->sc_iface);
4321 1.32 nonaka nqueues = id->bNumEndpoints - 1;
4322 1.32 nonaka if (nqueues == 0)
4323 1.42 skrll return EIO;
4324 1.32 nonaka
4325 1.32 nonaka /* Set number of pages for normal priority queue. */
4326 1.32 nonaka urtwn_write_2(sc, R92C_RQPN_NPQ, 0);
4327 1.32 nonaka urtwn_write_2(sc, R92C_RQPN_NPQ, 0x000d);
4328 1.32 nonaka urtwn_write_4(sc, R92C_RQPN, 0x808e000d);
4329 1.32 nonaka
4330 1.32 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_BCNQ_BDNY, R88E_TX_PAGE_BOUNDARY);
4331 1.32 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_MGQ_BDNY, R88E_TX_PAGE_BOUNDARY);
4332 1.32 nonaka urtwn_write_1(sc, R92C_TXPKTBUF_WMAC_LBK_BF_HD, R88E_TX_PAGE_BOUNDARY);
4333 1.32 nonaka urtwn_write_1(sc, R92C_TRXFF_BNDY, R88E_TX_PAGE_BOUNDARY);
4334 1.32 nonaka urtwn_write_1(sc, R92C_TDECTRL + 1, R88E_TX_PAGE_BOUNDARY);
4335 1.32 nonaka
4336 1.32 nonaka /* Set queue to USB pipe mapping. */
4337 1.32 nonaka reg = urtwn_read_2(sc, R92C_TRXDMA_CTRL);
4338 1.32 nonaka reg &= ~R92C_TRXDMA_CTRL_QMAP_M;
4339 1.32 nonaka if (nqueues == 1)
4340 1.32 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_LQ;
4341 1.32 nonaka else if (nqueues == 2)
4342 1.32 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_HQ_NQ;
4343 1.32 nonaka else
4344 1.32 nonaka reg |= R92C_TRXDMA_CTRL_QMAP_3EP;
4345 1.32 nonaka urtwn_write_2(sc, R92C_TRXDMA_CTRL, reg);
4346 1.32 nonaka
4347 1.32 nonaka /* Set Tx/Rx transfer page boundary. */
4348 1.32 nonaka urtwn_write_2(sc, R92C_TRXFF_BNDY + 2, 0x23ff);
4349 1.32 nonaka
4350 1.32 nonaka /* Set Tx/Rx transfer page size. */
4351 1.32 nonaka urtwn_write_1(sc, R92C_PBP,
4352 1.32 nonaka SM(R92C_PBP_PSRX, R92C_PBP_128) | SM(R92C_PBP_PSTX, R92C_PBP_128));
4353 1.32 nonaka
4354 1.42 skrll return 0;
4355 1.32 nonaka }
4356 1.32 nonaka
4357 1.1 nonaka static void
4358 1.1 nonaka urtwn_mac_init(struct urtwn_softc *sc)
4359 1.1 nonaka {
4360 1.22 christos size_t i;
4361 1.1 nonaka
4362 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4363 1.1 nonaka
4364 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4365 1.12 christos
4366 1.1 nonaka /* Write MAC initialization values. */
4367 1.32 nonaka if (ISSET(sc->chip, URTWN_CHIP_88E)) {
4368 1.32 nonaka for (i = 0; i < __arraycount(rtl8188eu_mac); i++)
4369 1.32 nonaka urtwn_write_1(sc, rtl8188eu_mac[i].reg,
4370 1.32 nonaka rtl8188eu_mac[i].val);
4371 1.52 skrll } else if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
4372 1.49 nat for (i = 0; i < __arraycount(rtl8192eu_mac); i++)
4373 1.49 nat urtwn_write_1(sc, rtl8192eu_mac[i].reg,
4374 1.49 nat rtl8192eu_mac[i].val);
4375 1.32 nonaka } else {
4376 1.32 nonaka for (i = 0; i < __arraycount(rtl8192cu_mac); i++)
4377 1.32 nonaka urtwn_write_1(sc, rtl8192cu_mac[i].reg,
4378 1.32 nonaka rtl8192cu_mac[i].val);
4379 1.32 nonaka }
4380 1.1 nonaka }
4381 1.1 nonaka
4382 1.1 nonaka static void
4383 1.1 nonaka urtwn_bb_init(struct urtwn_softc *sc)
4384 1.1 nonaka {
4385 1.1 nonaka const struct urtwn_bb_prog *prog;
4386 1.1 nonaka uint32_t reg;
4387 1.32 nonaka uint8_t crystalcap;
4388 1.22 christos size_t i;
4389 1.1 nonaka
4390 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4391 1.1 nonaka
4392 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4393 1.12 christos
4394 1.1 nonaka /* Enable BB and RF. */
4395 1.1 nonaka urtwn_write_2(sc, R92C_SYS_FUNC_EN,
4396 1.1 nonaka urtwn_read_2(sc, R92C_SYS_FUNC_EN) |
4397 1.1 nonaka R92C_SYS_FUNC_EN_BBRSTB | R92C_SYS_FUNC_EN_BB_GLB_RST |
4398 1.1 nonaka R92C_SYS_FUNC_EN_DIO_RF);
4399 1.1 nonaka
4400 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
4401 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
4402 1.32 nonaka urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x83);
4403 1.32 nonaka urtwn_write_1(sc, R92C_AFE_PLL_CTRL + 1, 0xdb);
4404 1.32 nonaka }
4405 1.1 nonaka
4406 1.1 nonaka urtwn_write_1(sc, R92C_RF_CTRL,
4407 1.1 nonaka R92C_RF_CTRL_EN | R92C_RF_CTRL_RSTB | R92C_RF_CTRL_SDMRSTB);
4408 1.1 nonaka urtwn_write_1(sc, R92C_SYS_FUNC_EN,
4409 1.1 nonaka R92C_SYS_FUNC_EN_USBA | R92C_SYS_FUNC_EN_USBD |
4410 1.1 nonaka R92C_SYS_FUNC_EN_BB_GLB_RST | R92C_SYS_FUNC_EN_BBRSTB);
4411 1.1 nonaka
4412 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
4413 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
4414 1.32 nonaka urtwn_write_1(sc, R92C_LDOHCI12_CTRL, 0x0f);
4415 1.32 nonaka urtwn_write_1(sc, 0x15, 0xe9);
4416 1.32 nonaka urtwn_write_1(sc, R92C_AFE_XTAL_CTRL + 1, 0x80);
4417 1.32 nonaka }
4418 1.1 nonaka
4419 1.1 nonaka /* Select BB programming based on board type. */
4420 1.32 nonaka if (ISSET(sc->chip, URTWN_CHIP_88E))
4421 1.32 nonaka prog = &rtl8188eu_bb_prog;
4422 1.49 nat else if (ISSET(sc->chip, URTWN_CHIP_92EU))
4423 1.49 nat prog = &rtl8192eu_bb_prog;
4424 1.32 nonaka else if (!(sc->chip & URTWN_CHIP_92C)) {
4425 1.1 nonaka if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
4426 1.1 nonaka prog = &rtl8188ce_bb_prog;
4427 1.1 nonaka } else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
4428 1.1 nonaka prog = &rtl8188ru_bb_prog;
4429 1.1 nonaka } else {
4430 1.1 nonaka prog = &rtl8188cu_bb_prog;
4431 1.1 nonaka }
4432 1.1 nonaka } else {
4433 1.1 nonaka if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
4434 1.1 nonaka prog = &rtl8192ce_bb_prog;
4435 1.1 nonaka } else {
4436 1.1 nonaka prog = &rtl8192cu_bb_prog;
4437 1.1 nonaka }
4438 1.1 nonaka }
4439 1.1 nonaka /* Write BB initialization values. */
4440 1.1 nonaka for (i = 0; i < prog->count; i++) {
4441 1.1 nonaka /* additional delay depend on registers */
4442 1.1 nonaka switch (prog->regs[i]) {
4443 1.1 nonaka case 0xfe:
4444 1.49 nat urtwn_delay_ms(sc, 50);
4445 1.1 nonaka break;
4446 1.1 nonaka case 0xfd:
4447 1.49 nat urtwn_delay_ms(sc, 5);
4448 1.1 nonaka break;
4449 1.1 nonaka case 0xfc:
4450 1.49 nat urtwn_delay_ms(sc, 1);
4451 1.1 nonaka break;
4452 1.1 nonaka case 0xfb:
4453 1.1 nonaka DELAY(50);
4454 1.1 nonaka break;
4455 1.1 nonaka case 0xfa:
4456 1.1 nonaka DELAY(5);
4457 1.1 nonaka break;
4458 1.1 nonaka case 0xf9:
4459 1.1 nonaka DELAY(1);
4460 1.1 nonaka break;
4461 1.1 nonaka }
4462 1.1 nonaka urtwn_bb_write(sc, prog->regs[i], prog->vals[i]);
4463 1.1 nonaka DELAY(1);
4464 1.1 nonaka }
4465 1.1 nonaka
4466 1.1 nonaka if (sc->chip & URTWN_CHIP_92C_1T2R) {
4467 1.1 nonaka /* 8192C 1T only configuration. */
4468 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_TXINFO);
4469 1.1 nonaka reg = (reg & ~0x00000003) | 0x2;
4470 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_TXINFO, reg);
4471 1.1 nonaka
4472 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA1_TXINFO);
4473 1.1 nonaka reg = (reg & ~0x00300033) | 0x00200022;
4474 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA1_TXINFO, reg);
4475 1.1 nonaka
4476 1.1 nonaka reg = urtwn_bb_read(sc, R92C_CCK0_AFESETTING);
4477 1.1 nonaka reg = (reg & ~0xff000000) | (0x45 << 24);
4478 1.1 nonaka urtwn_bb_write(sc, R92C_CCK0_AFESETTING, reg);
4479 1.1 nonaka
4480 1.1 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
4481 1.1 nonaka reg = (reg & ~0x000000ff) | 0x23;
4482 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg);
4483 1.1 nonaka
4484 1.1 nonaka reg = urtwn_bb_read(sc, R92C_OFDM0_AGCPARAM1);
4485 1.1 nonaka reg = (reg & ~0x00000030) | (1 << 4);
4486 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCPARAM1, reg);
4487 1.1 nonaka
4488 1.1 nonaka reg = urtwn_bb_read(sc, 0xe74);
4489 1.1 nonaka reg = (reg & ~0x0c000000) | (2 << 26);
4490 1.1 nonaka urtwn_bb_write(sc, 0xe74, reg);
4491 1.1 nonaka reg = urtwn_bb_read(sc, 0xe78);
4492 1.1 nonaka reg = (reg & ~0x0c000000) | (2 << 26);
4493 1.1 nonaka urtwn_bb_write(sc, 0xe78, reg);
4494 1.1 nonaka reg = urtwn_bb_read(sc, 0xe7c);
4495 1.1 nonaka reg = (reg & ~0x0c000000) | (2 << 26);
4496 1.1 nonaka urtwn_bb_write(sc, 0xe7c, reg);
4497 1.1 nonaka reg = urtwn_bb_read(sc, 0xe80);
4498 1.1 nonaka reg = (reg & ~0x0c000000) | (2 << 26);
4499 1.1 nonaka urtwn_bb_write(sc, 0xe80, reg);
4500 1.1 nonaka reg = urtwn_bb_read(sc, 0xe88);
4501 1.1 nonaka reg = (reg & ~0x0c000000) | (2 << 26);
4502 1.1 nonaka urtwn_bb_write(sc, 0xe88, reg);
4503 1.1 nonaka }
4504 1.1 nonaka
4505 1.1 nonaka /* Write AGC values. */
4506 1.1 nonaka for (i = 0; i < prog->agccount; i++) {
4507 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCRSSITABLE, prog->agcvals[i]);
4508 1.1 nonaka DELAY(1);
4509 1.1 nonaka }
4510 1.1 nonaka
4511 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
4512 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU)) {
4513 1.32 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553422);
4514 1.32 nonaka DELAY(1);
4515 1.32 nonaka urtwn_bb_write(sc, R92C_OFDM0_AGCCORE1(0), 0x69553420);
4516 1.32 nonaka DELAY(1);
4517 1.58 nat }
4518 1.32 nonaka
4519 1.58 nat if (ISSET(sc->chip, URTWN_CHIP_92EU)) {
4520 1.58 nat crystalcap = sc->r88e_rom[0xb9];
4521 1.58 nat if (crystalcap == 0x00)
4522 1.58 nat crystalcap = 0x20;
4523 1.58 nat crystalcap &= 0x3f;
4524 1.58 nat reg = urtwn_bb_read(sc, R92C_AFE_CTRL3);
4525 1.58 nat urtwn_bb_write(sc, R92C_AFE_CTRL3,
4526 1.58 nat RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
4527 1.58 nat crystalcap | crystalcap << 6));
4528 1.58 nat urtwn_write_4(sc, R92C_AFE_XTAL_CTRL, 0xf81fb);
4529 1.58 nat } else if (ISSET(sc->chip, URTWN_CHIP_88E)) {
4530 1.32 nonaka crystalcap = sc->r88e_rom[0xb9];
4531 1.32 nonaka if (crystalcap == 0xff)
4532 1.32 nonaka crystalcap = 0x20;
4533 1.32 nonaka crystalcap &= 0x3f;
4534 1.32 nonaka reg = urtwn_bb_read(sc, R92C_AFE_XTAL_CTRL);
4535 1.32 nonaka urtwn_bb_write(sc, R92C_AFE_XTAL_CTRL,
4536 1.32 nonaka RW(reg, R92C_AFE_XTAL_CTRL_ADDR,
4537 1.32 nonaka crystalcap | crystalcap << 6));
4538 1.32 nonaka } else {
4539 1.32 nonaka if (urtwn_bb_read(sc, R92C_HSSI_PARAM2(0)) &
4540 1.32 nonaka R92C_HSSI_PARAM2_CCK_HIPWR) {
4541 1.32 nonaka SET(sc->sc_flags, URTWN_FLAG_CCK_HIPWR);
4542 1.32 nonaka }
4543 1.1 nonaka }
4544 1.1 nonaka }
4545 1.1 nonaka
4546 1.1 nonaka static void
4547 1.1 nonaka urtwn_rf_init(struct urtwn_softc *sc)
4548 1.1 nonaka {
4549 1.1 nonaka const struct urtwn_rf_prog *prog;
4550 1.1 nonaka uint32_t reg, mask, saved;
4551 1.22 christos size_t i, j, idx;
4552 1.1 nonaka
4553 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4554 1.1 nonaka
4555 1.1 nonaka /* Select RF programming based on board type. */
4556 1.32 nonaka if (ISSET(sc->chip, URTWN_CHIP_88E))
4557 1.32 nonaka prog = rtl8188eu_rf_prog;
4558 1.49 nat else if (ISSET(sc->chip, URTWN_CHIP_92EU))
4559 1.49 nat prog = rtl8192eu_rf_prog;
4560 1.32 nonaka else if (!(sc->chip & URTWN_CHIP_92C)) {
4561 1.1 nonaka if (sc->board_type == R92C_BOARD_TYPE_MINICARD) {
4562 1.1 nonaka prog = rtl8188ce_rf_prog;
4563 1.1 nonaka } else if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
4564 1.1 nonaka prog = rtl8188ru_rf_prog;
4565 1.1 nonaka } else {
4566 1.1 nonaka prog = rtl8188cu_rf_prog;
4567 1.1 nonaka }
4568 1.1 nonaka } else {
4569 1.1 nonaka prog = rtl8192ce_rf_prog;
4570 1.1 nonaka }
4571 1.1 nonaka
4572 1.1 nonaka for (i = 0; i < sc->nrxchains; i++) {
4573 1.1 nonaka /* Save RF_ENV control type. */
4574 1.1 nonaka idx = i / 2;
4575 1.1 nonaka mask = 0xffffU << ((i % 2) * 16);
4576 1.1 nonaka saved = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)) & mask;
4577 1.1 nonaka
4578 1.1 nonaka /* Set RF_ENV enable. */
4579 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4580 1.1 nonaka reg |= 0x100000;
4581 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4582 1.49 nat DELAY(50);
4583 1.1 nonaka
4584 1.1 nonaka /* Set RF_ENV output high. */
4585 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACEOE(i));
4586 1.1 nonaka reg |= 0x10;
4587 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFIFACEOE(i), reg);
4588 1.49 nat DELAY(50);
4589 1.1 nonaka
4590 1.1 nonaka /* Set address and data lengths of RF registers. */
4591 1.1 nonaka reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4592 1.1 nonaka reg &= ~R92C_HSSI_PARAM2_ADDR_LENGTH;
4593 1.1 nonaka urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4594 1.49 nat DELAY(50);
4595 1.1 nonaka reg = urtwn_bb_read(sc, R92C_HSSI_PARAM2(i));
4596 1.1 nonaka reg &= ~R92C_HSSI_PARAM2_DATA_LENGTH;
4597 1.1 nonaka urtwn_bb_write(sc, R92C_HSSI_PARAM2(i), reg);
4598 1.49 nat DELAY(50);
4599 1.1 nonaka
4600 1.1 nonaka /* Write RF initialization values for this chain. */
4601 1.1 nonaka for (j = 0; j < prog[i].count; j++) {
4602 1.1 nonaka if (prog[i].regs[j] >= 0xf9 &&
4603 1.1 nonaka prog[i].regs[j] <= 0xfe) {
4604 1.1 nonaka /*
4605 1.1 nonaka * These are fake RF registers offsets that
4606 1.1 nonaka * indicate a delay is required.
4607 1.1 nonaka */
4608 1.49 nat urtwn_delay_ms(sc, 50);
4609 1.1 nonaka continue;
4610 1.1 nonaka }
4611 1.1 nonaka urtwn_rf_write(sc, i, prog[i].regs[j], prog[i].vals[j]);
4612 1.49 nat DELAY(5);
4613 1.1 nonaka }
4614 1.1 nonaka
4615 1.1 nonaka /* Restore RF_ENV control type. */
4616 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(idx)) & ~mask;
4617 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(idx), reg | saved);
4618 1.1 nonaka }
4619 1.1 nonaka
4620 1.1 nonaka if ((sc->chip & (URTWN_CHIP_UMC_A_CUT | URTWN_CHIP_92C)) ==
4621 1.1 nonaka URTWN_CHIP_UMC_A_CUT) {
4622 1.1 nonaka urtwn_rf_write(sc, 0, R92C_RF_RX_G1, 0x30255);
4623 1.1 nonaka urtwn_rf_write(sc, 0, R92C_RF_RX_G2, 0x50a00);
4624 1.1 nonaka }
4625 1.1 nonaka
4626 1.1 nonaka /* Cache RF register CHNLBW. */
4627 1.1 nonaka for (i = 0; i < 2; i++) {
4628 1.1 nonaka sc->rf_chnlbw[i] = urtwn_rf_read(sc, i, R92C_RF_CHNLBW);
4629 1.1 nonaka }
4630 1.1 nonaka }
4631 1.1 nonaka
4632 1.1 nonaka static void
4633 1.1 nonaka urtwn_cam_init(struct urtwn_softc *sc)
4634 1.1 nonaka {
4635 1.1 nonaka uint32_t content, command;
4636 1.1 nonaka uint8_t idx;
4637 1.22 christos size_t i;
4638 1.1 nonaka
4639 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4640 1.1 nonaka
4641 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4642 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU))
4643 1.49 nat return;
4644 1.12 christos
4645 1.1 nonaka for (idx = 0; idx < R92C_CAM_ENTRY_COUNT; idx++) {
4646 1.1 nonaka content = (idx & 3)
4647 1.1 nonaka | (R92C_CAM_ALGO_AES << R92C_CAM_ALGO_S)
4648 1.1 nonaka | R92C_CAM_VALID;
4649 1.1 nonaka
4650 1.1 nonaka command = R92C_CAMCMD_POLLING
4651 1.1 nonaka | R92C_CAMCMD_WRITE
4652 1.1 nonaka | R92C_CAM_CTL0(idx);
4653 1.1 nonaka
4654 1.1 nonaka urtwn_write_4(sc, R92C_CAMWRITE, content);
4655 1.1 nonaka urtwn_write_4(sc, R92C_CAMCMD, command);
4656 1.1 nonaka }
4657 1.1 nonaka
4658 1.1 nonaka for (idx = 0; idx < R92C_CAM_ENTRY_COUNT; idx++) {
4659 1.1 nonaka for (i = 0; i < /* CAM_CONTENT_COUNT */ 8; i++) {
4660 1.1 nonaka if (i == 0) {
4661 1.1 nonaka content = (idx & 3)
4662 1.1 nonaka | (R92C_CAM_ALGO_AES << R92C_CAM_ALGO_S)
4663 1.1 nonaka | R92C_CAM_VALID;
4664 1.1 nonaka } else {
4665 1.1 nonaka content = 0;
4666 1.1 nonaka }
4667 1.1 nonaka
4668 1.1 nonaka command = R92C_CAMCMD_POLLING
4669 1.1 nonaka | R92C_CAMCMD_WRITE
4670 1.1 nonaka | R92C_CAM_CTL0(idx)
4671 1.22 christos | i;
4672 1.1 nonaka
4673 1.1 nonaka urtwn_write_4(sc, R92C_CAMWRITE, content);
4674 1.1 nonaka urtwn_write_4(sc, R92C_CAMCMD, command);
4675 1.1 nonaka }
4676 1.1 nonaka }
4677 1.1 nonaka
4678 1.1 nonaka /* Invalidate all CAM entries. */
4679 1.1 nonaka urtwn_write_4(sc, R92C_CAMCMD, R92C_CAMCMD_POLLING | R92C_CAMCMD_CLR);
4680 1.1 nonaka }
4681 1.1 nonaka
4682 1.1 nonaka static void
4683 1.1 nonaka urtwn_pa_bias_init(struct urtwn_softc *sc)
4684 1.1 nonaka {
4685 1.1 nonaka uint8_t reg;
4686 1.22 christos size_t i;
4687 1.1 nonaka
4688 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4689 1.1 nonaka
4690 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4691 1.12 christos
4692 1.1 nonaka for (i = 0; i < sc->nrxchains; i++) {
4693 1.1 nonaka if (sc->pa_setting & (1U << i))
4694 1.1 nonaka continue;
4695 1.1 nonaka
4696 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_IPA, 0x0f406);
4697 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_IPA, 0x4f406);
4698 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_IPA, 0x8f406);
4699 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_IPA, 0xcf406);
4700 1.1 nonaka }
4701 1.1 nonaka if (!(sc->pa_setting & 0x10)) {
4702 1.1 nonaka reg = urtwn_read_1(sc, 0x16);
4703 1.1 nonaka reg = (reg & ~0xf0) | 0x90;
4704 1.1 nonaka urtwn_write_1(sc, 0x16, reg);
4705 1.1 nonaka }
4706 1.1 nonaka }
4707 1.1 nonaka
4708 1.1 nonaka static void
4709 1.1 nonaka urtwn_rxfilter_init(struct urtwn_softc *sc)
4710 1.1 nonaka {
4711 1.1 nonaka
4712 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4713 1.1 nonaka
4714 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4715 1.12 christos
4716 1.1 nonaka /* Initialize Rx filter. */
4717 1.1 nonaka /* TODO: use better filter for monitor mode. */
4718 1.1 nonaka urtwn_write_4(sc, R92C_RCR,
4719 1.1 nonaka R92C_RCR_AAP | R92C_RCR_APM | R92C_RCR_AM | R92C_RCR_AB |
4720 1.1 nonaka R92C_RCR_APP_ICV | R92C_RCR_AMF | R92C_RCR_HTC_LOC_CTRL |
4721 1.1 nonaka R92C_RCR_APP_MIC | R92C_RCR_APP_PHYSTS);
4722 1.1 nonaka /* Accept all multicast frames. */
4723 1.1 nonaka urtwn_write_4(sc, R92C_MAR + 0, 0xffffffff);
4724 1.1 nonaka urtwn_write_4(sc, R92C_MAR + 4, 0xffffffff);
4725 1.1 nonaka /* Accept all management frames. */
4726 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP0, 0xffff);
4727 1.1 nonaka /* Reject all control frames. */
4728 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP1, 0x0000);
4729 1.1 nonaka /* Accept all data frames. */
4730 1.1 nonaka urtwn_write_2(sc, R92C_RXFLTMAP2, 0xffff);
4731 1.1 nonaka }
4732 1.1 nonaka
4733 1.1 nonaka static void
4734 1.1 nonaka urtwn_edca_init(struct urtwn_softc *sc)
4735 1.1 nonaka {
4736 1.1 nonaka
4737 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
4738 1.1 nonaka
4739 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
4740 1.12 christos
4741 1.1 nonaka /* set spec SIFS (used in NAV) */
4742 1.1 nonaka urtwn_write_2(sc, R92C_SPEC_SIFS, 0x100a);
4743 1.1 nonaka urtwn_write_2(sc, R92C_MAC_SPEC_SIFS, 0x100a);
4744 1.1 nonaka
4745 1.1 nonaka /* set SIFS CCK/OFDM */
4746 1.1 nonaka urtwn_write_2(sc, R92C_SIFS_CCK, 0x100a);
4747 1.1 nonaka urtwn_write_2(sc, R92C_SIFS_OFDM, 0x100a);
4748 1.1 nonaka
4749 1.1 nonaka /* TXOP */
4750 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_BE_PARAM, 0x005ea42b);
4751 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_BK_PARAM, 0x0000a44f);
4752 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_VI_PARAM, 0x005ea324);
4753 1.1 nonaka urtwn_write_4(sc, R92C_EDCA_VO_PARAM, 0x002fa226);
4754 1.1 nonaka }
4755 1.1 nonaka
4756 1.1 nonaka static void
4757 1.1 nonaka urtwn_write_txpower(struct urtwn_softc *sc, int chain,
4758 1.1 nonaka uint16_t power[URTWN_RIDX_COUNT])
4759 1.1 nonaka {
4760 1.1 nonaka uint32_t reg;
4761 1.1 nonaka
4762 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: chain=%d\n", device_xname(sc->sc_dev),
4763 1.1 nonaka __func__, chain));
4764 1.1 nonaka
4765 1.1 nonaka /* Write per-CCK rate Tx power. */
4766 1.1 nonaka if (chain == 0) {
4767 1.1 nonaka reg = urtwn_bb_read(sc, R92C_TXAGC_A_CCK1_MCS32);
4768 1.1 nonaka reg = RW(reg, R92C_TXAGC_A_CCK1, power[0]);
4769 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_A_CCK1_MCS32, reg);
4770 1.1 nonaka
4771 1.1 nonaka reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4772 1.1 nonaka reg = RW(reg, R92C_TXAGC_A_CCK2, power[1]);
4773 1.1 nonaka reg = RW(reg, R92C_TXAGC_A_CCK55, power[2]);
4774 1.1 nonaka reg = RW(reg, R92C_TXAGC_A_CCK11, power[3]);
4775 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4776 1.1 nonaka } else {
4777 1.1 nonaka reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK1_55_MCS32);
4778 1.1 nonaka reg = RW(reg, R92C_TXAGC_B_CCK1, power[0]);
4779 1.1 nonaka reg = RW(reg, R92C_TXAGC_B_CCK2, power[1]);
4780 1.1 nonaka reg = RW(reg, R92C_TXAGC_B_CCK55, power[2]);
4781 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_B_CCK1_55_MCS32, reg);
4782 1.1 nonaka
4783 1.1 nonaka reg = urtwn_bb_read(sc, R92C_TXAGC_B_CCK11_A_CCK2_11);
4784 1.1 nonaka reg = RW(reg, R92C_TXAGC_B_CCK11, power[3]);
4785 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_B_CCK11_A_CCK2_11, reg);
4786 1.1 nonaka }
4787 1.1 nonaka /* Write per-OFDM rate Tx power. */
4788 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_RATE18_06(chain),
4789 1.1 nonaka SM(R92C_TXAGC_RATE06, power[ 4]) |
4790 1.1 nonaka SM(R92C_TXAGC_RATE09, power[ 5]) |
4791 1.1 nonaka SM(R92C_TXAGC_RATE12, power[ 6]) |
4792 1.1 nonaka SM(R92C_TXAGC_RATE18, power[ 7]));
4793 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_RATE54_24(chain),
4794 1.1 nonaka SM(R92C_TXAGC_RATE24, power[ 8]) |
4795 1.1 nonaka SM(R92C_TXAGC_RATE36, power[ 9]) |
4796 1.1 nonaka SM(R92C_TXAGC_RATE48, power[10]) |
4797 1.1 nonaka SM(R92C_TXAGC_RATE54, power[11]));
4798 1.1 nonaka /* Write per-MCS Tx power. */
4799 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_MCS03_MCS00(chain),
4800 1.1 nonaka SM(R92C_TXAGC_MCS00, power[12]) |
4801 1.1 nonaka SM(R92C_TXAGC_MCS01, power[13]) |
4802 1.1 nonaka SM(R92C_TXAGC_MCS02, power[14]) |
4803 1.1 nonaka SM(R92C_TXAGC_MCS03, power[15]));
4804 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_MCS07_MCS04(chain),
4805 1.1 nonaka SM(R92C_TXAGC_MCS04, power[16]) |
4806 1.1 nonaka SM(R92C_TXAGC_MCS05, power[17]) |
4807 1.1 nonaka SM(R92C_TXAGC_MCS06, power[18]) |
4808 1.1 nonaka SM(R92C_TXAGC_MCS07, power[19]));
4809 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_MCS11_MCS08(chain),
4810 1.1 nonaka SM(R92C_TXAGC_MCS08, power[20]) |
4811 1.1 nonaka SM(R92C_TXAGC_MCS09, power[21]) |
4812 1.1 nonaka SM(R92C_TXAGC_MCS10, power[22]) |
4813 1.1 nonaka SM(R92C_TXAGC_MCS11, power[23]));
4814 1.1 nonaka urtwn_bb_write(sc, R92C_TXAGC_MCS15_MCS12(chain),
4815 1.1 nonaka SM(R92C_TXAGC_MCS12, power[24]) |
4816 1.1 nonaka SM(R92C_TXAGC_MCS13, power[25]) |
4817 1.1 nonaka SM(R92C_TXAGC_MCS14, power[26]) |
4818 1.1 nonaka SM(R92C_TXAGC_MCS15, power[27]));
4819 1.1 nonaka }
4820 1.1 nonaka
4821 1.1 nonaka static void
4822 1.22 christos urtwn_get_txpower(struct urtwn_softc *sc, size_t chain, u_int chan, u_int ht40m,
4823 1.1 nonaka uint16_t power[URTWN_RIDX_COUNT])
4824 1.1 nonaka {
4825 1.1 nonaka struct r92c_rom *rom = &sc->rom;
4826 1.1 nonaka uint16_t cckpow, ofdmpow, htpow, diff, maxpow;
4827 1.1 nonaka const struct urtwn_txpwr *base;
4828 1.1 nonaka int ridx, group;
4829 1.1 nonaka
4830 1.22 christos DPRINTFN(DBG_FN, ("%s: %s: chain=%zd, chan=%d\n",
4831 1.1 nonaka device_xname(sc->sc_dev), __func__, chain, chan));
4832 1.1 nonaka
4833 1.1 nonaka /* Determine channel group. */
4834 1.1 nonaka if (chan <= 3) {
4835 1.1 nonaka group = 0;
4836 1.1 nonaka } else if (chan <= 9) {
4837 1.1 nonaka group = 1;
4838 1.1 nonaka } else {
4839 1.1 nonaka group = 2;
4840 1.1 nonaka }
4841 1.1 nonaka
4842 1.1 nonaka /* Get original Tx power based on board type and RF chain. */
4843 1.1 nonaka if (!(sc->chip & URTWN_CHIP_92C)) {
4844 1.1 nonaka if (sc->board_type == R92C_BOARD_TYPE_HIGHPA) {
4845 1.1 nonaka base = &rtl8188ru_txagc[chain];
4846 1.1 nonaka } else {
4847 1.1 nonaka base = &rtl8192cu_txagc[chain];
4848 1.1 nonaka }
4849 1.1 nonaka } else {
4850 1.1 nonaka base = &rtl8192cu_txagc[chain];
4851 1.1 nonaka }
4852 1.1 nonaka
4853 1.1 nonaka memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4854 1.1 nonaka if (sc->regulatory == 0) {
4855 1.1 nonaka for (ridx = 0; ridx <= 3; ridx++) {
4856 1.1 nonaka power[ridx] = base->pwr[0][ridx];
4857 1.1 nonaka }
4858 1.1 nonaka }
4859 1.1 nonaka for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) {
4860 1.1 nonaka if (sc->regulatory == 3) {
4861 1.1 nonaka power[ridx] = base->pwr[0][ridx];
4862 1.1 nonaka /* Apply vendor limits. */
4863 1.1 nonaka if (ht40m != IEEE80211_HTINFO_2NDCHAN_NONE) {
4864 1.1 nonaka maxpow = rom->ht40_max_pwr[group];
4865 1.1 nonaka } else {
4866 1.1 nonaka maxpow = rom->ht20_max_pwr[group];
4867 1.1 nonaka }
4868 1.1 nonaka maxpow = (maxpow >> (chain * 4)) & 0xf;
4869 1.1 nonaka if (power[ridx] > maxpow) {
4870 1.1 nonaka power[ridx] = maxpow;
4871 1.1 nonaka }
4872 1.1 nonaka } else if (sc->regulatory == 1) {
4873 1.1 nonaka if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE) {
4874 1.1 nonaka power[ridx] = base->pwr[group][ridx];
4875 1.1 nonaka }
4876 1.1 nonaka } else if (sc->regulatory != 2) {
4877 1.1 nonaka power[ridx] = base->pwr[0][ridx];
4878 1.1 nonaka }
4879 1.1 nonaka }
4880 1.1 nonaka
4881 1.1 nonaka /* Compute per-CCK rate Tx power. */
4882 1.1 nonaka cckpow = rom->cck_tx_pwr[chain][group];
4883 1.1 nonaka for (ridx = 0; ridx <= 3; ridx++) {
4884 1.1 nonaka power[ridx] += cckpow;
4885 1.1 nonaka if (power[ridx] > R92C_MAX_TX_PWR) {
4886 1.1 nonaka power[ridx] = R92C_MAX_TX_PWR;
4887 1.1 nonaka }
4888 1.1 nonaka }
4889 1.1 nonaka
4890 1.1 nonaka htpow = rom->ht40_1s_tx_pwr[chain][group];
4891 1.1 nonaka if (sc->ntxchains > 1) {
4892 1.1 nonaka /* Apply reduction for 2 spatial streams. */
4893 1.1 nonaka diff = rom->ht40_2s_tx_pwr_diff[group];
4894 1.1 nonaka diff = (diff >> (chain * 4)) & 0xf;
4895 1.1 nonaka htpow = (htpow > diff) ? htpow - diff : 0;
4896 1.1 nonaka }
4897 1.1 nonaka
4898 1.1 nonaka /* Compute per-OFDM rate Tx power. */
4899 1.1 nonaka diff = rom->ofdm_tx_pwr_diff[group];
4900 1.1 nonaka diff = (diff >> (chain * 4)) & 0xf;
4901 1.1 nonaka ofdmpow = htpow + diff; /* HT->OFDM correction. */
4902 1.1 nonaka for (ridx = 4; ridx <= 11; ridx++) {
4903 1.1 nonaka power[ridx] += ofdmpow;
4904 1.1 nonaka if (power[ridx] > R92C_MAX_TX_PWR) {
4905 1.1 nonaka power[ridx] = R92C_MAX_TX_PWR;
4906 1.1 nonaka }
4907 1.1 nonaka }
4908 1.1 nonaka
4909 1.1 nonaka /* Compute per-MCS Tx power. */
4910 1.1 nonaka if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE) {
4911 1.1 nonaka diff = rom->ht20_tx_pwr_diff[group];
4912 1.1 nonaka diff = (diff >> (chain * 4)) & 0xf;
4913 1.1 nonaka htpow += diff; /* HT40->HT20 correction. */
4914 1.1 nonaka }
4915 1.1 nonaka for (ridx = 12; ridx < URTWN_RIDX_COUNT; ridx++) {
4916 1.1 nonaka power[ridx] += htpow;
4917 1.1 nonaka if (power[ridx] > R92C_MAX_TX_PWR) {
4918 1.1 nonaka power[ridx] = R92C_MAX_TX_PWR;
4919 1.1 nonaka }
4920 1.1 nonaka }
4921 1.1 nonaka #ifdef URTWN_DEBUG
4922 1.1 nonaka if (urtwn_debug & DBG_RF) {
4923 1.1 nonaka /* Dump per-rate Tx power values. */
4924 1.22 christos printf("%s: %s: Tx power for chain %zd:\n",
4925 1.1 nonaka device_xname(sc->sc_dev), __func__, chain);
4926 1.1 nonaka for (ridx = 0; ridx < URTWN_RIDX_COUNT; ridx++) {
4927 1.1 nonaka printf("%s: %s: Rate %d = %u\n",
4928 1.1 nonaka device_xname(sc->sc_dev), __func__, ridx,
4929 1.1 nonaka power[ridx]);
4930 1.1 nonaka }
4931 1.1 nonaka }
4932 1.1 nonaka #endif
4933 1.1 nonaka }
4934 1.1 nonaka
4935 1.32 nonaka void
4936 1.32 nonaka urtwn_r88e_get_txpower(struct urtwn_softc *sc, size_t chain, u_int chan,
4937 1.32 nonaka u_int ht40m, uint16_t power[URTWN_RIDX_COUNT])
4938 1.32 nonaka {
4939 1.32 nonaka uint16_t cckpow, ofdmpow, bw20pow, htpow;
4940 1.32 nonaka const struct urtwn_r88e_txpwr *base;
4941 1.32 nonaka int ridx, group;
4942 1.32 nonaka
4943 1.32 nonaka DPRINTFN(DBG_FN, ("%s: %s: chain=%zd, chan=%d\n",
4944 1.32 nonaka device_xname(sc->sc_dev), __func__, chain, chan));
4945 1.32 nonaka
4946 1.32 nonaka /* Determine channel group. */
4947 1.32 nonaka if (chan <= 2)
4948 1.32 nonaka group = 0;
4949 1.32 nonaka else if (chan <= 5)
4950 1.32 nonaka group = 1;
4951 1.32 nonaka else if (chan <= 8)
4952 1.32 nonaka group = 2;
4953 1.32 nonaka else if (chan <= 11)
4954 1.32 nonaka group = 3;
4955 1.32 nonaka else if (chan <= 13)
4956 1.32 nonaka group = 4;
4957 1.32 nonaka else
4958 1.32 nonaka group = 5;
4959 1.32 nonaka
4960 1.32 nonaka /* Get original Tx power based on board type and RF chain. */
4961 1.32 nonaka base = &rtl8188eu_txagc[chain];
4962 1.32 nonaka
4963 1.32 nonaka memset(power, 0, URTWN_RIDX_COUNT * sizeof(power[0]));
4964 1.32 nonaka if (sc->regulatory == 0) {
4965 1.32 nonaka for (ridx = 0; ridx <= 3; ridx++)
4966 1.32 nonaka power[ridx] = base->pwr[0][ridx];
4967 1.32 nonaka }
4968 1.32 nonaka for (ridx = 4; ridx < URTWN_RIDX_COUNT; ridx++) {
4969 1.32 nonaka if (sc->regulatory == 3)
4970 1.32 nonaka power[ridx] = base->pwr[0][ridx];
4971 1.32 nonaka else if (sc->regulatory == 1) {
4972 1.32 nonaka if (ht40m == IEEE80211_HTINFO_2NDCHAN_NONE)
4973 1.32 nonaka power[ridx] = base->pwr[group][ridx];
4974 1.32 nonaka } else if (sc->regulatory != 2)
4975 1.32 nonaka power[ridx] = base->pwr[0][ridx];
4976 1.32 nonaka }
4977 1.32 nonaka
4978 1.32 nonaka /* Compute per-CCK rate Tx power. */
4979 1.32 nonaka cckpow = sc->cck_tx_pwr[group];
4980 1.32 nonaka for (ridx = 0; ridx <= 3; ridx++) {
4981 1.32 nonaka power[ridx] += cckpow;
4982 1.32 nonaka if (power[ridx] > R92C_MAX_TX_PWR)
4983 1.32 nonaka power[ridx] = R92C_MAX_TX_PWR;
4984 1.32 nonaka }
4985 1.32 nonaka
4986 1.32 nonaka htpow = sc->ht40_tx_pwr[group];
4987 1.32 nonaka
4988 1.32 nonaka /* Compute per-OFDM rate Tx power. */
4989 1.32 nonaka ofdmpow = htpow + sc->ofdm_tx_pwr_diff;
4990 1.32 nonaka for (ridx = 4; ridx <= 11; ridx++) {
4991 1.32 nonaka power[ridx] += ofdmpow;
4992 1.32 nonaka if (power[ridx] > R92C_MAX_TX_PWR)
4993 1.32 nonaka power[ridx] = R92C_MAX_TX_PWR;
4994 1.32 nonaka }
4995 1.32 nonaka
4996 1.32 nonaka bw20pow = htpow + sc->bw20_tx_pwr_diff;
4997 1.32 nonaka for (ridx = 12; ridx <= 27; ridx++) {
4998 1.32 nonaka power[ridx] += bw20pow;
4999 1.32 nonaka if (power[ridx] > R92C_MAX_TX_PWR)
5000 1.32 nonaka power[ridx] = R92C_MAX_TX_PWR;
5001 1.32 nonaka }
5002 1.32 nonaka }
5003 1.32 nonaka
5004 1.1 nonaka static void
5005 1.1 nonaka urtwn_set_txpower(struct urtwn_softc *sc, u_int chan, u_int ht40m)
5006 1.1 nonaka {
5007 1.1 nonaka uint16_t power[URTWN_RIDX_COUNT];
5008 1.22 christos size_t i;
5009 1.1 nonaka
5010 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5011 1.1 nonaka
5012 1.1 nonaka for (i = 0; i < sc->ntxchains; i++) {
5013 1.1 nonaka /* Compute per-rate Tx power values. */
5014 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
5015 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
5016 1.32 nonaka urtwn_r88e_get_txpower(sc, i, chan, ht40m, power);
5017 1.32 nonaka else
5018 1.32 nonaka urtwn_get_txpower(sc, i, chan, ht40m, power);
5019 1.1 nonaka /* Write per-rate Tx power values to hardware. */
5020 1.1 nonaka urtwn_write_txpower(sc, i, power);
5021 1.1 nonaka }
5022 1.1 nonaka }
5023 1.1 nonaka
5024 1.1 nonaka static void
5025 1.1 nonaka urtwn_set_chan(struct urtwn_softc *sc, struct ieee80211_channel *c, u_int ht40m)
5026 1.1 nonaka {
5027 1.1 nonaka struct ieee80211com *ic = &sc->sc_ic;
5028 1.1 nonaka u_int chan;
5029 1.22 christos size_t i;
5030 1.1 nonaka
5031 1.1 nonaka chan = ieee80211_chan2ieee(ic, c); /* XXX center freq! */
5032 1.1 nonaka
5033 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: chan=%d\n", device_xname(sc->sc_dev),
5034 1.1 nonaka __func__, chan));
5035 1.1 nonaka
5036 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
5037 1.12 christos
5038 1.1 nonaka if (ht40m == IEEE80211_HTINFO_2NDCHAN_ABOVE) {
5039 1.1 nonaka chan += 2;
5040 1.1 nonaka } else if (ht40m == IEEE80211_HTINFO_2NDCHAN_BELOW){
5041 1.1 nonaka chan -= 2;
5042 1.1 nonaka }
5043 1.1 nonaka
5044 1.1 nonaka /* Set Tx power for this new channel. */
5045 1.1 nonaka urtwn_set_txpower(sc, chan, ht40m);
5046 1.1 nonaka
5047 1.1 nonaka for (i = 0; i < sc->nrxchains; i++) {
5048 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_CHNLBW,
5049 1.1 nonaka RW(sc->rf_chnlbw[i], R92C_RF_CHNLBW_CHNL, chan));
5050 1.1 nonaka }
5051 1.1 nonaka
5052 1.1 nonaka if (ht40m) {
5053 1.1 nonaka /* Is secondary channel below or above primary? */
5054 1.1 nonaka int prichlo = (ht40m == IEEE80211_HTINFO_2NDCHAN_ABOVE);
5055 1.1 nonaka uint32_t reg;
5056 1.1 nonaka
5057 1.1 nonaka urtwn_write_1(sc, R92C_BWOPMODE,
5058 1.1 nonaka urtwn_read_1(sc, R92C_BWOPMODE) & ~R92C_BWOPMODE_20MHZ);
5059 1.1 nonaka
5060 1.1 nonaka reg = urtwn_read_1(sc, R92C_RRSR + 2);
5061 1.1 nonaka reg = (reg & ~0x6f) | (prichlo ? 1 : 2) << 5;
5062 1.1 nonaka urtwn_write_1(sc, R92C_RRSR + 2, (uint8_t)reg);
5063 1.1 nonaka
5064 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
5065 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA0_RFMOD) | R92C_RFMOD_40MHZ);
5066 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
5067 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA1_RFMOD) | R92C_RFMOD_40MHZ);
5068 1.1 nonaka
5069 1.1 nonaka /* Set CCK side band. */
5070 1.1 nonaka reg = urtwn_bb_read(sc, R92C_CCK0_SYSTEM);
5071 1.1 nonaka reg = (reg & ~0x00000010) | (prichlo ? 0 : 1) << 4;
5072 1.1 nonaka urtwn_bb_write(sc, R92C_CCK0_SYSTEM, reg);
5073 1.1 nonaka
5074 1.1 nonaka reg = urtwn_bb_read(sc, R92C_OFDM1_LSTF);
5075 1.1 nonaka reg = (reg & ~0x00000c00) | (prichlo ? 1 : 2) << 10;
5076 1.1 nonaka urtwn_bb_write(sc, R92C_OFDM1_LSTF, reg);
5077 1.1 nonaka
5078 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
5079 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) &
5080 1.1 nonaka ~R92C_FPGA0_ANAPARAM2_CBW20);
5081 1.1 nonaka
5082 1.1 nonaka reg = urtwn_bb_read(sc, 0x818);
5083 1.1 nonaka reg = (reg & ~0x0c000000) | (prichlo ? 2 : 1) << 26;
5084 1.1 nonaka urtwn_bb_write(sc, 0x818, reg);
5085 1.1 nonaka
5086 1.1 nonaka /* Select 40MHz bandwidth. */
5087 1.1 nonaka urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5088 1.1 nonaka (sc->rf_chnlbw[0] & ~0xfff) | chan);
5089 1.1 nonaka } else {
5090 1.1 nonaka urtwn_write_1(sc, R92C_BWOPMODE,
5091 1.1 nonaka urtwn_read_1(sc, R92C_BWOPMODE) | R92C_BWOPMODE_20MHZ);
5092 1.1 nonaka
5093 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFMOD,
5094 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA0_RFMOD) & ~R92C_RFMOD_40MHZ);
5095 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA1_RFMOD,
5096 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA1_RFMOD) & ~R92C_RFMOD_40MHZ);
5097 1.1 nonaka
5098 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
5099 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
5100 1.32 nonaka urtwn_bb_write(sc, R92C_FPGA0_ANAPARAM2,
5101 1.32 nonaka urtwn_bb_read(sc, R92C_FPGA0_ANAPARAM2) |
5102 1.32 nonaka R92C_FPGA0_ANAPARAM2_CBW20);
5103 1.32 nonaka }
5104 1.1 nonaka
5105 1.1 nonaka /* Select 20MHz bandwidth. */
5106 1.1 nonaka urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5107 1.32 nonaka (sc->rf_chnlbw[0] & ~0xfff) | chan |
5108 1.49 nat (ISSET(sc->chip, URTWN_CHIP_88E) ||
5109 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU) ?
5110 1.32 nonaka R88E_RF_CHNLBW_BW20 : R92C_RF_CHNLBW_BW20));
5111 1.1 nonaka }
5112 1.1 nonaka }
5113 1.1 nonaka
5114 1.1 nonaka static void
5115 1.1 nonaka urtwn_iq_calib(struct urtwn_softc *sc, bool inited)
5116 1.1 nonaka {
5117 1.1 nonaka
5118 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s: inited=%d\n", device_xname(sc->sc_dev),
5119 1.1 nonaka __func__, inited));
5120 1.1 nonaka
5121 1.48 nat uint32_t addaBackup[16], iqkBackup[4], piMode;
5122 1.48 nat
5123 1.48 nat #ifdef notyet
5124 1.48 nat uint32_t odfm0_agccore_regs[3];
5125 1.48 nat uint32_t ant_regs[3];
5126 1.48 nat uint32_t rf_regs[8];
5127 1.48 nat #endif
5128 1.48 nat uint32_t reg0, reg1, reg2;
5129 1.48 nat int i, attempt;
5130 1.48 nat
5131 1.48 nat #ifdef notyet
5132 1.48 nat urtwn_write_1(sc, R92E_STBC_SETTING + 2, urtwn_read_1(sc,
5133 1.48 nat R92E_STBC_SETTING + 2));
5134 1.48 nat urtwn_write_1(sc, R92C_ACLK_MON, 0);
5135 1.48 nat /* Save AGCCORE regs. */
5136 1.48 nat for (i = 0; i < sc->nrxchains; i++) {
5137 1.48 nat odfm0_agccore_regs[i] = urtwn_read_4(sc,
5138 1.48 nat R92C_OFDM0_AGCCORE1(i));
5139 1.48 nat }
5140 1.48 nat #endif
5141 1.48 nat /* Save BB regs. */
5142 1.48 nat reg0 = urtwn_bb_read(sc, R92C_OFDM0_TRXPATHENA);
5143 1.48 nat reg1 = urtwn_bb_read(sc, R92C_OFDM0_TRMUXPAR);
5144 1.48 nat reg2 = urtwn_bb_read(sc, R92C_FPGA0_RFIFACESW(1));
5145 1.52 skrll
5146 1.48 nat /* Save adda regs to be restored when finished. */
5147 1.48 nat for (i = 0; i < __arraycount(addaReg); i++)
5148 1.48 nat addaBackup[i] = urtwn_bb_read(sc, addaReg[i]);
5149 1.48 nat /* Save mac regs. */
5150 1.48 nat iqkBackup[0] = urtwn_read_1(sc, R92C_TXPAUSE);
5151 1.48 nat iqkBackup[1] = urtwn_read_1(sc, R92C_BCN_CTRL);
5152 1.48 nat iqkBackup[2] = urtwn_read_1(sc, R92C_USTIME_TSF);
5153 1.48 nat iqkBackup[3] = urtwn_read_4(sc, R92C_GPIO_MUXCFG);
5154 1.48 nat
5155 1.48 nat #ifdef notyet
5156 1.48 nat ant_regs[0] = urtwn_read_4(sc, R92C_CONFIG_ANT_A);
5157 1.48 nat ant_regs[1] = urtwn_read_4(sc, R92C_CONFIG_ANT_B);
5158 1.48 nat
5159 1.48 nat rf_regs[0] = urtwn_read_4(sc, R92C_FPGA0_RFIFACESW(0));
5160 1.48 nat for (i = 0; i < sc->nrxchains; i++)
5161 1.48 nat rf_regs[i+1] = urtwn_read_4(sc, R92C_FPGA0_RFIFACEOE(i));
5162 1.48 nat reg4 = urtwn_read_4(sc, R92C_CCK0_AFESETTING);
5163 1.48 nat #endif
5164 1.48 nat
5165 1.48 nat piMode = (urtwn_bb_read(sc, R92C_HSSI_PARAM1(0)) &
5166 1.48 nat R92C_HSSI_PARAM1_PI);
5167 1.48 nat if (piMode == 0) {
5168 1.48 nat urtwn_bb_write(sc, R92C_HSSI_PARAM1(0),
5169 1.48 nat urtwn_bb_read(sc, R92C_HSSI_PARAM1(0))|
5170 1.48 nat R92C_HSSI_PARAM1_PI);
5171 1.48 nat urtwn_bb_write(sc, R92C_HSSI_PARAM1(1),
5172 1.48 nat urtwn_bb_read(sc, R92C_HSSI_PARAM1(1))|
5173 1.48 nat R92C_HSSI_PARAM1_PI);
5174 1.48 nat }
5175 1.52 skrll
5176 1.48 nat attempt = 1;
5177 1.48 nat
5178 1.48 nat next_attempt:
5179 1.48 nat
5180 1.48 nat /* Set mac regs for calibration. */
5181 1.48 nat for (i = 0; i < __arraycount(addaReg); i++) {
5182 1.48 nat urtwn_bb_write(sc, addaReg[i],
5183 1.48 nat addaReg[__arraycount(addaReg) - 1]);
5184 1.48 nat }
5185 1.48 nat urtwn_write_2(sc, R92C_CCK0_AFESETTING, urtwn_read_2(sc,
5186 1.48 nat R92C_CCK0_AFESETTING));
5187 1.48 nat urtwn_write_2(sc, R92C_OFDM0_TRXPATHENA, R92C_IQK_TRXPATHENA);
5188 1.48 nat urtwn_write_2(sc, R92C_OFDM0_TRMUXPAR, R92C_IQK_TRMUXPAR);
5189 1.48 nat urtwn_write_2(sc, R92C_FPGA0_RFIFACESW(1), R92C_IQK_RFIFACESW1);
5190 1.48 nat urtwn_write_4(sc, R92C_LSSI_PARAM(0), R92C_IQK_LSSI_PARAM);
5191 1.48 nat
5192 1.48 nat if (sc->ntxchains > 1)
5193 1.48 nat urtwn_bb_write(sc, R92C_LSSI_PARAM(1), R92C_IQK_LSSI_PARAM);
5194 1.52 skrll
5195 1.48 nat urtwn_write_1(sc, R92C_TXPAUSE, (~TP_STOPBECON) & TP_STOPALL);
5196 1.48 nat urtwn_write_1(sc, R92C_BCN_CTRL, (iqkBackup[1] &
5197 1.48 nat ~R92C_BCN_CTRL_EN_BCN));
5198 1.48 nat urtwn_write_1(sc, R92C_USTIME_TSF, (iqkBackup[2] & ~0x8));
5199 1.48 nat
5200 1.48 nat urtwn_write_1(sc, R92C_GPIO_MUXCFG, (iqkBackup[3] &
5201 1.48 nat ~R92C_GPIO_MUXCFG_ENBT));
5202 1.48 nat
5203 1.48 nat urtwn_bb_write(sc, R92C_CONFIG_ANT_A, R92C_IQK_CONFIG_ANT);
5204 1.48 nat
5205 1.48 nat if (sc->ntxchains > 1)
5206 1.48 nat urtwn_bb_write(sc, R92C_CONFIG_ANT_B, R92C_IQK_CONFIG_ANT);
5207 1.48 nat urtwn_bb_write(sc, R92C_FPGA0_IQK, R92C_FPGA0_IQK_SETTING);
5208 1.48 nat urtwn_bb_write(sc, R92C_TX_IQK, R92C_TX_IQK_SETTING);
5209 1.48 nat urtwn_bb_write(sc, R92C_RX_IQK, R92C_RX_IQK_SETTING);
5210 1.48 nat
5211 1.48 nat /* Restore BB regs. */
5212 1.48 nat urtwn_bb_write(sc, R92C_OFDM0_TRXPATHENA, reg0);
5213 1.48 nat urtwn_bb_write(sc, R92C_FPGA0_RFIFACESW(1), reg2);
5214 1.48 nat urtwn_bb_write(sc, R92C_OFDM0_TRMUXPAR, reg1);
5215 1.48 nat
5216 1.48 nat urtwn_bb_write(sc, R92C_FPGA0_IQK, 0x0);
5217 1.48 nat urtwn_bb_write(sc, R92C_LSSI_PARAM(0), R92C_IQK_LSSI_RESTORE);
5218 1.48 nat if (sc->nrxchains > 1)
5219 1.48 nat urtwn_bb_write(sc, R92C_LSSI_PARAM(1), R92C_IQK_LSSI_RESTORE);
5220 1.48 nat
5221 1.48 nat if (attempt-- > 0)
5222 1.48 nat goto next_attempt;
5223 1.48 nat
5224 1.48 nat /* Restore mode. */
5225 1.48 nat if (piMode == 0) {
5226 1.48 nat urtwn_bb_write(sc, R92C_HSSI_PARAM1(0),
5227 1.48 nat urtwn_bb_read(sc, R92C_HSSI_PARAM1(0)) &
5228 1.48 nat ~R92C_HSSI_PARAM1_PI);
5229 1.48 nat urtwn_bb_write(sc, R92C_HSSI_PARAM1(1),
5230 1.48 nat urtwn_bb_read(sc, R92C_HSSI_PARAM1(1)) &
5231 1.48 nat ~R92C_HSSI_PARAM1_PI);
5232 1.48 nat }
5233 1.48 nat
5234 1.48 nat #ifdef notyet
5235 1.48 nat for (i = 0; i < sc->nrxchains; i++) {
5236 1.48 nat urtwn_write_4(sc, R92C_OFDM0_AGCCORE1(i),
5237 1.48 nat odfm0_agccore_regs[i]);
5238 1.48 nat }
5239 1.48 nat #endif
5240 1.48 nat
5241 1.48 nat /* Restore adda regs. */
5242 1.48 nat for (i = 0; i < __arraycount(addaReg); i++)
5243 1.48 nat urtwn_bb_write(sc, addaReg[i], addaBackup[i]);
5244 1.48 nat /* Restore mac regs. */
5245 1.48 nat urtwn_write_1(sc, R92C_TXPAUSE, iqkBackup[0]);
5246 1.48 nat urtwn_write_1(sc, R92C_BCN_CTRL, iqkBackup[1]);
5247 1.48 nat urtwn_write_1(sc, R92C_USTIME_TSF, iqkBackup[2]);
5248 1.48 nat urtwn_write_4(sc, R92C_GPIO_MUXCFG, iqkBackup[3]);
5249 1.48 nat
5250 1.48 nat #ifdef notyet
5251 1.48 nat urtwn_write_4(sc, R92C_CONFIG_ANT_A, ant_regs[0]);
5252 1.48 nat urtwn_write_4(sc, R92C_CONFIG_ANT_B, ant_regs[1]);
5253 1.48 nat
5254 1.48 nat urtwn_write_4(sc, R92C_FPGA0_RFIFACESW(0), rf_regs[0]);
5255 1.48 nat for (i = 0; i < sc->nrxchains; i++)
5256 1.48 nat urtwn_write_4(sc, R92C_FPGA0_RFIFACEOE(i), rf_regs[i+1]);
5257 1.48 nat urtwn_write_4(sc, R92C_CCK0_AFESETTING, reg4);
5258 1.48 nat #endif
5259 1.1 nonaka }
5260 1.1 nonaka
5261 1.1 nonaka static void
5262 1.1 nonaka urtwn_lc_calib(struct urtwn_softc *sc)
5263 1.1 nonaka {
5264 1.1 nonaka uint32_t rf_ac[2];
5265 1.1 nonaka uint8_t txmode;
5266 1.22 christos size_t i;
5267 1.1 nonaka
5268 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5269 1.1 nonaka
5270 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
5271 1.12 christos
5272 1.1 nonaka txmode = urtwn_read_1(sc, R92C_OFDM1_LSTF + 3);
5273 1.1 nonaka if ((txmode & 0x70) != 0) {
5274 1.1 nonaka /* Disable all continuous Tx. */
5275 1.1 nonaka urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode & ~0x70);
5276 1.1 nonaka
5277 1.1 nonaka /* Set RF mode to standby mode. */
5278 1.1 nonaka for (i = 0; i < sc->nrxchains; i++) {
5279 1.1 nonaka rf_ac[i] = urtwn_rf_read(sc, i, R92C_RF_AC);
5280 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_AC,
5281 1.1 nonaka RW(rf_ac[i], R92C_RF_AC_MODE,
5282 1.1 nonaka R92C_RF_AC_MODE_STANDBY));
5283 1.1 nonaka }
5284 1.1 nonaka } else {
5285 1.1 nonaka /* Block all Tx queues. */
5286 1.1 nonaka urtwn_write_1(sc, R92C_TXPAUSE, 0xff);
5287 1.1 nonaka }
5288 1.1 nonaka /* Start calibration. */
5289 1.1 nonaka urtwn_rf_write(sc, 0, R92C_RF_CHNLBW,
5290 1.1 nonaka urtwn_rf_read(sc, 0, R92C_RF_CHNLBW) | R92C_RF_CHNLBW_LCSTART);
5291 1.1 nonaka
5292 1.1 nonaka /* Give calibration the time to complete. */
5293 1.49 nat urtwn_delay_ms(sc, 100);
5294 1.1 nonaka
5295 1.1 nonaka /* Restore configuration. */
5296 1.1 nonaka if ((txmode & 0x70) != 0) {
5297 1.1 nonaka /* Restore Tx mode. */
5298 1.1 nonaka urtwn_write_1(sc, R92C_OFDM1_LSTF + 3, txmode);
5299 1.1 nonaka /* Restore RF mode. */
5300 1.1 nonaka for (i = 0; i < sc->nrxchains; i++) {
5301 1.1 nonaka urtwn_rf_write(sc, i, R92C_RF_AC, rf_ac[i]);
5302 1.1 nonaka }
5303 1.1 nonaka } else {
5304 1.1 nonaka /* Unblock all Tx queues. */
5305 1.1 nonaka urtwn_write_1(sc, R92C_TXPAUSE, 0x00);
5306 1.1 nonaka }
5307 1.1 nonaka }
5308 1.1 nonaka
5309 1.1 nonaka static void
5310 1.1 nonaka urtwn_temp_calib(struct urtwn_softc *sc)
5311 1.1 nonaka {
5312 1.49 nat int temp, t_meter_reg;
5313 1.1 nonaka
5314 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5315 1.1 nonaka
5316 1.12 christos KASSERT(mutex_owned(&sc->sc_write_mtx));
5317 1.12 christos
5318 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_92EU))
5319 1.49 nat t_meter_reg = R92C_RF_T_METER;
5320 1.49 nat else
5321 1.49 nat t_meter_reg = R92E_RF_T_METER;
5322 1.49 nat
5323 1.1 nonaka if (sc->thcal_state == 0) {
5324 1.1 nonaka /* Start measuring temperature. */
5325 1.1 nonaka DPRINTFN(DBG_RF, ("%s: %s: start measuring temperature\n",
5326 1.1 nonaka device_xname(sc->sc_dev), __func__));
5327 1.49 nat urtwn_rf_write(sc, 0, t_meter_reg, 0x60);
5328 1.1 nonaka sc->thcal_state = 1;
5329 1.1 nonaka return;
5330 1.1 nonaka }
5331 1.1 nonaka sc->thcal_state = 0;
5332 1.1 nonaka
5333 1.1 nonaka /* Read measured temperature. */
5334 1.1 nonaka temp = urtwn_rf_read(sc, 0, R92C_RF_T_METER) & 0x1f;
5335 1.1 nonaka DPRINTFN(DBG_RF, ("%s: %s: temperature=%d\n", device_xname(sc->sc_dev),
5336 1.1 nonaka __func__, temp));
5337 1.49 nat if (temp == 0) /* Read failed, skip. */
5338 1.1 nonaka return;
5339 1.1 nonaka
5340 1.1 nonaka /*
5341 1.1 nonaka * Redo LC calibration if temperature changed significantly since
5342 1.1 nonaka * last calibration.
5343 1.1 nonaka */
5344 1.1 nonaka if (sc->thcal_lctemp == 0) {
5345 1.1 nonaka /* First LC calibration is performed in urtwn_init(). */
5346 1.1 nonaka sc->thcal_lctemp = temp;
5347 1.1 nonaka } else if (abs(temp - sc->thcal_lctemp) > 1) {
5348 1.1 nonaka DPRINTFN(DBG_RF,
5349 1.1 nonaka ("%s: %s: LC calib triggered by temp: %d -> %d\n",
5350 1.1 nonaka device_xname(sc->sc_dev), __func__, sc->thcal_lctemp,
5351 1.1 nonaka temp));
5352 1.1 nonaka urtwn_lc_calib(sc);
5353 1.1 nonaka /* Record temperature of last LC calibration. */
5354 1.1 nonaka sc->thcal_lctemp = temp;
5355 1.1 nonaka }
5356 1.1 nonaka }
5357 1.1 nonaka
5358 1.1 nonaka static int
5359 1.1 nonaka urtwn_init(struct ifnet *ifp)
5360 1.1 nonaka {
5361 1.59.2.3 phil struct ieee80211vap *vap = ifp->if_softc;
5362 1.59.2.3 phil struct ieee80211com *ic = vap->iv_ic;
5363 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
5364 1.1 nonaka struct urtwn_rx_data *data;
5365 1.1 nonaka uint32_t reg;
5366 1.22 christos size_t i;
5367 1.22 christos int error;
5368 1.1 nonaka
5369 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5370 1.1 nonaka
5371 1.1 nonaka urtwn_stop(ifp, 0);
5372 1.1 nonaka
5373 1.12 christos mutex_enter(&sc->sc_write_mtx);
5374 1.12 christos
5375 1.1 nonaka mutex_enter(&sc->sc_task_mtx);
5376 1.1 nonaka /* Init host async commands ring. */
5377 1.1 nonaka sc->cmdq.cur = sc->cmdq.next = sc->cmdq.queued = 0;
5378 1.1 nonaka mutex_exit(&sc->sc_task_mtx);
5379 1.1 nonaka
5380 1.1 nonaka mutex_enter(&sc->sc_fwcmd_mtx);
5381 1.1 nonaka /* Init firmware commands ring. */
5382 1.1 nonaka sc->fwcur = 0;
5383 1.1 nonaka mutex_exit(&sc->sc_fwcmd_mtx);
5384 1.1 nonaka
5385 1.12 christos /* Allocate Tx/Rx buffers. */
5386 1.12 christos error = urtwn_alloc_rx_list(sc);
5387 1.12 christos if (error != 0) {
5388 1.12 christos aprint_error_dev(sc->sc_dev,
5389 1.12 christos "could not allocate Rx buffers\n");
5390 1.12 christos goto fail;
5391 1.12 christos }
5392 1.12 christos error = urtwn_alloc_tx_list(sc);
5393 1.12 christos if (error != 0) {
5394 1.12 christos aprint_error_dev(sc->sc_dev,
5395 1.12 christos "could not allocate Tx buffers\n");
5396 1.12 christos goto fail;
5397 1.1 nonaka }
5398 1.1 nonaka
5399 1.1 nonaka /* Power on adapter. */
5400 1.1 nonaka error = urtwn_power_on(sc);
5401 1.1 nonaka if (error != 0)
5402 1.1 nonaka goto fail;
5403 1.1 nonaka
5404 1.1 nonaka /* Initialize DMA. */
5405 1.1 nonaka error = urtwn_dma_init(sc);
5406 1.1 nonaka if (error != 0)
5407 1.1 nonaka goto fail;
5408 1.1 nonaka
5409 1.1 nonaka /* Set info size in Rx descriptors (in 64-bit words). */
5410 1.1 nonaka urtwn_write_1(sc, R92C_RX_DRVINFO_SZ, 4);
5411 1.1 nonaka
5412 1.1 nonaka /* Init interrupts. */
5413 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
5414 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU)) {
5415 1.32 nonaka urtwn_write_4(sc, R88E_HISR, 0xffffffff);
5416 1.32 nonaka urtwn_write_4(sc, R88E_HIMR, R88E_HIMR_CPWM | R88E_HIMR_CPWM2 |
5417 1.32 nonaka R88E_HIMR_TBDER | R88E_HIMR_PSTIMEOUT);
5418 1.32 nonaka urtwn_write_4(sc, R88E_HIMRE, R88E_HIMRE_RXFOVW |
5419 1.32 nonaka R88E_HIMRE_TXFOVW | R88E_HIMRE_RXERR | R88E_HIMRE_TXERR);
5420 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E)) {
5421 1.49 nat urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5422 1.49 nat urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) |
5423 1.49 nat R92C_USB_SPECIAL_OPTION_INT_BULK_SEL);
5424 1.49 nat }
5425 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU))
5426 1.49 nat urtwn_write_1(sc, R92C_USB_HRPWM, 0);
5427 1.32 nonaka } else {
5428 1.32 nonaka urtwn_write_4(sc, R92C_HISR, 0xffffffff);
5429 1.32 nonaka urtwn_write_4(sc, R92C_HIMR, 0xffffffff);
5430 1.32 nonaka }
5431 1.1 nonaka
5432 1.1 nonaka /* Set MAC address. */
5433 1.59.2.1 phil IEEE80211_ADDR_COPY(ic->ic_macaddr, CLLADDR(ifp->if_sadl));
5434 1.59.2.1 phil urtwn_write_region(sc, R92C_MACID, ic->ic_macaddr, IEEE80211_ADDR_LEN);
5435 1.1 nonaka
5436 1.1 nonaka /* Set initial network type. */
5437 1.1 nonaka reg = urtwn_read_4(sc, R92C_CR);
5438 1.1 nonaka switch (ic->ic_opmode) {
5439 1.1 nonaka case IEEE80211_M_STA:
5440 1.1 nonaka default:
5441 1.1 nonaka reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_INFRA);
5442 1.1 nonaka break;
5443 1.7 christos
5444 1.1 nonaka case IEEE80211_M_IBSS:
5445 1.1 nonaka reg = RW(reg, R92C_CR_NETTYPE, R92C_CR_NETTYPE_ADHOC);
5446 1.1 nonaka break;
5447 1.1 nonaka }
5448 1.1 nonaka urtwn_write_4(sc, R92C_CR, reg);
5449 1.1 nonaka
5450 1.1 nonaka /* Set response rate */
5451 1.1 nonaka reg = urtwn_read_4(sc, R92C_RRSR);
5452 1.1 nonaka reg = RW(reg, R92C_RRSR_RATE_BITMAP, R92C_RRSR_RATE_CCK_ONLY_1M);
5453 1.1 nonaka urtwn_write_4(sc, R92C_RRSR, reg);
5454 1.1 nonaka
5455 1.1 nonaka /* SIFS (used in NAV) */
5456 1.1 nonaka urtwn_write_2(sc, R92C_SPEC_SIFS,
5457 1.1 nonaka SM(R92C_SPEC_SIFS_CCK, 0x10) | SM(R92C_SPEC_SIFS_OFDM, 0x10));
5458 1.1 nonaka
5459 1.1 nonaka /* Set short/long retry limits. */
5460 1.1 nonaka urtwn_write_2(sc, R92C_RL,
5461 1.1 nonaka SM(R92C_RL_SRL, 0x30) | SM(R92C_RL_LRL, 0x30));
5462 1.1 nonaka
5463 1.1 nonaka /* Initialize EDCA parameters. */
5464 1.1 nonaka urtwn_edca_init(sc);
5465 1.1 nonaka
5466 1.1 nonaka /* Setup rate fallback. */
5467 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
5468 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
5469 1.32 nonaka urtwn_write_4(sc, R92C_DARFRC + 0, 0x00000000);
5470 1.32 nonaka urtwn_write_4(sc, R92C_DARFRC + 4, 0x10080404);
5471 1.32 nonaka urtwn_write_4(sc, R92C_RARFRC + 0, 0x04030201);
5472 1.32 nonaka urtwn_write_4(sc, R92C_RARFRC + 4, 0x08070605);
5473 1.32 nonaka }
5474 1.1 nonaka
5475 1.1 nonaka urtwn_write_1(sc, R92C_FWHW_TXQ_CTRL,
5476 1.1 nonaka urtwn_read_1(sc, R92C_FWHW_TXQ_CTRL) |
5477 1.1 nonaka R92C_FWHW_TXQ_CTRL_AMPDU_RTY_NEW);
5478 1.1 nonaka /* Set ACK timeout. */
5479 1.1 nonaka urtwn_write_1(sc, R92C_ACKTO, 0x40);
5480 1.1 nonaka
5481 1.1 nonaka /* Setup USB aggregation. */
5482 1.1 nonaka /* Tx */
5483 1.1 nonaka reg = urtwn_read_4(sc, R92C_TDECTRL);
5484 1.1 nonaka reg = RW(reg, R92C_TDECTRL_BLK_DESC_NUM, 6);
5485 1.1 nonaka urtwn_write_4(sc, R92C_TDECTRL, reg);
5486 1.1 nonaka /* Rx */
5487 1.1 nonaka urtwn_write_1(sc, R92C_TRXDMA_CTRL,
5488 1.1 nonaka urtwn_read_1(sc, R92C_TRXDMA_CTRL) |
5489 1.1 nonaka R92C_TRXDMA_CTRL_RXDMA_AGG_EN);
5490 1.1 nonaka urtwn_write_1(sc, R92C_USB_SPECIAL_OPTION,
5491 1.1 nonaka urtwn_read_1(sc, R92C_USB_SPECIAL_OPTION) &
5492 1.1 nonaka ~R92C_USB_SPECIAL_OPTION_AGG_EN);
5493 1.1 nonaka urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH, 48);
5494 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
5495 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
5496 1.32 nonaka urtwn_write_1(sc, R92C_RXDMA_AGG_PG_TH + 1, 4);
5497 1.32 nonaka else
5498 1.32 nonaka urtwn_write_1(sc, R92C_USB_DMA_AGG_TO, 4);
5499 1.1 nonaka
5500 1.1 nonaka /* Initialize beacon parameters. */
5501 1.32 nonaka urtwn_write_2(sc, R92C_BCN_CTRL, 0x1010);
5502 1.1 nonaka urtwn_write_2(sc, R92C_TBTT_PROHIBIT, 0x6404);
5503 1.26 christos urtwn_write_1(sc, R92C_DRVERLYINT, R92C_DRIVER_EARLY_INT_TIME);
5504 1.26 christos urtwn_write_1(sc, R92C_BCNDMATIM, R92C_DMA_ATIME_INT_TIME);
5505 1.1 nonaka urtwn_write_2(sc, R92C_BCNTCFG, 0x660f);
5506 1.1 nonaka
5507 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
5508 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
5509 1.32 nonaka /* Setup AMPDU aggregation. */
5510 1.32 nonaka urtwn_write_4(sc, R92C_AGGLEN_LMT, 0x99997631); /* MCS7~0 */
5511 1.32 nonaka urtwn_write_1(sc, R92C_AGGR_BREAK_TIME, 0x16);
5512 1.32 nonaka urtwn_write_2(sc, 0x4ca, 0x0708);
5513 1.1 nonaka
5514 1.32 nonaka urtwn_write_1(sc, R92C_BCN_MAX_ERR, 0xff);
5515 1.32 nonaka urtwn_write_1(sc, R92C_BCN_CTRL, R92C_BCN_CTRL_DIS_TSF_UDT0);
5516 1.32 nonaka }
5517 1.1 nonaka
5518 1.1 nonaka /* Load 8051 microcode. */
5519 1.1 nonaka error = urtwn_load_firmware(sc);
5520 1.1 nonaka if (error != 0)
5521 1.1 nonaka goto fail;
5522 1.1 nonaka SET(sc->sc_flags, URTWN_FLAG_FWREADY);
5523 1.1 nonaka
5524 1.1 nonaka /* Initialize MAC/BB/RF blocks. */
5525 1.19 christos /*
5526 1.19 christos * XXX: urtwn_mac_init() sets R92C_RCR[0:15] = R92C_RCR_APM |
5527 1.19 christos * R92C_RCR_AM | R92C_RCR_AB | R92C_RCR_AICV | R92C_RCR_AMF.
5528 1.19 christos * XXX: This setting should be removed from rtl8192cu_mac[].
5529 1.19 christos */
5530 1.19 christos urtwn_mac_init(sc); // sets R92C_RCR[0:15]
5531 1.19 christos urtwn_rxfilter_init(sc); // reset R92C_RCR
5532 1.1 nonaka urtwn_bb_init(sc);
5533 1.1 nonaka urtwn_rf_init(sc);
5534 1.1 nonaka
5535 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
5536 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU)) {
5537 1.32 nonaka urtwn_write_2(sc, R92C_CR,
5538 1.32 nonaka urtwn_read_2(sc, R92C_CR) | R92C_CR_MACTXEN |
5539 1.32 nonaka R92C_CR_MACRXEN);
5540 1.32 nonaka }
5541 1.32 nonaka
5542 1.1 nonaka /* Turn CCK and OFDM blocks on. */
5543 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5544 1.1 nonaka reg |= R92C_RFMOD_CCK_EN;
5545 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5546 1.1 nonaka reg = urtwn_bb_read(sc, R92C_FPGA0_RFMOD);
5547 1.1 nonaka reg |= R92C_RFMOD_OFDM_EN;
5548 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFMOD, reg);
5549 1.1 nonaka
5550 1.1 nonaka /* Clear per-station keys table. */
5551 1.1 nonaka urtwn_cam_init(sc);
5552 1.1 nonaka
5553 1.1 nonaka /* Enable hardware sequence numbering. */
5554 1.1 nonaka urtwn_write_1(sc, R92C_HWSEQ_CTRL, 0xff);
5555 1.1 nonaka
5556 1.1 nonaka /* Perform LO and IQ calibrations. */
5557 1.1 nonaka urtwn_iq_calib(sc, sc->iqk_inited);
5558 1.1 nonaka sc->iqk_inited = true;
5559 1.1 nonaka
5560 1.1 nonaka /* Perform LC calibration. */
5561 1.1 nonaka urtwn_lc_calib(sc);
5562 1.1 nonaka
5563 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
5564 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU)) {
5565 1.32 nonaka /* Fix USB interference issue. */
5566 1.32 nonaka urtwn_write_1(sc, 0xfe40, 0xe0);
5567 1.32 nonaka urtwn_write_1(sc, 0xfe41, 0x8d);
5568 1.32 nonaka urtwn_write_1(sc, 0xfe42, 0x80);
5569 1.32 nonaka urtwn_write_4(sc, 0x20c, 0xfd0320);
5570 1.1 nonaka
5571 1.32 nonaka urtwn_pa_bias_init(sc);
5572 1.32 nonaka }
5573 1.1 nonaka
5574 1.49 nat if (!(sc->chip & (URTWN_CHIP_92C | URTWN_CHIP_92C_1T2R)) ||
5575 1.49 nat !(sc->chip & URTWN_CHIP_92EU)) {
5576 1.1 nonaka /* 1T1R */
5577 1.1 nonaka urtwn_bb_write(sc, R92C_FPGA0_RFPARAM(0),
5578 1.1 nonaka urtwn_bb_read(sc, R92C_FPGA0_RFPARAM(0)) | __BIT(13));
5579 1.1 nonaka }
5580 1.1 nonaka
5581 1.1 nonaka /* Initialize GPIO setting. */
5582 1.1 nonaka urtwn_write_1(sc, R92C_GPIO_MUXCFG,
5583 1.1 nonaka urtwn_read_1(sc, R92C_GPIO_MUXCFG) & ~R92C_GPIO_MUXCFG_ENBT);
5584 1.1 nonaka
5585 1.1 nonaka /* Fix for lower temperature. */
5586 1.49 nat if (!ISSET(sc->chip, URTWN_CHIP_88E) &&
5587 1.49 nat !ISSET(sc->chip, URTWN_CHIP_92EU))
5588 1.32 nonaka urtwn_write_1(sc, 0x15, 0xe9);
5589 1.1 nonaka
5590 1.1 nonaka /* Set default channel. */
5591 1.13 jmcneill urtwn_set_chan(sc, ic->ic_curchan, IEEE80211_HTINFO_2NDCHAN_NONE);
5592 1.1 nonaka
5593 1.1 nonaka /* Queue Rx xfers. */
5594 1.49 nat for (size_t j = 0; j < sc->rx_npipe; j++) {
5595 1.49 nat for (i = 0; i < URTWN_RX_LIST_COUNT; i++) {
5596 1.49 nat data = &sc->rx_data[j][i];
5597 1.49 nat usbd_setup_xfer(data->xfer, data, data->buf,
5598 1.49 nat URTWN_RXBUFSZ, USBD_SHORT_XFER_OK, USBD_NO_TIMEOUT,
5599 1.49 nat urtwn_rxeof);
5600 1.49 nat error = usbd_transfer(data->xfer);
5601 1.49 nat if (__predict_false(error != USBD_NORMAL_COMPLETION &&
5602 1.49 nat error != USBD_IN_PROGRESS))
5603 1.49 nat goto fail;
5604 1.49 nat }
5605 1.1 nonaka }
5606 1.1 nonaka
5607 1.1 nonaka /* We're ready to go. */
5608 1.1 nonaka ifp->if_flags &= ~IFF_OACTIVE;
5609 1.1 nonaka ifp->if_flags |= IFF_RUNNING;
5610 1.49 nat sc->sc_running = true;
5611 1.1 nonaka
5612 1.16 jmcneill mutex_exit(&sc->sc_write_mtx);
5613 1.16 jmcneill
5614 1.1 nonaka if (ic->ic_opmode == IEEE80211_M_MONITOR)
5615 1.59.2.1 phil ieee80211_new_state(vap, IEEE80211_S_RUN, -1);
5616 1.59.2.1 phil else if (vap->iv_roaming != IEEE80211_ROAMING_MANUAL)
5617 1.59.2.1 phil ieee80211_new_state(vap, IEEE80211_S_SCAN, -1);
5618 1.16 jmcneill urtwn_wait_async(sc);
5619 1.12 christos
5620 1.59.2.5 phil /* Init the rest of the 802.11 stuff */
5621 1.59.2.5 phil ieee80211_init(ifp);
5622 1.59.2.5 phil
5623 1.42 skrll return 0;
5624 1.1 nonaka
5625 1.1 nonaka fail:
5626 1.12 christos mutex_exit(&sc->sc_write_mtx);
5627 1.12 christos
5628 1.1 nonaka urtwn_stop(ifp, 1);
5629 1.42 skrll return error;
5630 1.1 nonaka }
5631 1.1 nonaka
5632 1.1 nonaka static void
5633 1.1 nonaka urtwn_stop(struct ifnet *ifp, int disable)
5634 1.1 nonaka {
5635 1.59.2.3 phil struct ieee80211vap *vap = ifp->if_softc;
5636 1.59.2.3 phil struct ieee80211com *ic = vap->iv_ic;
5637 1.59.2.3 phil struct urtwn_softc *sc = ic->ic_softc;
5638 1.22 christos size_t i;
5639 1.22 christos int s;
5640 1.1 nonaka
5641 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5642 1.1 nonaka
5643 1.1 nonaka s = splusb();
5644 1.59.2.1 phil ieee80211_new_state(vap, IEEE80211_S_INIT, -1);
5645 1.1 nonaka urtwn_wait_async(sc);
5646 1.1 nonaka splx(s);
5647 1.1 nonaka
5648 1.16 jmcneill sc->tx_timer = 0;
5649 1.16 jmcneill ifp->if_timer = 0;
5650 1.16 jmcneill ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
5651 1.16 jmcneill
5652 1.1 nonaka callout_stop(&sc->sc_scan_to);
5653 1.1 nonaka callout_stop(&sc->sc_calib_to);
5654 1.1 nonaka
5655 1.1 nonaka /* Abort Tx. */
5656 1.49 nat for (i = 0; i < sc->tx_npipe; i++) {
5657 1.1 nonaka if (sc->tx_pipe[i] != NULL)
5658 1.1 nonaka usbd_abort_pipe(sc->tx_pipe[i]);
5659 1.1 nonaka }
5660 1.1 nonaka
5661 1.1 nonaka /* Stop Rx pipe. */
5662 1.49 nat for (i = 0; i < sc->rx_npipe; i++) {
5663 1.49 nat if (sc->rx_pipe[i] != NULL)
5664 1.49 nat usbd_abort_pipe(sc->rx_pipe[i]);
5665 1.49 nat }
5666 1.1 nonaka
5667 1.12 christos /* Free Tx/Rx buffers. */
5668 1.12 christos urtwn_free_tx_list(sc);
5669 1.12 christos urtwn_free_rx_list(sc);
5670 1.12 christos
5671 1.49 nat sc->sc_running = false;
5672 1.1 nonaka if (disable)
5673 1.1 nonaka urtwn_chip_stop(sc);
5674 1.1 nonaka }
5675 1.1 nonaka
5676 1.59.2.2 phil static int
5677 1.59.2.2 phil urtwn_reset(struct ieee80211vap *vap, u_long arg)
5678 1.16 jmcneill {
5679 1.59.2.2 phil struct ifnet *ifp = vap->iv_ifp;
5680 1.16 jmcneill struct urtwn_softc *sc = ifp->if_softc;
5681 1.16 jmcneill struct ieee80211com *ic = &sc->sc_ic;
5682 1.16 jmcneill
5683 1.16 jmcneill if (ic->ic_opmode != IEEE80211_M_MONITOR)
5684 1.16 jmcneill return ENETRESET;
5685 1.16 jmcneill
5686 1.16 jmcneill urtwn_set_chan(sc, ic->ic_curchan, IEEE80211_HTINFO_2NDCHAN_NONE);
5687 1.16 jmcneill
5688 1.16 jmcneill return 0;
5689 1.16 jmcneill }
5690 1.16 jmcneill
5691 1.1 nonaka static void
5692 1.1 nonaka urtwn_chip_stop(struct urtwn_softc *sc)
5693 1.1 nonaka {
5694 1.1 nonaka uint32_t reg;
5695 1.1 nonaka bool disabled = true;
5696 1.1 nonaka
5697 1.1 nonaka DPRINTFN(DBG_FN, ("%s: %s\n", device_xname(sc->sc_dev), __func__));
5698 1.1 nonaka
5699 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_92EU))
5700 1.49 nat return;
5701 1.49 nat
5702 1.12 christos mutex_enter(&sc->sc_write_mtx);
5703 1.12 christos
5704 1.1 nonaka /*
5705 1.1 nonaka * RF Off Sequence
5706 1.1 nonaka */
5707 1.1 nonaka /* Pause MAC TX queue */
5708 1.1 nonaka urtwn_write_1(sc, R92C_TXPAUSE, 0xFF);
5709 1.1 nonaka
5710 1.1 nonaka /* Disable RF */
5711 1.1 nonaka urtwn_rf_write(sc, 0, 0, 0);
5712 1.1 nonaka
5713 1.1 nonaka urtwn_write_1(sc, R92C_APSD_CTRL, R92C_APSD_CTRL_OFF);
5714 1.1 nonaka
5715 1.1 nonaka /* Reset BB state machine */
5716 1.1 nonaka urtwn_write_1(sc, R92C_SYS_FUNC_EN,
5717 1.1 nonaka R92C_SYS_FUNC_EN_USBD |
5718 1.1 nonaka R92C_SYS_FUNC_EN_USBA |
5719 1.1 nonaka R92C_SYS_FUNC_EN_BB_GLB_RST);
5720 1.1 nonaka urtwn_write_1(sc, R92C_SYS_FUNC_EN,
5721 1.1 nonaka R92C_SYS_FUNC_EN_USBD | R92C_SYS_FUNC_EN_USBA);
5722 1.1 nonaka
5723 1.1 nonaka /*
5724 1.1 nonaka * Reset digital sequence
5725 1.1 nonaka */
5726 1.1 nonaka if (urtwn_read_1(sc, R92C_MCUFWDL) & R92C_MCUFWDL_RDY) {
5727 1.1 nonaka /* Reset MCU ready status */
5728 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL, 0);
5729 1.1 nonaka /* If firmware in ram code, do reset */
5730 1.1 nonaka if (ISSET(sc->sc_flags, URTWN_FLAG_FWREADY)) {
5731 1.49 nat if (ISSET(sc->chip, URTWN_CHIP_88E) ||
5732 1.49 nat ISSET(sc->chip, URTWN_CHIP_92EU))
5733 1.32 nonaka urtwn_r88e_fw_reset(sc);
5734 1.32 nonaka else
5735 1.32 nonaka urtwn_fw_reset(sc);
5736 1.1 nonaka CLR(sc->sc_flags, URTWN_FLAG_FWREADY);
5737 1.1 nonaka }
5738 1.1 nonaka }
5739 1.1 nonaka
5740 1.1 nonaka /* Reset MAC and Enable 8051 */
5741 1.1 nonaka urtwn_write_1(sc, R92C_SYS_FUNC_EN + 1, 0x54);
5742 1.1 nonaka
5743 1.1 nonaka /* Reset MCU ready status */
5744 1.1 nonaka urtwn_write_1(sc, R92C_MCUFWDL, 0);
5745 1.1 nonaka
5746 1.1 nonaka if (disabled) {
5747 1.1 nonaka /* Disable MAC clock */
5748 1.1 nonaka urtwn_write_2(sc, R92C_SYS_CLKR, 0x70A3);
5749 1.1 nonaka /* Disable AFE PLL */
5750 1.1 nonaka urtwn_write_1(sc, R92C_AFE_PLL_CTRL, 0x80);
5751 1.1 nonaka /* Gated AFE DIG_CLOCK */
5752 1.1 nonaka urtwn_write_2(sc, R92C_AFE_XTAL_CTRL, 0x880F);
5753 1.1 nonaka /* Isolated digital to PON */
5754 1.1 nonaka urtwn_write_1(sc, R92C_SYS_ISO_CTRL, 0xF9);
5755 1.1 nonaka }
5756 1.1 nonaka
5757 1.1 nonaka /*
5758 1.1 nonaka * Pull GPIO PIN to balance level and LED control
5759 1.1 nonaka */
5760 1.1 nonaka /* 1. Disable GPIO[7:0] */
5761 1.1 nonaka urtwn_write_2(sc, R92C_GPIO_PIN_CTRL + 2, 0x0000);
5762 1.1 nonaka
5763 1.1 nonaka reg = urtwn_read_4(sc, R92C_GPIO_PIN_CTRL) & ~0x0000ff00;
5764 1.1 nonaka reg |= ((reg << 8) & 0x0000ff00) | 0x00ff0000;
5765 1.1 nonaka urtwn_write_4(sc, R92C_GPIO_PIN_CTRL, reg);
5766 1.1 nonaka
5767 1.28 christos /* Disable GPIO[10:8] */
5768 1.28 christos urtwn_write_1(sc, R92C_GPIO_MUXCFG + 3, 0x00);
5769 1.1 nonaka
5770 1.1 nonaka reg = urtwn_read_2(sc, R92C_GPIO_MUXCFG + 2) & ~0x00f0;
5771 1.28 christos reg |= (((reg & 0x000f) << 4) | 0x0780);
5772 1.41 nonaka urtwn_write_2(sc, R92C_GPIO_MUXCFG + 2, reg);
5773 1.1 nonaka
5774 1.1 nonaka /* Disable LED0 & 1 */
5775 1.28 christos urtwn_write_2(sc, R92C_LEDCFG0, 0x8080);
5776 1.1 nonaka
5777 1.1 nonaka /*
5778 1.1 nonaka * Reset digital sequence
5779 1.1 nonaka */
5780 1.28 christos if (disabled) {
5781 1.1 nonaka /* Disable ELDR clock */
5782 1.1 nonaka urtwn_write_2(sc, R92C_SYS_CLKR, 0x70A3);
5783 1.1 nonaka /* Isolated ELDR to PON */
5784 1.1 nonaka urtwn_write_1(sc, R92C_SYS_ISO_CTRL + 1, 0x82);
5785 1.1 nonaka }
5786 1.1 nonaka
5787 1.1 nonaka /*
5788 1.1 nonaka * Disable analog sequence
5789 1.1 nonaka */
5790 1.28 christos if (disabled) {
5791 1.1 nonaka /* Disable A15 power */
5792 1.28 christos urtwn_write_1(sc, R92C_LDOA15_CTRL, 0x04);
5793 1.1 nonaka /* Disable digital core power */
5794 1.28 christos urtwn_write_1(sc, R92C_LDOV12D_CTRL,
5795 1.28 christos urtwn_read_1(sc, R92C_LDOV12D_CTRL) &
5796 1.1 nonaka ~R92C_LDOV12D_CTRL_LDV12_EN);
5797 1.28 christos }
5798 1.1 nonaka
5799 1.1 nonaka /* Enter PFM mode */
5800 1.1 nonaka urtwn_write_1(sc, R92C_SPS0_CTRL, 0x23);
5801 1.1 nonaka
5802 1.1 nonaka /* Set USB suspend */
5803 1.1 nonaka urtwn_write_2(sc, R92C_APS_FSMCO,
5804 1.1 nonaka R92C_APS_FSMCO_APDM_HOST |
5805 1.1 nonaka R92C_APS_FSMCO_AFSM_HSUS |
5806 1.1 nonaka R92C_APS_FSMCO_PFM_ALDN);
5807 1.1 nonaka
5808 1.1 nonaka urtwn_write_1(sc, R92C_RSV_CTRL, 0x0E);
5809 1.12 christos
5810 1.12 christos mutex_exit(&sc->sc_write_mtx);
5811 1.1 nonaka }
5812 1.1 nonaka
5813 1.49 nat static void
5814 1.49 nat urtwn_delay_ms(struct urtwn_softc *sc, int ms)
5815 1.49 nat {
5816 1.49 nat if (sc->sc_running == false)
5817 1.49 nat DELAY(ms * 1000);
5818 1.49 nat else
5819 1.49 nat usbd_delay_ms(sc->sc_udev, ms);
5820 1.49 nat }
5821 1.49 nat
5822 1.4 nonaka MODULE(MODULE_CLASS_DRIVER, if_urtwn, "bpf");
5823 1.1 nonaka
5824 1.1 nonaka #ifdef _MODULE
5825 1.1 nonaka #include "ioconf.c"
5826 1.1 nonaka #endif
5827 1.1 nonaka
5828 1.1 nonaka static int
5829 1.1 nonaka if_urtwn_modcmd(modcmd_t cmd, void *aux)
5830 1.1 nonaka {
5831 1.1 nonaka int error = 0;
5832 1.1 nonaka
5833 1.1 nonaka switch (cmd) {
5834 1.1 nonaka case MODULE_CMD_INIT:
5835 1.1 nonaka #ifdef _MODULE
5836 1.1 nonaka error = config_init_component(cfdriver_ioconf_urtwn,
5837 1.1 nonaka cfattach_ioconf_urtwn, cfdata_ioconf_urtwn);
5838 1.1 nonaka #endif
5839 1.42 skrll return error;
5840 1.1 nonaka case MODULE_CMD_FINI:
5841 1.1 nonaka #ifdef _MODULE
5842 1.1 nonaka error = config_fini_component(cfdriver_ioconf_urtwn,
5843 1.1 nonaka cfattach_ioconf_urtwn, cfdata_ioconf_urtwn);
5844 1.1 nonaka #endif
5845 1.42 skrll return error;
5846 1.1 nonaka default:
5847 1.42 skrll return ENOTTY;
5848 1.1 nonaka }
5849 1.1 nonaka }
5850