Commit | Line | Data |
---|---|---|
d2839953 RC |
1 | /** @file dbus.c |
2 | * | |
3 | * Hides details of USB / SDIO / SPI interfaces and OS details. It is intended to shield details and | |
4 | * provide the caller with one common bus interface for all dongle devices. In practice, it is only | |
5 | * used for USB interfaces. DBUS is not a protocol, but an abstraction layer. | |
6 | * | |
7 | * Copyright (C) 1999-2016, Broadcom Corporation | |
8 | * | |
9 | * Unless you and Broadcom execute a separate written software license | |
10 | * agreement governing use of this software, this software is licensed to you | |
11 | * under the terms of the GNU General Public License version 2 (the "GPL"), | |
12 | * available at http://www.broadcom.com/licenses/GPLv2.php, with the | |
13 | * following added to such license: | |
14 | * | |
15 | * As a special exception, the copyright holders of this software give you | |
16 | * permission to link this software with independent modules, and to copy and | |
17 | * distribute the resulting executable under terms of your choice, provided that | |
18 | * you also meet, for each linked independent module, the terms and conditions of | |
19 | * the license of that module. An independent module is a module which is not | |
20 | * derived from this software. The special exception does not apply to any | |
21 | * modifications of the software. | |
22 | * | |
23 | * Notwithstanding the above, under no circumstances may you combine this | |
24 | * software in any way with any other Broadcom software provided under a license | |
25 | * other than the GPL, without Broadcom's express prior written consent. | |
26 | * | |
27 | * | |
28 | * <<Broadcom-WL-IPTag/Open:>> | |
29 | * | |
30 | * $Id: dbus.c 553311 2015-04-29 10:23:08Z $ | |
31 | */ | |
32 | ||
33 | ||
34 | #include "osl.h" | |
35 | #include "dbus.h" | |
36 | #include <bcmutils.h> | |
37 | #include <dngl_stats.h> | |
38 | #include <dhd.h> | |
39 | #include <dhd_proto.h> | |
40 | #ifdef PROP_TXSTATUS /* a form of flow control between host and dongle */ | |
41 | #include <dhd_wlfc.h> | |
42 | #endif | |
43 | #include <dhd_config.h> | |
44 | ||
45 | #if defined(BCM_REQUEST_FW) | |
46 | #include <bcmsrom_fmt.h> | |
47 | #include <trxhdr.h> | |
48 | #include <usbrdl.h> | |
49 | #include <bcmendian.h> | |
50 | #include <sbpcmcia.h> | |
51 | #include <bcmnvram.h> | |
52 | #include <bcmdevs.h> | |
53 | #endif | |
54 | ||
55 | ||
56 | ||
57 | #if defined(BCM_REQUEST_FW) | |
58 | #ifndef VARS_MAX | |
59 | #define VARS_MAX 8192 | |
60 | #endif | |
61 | #endif | |
62 | ||
63 | #ifdef DBUS_USB_LOOPBACK | |
64 | extern bool is_loopback_pkt(void *buf); | |
65 | extern int matches_loopback_pkt(void *buf); | |
66 | #endif | |
67 | ||
68 | /** General info for all BUS types */ | |
69 | typedef struct dbus_irbq { | |
70 | dbus_irb_t *head; | |
71 | dbus_irb_t *tail; | |
72 | int cnt; | |
73 | } dbus_irbq_t; | |
74 | ||
75 | /** | |
76 | * This private structure dhd_bus_t is also declared in dbus_usb_linux.c. | |
77 | * All the fields must be consistent in both declarations. | |
78 | */ | |
79 | typedef struct dhd_bus { | |
80 | dbus_pub_t pub; /* MUST BE FIRST */ | |
81 | dhd_pub_t *dhd; | |
82 | ||
83 | void *cbarg; | |
84 | dbus_callbacks_t *cbs; /* callbacks to higher level, e.g. dhd_linux.c */ | |
85 | void *bus_info; | |
86 | dbus_intf_t *drvintf; /* callbacks to lower level, e.g. dbus_usb.c or dbus_usb_linux.c */ | |
87 | uint8 *fw; | |
88 | int fwlen; | |
89 | uint32 errmask; | |
90 | int rx_low_watermark; /* avoid rx overflow by filling rx with free IRBs */ | |
91 | int tx_low_watermark; | |
92 | bool txoff; | |
93 | bool txoverride; /* flow control related */ | |
94 | bool rxoff; | |
95 | bool tx_timer_ticking; | |
96 | ||
97 | ||
98 | dbus_irbq_t *rx_q; | |
99 | dbus_irbq_t *tx_q; | |
100 | ||
101 | uint8 *nvram; | |
102 | int nvram_len; | |
103 | uint8 *image; /* buffer for combine fw and nvram */ | |
104 | int image_len; | |
105 | uint8 *orig_fw; | |
106 | int origfw_len; | |
107 | int decomp_memsize; | |
108 | dbus_extdl_t extdl; | |
109 | int nvram_nontxt; | |
110 | #if defined(BCM_REQUEST_FW) | |
111 | void *firmware; | |
112 | void *nvfile; | |
113 | #endif | |
114 | char *fw_path; /* module_param: path to firmware image */ | |
115 | char *nv_path; /* module_param: path to nvram vars file */ | |
116 | } dhd_bus_t; | |
117 | ||
118 | struct exec_parms { | |
119 | union { | |
120 | /* Can consolidate same params, if need be, but this shows | |
121 | * group of parameters per function | |
122 | */ | |
123 | struct { | |
124 | dbus_irbq_t *q; | |
125 | dbus_irb_t *b; | |
126 | } qenq; | |
127 | ||
128 | struct { | |
129 | dbus_irbq_t *q; | |
130 | } qdeq; | |
131 | }; | |
132 | }; | |
133 | ||
134 | #define EXEC_RXLOCK(info, fn, a) \ | |
135 | info->drvintf->exec_rxlock(dhd_bus->bus_info, ((exec_cb_t)fn), ((struct exec_parms *) a)) | |
136 | ||
137 | #define EXEC_TXLOCK(info, fn, a) \ | |
138 | info->drvintf->exec_txlock(dhd_bus->bus_info, ((exec_cb_t)fn), ((struct exec_parms *) a)) | |
139 | ||
140 | /* | |
141 | * Callbacks common for all BUS | |
142 | */ | |
143 | static void dbus_if_send_irb_timeout(void *handle, dbus_irb_tx_t *txirb); | |
144 | static void dbus_if_send_irb_complete(void *handle, dbus_irb_tx_t *txirb, int status); | |
145 | static void dbus_if_recv_irb_complete(void *handle, dbus_irb_rx_t *rxirb, int status); | |
146 | static void dbus_if_errhandler(void *handle, int err); | |
147 | static void dbus_if_ctl_complete(void *handle, int type, int status); | |
148 | static void dbus_if_state_change(void *handle, int state); | |
149 | static void *dbus_if_pktget(void *handle, uint len, bool send); | |
150 | static void dbus_if_pktfree(void *handle, void *p, bool send); | |
151 | static struct dbus_irb *dbus_if_getirb(void *cbarg, bool send); | |
152 | static void dbus_if_rxerr_indicate(void *handle, bool on); | |
153 | ||
154 | void * dhd_dbus_probe_cb(void *arg, const char *desc, uint32 bustype, | |
155 | uint16 bus_no, uint16 slot, uint32 hdrlen); | |
156 | void dhd_dbus_disconnect_cb(void *arg); | |
157 | void dbus_detach(dhd_bus_t *pub); | |
158 | ||
159 | /** functions in this file that are called by lower DBUS levels, e.g. dbus_usb.c */ | |
160 | static dbus_intf_callbacks_t dbus_intf_cbs = { | |
161 | dbus_if_send_irb_timeout, | |
162 | dbus_if_send_irb_complete, | |
163 | dbus_if_recv_irb_complete, | |
164 | dbus_if_errhandler, | |
165 | dbus_if_ctl_complete, | |
166 | dbus_if_state_change, | |
167 | NULL, /* isr */ | |
168 | NULL, /* dpc */ | |
169 | NULL, /* watchdog */ | |
170 | dbus_if_pktget, | |
171 | dbus_if_pktfree, | |
172 | dbus_if_getirb, | |
173 | dbus_if_rxerr_indicate | |
174 | }; | |
175 | ||
176 | /* | |
177 | * Need global for probe() and disconnect() since | |
178 | * attach() is not called at probe and detach() | |
179 | * can be called inside disconnect() | |
180 | */ | |
181 | static dbus_intf_t *g_busintf = NULL; | |
182 | static probe_cb_t probe_cb = NULL; | |
183 | static disconnect_cb_t disconnect_cb = NULL; | |
184 | static void *probe_arg = NULL; | |
185 | static void *disc_arg = NULL; | |
186 | ||
187 | #if defined(BCM_REQUEST_FW) | |
188 | int8 *nonfwnvram = NULL; /* stand-alone multi-nvram given with driver load */ | |
189 | int nonfwnvramlen = 0; | |
190 | #endif /* #if defined(BCM_REQUEST_FW) */ | |
191 | ||
192 | static void* q_enq(dbus_irbq_t *q, dbus_irb_t *b); | |
193 | static void* q_enq_exec(struct exec_parms *args); | |
194 | static dbus_irb_t*q_deq(dbus_irbq_t *q); | |
195 | static void* q_deq_exec(struct exec_parms *args); | |
196 | static int dbus_tx_timer_init(dhd_bus_t *dhd_bus); | |
197 | static int dbus_tx_timer_start(dhd_bus_t *dhd_bus, uint timeout); | |
198 | static int dbus_tx_timer_stop(dhd_bus_t *dhd_bus); | |
199 | static int dbus_irbq_init(dhd_bus_t *dhd_bus, dbus_irbq_t *q, int nq, int size_irb); | |
200 | static int dbus_irbq_deinit(dhd_bus_t *dhd_bus, dbus_irbq_t *q, int size_irb); | |
201 | static int dbus_rxirbs_fill(dhd_bus_t *dhd_bus); | |
202 | static int dbus_send_irb(dbus_pub_t *pub, uint8 *buf, int len, void *pkt, void *info); | |
203 | static void dbus_disconnect(void *handle); | |
204 | static void *dbus_probe(void *arg, const char *desc, uint32 bustype, | |
205 | uint16 bus_no, uint16 slot, uint32 hdrlen); | |
206 | ||
207 | #if defined(BCM_REQUEST_FW) | |
208 | extern char * dngl_firmware; | |
209 | extern unsigned int dngl_fwlen; | |
210 | #ifndef EXTERNAL_FW_PATH | |
211 | static int dbus_get_nvram(dhd_bus_t *dhd_bus); | |
212 | static int dbus_jumbo_nvram(dhd_bus_t *dhd_bus); | |
213 | static int dbus_otp(dhd_bus_t *dhd_bus, uint16 *boardtype, uint16 *boardrev); | |
214 | static int dbus_select_nvram(dhd_bus_t *dhd_bus, int8 *jumbonvram, int jumbolen, | |
215 | uint16 boardtype, uint16 boardrev, int8 **nvram, int *nvram_len); | |
216 | #endif /* !EXTERNAL_FW_PATH */ | |
217 | extern int dbus_zlib_decomp(dhd_bus_t *dhd_bus); | |
218 | extern void *dbus_zlib_calloc(int num, int size); | |
219 | extern void dbus_zlib_free(void *ptr); | |
220 | #endif | |
221 | ||
222 | /* function */ | |
223 | void | |
224 | dbus_flowctrl_tx(void *dbi, bool on) | |
225 | { | |
226 | dhd_bus_t *dhd_bus = dbi; | |
227 | ||
228 | if (dhd_bus == NULL) | |
229 | return; | |
230 | ||
231 | DBUSTRACE(("%s on %d\n", __FUNCTION__, on)); | |
232 | ||
233 | if (dhd_bus->txoff == on) | |
234 | return; | |
235 | ||
236 | dhd_bus->txoff = on; | |
237 | ||
238 | if (dhd_bus->cbs && dhd_bus->cbs->txflowcontrol) | |
239 | dhd_bus->cbs->txflowcontrol(dhd_bus->cbarg, on); | |
240 | } | |
241 | ||
242 | /** | |
243 | * if lower level DBUS signaled a rx error, more free rx IRBs should be allocated or flow control | |
244 | * should kick in to make more free rx IRBs available. | |
245 | */ | |
246 | static void | |
247 | dbus_if_rxerr_indicate(void *handle, bool on) | |
248 | { | |
249 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
250 | ||
251 | DBUSTRACE(("%s, on %d\n", __FUNCTION__, on)); | |
252 | ||
253 | if (dhd_bus == NULL) | |
254 | return; | |
255 | ||
256 | if (dhd_bus->txoverride == on) | |
257 | return; | |
258 | ||
259 | dhd_bus->txoverride = on; /* flow control */ | |
260 | ||
261 | if (!on) | |
262 | dbus_rxirbs_fill(dhd_bus); | |
263 | ||
264 | } | |
265 | ||
266 | /** q_enq()/q_deq() are executed with protection via exec_rxlock()/exec_txlock() */ | |
267 | static void* | |
268 | q_enq(dbus_irbq_t *q, dbus_irb_t *b) | |
269 | { | |
270 | ASSERT(q->tail != b); | |
271 | ASSERT(b->next == NULL); | |
272 | b->next = NULL; | |
273 | if (q->tail) { | |
274 | q->tail->next = b; | |
275 | q->tail = b; | |
276 | } else | |
277 | q->head = q->tail = b; | |
278 | ||
279 | q->cnt++; | |
280 | ||
281 | return b; | |
282 | } | |
283 | ||
284 | static void* | |
285 | q_enq_exec(struct exec_parms *args) | |
286 | { | |
287 | return q_enq(args->qenq.q, args->qenq.b); | |
288 | } | |
289 | ||
290 | static dbus_irb_t* | |
291 | q_deq(dbus_irbq_t *q) | |
292 | { | |
293 | dbus_irb_t *b; | |
294 | ||
295 | b = q->head; | |
296 | if (b) { | |
297 | q->head = q->head->next; | |
298 | b->next = NULL; | |
299 | ||
300 | if (q->head == NULL) | |
301 | q->tail = q->head; | |
302 | ||
303 | q->cnt--; | |
304 | } | |
305 | return b; | |
306 | } | |
307 | ||
308 | static void* | |
309 | q_deq_exec(struct exec_parms *args) | |
310 | { | |
311 | return q_deq(args->qdeq.q); | |
312 | } | |
313 | ||
314 | /** | |
315 | * called during attach phase. Status @ Dec 2012: this function does nothing since for all of the | |
316 | * lower DBUS levels dhd_bus->drvintf->tx_timer_init is NULL. | |
317 | */ | |
318 | static int | |
319 | dbus_tx_timer_init(dhd_bus_t *dhd_bus) | |
320 | { | |
321 | if (dhd_bus && dhd_bus->drvintf && dhd_bus->drvintf->tx_timer_init) | |
322 | return dhd_bus->drvintf->tx_timer_init(dhd_bus->bus_info); | |
323 | else | |
324 | return DBUS_ERR; | |
325 | } | |
326 | ||
327 | static int | |
328 | dbus_tx_timer_start(dhd_bus_t *dhd_bus, uint timeout) | |
329 | { | |
330 | if (dhd_bus == NULL) | |
331 | return DBUS_ERR; | |
332 | ||
333 | if (dhd_bus->tx_timer_ticking) | |
334 | return DBUS_OK; | |
335 | ||
336 | if (dhd_bus->drvintf && dhd_bus->drvintf->tx_timer_start) { | |
337 | if (dhd_bus->drvintf->tx_timer_start(dhd_bus->bus_info, timeout) == DBUS_OK) { | |
338 | dhd_bus->tx_timer_ticking = TRUE; | |
339 | return DBUS_OK; | |
340 | } | |
341 | } | |
342 | ||
343 | return DBUS_ERR; | |
344 | } | |
345 | ||
346 | static int | |
347 | dbus_tx_timer_stop(dhd_bus_t *dhd_bus) | |
348 | { | |
349 | if (dhd_bus == NULL) | |
350 | return DBUS_ERR; | |
351 | ||
352 | if (!dhd_bus->tx_timer_ticking) | |
353 | return DBUS_OK; | |
354 | ||
355 | if (dhd_bus->drvintf && dhd_bus->drvintf->tx_timer_stop) { | |
356 | if (dhd_bus->drvintf->tx_timer_stop(dhd_bus->bus_info) == DBUS_OK) { | |
357 | dhd_bus->tx_timer_ticking = FALSE; | |
358 | return DBUS_OK; | |
359 | } | |
360 | } | |
361 | ||
362 | return DBUS_ERR; | |
363 | } | |
364 | ||
365 | /** called during attach phase. */ | |
366 | static int | |
367 | dbus_irbq_init(dhd_bus_t *dhd_bus, dbus_irbq_t *q, int nq, int size_irb) | |
368 | { | |
369 | int i; | |
370 | dbus_irb_t *irb; | |
371 | ||
372 | ASSERT(q); | |
373 | ASSERT(dhd_bus); | |
374 | ||
375 | for (i = 0; i < nq; i++) { | |
376 | /* MALLOC dbus_irb_tx or dbus_irb_rx, but cast to simple dbus_irb_t linkedlist */ | |
377 | irb = (dbus_irb_t *) MALLOC(dhd_bus->pub.osh, size_irb); | |
378 | if (irb == NULL) { | |
379 | ASSERT(irb); | |
380 | return DBUS_ERR; | |
381 | } | |
382 | bzero(irb, size_irb); | |
383 | ||
384 | /* q_enq() does not need to go through EXEC_xxLOCK() during init() */ | |
385 | q_enq(q, irb); | |
386 | } | |
387 | ||
388 | return DBUS_OK; | |
389 | } | |
390 | ||
391 | /** called during detach phase or when attach failed */ | |
392 | static int | |
393 | dbus_irbq_deinit(dhd_bus_t *dhd_bus, dbus_irbq_t *q, int size_irb) | |
394 | { | |
395 | dbus_irb_t *irb; | |
396 | ||
397 | ASSERT(q); | |
398 | ASSERT(dhd_bus); | |
399 | ||
400 | /* q_deq() does not need to go through EXEC_xxLOCK() | |
401 | * during deinit(); all callbacks are stopped by this time | |
402 | */ | |
403 | while ((irb = q_deq(q)) != NULL) { | |
404 | MFREE(dhd_bus->pub.osh, irb, size_irb); | |
405 | } | |
406 | ||
407 | if (q->cnt) | |
408 | DBUSERR(("deinit: q->cnt=%d > 0\n", q->cnt)); | |
409 | return DBUS_OK; | |
410 | } | |
411 | ||
412 | /** multiple code paths require the rx queue to be filled with more free IRBs */ | |
413 | static int | |
414 | dbus_rxirbs_fill(dhd_bus_t *dhd_bus) | |
415 | { | |
416 | int err = DBUS_OK; | |
417 | ||
418 | ||
419 | dbus_irb_rx_t *rxirb; | |
420 | struct exec_parms args; | |
421 | ||
422 | ASSERT(dhd_bus); | |
423 | if (dhd_bus->pub.busstate != DBUS_STATE_UP) { | |
424 | DBUSERR(("dbus_rxirbs_fill: DBUS not up \n")); | |
425 | return DBUS_ERR; | |
426 | } else if (!dhd_bus->drvintf || (dhd_bus->drvintf->recv_irb == NULL)) { | |
427 | /* Lower edge bus interface does not support recv_irb(). | |
428 | * No need to pre-submit IRBs in this case. | |
429 | */ | |
430 | return DBUS_ERR; | |
431 | } | |
432 | ||
433 | /* The dongle recv callback is freerunning without lock. So multiple callbacks(and this | |
434 | * refill) can run in parallel. While the rxoff condition is triggered outside, | |
435 | * below while loop has to check and abort posting more to avoid RPC rxq overflow. | |
436 | */ | |
437 | args.qdeq.q = dhd_bus->rx_q; | |
438 | while ((!dhd_bus->rxoff) && | |
439 | (rxirb = (EXEC_RXLOCK(dhd_bus, q_deq_exec, &args))) != NULL) { | |
440 | err = dhd_bus->drvintf->recv_irb(dhd_bus->bus_info, rxirb); | |
441 | if (err == DBUS_ERR_RXDROP || err == DBUS_ERR_RXFAIL) { | |
442 | /* Add the the free rxirb back to the queue | |
443 | * and wait till later | |
444 | */ | |
445 | bzero(rxirb, sizeof(dbus_irb_rx_t)); | |
446 | args.qenq.q = dhd_bus->rx_q; | |
447 | args.qenq.b = (dbus_irb_t *) rxirb; | |
448 | EXEC_RXLOCK(dhd_bus, q_enq_exec, &args); | |
449 | break; | |
450 | } else if (err != DBUS_OK) { | |
451 | int i = 0; | |
452 | while (i++ < 100) { | |
453 | DBUSERR(("%s :: memory leak for rxirb note?\n", __FUNCTION__)); | |
454 | } | |
455 | } | |
456 | } | |
457 | return err; | |
458 | } /* dbus_rxirbs_fill */ | |
459 | ||
460 | /** called when the DBUS interface state changed. */ | |
461 | void | |
462 | dbus_flowctrl_rx(dbus_pub_t *pub, bool on) | |
463 | { | |
464 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
465 | ||
466 | if (dhd_bus == NULL) | |
467 | return; | |
468 | ||
469 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
470 | ||
471 | if (dhd_bus->rxoff == on) | |
472 | return; | |
473 | ||
474 | dhd_bus->rxoff = on; | |
475 | ||
476 | if (dhd_bus->pub.busstate == DBUS_STATE_UP) { | |
477 | if (!on) { | |
478 | /* post more irbs, resume rx if necessary */ | |
479 | dbus_rxirbs_fill(dhd_bus); | |
480 | if (dhd_bus && dhd_bus->drvintf->recv_resume) { | |
481 | dhd_bus->drvintf->recv_resume(dhd_bus->bus_info); | |
482 | } | |
483 | } else { | |
484 | /* ??? cancell posted irbs first */ | |
485 | ||
486 | if (dhd_bus && dhd_bus->drvintf->recv_stop) { | |
487 | dhd_bus->drvintf->recv_stop(dhd_bus->bus_info); | |
488 | } | |
489 | } | |
490 | } | |
491 | } | |
492 | ||
493 | /** | |
494 | * Several code paths in this file want to send a buffer to the dongle. This function handles both | |
495 | * sending of a buffer or a pkt. | |
496 | */ | |
497 | static int | |
498 | dbus_send_irb(dbus_pub_t *pub, uint8 *buf, int len, void *pkt, void *info) | |
499 | { | |
500 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
501 | int err = DBUS_OK; | |
502 | dbus_irb_tx_t *txirb = NULL; | |
503 | int txirb_pending; | |
504 | struct exec_parms args; | |
505 | ||
506 | if (dhd_bus == NULL) | |
507 | return DBUS_ERR; | |
508 | ||
509 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
510 | ||
511 | if (dhd_bus->pub.busstate == DBUS_STATE_UP || | |
512 | dhd_bus->pub.busstate == DBUS_STATE_SLEEP) { | |
513 | args.qdeq.q = dhd_bus->tx_q; | |
514 | if (dhd_bus->drvintf) | |
515 | txirb = EXEC_TXLOCK(dhd_bus, q_deq_exec, &args); | |
516 | ||
517 | if (txirb == NULL) { | |
518 | DBUSERR(("Out of tx dbus_bufs\n")); | |
519 | return DBUS_ERR; | |
520 | } | |
521 | ||
522 | if (pkt != NULL) { | |
523 | txirb->pkt = pkt; | |
524 | txirb->buf = NULL; | |
525 | txirb->len = 0; | |
526 | } else if (buf != NULL) { | |
527 | txirb->pkt = NULL; | |
528 | txirb->buf = buf; | |
529 | txirb->len = len; | |
530 | } else { | |
531 | ASSERT(0); /* Should not happen */ | |
532 | } | |
533 | txirb->info = info; | |
534 | txirb->arg = NULL; | |
535 | txirb->retry_count = 0; | |
536 | ||
537 | if (dhd_bus->drvintf && dhd_bus->drvintf->send_irb) { | |
538 | /* call lower DBUS level send_irb function */ | |
539 | err = dhd_bus->drvintf->send_irb(dhd_bus->bus_info, txirb); | |
540 | if (err == DBUS_ERR_TXDROP) { | |
541 | /* tx fail and no completion routine to clean up, reclaim irb NOW */ | |
542 | DBUSERR(("%s: send_irb failed, status = %d\n", __FUNCTION__, err)); | |
543 | bzero(txirb, sizeof(dbus_irb_tx_t)); | |
544 | args.qenq.q = dhd_bus->tx_q; | |
545 | args.qenq.b = (dbus_irb_t *) txirb; | |
546 | EXEC_TXLOCK(dhd_bus, q_enq_exec, &args); | |
547 | } else { | |
548 | dbus_tx_timer_start(dhd_bus, DBUS_TX_TIMEOUT_INTERVAL); | |
549 | txirb_pending = dhd_bus->pub.ntxq - dhd_bus->tx_q->cnt; | |
550 | if (txirb_pending > (dhd_bus->tx_low_watermark * 3)) { | |
551 | dbus_flowctrl_tx(dhd_bus, TRUE); | |
552 | } | |
553 | } | |
554 | } | |
555 | } else { | |
556 | err = DBUS_ERR_TXFAIL; | |
557 | DBUSTRACE(("%s: bus down, send_irb failed\n", __FUNCTION__)); | |
558 | } | |
559 | ||
560 | return err; | |
561 | } /* dbus_send_irb */ | |
562 | ||
563 | #if defined(BCM_REQUEST_FW) | |
564 | ||
565 | /** | |
566 | * Before downloading a firmware image into the dongle, the validity of the image must be checked. | |
567 | */ | |
568 | static int | |
569 | check_file(osl_t *osh, unsigned char *headers) | |
570 | { | |
571 | struct trx_header *trx; | |
572 | int actual_len = -1; | |
573 | ||
574 | /* Extract trx header */ | |
575 | trx = (struct trx_header *)headers; | |
576 | if (ltoh32(trx->magic) != TRX_MAGIC) { | |
577 | printf("Error: trx bad hdr %x\n", ltoh32(trx->magic)); | |
578 | return -1; | |
579 | } | |
580 | ||
581 | headers += SIZEOF_TRX(trx); | |
582 | ||
583 | /* TRX V1: get firmware len */ | |
584 | /* TRX V2: get firmware len and DSG/CFG lengths */ | |
585 | if (ltoh32(trx->flag_version) & TRX_UNCOMP_IMAGE) { | |
586 | actual_len = ltoh32(trx->offsets[TRX_OFFSETS_DLFWLEN_IDX]) + | |
587 | SIZEOF_TRX(trx); | |
588 | #ifdef BCMTRXV2 | |
589 | if (ISTRX_V2(trx)) { | |
590 | actual_len += ltoh32(trx->offsets[TRX_OFFSETS_DSG_LEN_IDX]) + | |
591 | ltoh32(trx->offsets[TRX_OFFSETS_CFG_LEN_IDX]); | |
592 | } | |
593 | #endif | |
594 | return actual_len; | |
595 | } else { | |
596 | printf("compressed image\n"); | |
597 | } | |
598 | ||
599 | return -1; | |
600 | } | |
601 | ||
602 | #ifdef EXTERNAL_FW_PATH | |
603 | static int | |
604 | dbus_get_fw_nvram(dhd_bus_t *dhd_bus, char *pfw_path, char *pnv_path) | |
605 | { | |
606 | int bcmerror = -1, i; | |
607 | uint len, total_len; | |
608 | void *nv_image = NULL, *fw_image = NULL; | |
609 | char *nv_memblock = NULL, *fw_memblock = NULL; | |
610 | char *bufp; | |
611 | bool file_exists; | |
612 | uint8 nvram_words_pad = 0; | |
613 | uint memblock_size = 2048; | |
614 | uint8 *memptr; | |
615 | int actual_fwlen; | |
616 | struct trx_header *hdr; | |
617 | uint32 img_offset = 0; | |
618 | int offset = 0; | |
619 | ||
620 | /* For Get nvram */ | |
621 | file_exists = ((pnv_path != NULL) && (pnv_path[0] != '\0')); | |
622 | if (file_exists) { | |
623 | nv_image = dhd_os_open_image1(dhd_bus->dhd, pnv_path); | |
624 | if (nv_image == NULL) { | |
625 | printf("%s: Open nvram file failed %s\n", __FUNCTION__, pnv_path); | |
626 | goto err; | |
627 | } | |
628 | } | |
629 | nv_memblock = MALLOC(dhd_bus->pub.osh, MAX_NVRAMBUF_SIZE); | |
630 | if (nv_memblock == NULL) { | |
631 | DBUSERR(("%s: Failed to allocate memory %d bytes\n", | |
632 | __FUNCTION__, MAX_NVRAMBUF_SIZE)); | |
633 | goto err; | |
634 | } | |
635 | len = dhd_os_get_image_block(nv_memblock, MAX_NVRAMBUF_SIZE, nv_image); | |
636 | if (len > 0 && len < MAX_NVRAMBUF_SIZE) { | |
637 | bufp = (char *)nv_memblock; | |
638 | bufp[len] = 0; | |
639 | dhd_bus->nvram_len = process_nvram_vars(bufp, len); | |
640 | if (dhd_bus->nvram_len % 4) | |
641 | nvram_words_pad = 4 - dhd_bus->nvram_len % 4; | |
642 | } else { | |
643 | DBUSERR(("%s: error reading nvram file: %d\n", __FUNCTION__, len)); | |
644 | bcmerror = DBUS_ERR_NVRAM; | |
645 | goto err; | |
646 | } | |
ce3b8cf9 | 647 | if (nv_image) { |
d2839953 | 648 | dhd_os_close_image1(dhd_bus->dhd, nv_image); |
ce3b8cf9 RC |
649 | nv_image = NULL; |
650 | } | |
d2839953 RC |
651 | |
652 | /* For Get first block of fw to calculate total_len */ | |
653 | file_exists = ((pfw_path != NULL) && (pfw_path[0] != '\0')); | |
654 | if (file_exists) { | |
655 | fw_image = dhd_os_open_image1(dhd_bus->dhd, pfw_path); | |
656 | if (fw_image == NULL) { | |
657 | printf("%s: Open fw file failed %s\n", __FUNCTION__, pfw_path); | |
658 | goto err; | |
659 | } | |
660 | } | |
661 | memptr = fw_memblock = MALLOC(dhd_bus->pub.osh, memblock_size); | |
662 | if (fw_memblock == NULL) { | |
663 | DBUSERR(("%s: Failed to allocate memory %d bytes\n", __FUNCTION__, | |
664 | memblock_size)); | |
665 | goto err; | |
666 | } | |
667 | len = dhd_os_get_image_block((char*)memptr, memblock_size, fw_image); | |
668 | if ((actual_fwlen = check_file(dhd_bus->pub.osh, memptr)) <= 0) { | |
669 | DBUSERR(("%s: bad firmware format!\n", __FUNCTION__)); | |
670 | goto err; | |
671 | } | |
672 | ||
673 | total_len = actual_fwlen + dhd_bus->nvram_len + nvram_words_pad; | |
674 | dhd_bus->image = MALLOC(dhd_bus->pub.osh, total_len); | |
675 | dhd_bus->image_len = total_len; | |
676 | if (dhd_bus->image == NULL) { | |
677 | DBUSERR(("%s: malloc failed!\n", __FUNCTION__)); | |
678 | goto err; | |
679 | } | |
680 | ||
681 | /* Step1: Copy trx header + firmwre */ | |
682 | memptr = fw_memblock; | |
683 | do { | |
684 | if (len < 0) { | |
685 | DBUSERR(("%s: dhd_os_get_image_block failed (%d)\n", __FUNCTION__, len)); | |
686 | bcmerror = BCME_ERROR; | |
687 | goto err; | |
688 | } | |
689 | bcopy(memptr, dhd_bus->image+offset, len); | |
690 | offset += len; | |
691 | } while ((len = dhd_os_get_image_block((char*)memptr, memblock_size, fw_image))); | |
692 | /* Step2: Copy NVRAM + pad */ | |
693 | hdr = (struct trx_header *)dhd_bus->image; | |
694 | img_offset = SIZEOF_TRX(hdr) + hdr->offsets[TRX_OFFSETS_DLFWLEN_IDX]; | |
695 | bcopy(nv_memblock, (uint8 *)(dhd_bus->image + img_offset), | |
696 | dhd_bus->nvram_len); | |
697 | img_offset += dhd_bus->nvram_len; | |
698 | if (nvram_words_pad) { | |
699 | bzero(&dhd_bus->image[img_offset], nvram_words_pad); | |
700 | img_offset += nvram_words_pad; | |
701 | } | |
702 | #ifdef BCMTRXV2 | |
703 | /* Step3: Copy DSG/CFG for V2 */ | |
704 | if (ISTRX_V2(hdr) && | |
705 | (hdr->offsets[TRX_OFFSETS_DSG_LEN_IDX] || | |
706 | hdr->offsets[TRX_OFFSETS_CFG_LEN_IDX])) { | |
707 | DBUSERR(("%s: fix me\n", __FUNCTION__)); | |
708 | } | |
709 | #endif /* BCMTRXV2 */ | |
710 | /* Step4: update TRX header for nvram size */ | |
711 | hdr = (struct trx_header *)dhd_bus->image; | |
712 | hdr->len = htol32(total_len); | |
713 | /* Pass the actual fw len */ | |
714 | hdr->offsets[TRX_OFFSETS_NVM_LEN_IDX] = | |
715 | htol32(dhd_bus->nvram_len + nvram_words_pad); | |
716 | /* Calculate CRC over header */ | |
717 | hdr->crc32 = hndcrc32((uint8 *)&hdr->flag_version, | |
718 | SIZEOF_TRX(hdr) - OFFSETOF(struct trx_header, flag_version), | |
719 | CRC32_INIT_VALUE); | |
720 | ||
721 | /* Calculate CRC over data */ | |
722 | for (i = SIZEOF_TRX(hdr); i < total_len; ++i) | |
723 | hdr->crc32 = hndcrc32((uint8 *)&dhd_bus->image[i], 1, hdr->crc32); | |
724 | hdr->crc32 = htol32(hdr->crc32); | |
725 | ||
726 | bcmerror = DBUS_OK; | |
727 | ||
728 | err: | |
729 | if (fw_memblock) | |
730 | MFREE(dhd_bus->pub.osh, fw_memblock, MAX_NVRAMBUF_SIZE); | |
731 | if (fw_image) | |
732 | dhd_os_close_image1(dhd_bus->dhd, fw_image); | |
733 | if (nv_memblock) | |
734 | MFREE(dhd_bus->pub.osh, nv_memblock, MAX_NVRAMBUF_SIZE); | |
735 | if (nv_image) | |
736 | dhd_os_close_image1(dhd_bus->dhd, nv_image); | |
737 | ||
738 | return bcmerror; | |
739 | } | |
740 | ||
741 | /** | |
742 | * during driver initialization ('attach') or after PnP 'resume', firmware needs to be loaded into | |
743 | * the dongle | |
744 | */ | |
745 | static int | |
746 | dbus_do_download(dhd_bus_t *dhd_bus, char *pfw_path, char *pnv_path) | |
747 | { | |
748 | int err = DBUS_OK; | |
749 | ||
750 | err = dbus_get_fw_nvram(dhd_bus, pfw_path, pnv_path); | |
751 | if (err) { | |
752 | DBUSERR(("dbus_do_download: fail to get nvram %d\n", err)); | |
753 | return err; | |
754 | } | |
755 | ||
756 | if (dhd_bus->drvintf->dlstart && dhd_bus->drvintf->dlrun) { | |
757 | err = dhd_bus->drvintf->dlstart(dhd_bus->bus_info, | |
758 | dhd_bus->image, dhd_bus->image_len); | |
759 | if (err == DBUS_OK) { | |
760 | err = dhd_bus->drvintf->dlrun(dhd_bus->bus_info); | |
761 | } | |
762 | } else | |
763 | err = DBUS_ERR; | |
764 | ||
765 | if (dhd_bus->image) { | |
766 | MFREE(dhd_bus->pub.osh, dhd_bus->image, dhd_bus->image_len); | |
767 | dhd_bus->image = NULL; | |
768 | dhd_bus->image_len = 0; | |
769 | } | |
770 | ||
771 | return err; | |
772 | } /* dbus_do_download */ | |
773 | #else | |
774 | ||
775 | /** | |
776 | * It is easy for the user to pass one jumbo nvram file to the driver than a set of smaller files. | |
777 | * The 'jumbo nvram' file format is essentially a set of nvram files. Before commencing firmware | |
778 | * download, the dongle needs to be probed so that the correct nvram contents within the jumbo nvram | |
779 | * file is selected. | |
780 | */ | |
781 | static int | |
782 | dbus_jumbo_nvram(dhd_bus_t *dhd_bus) | |
783 | { | |
784 | int8 *nvram = NULL; | |
785 | int nvram_len = 0; | |
786 | int ret = DBUS_OK; | |
787 | uint16 boardrev = 0xFFFF; | |
788 | uint16 boardtype = 0xFFFF; | |
789 | ||
790 | /* read the otp for boardrev & boardtype | |
791 | * if boardtype/rev are present in otp | |
792 | * select nvram data for that boardtype/rev | |
793 | */ | |
794 | dbus_otp(dhd_bus, &boardtype, &boardrev); | |
795 | ||
796 | ret = dbus_select_nvram(dhd_bus, dhd_bus->extdl.vars, dhd_bus->extdl.varslen, | |
797 | boardtype, boardrev, &nvram, &nvram_len); | |
798 | ||
799 | if (ret == DBUS_JUMBO_BAD_FORMAT) | |
800 | return DBUS_ERR_NVRAM; | |
801 | else if (ret == DBUS_JUMBO_NOMATCH && | |
802 | (boardtype != 0xFFFF || boardrev != 0xFFFF)) { | |
803 | DBUSERR(("No matching NVRAM for boardtype 0x%02x boardrev 0x%02x\n", | |
804 | boardtype, boardrev)); | |
805 | return DBUS_ERR_NVRAM; | |
806 | } | |
807 | dhd_bus->nvram = nvram; | |
808 | dhd_bus->nvram_len = nvram_len; | |
809 | ||
810 | return DBUS_OK; | |
811 | } | |
812 | ||
813 | /** before commencing fw download, the correct NVRAM image to download has to be picked */ | |
814 | static int | |
815 | dbus_get_nvram(dhd_bus_t *dhd_bus) | |
816 | { | |
817 | int len, i; | |
818 | struct trx_header *hdr; | |
819 | int actual_fwlen; | |
820 | uint32 img_offset = 0; | |
821 | ||
822 | dhd_bus->nvram_len = 0; | |
823 | if (dhd_bus->extdl.varslen) { | |
824 | if (DBUS_OK != dbus_jumbo_nvram(dhd_bus)) | |
825 | return DBUS_ERR_NVRAM; | |
826 | DBUSERR(("NVRAM %d bytes downloaded\n", dhd_bus->nvram_len)); | |
827 | } | |
828 | #if defined(BCM_REQUEST_FW) | |
829 | else if (nonfwnvram) { | |
830 | dhd_bus->nvram = nonfwnvram; | |
831 | dhd_bus->nvram_len = nonfwnvramlen; | |
832 | DBUSERR(("NVRAM %d bytes downloaded\n", dhd_bus->nvram_len)); | |
833 | } | |
834 | #endif | |
835 | if (dhd_bus->nvram) { | |
836 | uint8 nvram_words_pad = 0; | |
837 | /* Validate the format/length etc of the file */ | |
838 | if ((actual_fwlen = check_file(dhd_bus->pub.osh, dhd_bus->fw)) <= 0) { | |
839 | DBUSERR(("%s: bad firmware format!\n", __FUNCTION__)); | |
840 | return DBUS_ERR_NVRAM; | |
841 | } | |
842 | ||
843 | if (!dhd_bus->nvram_nontxt) { | |
844 | /* host supplied nvram could be in .txt format | |
845 | * with all the comments etc... | |
846 | */ | |
847 | dhd_bus->nvram_len = process_nvram_vars(dhd_bus->nvram, | |
848 | dhd_bus->nvram_len); | |
849 | } | |
850 | if (dhd_bus->nvram_len % 4) | |
851 | nvram_words_pad = 4 - dhd_bus->nvram_len % 4; | |
852 | ||
853 | len = actual_fwlen + dhd_bus->nvram_len + nvram_words_pad; | |
854 | dhd_bus->image = MALLOC(dhd_bus->pub.osh, len); | |
855 | dhd_bus->image_len = len; | |
856 | if (dhd_bus->image == NULL) { | |
857 | DBUSERR(("%s: malloc failed!\n", __FUNCTION__)); | |
858 | return DBUS_ERR_NVRAM; | |
859 | } | |
860 | hdr = (struct trx_header *)dhd_bus->fw; | |
861 | /* Step1: Copy trx header + firmwre */ | |
862 | img_offset = SIZEOF_TRX(hdr) + hdr->offsets[TRX_OFFSETS_DLFWLEN_IDX]; | |
863 | bcopy(dhd_bus->fw, dhd_bus->image, img_offset); | |
864 | /* Step2: Copy NVRAM + pad */ | |
865 | bcopy(dhd_bus->nvram, (uint8 *)(dhd_bus->image + img_offset), | |
866 | dhd_bus->nvram_len); | |
867 | img_offset += dhd_bus->nvram_len; | |
868 | if (nvram_words_pad) { | |
869 | bzero(&dhd_bus->image[img_offset], | |
870 | nvram_words_pad); | |
871 | img_offset += nvram_words_pad; | |
872 | } | |
873 | #ifdef BCMTRXV2 | |
874 | /* Step3: Copy DSG/CFG for V2 */ | |
875 | if (ISTRX_V2(hdr) && | |
876 | (hdr->offsets[TRX_OFFSETS_DSG_LEN_IDX] || | |
877 | hdr->offsets[TRX_OFFSETS_CFG_LEN_IDX])) { | |
878 | ||
879 | bcopy(dhd_bus->fw + SIZEOF_TRX(hdr) + | |
880 | hdr->offsets[TRX_OFFSETS_DLFWLEN_IDX] + | |
881 | hdr->offsets[TRX_OFFSETS_NVM_LEN_IDX], | |
882 | dhd_bus->image + img_offset, | |
883 | hdr->offsets[TRX_OFFSETS_DSG_LEN_IDX] + | |
884 | hdr->offsets[TRX_OFFSETS_CFG_LEN_IDX]); | |
885 | ||
886 | img_offset += hdr->offsets[TRX_OFFSETS_DSG_LEN_IDX] + | |
887 | hdr->offsets[TRX_OFFSETS_CFG_LEN_IDX]; | |
888 | } | |
889 | #endif /* BCMTRXV2 */ | |
890 | /* Step4: update TRX header for nvram size */ | |
891 | hdr = (struct trx_header *)dhd_bus->image; | |
892 | hdr->len = htol32(len); | |
893 | /* Pass the actual fw len */ | |
894 | hdr->offsets[TRX_OFFSETS_NVM_LEN_IDX] = | |
895 | htol32(dhd_bus->nvram_len + nvram_words_pad); | |
896 | /* Calculate CRC over header */ | |
897 | hdr->crc32 = hndcrc32((uint8 *)&hdr->flag_version, | |
898 | SIZEOF_TRX(hdr) - OFFSETOF(struct trx_header, flag_version), | |
899 | CRC32_INIT_VALUE); | |
900 | ||
901 | /* Calculate CRC over data */ | |
902 | for (i = SIZEOF_TRX(hdr); i < len; ++i) | |
903 | hdr->crc32 = hndcrc32((uint8 *)&dhd_bus->image[i], 1, hdr->crc32); | |
904 | hdr->crc32 = htol32(hdr->crc32); | |
905 | } else { | |
906 | dhd_bus->image = dhd_bus->fw; | |
907 | dhd_bus->image_len = (uint32)dhd_bus->fwlen; | |
908 | } | |
909 | ||
910 | return DBUS_OK; | |
911 | } /* dbus_get_nvram */ | |
912 | ||
913 | /** | |
914 | * during driver initialization ('attach') or after PnP 'resume', firmware needs to be loaded into | |
915 | * the dongle | |
916 | */ | |
917 | static int | |
918 | dbus_do_download(dhd_bus_t *dhd_bus) | |
919 | { | |
920 | int err = DBUS_OK; | |
921 | #ifndef BCM_REQUEST_FW | |
922 | int decomp_override = 0; | |
923 | #endif | |
924 | #ifdef BCM_REQUEST_FW | |
925 | uint16 boardrev = 0xFFFF, boardtype = 0xFFFF; | |
926 | int8 *temp_nvram; | |
927 | int temp_len; | |
928 | #endif | |
929 | ||
930 | #if defined(BCM_REQUEST_FW) | |
931 | dhd_bus->firmware = dbus_get_fw_nvfile(dhd_bus->pub.attrib.devid, | |
932 | dhd_bus->pub.attrib.chiprev, &dhd_bus->fw, &dhd_bus->fwlen, | |
933 | DBUS_FIRMWARE, 0, 0); | |
934 | if (!dhd_bus->firmware) | |
935 | return DBUS_ERR; | |
936 | #endif | |
937 | ||
938 | dhd_bus->image = dhd_bus->fw; | |
939 | dhd_bus->image_len = (uint32)dhd_bus->fwlen; | |
940 | ||
941 | #ifndef BCM_REQUEST_FW | |
942 | if (UNZIP_ENAB(dhd_bus) && !decomp_override) { | |
943 | err = dbus_zlib_decomp(dhd_bus); | |
944 | if (err) { | |
945 | DBUSERR(("dbus_attach: fw decompress fail %d\n", err)); | |
946 | return err; | |
947 | } | |
948 | } | |
949 | #endif | |
950 | ||
951 | #if defined(BCM_REQUEST_FW) | |
952 | /* check if firmware is appended with nvram file */ | |
953 | err = dbus_otp(dhd_bus, &boardtype, &boardrev); | |
954 | /* check if nvram is provided as separte file */ | |
955 | nonfwnvram = NULL; | |
956 | nonfwnvramlen = 0; | |
957 | dhd_bus->nvfile = dbus_get_fw_nvfile(dhd_bus->pub.attrib.devid, | |
958 | dhd_bus->pub.attrib.chiprev, (void *)&temp_nvram, &temp_len, | |
959 | DBUS_NVFILE, boardtype, boardrev); | |
960 | if (dhd_bus->nvfile) { | |
961 | int8 *tmp = MALLOC(dhd_bus->pub.osh, temp_len); | |
962 | if (tmp) { | |
963 | bcopy(temp_nvram, tmp, temp_len); | |
964 | nonfwnvram = tmp; | |
965 | nonfwnvramlen = temp_len; | |
966 | } else { | |
967 | err = DBUS_ERR; | |
968 | goto fail; | |
969 | } | |
970 | } | |
971 | #endif /* defined(BCM_REQUEST_FW) */ | |
972 | ||
973 | err = dbus_get_nvram(dhd_bus); | |
974 | if (err) { | |
975 | DBUSERR(("dbus_do_download: fail to get nvram %d\n", err)); | |
976 | return err; | |
977 | } | |
978 | ||
979 | ||
980 | if (dhd_bus->drvintf->dlstart && dhd_bus->drvintf->dlrun) { | |
981 | err = dhd_bus->drvintf->dlstart(dhd_bus->bus_info, | |
982 | dhd_bus->image, dhd_bus->image_len); | |
983 | ||
984 | if (err == DBUS_OK) | |
985 | err = dhd_bus->drvintf->dlrun(dhd_bus->bus_info); | |
986 | } else | |
987 | err = DBUS_ERR; | |
988 | ||
989 | if (dhd_bus->nvram) { | |
990 | MFREE(dhd_bus->pub.osh, dhd_bus->image, dhd_bus->image_len); | |
991 | dhd_bus->image = dhd_bus->fw; | |
992 | dhd_bus->image_len = (uint32)dhd_bus->fwlen; | |
993 | } | |
994 | ||
995 | #ifndef BCM_REQUEST_FW | |
996 | if (UNZIP_ENAB(dhd_bus) && (!decomp_override) && dhd_bus->orig_fw) { | |
997 | MFREE(dhd_bus->pub.osh, dhd_bus->fw, dhd_bus->decomp_memsize); | |
998 | dhd_bus->image = dhd_bus->fw = dhd_bus->orig_fw; | |
999 | dhd_bus->image_len = dhd_bus->fwlen = dhd_bus->origfw_len; | |
1000 | } | |
1001 | #endif | |
1002 | ||
1003 | #if defined(BCM_REQUEST_FW) | |
1004 | fail: | |
1005 | if (dhd_bus->firmware) { | |
1006 | dbus_release_fw_nvfile(dhd_bus->firmware); | |
1007 | dhd_bus->firmware = NULL; | |
1008 | } | |
1009 | if (dhd_bus->nvfile) { | |
1010 | dbus_release_fw_nvfile(dhd_bus->nvfile); | |
1011 | dhd_bus->nvfile = NULL; | |
1012 | } | |
1013 | if (nonfwnvram) { | |
1014 | MFREE(dhd_bus->pub.osh, nonfwnvram, nonfwnvramlen); | |
1015 | nonfwnvram = NULL; | |
1016 | nonfwnvramlen = 0; | |
1017 | } | |
1018 | #endif | |
1019 | return err; | |
1020 | } /* dbus_do_download */ | |
1021 | #endif /* EXTERNAL_FW_PATH */ | |
1022 | #endif | |
1023 | ||
1024 | /** required for DBUS deregistration */ | |
1025 | static void | |
1026 | dbus_disconnect(void *handle) | |
1027 | { | |
1028 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1029 | ||
1030 | if (disconnect_cb) | |
1031 | disconnect_cb(disc_arg); | |
1032 | } | |
1033 | ||
1034 | /** | |
1035 | * This function is called when the sent irb times out without a tx response status. | |
1036 | * DBUS adds reliability by resending timed out IRBs DBUS_TX_RETRY_LIMIT times. | |
1037 | */ | |
1038 | static void | |
1039 | dbus_if_send_irb_timeout(void *handle, dbus_irb_tx_t *txirb) | |
1040 | { | |
1041 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1042 | ||
1043 | if ((dhd_bus == NULL) || (dhd_bus->drvintf == NULL) || (txirb == NULL)) { | |
1044 | return; | |
1045 | } | |
1046 | ||
1047 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1048 | ||
1049 | return; | |
1050 | ||
1051 | } /* dbus_if_send_irb_timeout */ | |
1052 | ||
1053 | /** | |
1054 | * When lower DBUS level signals that a send IRB completed, either successful or not, the higher | |
1055 | * level (e.g. dhd_linux.c) has to be notified, and transmit flow control has to be evaluated. | |
1056 | */ | |
1057 | static void BCMFASTPATH | |
1058 | dbus_if_send_irb_complete(void *handle, dbus_irb_tx_t *txirb, int status) | |
1059 | { | |
1060 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1061 | int txirb_pending; | |
1062 | struct exec_parms args; | |
1063 | void *pktinfo; | |
1064 | ||
1065 | if ((dhd_bus == NULL) || (txirb == NULL)) { | |
1066 | return; | |
1067 | } | |
1068 | ||
1069 | DBUSTRACE(("%s: status = %d\n", __FUNCTION__, status)); | |
1070 | ||
1071 | dbus_tx_timer_stop(dhd_bus); | |
1072 | ||
1073 | /* re-queue BEFORE calling send_complete which will assume that this irb | |
1074 | is now available. | |
1075 | */ | |
1076 | pktinfo = txirb->info; | |
1077 | bzero(txirb, sizeof(dbus_irb_tx_t)); | |
1078 | args.qenq.q = dhd_bus->tx_q; | |
1079 | args.qenq.b = (dbus_irb_t *) txirb; | |
1080 | EXEC_TXLOCK(dhd_bus, q_enq_exec, &args); | |
1081 | ||
1082 | if (dhd_bus->pub.busstate != DBUS_STATE_DOWN) { | |
1083 | if ((status == DBUS_OK) || (status == DBUS_ERR_NODEVICE)) { | |
1084 | if (dhd_bus->cbs && dhd_bus->cbs->send_complete) | |
1085 | dhd_bus->cbs->send_complete(dhd_bus->cbarg, pktinfo, | |
1086 | status); | |
1087 | ||
1088 | if (status == DBUS_OK) { | |
1089 | txirb_pending = dhd_bus->pub.ntxq - dhd_bus->tx_q->cnt; | |
1090 | if (txirb_pending) | |
1091 | dbus_tx_timer_start(dhd_bus, DBUS_TX_TIMEOUT_INTERVAL); | |
1092 | if ((txirb_pending < dhd_bus->tx_low_watermark) && | |
1093 | dhd_bus->txoff && !dhd_bus->txoverride) { | |
1094 | dbus_flowctrl_tx(dhd_bus, OFF); | |
1095 | } | |
1096 | } | |
1097 | } else { | |
1098 | DBUSERR(("%s: %d WARNING freeing orphan pkt %p\n", __FUNCTION__, __LINE__, | |
1099 | pktinfo)); | |
1100 | #if defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_TXNOCOPY) || defined(BCM_RPC_TOC) | |
1101 | if (pktinfo) | |
1102 | if (dhd_bus->cbs && dhd_bus->cbs->send_complete) | |
1103 | dhd_bus->cbs->send_complete(dhd_bus->cbarg, pktinfo, | |
1104 | status); | |
1105 | #else | |
1106 | dbus_if_pktfree(dhd_bus, (void*)pktinfo, TRUE); | |
1107 | #endif /* defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_TXNOCOPY) || defined(BCM_RPC_TOC) */ | |
1108 | } | |
1109 | } else { | |
1110 | DBUSERR(("%s: %d WARNING freeing orphan pkt %p\n", __FUNCTION__, __LINE__, | |
1111 | pktinfo)); | |
1112 | #if defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_TXNOCOPY) || defined(BCM_RPC_TOC) | |
1113 | if (pktinfo) | |
1114 | if (dhd_bus->cbs && dhd_bus->cbs->send_complete) | |
1115 | dhd_bus->cbs->send_complete(dhd_bus->cbarg, pktinfo, | |
1116 | status); | |
1117 | #else | |
1118 | dbus_if_pktfree(dhd_bus, (void*)pktinfo, TRUE); | |
1119 | #endif /* defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_TXNOCOPY) defined(BCM_RPC_TOC) */ | |
1120 | } | |
1121 | } /* dbus_if_send_irb_complete */ | |
1122 | ||
1123 | /** | |
1124 | * When lower DBUS level signals that a receive IRB completed, either successful or not, the higher | |
1125 | * level (e.g. dhd_linux.c) has to be notified, and fresh free receive IRBs may have to be given | |
1126 | * to lower levels. | |
1127 | */ | |
1128 | static void BCMFASTPATH | |
1129 | dbus_if_recv_irb_complete(void *handle, dbus_irb_rx_t *rxirb, int status) | |
1130 | { | |
1131 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1132 | int rxirb_pending; | |
1133 | struct exec_parms args; | |
1134 | ||
1135 | if ((dhd_bus == NULL) || (rxirb == NULL)) { | |
1136 | return; | |
1137 | } | |
1138 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1139 | if (dhd_bus->pub.busstate != DBUS_STATE_DOWN && | |
1140 | dhd_bus->pub.busstate != DBUS_STATE_SLEEP) { | |
1141 | if (status == DBUS_OK) { | |
1142 | if ((rxirb->buf != NULL) && (rxirb->actual_len > 0)) { | |
1143 | #ifdef DBUS_USB_LOOPBACK | |
1144 | if (is_loopback_pkt(rxirb->buf)) { | |
1145 | matches_loopback_pkt(rxirb->buf); | |
1146 | } else | |
1147 | #endif | |
1148 | if (dhd_bus->cbs && dhd_bus->cbs->recv_buf) { | |
1149 | dhd_bus->cbs->recv_buf(dhd_bus->cbarg, rxirb->buf, | |
1150 | rxirb->actual_len); | |
1151 | } | |
1152 | } else if (rxirb->pkt != NULL) { | |
1153 | if (dhd_bus->cbs && dhd_bus->cbs->recv_pkt) | |
1154 | dhd_bus->cbs->recv_pkt(dhd_bus->cbarg, rxirb->pkt); | |
1155 | } else { | |
1156 | ASSERT(0); /* Should not happen */ | |
1157 | } | |
1158 | ||
1159 | rxirb_pending = dhd_bus->pub.nrxq - dhd_bus->rx_q->cnt - 1; | |
1160 | if ((rxirb_pending <= dhd_bus->rx_low_watermark) && | |
1161 | !dhd_bus->rxoff) { | |
1162 | DBUSTRACE(("Low watermark so submit more %d <= %d \n", | |
1163 | dhd_bus->rx_low_watermark, rxirb_pending)); | |
1164 | dbus_rxirbs_fill(dhd_bus); | |
1165 | } else if (dhd_bus->rxoff) | |
1166 | DBUSTRACE(("rx flow controlled. not filling more. cut_rxq=%d\n", | |
1167 | dhd_bus->rx_q->cnt)); | |
1168 | } else if (status == DBUS_ERR_NODEVICE) { | |
1169 | DBUSERR(("%s: %d status = %d, buf %p\n", __FUNCTION__, __LINE__, status, | |
1170 | rxirb->buf)); | |
1171 | #if defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_RXNOCOPY) | |
1172 | if (rxirb->buf) { | |
1173 | PKTFRMNATIVE(dhd_bus->pub.osh, rxirb->buf); | |
1174 | PKTFREE(dhd_bus->pub.osh, rxirb->buf, FALSE); | |
1175 | } | |
1176 | #endif /* BCM_RPC_NOCOPY || BCM_RPC_TXNOCOPY || BCM_RPC_TOC */ | |
1177 | } else { | |
1178 | if (status != DBUS_ERR_RXZLP) | |
1179 | DBUSERR(("%s: %d status = %d, buf %p\n", __FUNCTION__, __LINE__, | |
1180 | status, rxirb->buf)); | |
1181 | #if defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_RXNOCOPY) | |
1182 | if (rxirb->buf) { | |
1183 | PKTFRMNATIVE(dhd_bus->pub.osh, rxirb->buf); | |
1184 | PKTFREE(dhd_bus->pub.osh, rxirb->buf, FALSE); | |
1185 | } | |
1186 | #endif /* BCM_RPC_NOCOPY || BCM_RPC_TXNOCOPY || BCM_RPC_TOC */ | |
1187 | } | |
1188 | } else { | |
1189 | DBUSTRACE(("%s: DBUS down, ignoring recv callback. buf %p\n", __FUNCTION__, | |
1190 | rxirb->buf)); | |
1191 | #if defined(BCM_RPC_NOCOPY) || defined(BCM_RPC_RXNOCOPY) | |
1192 | if (rxirb->buf) { | |
1193 | PKTFRMNATIVE(dhd_bus->pub.osh, rxirb->buf); | |
1194 | PKTFREE(dhd_bus->pub.osh, rxirb->buf, FALSE); | |
1195 | } | |
1196 | #endif /* BCM_RPC_NOCOPY || BCM_RPC_TXNOCOPY || BCM_RPC_TOC */ | |
1197 | } | |
1198 | if (dhd_bus->rx_q != NULL) { | |
1199 | bzero(rxirb, sizeof(dbus_irb_rx_t)); | |
1200 | args.qenq.q = dhd_bus->rx_q; | |
1201 | args.qenq.b = (dbus_irb_t *) rxirb; | |
1202 | EXEC_RXLOCK(dhd_bus, q_enq_exec, &args); | |
1203 | } else | |
1204 | MFREE(dhd_bus->pub.osh, rxirb, sizeof(dbus_irb_tx_t)); | |
1205 | } /* dbus_if_recv_irb_complete */ | |
1206 | ||
1207 | /** | |
1208 | * Accumulate errors signaled by lower DBUS levels and signal them to higher (e.g. dhd_linux.c) | |
1209 | * level. | |
1210 | */ | |
1211 | static void | |
1212 | dbus_if_errhandler(void *handle, int err) | |
1213 | { | |
1214 | dhd_bus_t *dhd_bus = handle; | |
1215 | uint32 mask = 0; | |
1216 | ||
1217 | if (dhd_bus == NULL) | |
1218 | return; | |
1219 | ||
1220 | switch (err) { | |
1221 | case DBUS_ERR_TXFAIL: | |
1222 | dhd_bus->pub.stats.tx_errors++; | |
1223 | mask |= ERR_CBMASK_TXFAIL; | |
1224 | break; | |
1225 | case DBUS_ERR_TXDROP: | |
1226 | dhd_bus->pub.stats.tx_dropped++; | |
1227 | mask |= ERR_CBMASK_TXFAIL; | |
1228 | break; | |
1229 | case DBUS_ERR_RXFAIL: | |
1230 | dhd_bus->pub.stats.rx_errors++; | |
1231 | mask |= ERR_CBMASK_RXFAIL; | |
1232 | break; | |
1233 | case DBUS_ERR_RXDROP: | |
1234 | dhd_bus->pub.stats.rx_dropped++; | |
1235 | mask |= ERR_CBMASK_RXFAIL; | |
1236 | break; | |
1237 | default: | |
1238 | break; | |
1239 | } | |
1240 | ||
1241 | if (dhd_bus->cbs && dhd_bus->cbs->errhandler && (dhd_bus->errmask & mask)) | |
1242 | dhd_bus->cbs->errhandler(dhd_bus->cbarg, err); | |
1243 | } | |
1244 | ||
1245 | /** | |
1246 | * When lower DBUS level signals control IRB completed, higher level (e.g. dhd_linux.c) has to be | |
1247 | * notified. | |
1248 | */ | |
1249 | static void | |
1250 | dbus_if_ctl_complete(void *handle, int type, int status) | |
1251 | { | |
1252 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1253 | ||
1254 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1255 | ||
1256 | if (dhd_bus == NULL) { | |
1257 | DBUSERR(("%s: dhd_bus is NULL\n", __FUNCTION__)); | |
1258 | return; | |
1259 | } | |
1260 | ||
1261 | if (dhd_bus->pub.busstate != DBUS_STATE_DOWN) { | |
1262 | if (dhd_bus->cbs && dhd_bus->cbs->ctl_complete) | |
1263 | dhd_bus->cbs->ctl_complete(dhd_bus->cbarg, type, status); | |
1264 | } | |
1265 | } | |
1266 | ||
1267 | /** | |
1268 | * Rx related functionality (flow control, posting of free IRBs to rx queue) is dependent upon the | |
1269 | * bus state. When lower DBUS level signals a change in the interface state, take appropriate action | |
1270 | * and forward the signaling to the higher (e.g. dhd_linux.c) level. | |
1271 | */ | |
1272 | static void | |
1273 | dbus_if_state_change(void *handle, int state) | |
1274 | { | |
1275 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1276 | int old_state; | |
1277 | ||
1278 | if (dhd_bus == NULL) | |
1279 | return; | |
1280 | ||
1281 | if (dhd_bus->pub.busstate == state) | |
1282 | return; | |
1283 | old_state = dhd_bus->pub.busstate; | |
1284 | if (state == DBUS_STATE_DISCONNECT) { | |
1285 | DBUSERR(("DBUS disconnected\n")); | |
1286 | } | |
1287 | ||
1288 | /* Ignore USB SUSPEND while not up yet */ | |
1289 | if (state == DBUS_STATE_SLEEP && old_state != DBUS_STATE_UP) | |
1290 | return; | |
1291 | ||
1292 | DBUSTRACE(("dbus state change from %d to to %d\n", old_state, state)); | |
1293 | ||
1294 | /* Don't update state if it's PnP firmware re-download */ | |
1295 | if (state != DBUS_STATE_PNP_FWDL) | |
1296 | dhd_bus->pub.busstate = state; | |
1297 | else | |
1298 | dbus_flowctrl_rx(handle, FALSE); | |
1299 | if (state == DBUS_STATE_SLEEP) | |
1300 | dbus_flowctrl_rx(handle, TRUE); | |
1301 | if (state == DBUS_STATE_UP) { | |
1302 | dbus_rxirbs_fill(dhd_bus); | |
1303 | dbus_flowctrl_rx(handle, FALSE); | |
1304 | } | |
1305 | ||
1306 | if (dhd_bus->cbs && dhd_bus->cbs->state_change) | |
1307 | dhd_bus->cbs->state_change(dhd_bus->cbarg, state); | |
1308 | } | |
1309 | ||
1310 | /** Forward request for packet from lower DBUS layer to higher layer (e.g. dhd_linux.c) */ | |
1311 | static void * | |
1312 | dbus_if_pktget(void *handle, uint len, bool send) | |
1313 | { | |
1314 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1315 | void *p = NULL; | |
1316 | ||
1317 | if (dhd_bus == NULL) | |
1318 | return NULL; | |
1319 | ||
1320 | if (dhd_bus->cbs && dhd_bus->cbs->pktget) | |
1321 | p = dhd_bus->cbs->pktget(dhd_bus->cbarg, len, send); | |
1322 | else | |
1323 | ASSERT(0); | |
1324 | ||
1325 | return p; | |
1326 | } | |
1327 | ||
1328 | /** Forward request to free packet from lower DBUS layer to higher layer (e.g. dhd_linux.c) */ | |
1329 | static void | |
1330 | dbus_if_pktfree(void *handle, void *p, bool send) | |
1331 | { | |
1332 | dhd_bus_t *dhd_bus = (dhd_bus_t *) handle; | |
1333 | ||
1334 | if (dhd_bus == NULL) | |
1335 | return; | |
1336 | ||
1337 | if (dhd_bus->cbs && dhd_bus->cbs->pktfree) | |
1338 | dhd_bus->cbs->pktfree(dhd_bus->cbarg, p, send); | |
1339 | else | |
1340 | ASSERT(0); | |
1341 | } | |
1342 | ||
1343 | /** Lower DBUS level requests either a send or receive IRB */ | |
1344 | static struct dbus_irb* | |
1345 | dbus_if_getirb(void *cbarg, bool send) | |
1346 | { | |
1347 | dhd_bus_t *dhd_bus = (dhd_bus_t *) cbarg; | |
1348 | struct exec_parms args; | |
1349 | struct dbus_irb *irb; | |
1350 | ||
1351 | if ((dhd_bus == NULL) || (dhd_bus->pub.busstate != DBUS_STATE_UP)) | |
1352 | return NULL; | |
1353 | ||
1354 | if (send == TRUE) { | |
1355 | args.qdeq.q = dhd_bus->tx_q; | |
1356 | irb = EXEC_TXLOCK(dhd_bus, q_deq_exec, &args); | |
1357 | } else { | |
1358 | args.qdeq.q = dhd_bus->rx_q; | |
1359 | irb = EXEC_RXLOCK(dhd_bus, q_deq_exec, &args); | |
1360 | } | |
1361 | ||
1362 | return irb; | |
1363 | } | |
1364 | ||
1365 | /** | |
1366 | * Called as part of DBUS bus registration. Calls back into higher level (e.g. dhd_linux.c) probe | |
1367 | * function. | |
1368 | */ | |
1369 | static void * | |
1370 | dbus_probe(void *arg, const char *desc, uint32 bustype, uint16 bus_no, | |
1371 | uint16 slot, uint32 hdrlen) | |
1372 | { | |
1373 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1374 | if (probe_cb) { | |
1375 | disc_arg = probe_cb(probe_arg, desc, bustype, bus_no, slot, hdrlen); | |
1376 | return disc_arg; | |
1377 | } | |
1378 | ||
1379 | return (void *)DBUS_ERR; | |
1380 | } | |
1381 | ||
1382 | /** | |
1383 | * As part of initialization, higher level (e.g. dhd_linux.c) requests DBUS to prepare for | |
1384 | * action. | |
1385 | */ | |
1386 | int | |
1387 | dhd_bus_register(void) | |
1388 | { | |
1389 | int err; | |
1390 | ||
1391 | DBUSTRACE(("%s: Enter\n", __FUNCTION__)); | |
1392 | ||
1393 | probe_cb = dhd_dbus_probe_cb; | |
1394 | disconnect_cb = dhd_dbus_disconnect_cb; | |
1395 | probe_arg = NULL; | |
1396 | ||
1397 | err = dbus_bus_register(0xa5c, 0x48f, dbus_probe, /* call lower DBUS level register function */ | |
1398 | dbus_disconnect, NULL, &g_busintf, NULL, NULL); | |
1399 | ||
1400 | /* Device not detected */ | |
1401 | if (err == DBUS_ERR_NODEVICE) | |
1402 | err = DBUS_OK; | |
1403 | ||
1404 | return err; | |
1405 | } | |
1406 | ||
1407 | dhd_pub_t *g_pub = NULL; | |
1408 | void | |
1409 | dhd_bus_unregister(void) | |
1410 | { | |
1411 | int ret; | |
1412 | ||
1413 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1414 | ||
1415 | DHD_MUTEX_LOCK(); | |
1416 | if (g_pub) { | |
1417 | g_pub->dhd_remove = TRUE; | |
1418 | if (!g_pub->bus) { | |
1419 | dhd_dbus_disconnect_cb(g_pub->bus); | |
1420 | } | |
1421 | } | |
1422 | probe_cb = NULL; | |
1423 | DHD_MUTEX_UNLOCK(); | |
1424 | ret = dbus_bus_deregister(); | |
1425 | disconnect_cb = NULL; | |
1426 | probe_arg = NULL; | |
1427 | } | |
1428 | ||
1429 | /** As part of initialization, data structures have to be allocated and initialized */ | |
1430 | dhd_bus_t * | |
1431 | dbus_attach(osl_t *osh, int rxsize, int nrxq, int ntxq, dhd_pub_t *pub, | |
1432 | dbus_callbacks_t *cbs, dbus_extdl_t *extdl, struct shared_info *sh) | |
1433 | { | |
1434 | dhd_bus_t *dhd_bus; | |
1435 | int err; | |
1436 | ||
1437 | if ((g_busintf == NULL) || (g_busintf->attach == NULL) || (cbs == NULL)) | |
1438 | return NULL; | |
1439 | ||
1440 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1441 | ||
1442 | if ((nrxq <= 0) || (ntxq <= 0)) | |
1443 | return NULL; | |
1444 | ||
1445 | dhd_bus = MALLOC(osh, sizeof(dhd_bus_t)); | |
1446 | if (dhd_bus == NULL) { | |
1447 | DBUSERR(("%s: malloc failed %zu\n", __FUNCTION__, sizeof(dhd_bus_t))); | |
1448 | return NULL; | |
1449 | } | |
1450 | ||
1451 | bzero(dhd_bus, sizeof(dhd_bus_t)); | |
1452 | ||
1453 | /* BUS-specific driver interface (at a lower DBUS level) */ | |
1454 | dhd_bus->drvintf = g_busintf; | |
1455 | dhd_bus->cbarg = pub; | |
1456 | dhd_bus->cbs = cbs; | |
1457 | ||
1458 | dhd_bus->pub.sh = sh; | |
1459 | dhd_bus->pub.osh = osh; | |
1460 | dhd_bus->pub.rxsize = rxsize; | |
1461 | ||
1462 | dhd_bus->pub.nrxq = nrxq; | |
1463 | dhd_bus->rx_low_watermark = nrxq / 2; /* keep enough posted rx urbs */ | |
1464 | dhd_bus->pub.ntxq = ntxq; | |
1465 | dhd_bus->tx_low_watermark = ntxq / 4; /* flow control when too many tx urbs posted */ | |
1466 | ||
1467 | dhd_bus->tx_q = MALLOC(osh, sizeof(dbus_irbq_t)); | |
1468 | if (dhd_bus->tx_q == NULL) | |
1469 | goto error; | |
1470 | else { | |
1471 | bzero(dhd_bus->tx_q, sizeof(dbus_irbq_t)); | |
1472 | err = dbus_irbq_init(dhd_bus, dhd_bus->tx_q, ntxq, sizeof(dbus_irb_tx_t)); | |
1473 | if (err != DBUS_OK) | |
1474 | goto error; | |
1475 | } | |
1476 | ||
1477 | dhd_bus->rx_q = MALLOC(osh, sizeof(dbus_irbq_t)); | |
1478 | if (dhd_bus->rx_q == NULL) | |
1479 | goto error; | |
1480 | else { | |
1481 | bzero(dhd_bus->rx_q, sizeof(dbus_irbq_t)); | |
1482 | err = dbus_irbq_init(dhd_bus, dhd_bus->rx_q, nrxq, sizeof(dbus_irb_rx_t)); | |
1483 | if (err != DBUS_OK) | |
1484 | goto error; | |
1485 | } | |
1486 | ||
1487 | ||
1488 | dhd_bus->bus_info = (void *)g_busintf->attach(&dhd_bus->pub, | |
1489 | dhd_bus, &dbus_intf_cbs); | |
1490 | if (dhd_bus->bus_info == NULL) | |
1491 | goto error; | |
1492 | ||
1493 | dbus_tx_timer_init(dhd_bus); | |
1494 | ||
1495 | #if defined(BCM_REQUEST_FW) | |
1496 | /* Need to copy external image for re-download */ | |
1497 | if (extdl && extdl->fw && (extdl->fwlen > 0)) { | |
1498 | dhd_bus->extdl.fw = MALLOC(osh, extdl->fwlen); | |
1499 | if (dhd_bus->extdl.fw) { | |
1500 | bcopy(extdl->fw, dhd_bus->extdl.fw, extdl->fwlen); | |
1501 | dhd_bus->extdl.fwlen = extdl->fwlen; | |
1502 | } | |
1503 | } | |
1504 | ||
1505 | if (extdl && extdl->vars && (extdl->varslen > 0)) { | |
1506 | dhd_bus->extdl.vars = MALLOC(osh, extdl->varslen); | |
1507 | if (dhd_bus->extdl.vars) { | |
1508 | bcopy(extdl->vars, dhd_bus->extdl.vars, extdl->varslen); | |
1509 | dhd_bus->extdl.varslen = extdl->varslen; | |
1510 | } | |
1511 | } | |
1512 | #endif | |
1513 | ||
1514 | return (dhd_bus_t *)dhd_bus; | |
1515 | ||
1516 | error: | |
1517 | DBUSERR(("%s: Failed\n", __FUNCTION__)); | |
1518 | dbus_detach(dhd_bus); | |
1519 | return NULL; | |
1520 | } /* dbus_attach */ | |
1521 | ||
1522 | void | |
1523 | dbus_detach(dhd_bus_t *pub) | |
1524 | { | |
1525 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1526 | osl_t *osh; | |
1527 | ||
1528 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1529 | ||
1530 | if (dhd_bus == NULL) | |
1531 | return; | |
1532 | ||
1533 | dbus_tx_timer_stop(dhd_bus); | |
1534 | ||
1535 | osh = pub->pub.osh; | |
1536 | ||
1537 | if (dhd_bus->drvintf && dhd_bus->drvintf->detach) | |
1538 | dhd_bus->drvintf->detach((dbus_pub_t *)dhd_bus, dhd_bus->bus_info); | |
1539 | ||
1540 | if (dhd_bus->tx_q) { | |
1541 | dbus_irbq_deinit(dhd_bus, dhd_bus->tx_q, sizeof(dbus_irb_tx_t)); | |
1542 | MFREE(osh, dhd_bus->tx_q, sizeof(dbus_irbq_t)); | |
1543 | dhd_bus->tx_q = NULL; | |
1544 | } | |
1545 | ||
1546 | if (dhd_bus->rx_q) { | |
1547 | dbus_irbq_deinit(dhd_bus, dhd_bus->rx_q, sizeof(dbus_irb_rx_t)); | |
1548 | MFREE(osh, dhd_bus->rx_q, sizeof(dbus_irbq_t)); | |
1549 | dhd_bus->rx_q = NULL; | |
1550 | } | |
1551 | ||
1552 | ||
1553 | if (dhd_bus->extdl.fw && (dhd_bus->extdl.fwlen > 0)) { | |
1554 | MFREE(osh, dhd_bus->extdl.fw, dhd_bus->extdl.fwlen); | |
1555 | dhd_bus->extdl.fw = NULL; | |
1556 | dhd_bus->extdl.fwlen = 0; | |
1557 | } | |
1558 | ||
1559 | if (dhd_bus->extdl.vars && (dhd_bus->extdl.varslen > 0)) { | |
1560 | MFREE(osh, dhd_bus->extdl.vars, dhd_bus->extdl.varslen); | |
1561 | dhd_bus->extdl.vars = NULL; | |
1562 | dhd_bus->extdl.varslen = 0; | |
1563 | } | |
1564 | ||
1565 | MFREE(osh, dhd_bus, sizeof(dhd_bus_t)); | |
1566 | } /* dbus_detach */ | |
1567 | ||
1568 | int dbus_dlneeded(dhd_bus_t *pub) | |
1569 | { | |
1570 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1571 | int dlneeded = DBUS_ERR; | |
1572 | ||
1573 | if (!dhd_bus) { | |
1574 | DBUSERR(("%s: dhd_bus is NULL\n", __FUNCTION__)); | |
1575 | return DBUS_ERR; | |
1576 | } | |
1577 | ||
1578 | DBUSTRACE(("%s: state %d\n", __FUNCTION__, dhd_bus->pub.busstate)); | |
1579 | ||
1580 | if (dhd_bus->drvintf->dlneeded) { | |
1581 | dlneeded = dhd_bus->drvintf->dlneeded(dhd_bus->bus_info); | |
1582 | } | |
1583 | printf("%s: dlneeded=%d\n", __FUNCTION__, dlneeded); | |
1584 | ||
1585 | /* dlneeded > 0: need to download | |
1586 | * dlneeded = 0: downloaded | |
1587 | * dlneeded < 0: bus error*/ | |
1588 | return dlneeded; | |
1589 | } | |
1590 | ||
1591 | #if defined(BCM_REQUEST_FW) | |
1592 | int dbus_download_firmware(dhd_bus_t *pub, char *pfw_path, char *pnv_path) | |
1593 | { | |
1594 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1595 | int err = DBUS_OK; | |
1596 | ||
1597 | if (!dhd_bus) { | |
1598 | DBUSERR(("%s: dhd_bus is NULL\n", __FUNCTION__)); | |
1599 | return DBUS_ERR; | |
1600 | } | |
1601 | ||
1602 | DBUSTRACE(("%s: state %d\n", __FUNCTION__, dhd_bus->pub.busstate)); | |
1603 | ||
1604 | dhd_bus->pub.busstate = DBUS_STATE_DL_PENDING; | |
1605 | #ifdef EXTERNAL_FW_PATH | |
1606 | err = dbus_do_download(dhd_bus, pfw_path, pnv_path); | |
1607 | #else | |
1608 | err = dbus_do_download(dhd_bus); | |
1609 | #endif /* EXTERNAL_FW_PATH */ | |
1610 | if (err == DBUS_OK) { | |
1611 | dhd_bus->pub.busstate = DBUS_STATE_DL_DONE; | |
1612 | } else { | |
1613 | DBUSERR(("%s: download failed (%d)\n", __FUNCTION__, err)); | |
1614 | } | |
1615 | ||
1616 | return err; | |
1617 | } | |
1618 | #endif | |
1619 | ||
1620 | /** | |
1621 | * higher layer requests us to 'up' the interface to the dongle. Prerequisite is that firmware (not | |
1622 | * bootloader) must be active in the dongle. | |
1623 | */ | |
1624 | int | |
1625 | dbus_up(struct dhd_bus *pub) | |
1626 | { | |
1627 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1628 | int err = DBUS_OK; | |
1629 | ||
1630 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1631 | ||
1632 | if (dhd_bus == NULL) { | |
1633 | DBUSERR(("%s: dhd_bus is NULL\n", __FUNCTION__)); | |
1634 | return DBUS_ERR; | |
1635 | } | |
1636 | ||
1637 | if ((dhd_bus->pub.busstate == DBUS_STATE_DL_DONE) || | |
1638 | (dhd_bus->pub.busstate == DBUS_STATE_DOWN) || | |
1639 | (dhd_bus->pub.busstate == DBUS_STATE_SLEEP)) { | |
1640 | if (dhd_bus->drvintf && dhd_bus->drvintf->up) { | |
1641 | err = dhd_bus->drvintf->up(dhd_bus->bus_info); | |
1642 | ||
1643 | if (err == DBUS_OK) { | |
1644 | dbus_rxirbs_fill(dhd_bus); | |
1645 | } | |
1646 | } | |
1647 | } else | |
1648 | err = DBUS_ERR; | |
1649 | ||
1650 | return err; | |
1651 | } | |
1652 | ||
1653 | /** higher layer requests us to 'down' the interface to the dongle. */ | |
1654 | int | |
1655 | dbus_down(dbus_pub_t *pub) | |
1656 | { | |
1657 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1658 | ||
1659 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1660 | ||
1661 | if (dhd_bus == NULL) | |
1662 | return DBUS_ERR; | |
1663 | ||
1664 | dbus_tx_timer_stop(dhd_bus); | |
1665 | ||
1666 | if (dhd_bus->pub.busstate == DBUS_STATE_UP || | |
1667 | dhd_bus->pub.busstate == DBUS_STATE_SLEEP) { | |
1668 | if (dhd_bus->drvintf && dhd_bus->drvintf->down) | |
1669 | return dhd_bus->drvintf->down(dhd_bus->bus_info); | |
1670 | } | |
1671 | ||
1672 | return DBUS_ERR; | |
1673 | } | |
1674 | ||
1675 | int | |
1676 | dbus_shutdown(dbus_pub_t *pub) | |
1677 | { | |
1678 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1679 | ||
1680 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1681 | ||
1682 | if (dhd_bus == NULL) | |
1683 | return DBUS_ERR; | |
1684 | ||
1685 | if (dhd_bus->drvintf && dhd_bus->drvintf->shutdown) | |
1686 | return dhd_bus->drvintf->shutdown(dhd_bus->bus_info); | |
1687 | ||
1688 | return DBUS_OK; | |
1689 | } | |
1690 | ||
1691 | int | |
1692 | dbus_stop(struct dhd_bus *pub) | |
1693 | { | |
1694 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1695 | ||
1696 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1697 | ||
1698 | if (dhd_bus == NULL) | |
1699 | return DBUS_ERR; | |
1700 | ||
1701 | if (dhd_bus->pub.busstate == DBUS_STATE_UP || | |
1702 | dhd_bus->pub.busstate == DBUS_STATE_SLEEP) { | |
1703 | if (dhd_bus->drvintf && dhd_bus->drvintf->stop) | |
1704 | return dhd_bus->drvintf->stop(dhd_bus->bus_info); | |
1705 | } | |
1706 | ||
1707 | return DBUS_ERR; | |
1708 | } | |
1709 | ||
1710 | int dbus_send_txdata(dbus_pub_t *dbus, void *pktbuf) | |
1711 | { | |
1712 | return dbus_send_pkt(dbus, pktbuf, pktbuf /* pktinfo */); | |
1713 | } | |
1714 | ||
1715 | int | |
1716 | dbus_send_buf(dbus_pub_t *pub, uint8 *buf, int len, void *info) | |
1717 | { | |
1718 | return dbus_send_irb(pub, buf, len, NULL, info); | |
1719 | } | |
1720 | ||
1721 | int | |
1722 | dbus_send_pkt(dbus_pub_t *pub, void *pkt, void *info) | |
1723 | { | |
1724 | return dbus_send_irb(pub, NULL, 0, pkt, info); | |
1725 | } | |
1726 | ||
1727 | int | |
1728 | dbus_send_ctl(struct dhd_bus *pub, uint8 *buf, int len) | |
1729 | { | |
1730 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1731 | ||
1732 | if (dhd_bus == NULL) { | |
1733 | DBUSERR(("%s: dhd_bus is NULL\n", __FUNCTION__)); | |
1734 | return DBUS_ERR; | |
1735 | } | |
1736 | ||
1737 | if (dhd_bus->pub.busstate == DBUS_STATE_UP || | |
1738 | dhd_bus->pub.busstate == DBUS_STATE_SLEEP) { | |
1739 | if (dhd_bus->drvintf && dhd_bus->drvintf->send_ctl) | |
1740 | return dhd_bus->drvintf->send_ctl(dhd_bus->bus_info, buf, len); | |
1741 | } else { | |
1742 | DBUSERR(("%s: bustate=%d\n", __FUNCTION__, dhd_bus->pub.busstate)); | |
1743 | } | |
1744 | ||
1745 | return DBUS_ERR; | |
1746 | } | |
1747 | ||
1748 | int | |
1749 | dbus_recv_ctl(struct dhd_bus *pub, uint8 *buf, int len) | |
1750 | { | |
1751 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1752 | ||
1753 | if ((dhd_bus == NULL) || (buf == NULL)) | |
1754 | return DBUS_ERR; | |
1755 | ||
1756 | if (dhd_bus->pub.busstate == DBUS_STATE_UP || | |
1757 | dhd_bus->pub.busstate == DBUS_STATE_SLEEP) { | |
1758 | if (dhd_bus->drvintf && dhd_bus->drvintf->recv_ctl) | |
1759 | return dhd_bus->drvintf->recv_ctl(dhd_bus->bus_info, buf, len); | |
1760 | } | |
1761 | ||
1762 | return DBUS_ERR; | |
1763 | } | |
1764 | ||
1765 | /** Only called via RPC (Dec 2012) */ | |
1766 | int | |
1767 | dbus_recv_bulk(dbus_pub_t *pub, uint32 ep_idx) | |
1768 | { | |
1769 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1770 | ||
1771 | dbus_irb_rx_t *rxirb; | |
1772 | struct exec_parms args; | |
1773 | int status; | |
1774 | ||
1775 | ||
1776 | if (dhd_bus == NULL) | |
1777 | return DBUS_ERR; | |
1778 | ||
1779 | args.qdeq.q = dhd_bus->rx_q; | |
1780 | if (dhd_bus->pub.busstate == DBUS_STATE_UP) { | |
1781 | if (dhd_bus->drvintf && dhd_bus->drvintf->recv_irb_from_ep) { | |
1782 | if ((rxirb = (EXEC_RXLOCK(dhd_bus, q_deq_exec, &args))) != NULL) { | |
1783 | status = dhd_bus->drvintf->recv_irb_from_ep(dhd_bus->bus_info, | |
1784 | rxirb, ep_idx); | |
1785 | if (status == DBUS_ERR_RXDROP) { | |
1786 | bzero(rxirb, sizeof(dbus_irb_rx_t)); | |
1787 | args.qenq.q = dhd_bus->rx_q; | |
1788 | args.qenq.b = (dbus_irb_t *) rxirb; | |
1789 | EXEC_RXLOCK(dhd_bus, q_enq_exec, &args); | |
1790 | } | |
1791 | } | |
1792 | } | |
1793 | } | |
1794 | ||
1795 | return DBUS_ERR; | |
1796 | } | |
1797 | ||
1798 | /** only called by dhd_cdc.c (Dec 2012) */ | |
1799 | int | |
1800 | dbus_poll_intr(dbus_pub_t *pub) | |
1801 | { | |
1802 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1803 | ||
1804 | int status = DBUS_ERR; | |
1805 | ||
1806 | if (dhd_bus == NULL) | |
1807 | return DBUS_ERR; | |
1808 | ||
1809 | if (dhd_bus->pub.busstate == DBUS_STATE_UP) { | |
1810 | if (dhd_bus->drvintf && dhd_bus->drvintf->recv_irb_from_ep) { | |
1811 | status = dhd_bus->drvintf->recv_irb_from_ep(dhd_bus->bus_info, | |
1812 | NULL, 0xff); | |
1813 | } | |
1814 | } | |
1815 | return status; | |
1816 | } | |
1817 | ||
1818 | /** called by nobody (Dec 2012) */ | |
1819 | void * | |
1820 | dbus_pktget(dbus_pub_t *pub, int len) | |
1821 | { | |
1822 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1823 | ||
1824 | if ((dhd_bus == NULL) || (len < 0)) | |
1825 | return NULL; | |
1826 | ||
1827 | return PKTGET(dhd_bus->pub.osh, len, TRUE); | |
1828 | } | |
1829 | ||
1830 | /** called by nobody (Dec 2012) */ | |
1831 | void | |
1832 | dbus_pktfree(dbus_pub_t *pub, void* pkt) | |
1833 | { | |
1834 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1835 | ||
1836 | if ((dhd_bus == NULL) || (pkt == NULL)) | |
1837 | return; | |
1838 | ||
1839 | PKTFREE(dhd_bus->pub.osh, pkt, TRUE); | |
1840 | } | |
1841 | ||
1842 | /** called by nobody (Dec 2012) */ | |
1843 | int | |
1844 | dbus_get_stats(dbus_pub_t *pub, dbus_stats_t *stats) | |
1845 | { | |
1846 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1847 | ||
1848 | if ((dhd_bus == NULL) || (stats == NULL)) | |
1849 | return DBUS_ERR; | |
1850 | ||
1851 | bcopy(&dhd_bus->pub.stats, stats, sizeof(dbus_stats_t)); | |
1852 | ||
1853 | return DBUS_OK; | |
1854 | } | |
1855 | ||
1856 | int | |
1857 | dbus_get_attrib(dhd_bus_t *pub, dbus_attrib_t *attrib) | |
1858 | { | |
1859 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1860 | int err = DBUS_ERR; | |
1861 | ||
1862 | if ((dhd_bus == NULL) || (attrib == NULL)) | |
1863 | return DBUS_ERR; | |
1864 | ||
1865 | if (dhd_bus->drvintf && dhd_bus->drvintf->get_attrib) { | |
1866 | err = dhd_bus->drvintf->get_attrib(dhd_bus->bus_info, | |
1867 | &dhd_bus->pub.attrib); | |
1868 | } | |
1869 | ||
1870 | bcopy(&dhd_bus->pub.attrib, attrib, sizeof(dbus_attrib_t)); | |
1871 | return err; | |
1872 | } | |
1873 | ||
1874 | int | |
1875 | dbus_get_device_speed(dbus_pub_t *pub) | |
1876 | { | |
1877 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1878 | ||
1879 | if (dhd_bus == NULL) | |
1880 | return INVALID_SPEED; | |
1881 | ||
1882 | return (dhd_bus->pub.device_speed); | |
1883 | } | |
1884 | ||
1885 | int | |
1886 | dbus_set_config(dbus_pub_t *pub, dbus_config_t *config) | |
1887 | { | |
1888 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1889 | int err = DBUS_ERR; | |
1890 | ||
1891 | if ((dhd_bus == NULL) || (config == NULL)) | |
1892 | return DBUS_ERR; | |
1893 | ||
1894 | if (dhd_bus->drvintf && dhd_bus->drvintf->set_config) { | |
1895 | err = dhd_bus->drvintf->set_config(dhd_bus->bus_info, | |
1896 | config); | |
1897 | ||
1898 | if ((config->config_id == DBUS_CONFIG_ID_AGGR_LIMIT) && | |
1899 | (!err) && | |
1900 | (dhd_bus->pub.busstate == DBUS_STATE_UP)) { | |
1901 | dbus_rxirbs_fill(dhd_bus); | |
1902 | } | |
1903 | } | |
1904 | ||
1905 | return err; | |
1906 | } | |
1907 | ||
1908 | int | |
1909 | dbus_get_config(dbus_pub_t *pub, dbus_config_t *config) | |
1910 | { | |
1911 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1912 | int err = DBUS_ERR; | |
1913 | ||
1914 | if ((dhd_bus == NULL) || (config == NULL)) | |
1915 | return DBUS_ERR; | |
1916 | ||
1917 | if (dhd_bus->drvintf && dhd_bus->drvintf->get_config) { | |
1918 | err = dhd_bus->drvintf->get_config(dhd_bus->bus_info, | |
1919 | config); | |
1920 | } | |
1921 | ||
1922 | return err; | |
1923 | } | |
1924 | ||
1925 | int | |
1926 | dbus_set_errmask(dbus_pub_t *pub, uint32 mask) | |
1927 | { | |
1928 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1929 | int err = DBUS_OK; | |
1930 | ||
1931 | if (dhd_bus == NULL) | |
1932 | return DBUS_ERR; | |
1933 | ||
1934 | dhd_bus->errmask = mask; | |
1935 | return err; | |
1936 | } | |
1937 | ||
1938 | int | |
1939 | dbus_pnp_resume(dbus_pub_t *pub, int *fw_reload) | |
1940 | { | |
1941 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1942 | int err = DBUS_ERR; | |
1943 | bool fwdl = FALSE; | |
1944 | ||
1945 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1946 | ||
1947 | if (dhd_bus == NULL) | |
1948 | return DBUS_ERR; | |
1949 | ||
1950 | if (dhd_bus->pub.busstate == DBUS_STATE_UP) { | |
1951 | return DBUS_OK; | |
1952 | } | |
1953 | ||
1954 | ||
1955 | ||
1956 | if (dhd_bus->drvintf->pnp) { | |
1957 | err = dhd_bus->drvintf->pnp(dhd_bus->bus_info, | |
1958 | DBUS_PNP_RESUME); | |
1959 | } | |
1960 | ||
1961 | if (dhd_bus->drvintf->recv_needed) { | |
1962 | if (dhd_bus->drvintf->recv_needed(dhd_bus->bus_info)) { | |
1963 | /* Refill after sleep/hibernate */ | |
1964 | dbus_rxirbs_fill(dhd_bus); | |
1965 | } | |
1966 | } | |
1967 | ||
1968 | ||
1969 | if (fw_reload) | |
1970 | *fw_reload = fwdl; | |
1971 | ||
1972 | return err; | |
1973 | } /* dbus_pnp_resume */ | |
1974 | ||
1975 | int | |
1976 | dbus_pnp_sleep(dbus_pub_t *pub) | |
1977 | { | |
1978 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
1979 | int err = DBUS_ERR; | |
1980 | ||
1981 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
1982 | ||
1983 | if (dhd_bus == NULL) | |
1984 | return DBUS_ERR; | |
1985 | ||
1986 | dbus_tx_timer_stop(dhd_bus); | |
1987 | ||
1988 | if (dhd_bus->drvintf && dhd_bus->drvintf->pnp) { | |
1989 | err = dhd_bus->drvintf->pnp(dhd_bus->bus_info, | |
1990 | DBUS_PNP_SLEEP); | |
1991 | } | |
1992 | ||
1993 | return err; | |
1994 | } | |
1995 | ||
1996 | int | |
1997 | dbus_pnp_disconnect(dbus_pub_t *pub) | |
1998 | { | |
1999 | dhd_bus_t *dhd_bus = (dhd_bus_t *) pub; | |
2000 | int err = DBUS_ERR; | |
2001 | ||
2002 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
2003 | ||
2004 | if (dhd_bus == NULL) | |
2005 | return DBUS_ERR; | |
2006 | ||
2007 | dbus_tx_timer_stop(dhd_bus); | |
2008 | ||
2009 | if (dhd_bus->drvintf && dhd_bus->drvintf->pnp) { | |
2010 | err = dhd_bus->drvintf->pnp(dhd_bus->bus_info, | |
2011 | DBUS_PNP_DISCONNECT); | |
2012 | } | |
2013 | ||
2014 | return err; | |
2015 | } | |
2016 | ||
2017 | int | |
2018 | dhd_bus_iovar_op(dhd_pub_t *dhdp, const char *name, | |
2019 | void *params, int plen, void *arg, int len, bool set) | |
2020 | { | |
2021 | dhd_bus_t *dhd_bus = (dhd_bus_t *) dhdp->bus; | |
2022 | int err = DBUS_ERR; | |
2023 | ||
2024 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
2025 | ||
2026 | if (dhd_bus == NULL) | |
2027 | return DBUS_ERR; | |
2028 | ||
2029 | if (dhd_bus->drvintf && dhd_bus->drvintf->iovar_op) { | |
2030 | err = dhd_bus->drvintf->iovar_op(dhd_bus->bus_info, | |
2031 | name, params, plen, arg, len, set); | |
2032 | } | |
2033 | ||
2034 | return err; | |
2035 | } | |
2036 | ||
2037 | ||
2038 | void * | |
2039 | dhd_dbus_txq(const dbus_pub_t *pub) | |
2040 | { | |
2041 | return NULL; | |
2042 | } | |
2043 | ||
2044 | uint | |
2045 | dhd_dbus_hdrlen(const dbus_pub_t *pub) | |
2046 | { | |
2047 | return 0; | |
2048 | } | |
2049 | ||
2050 | void * | |
2051 | dbus_get_devinfo(dbus_pub_t *pub) | |
2052 | { | |
2053 | return pub->dev_info; | |
2054 | } | |
2055 | ||
2056 | #if defined(BCM_REQUEST_FW) && !defined(EXTERNAL_FW_PATH) | |
2057 | static int | |
2058 | dbus_otp(dhd_bus_t *dhd_bus, uint16 *boardtype, uint16 *boardrev) | |
2059 | { | |
2060 | uint32 value = 0; | |
2061 | uint8 *cis; | |
2062 | uint16 *otpinfo; | |
2063 | uint32 i; | |
2064 | bool standard_cis = TRUE; | |
2065 | uint8 tup, tlen; | |
2066 | bool btype_present = FALSE; | |
2067 | bool brev_present = FALSE; | |
2068 | int ret; | |
2069 | int devid; | |
2070 | uint16 btype = 0; | |
2071 | uint16 brev = 0; | |
2072 | uint32 otp_size = 0, otp_addr = 0, otp_sw_rgn = 0; | |
2073 | ||
2074 | if (dhd_bus == NULL || dhd_bus->drvintf == NULL || | |
2075 | dhd_bus->drvintf->readreg == NULL) | |
2076 | return DBUS_ERR; | |
2077 | ||
2078 | devid = dhd_bus->pub.attrib.devid; | |
2079 | ||
2080 | if ((devid == BCM43234_CHIP_ID) || (devid == BCM43235_CHIP_ID) || | |
2081 | (devid == BCM43236_CHIP_ID)) { | |
2082 | ||
2083 | otp_size = BCM_OTP_SIZE_43236; | |
2084 | otp_sw_rgn = BCM_OTP_SW_RGN_43236; | |
2085 | otp_addr = BCM_OTP_ADDR_43236; | |
2086 | ||
2087 | } else { | |
2088 | return DBUS_ERR_NVRAM; | |
2089 | } | |
2090 | ||
2091 | cis = MALLOC(dhd_bus->pub.osh, otp_size * 2); | |
2092 | if (cis == NULL) | |
2093 | return DBUS_ERR; | |
2094 | ||
2095 | otpinfo = (uint16 *) cis; | |
2096 | ||
2097 | for (i = 0; i < otp_size; i++) { | |
2098 | ||
2099 | ret = dhd_bus->drvintf->readreg(dhd_bus->bus_info, | |
2100 | otp_addr + ((otp_sw_rgn + i) << 1), 2, &value); | |
2101 | ||
2102 | if (ret != DBUS_OK) { | |
2103 | MFREE(dhd_bus->pub.osh, cis, otp_size * 2); | |
2104 | return ret; | |
2105 | } | |
2106 | otpinfo[i] = (uint16) value; | |
2107 | } | |
2108 | ||
2109 | for (i = 0; i < (otp_size << 1); ) { | |
2110 | ||
2111 | if (standard_cis) { | |
2112 | tup = cis[i++]; | |
2113 | if (tup == CISTPL_NULL || tup == CISTPL_END) | |
2114 | tlen = 0; | |
2115 | else | |
2116 | tlen = cis[i++]; | |
2117 | } else { | |
2118 | if (cis[i] == CISTPL_NULL || cis[i] == CISTPL_END) { | |
2119 | tlen = 0; | |
2120 | tup = cis[i]; | |
2121 | } else { | |
2122 | tlen = cis[i]; | |
2123 | tup = CISTPL_BRCM_HNBU; | |
2124 | } | |
2125 | ++i; | |
2126 | } | |
2127 | ||
2128 | if (tup == CISTPL_END || (i + tlen) >= (otp_size << 1)) { | |
2129 | break; | |
2130 | } | |
2131 | ||
2132 | switch (tup) { | |
2133 | ||
2134 | case CISTPL_BRCM_HNBU: | |
2135 | ||
2136 | switch (cis[i]) { | |
2137 | ||
2138 | case HNBU_BOARDTYPE: | |
2139 | ||
2140 | btype = (uint16) ((cis[i + 2] << 8) + cis[i + 1]); | |
2141 | btype_present = TRUE; | |
2142 | DBUSTRACE(("%s: HNBU_BOARDTYPE = 0x%2x\n", __FUNCTION__, | |
2143 | (uint32)btype)); | |
2144 | break; | |
2145 | ||
2146 | case HNBU_BOARDREV: | |
2147 | ||
2148 | if (tlen == 2) | |
2149 | brev = (uint16) cis[i + 1]; | |
2150 | else | |
2151 | brev = (uint16) ((cis[i + 2] << 8) + cis[i + 1]); | |
2152 | brev_present = TRUE; | |
2153 | DBUSTRACE(("%s: HNBU_BOARDREV = 0x%2x\n", __FUNCTION__, | |
2154 | (uint32)*boardrev)); | |
2155 | break; | |
2156 | ||
2157 | case HNBU_HNBUCIS: | |
2158 | DBUSTRACE(("%s: HNBU_HNBUCIS\n", __FUNCTION__)); | |
2159 | tlen++; | |
2160 | standard_cis = FALSE; | |
2161 | break; | |
2162 | } | |
2163 | break; | |
2164 | } | |
2165 | ||
2166 | i += tlen; | |
2167 | } | |
2168 | ||
2169 | MFREE(dhd_bus->pub.osh, cis, otp_size * 2); | |
2170 | ||
2171 | if (btype_present == TRUE && brev_present == TRUE) { | |
2172 | *boardtype = btype; | |
2173 | *boardrev = brev; | |
2174 | DBUSERR(("otp boardtype = 0x%2x boardrev = 0x%2x\n", | |
2175 | *boardtype, *boardrev)); | |
2176 | ||
2177 | return DBUS_OK; | |
2178 | } | |
2179 | else | |
2180 | return DBUS_ERR; | |
2181 | } /* dbus_otp */ | |
2182 | ||
2183 | static int | |
2184 | dbus_select_nvram(dhd_bus_t *dhd_bus, int8 *jumbonvram, int jumbolen, | |
2185 | uint16 boardtype, uint16 boardrev, int8 **nvram, int *nvram_len) | |
2186 | { | |
2187 | /* Multi board nvram file format is contenation of nvram info with \r | |
2188 | * The file format for two contatenated set is | |
2189 | * \nBroadcom Jumbo Nvram file\nfirst_set\nsecond_set\nthird_set\n | |
2190 | */ | |
2191 | uint8 *nvram_start = NULL, *nvram_end = NULL; | |
2192 | uint8 *nvram_start_prev = NULL, *nvram_end_prev = NULL; | |
2193 | uint16 btype = 0, brev = 0; | |
2194 | int len = 0; | |
2195 | char *field; | |
2196 | ||
2197 | *nvram = NULL; | |
2198 | *nvram_len = 0; | |
2199 | ||
2200 | if (strncmp(BCM_JUMBO_START, jumbonvram, strlen(BCM_JUMBO_START))) { | |
2201 | /* single nvram file in the native format */ | |
2202 | DBUSTRACE(("%s: Non-Jumbo NVRAM File \n", __FUNCTION__)); | |
2203 | *nvram = jumbonvram; | |
2204 | *nvram_len = jumbolen; | |
2205 | return DBUS_OK; | |
2206 | } else { | |
2207 | DBUSTRACE(("%s: Jumbo NVRAM File \n", __FUNCTION__)); | |
2208 | } | |
2209 | ||
2210 | /* sanity test the end of the config sets for proper ending */ | |
2211 | if (jumbonvram[jumbolen - 1] != BCM_JUMBO_NVRAM_DELIMIT || | |
2212 | jumbonvram[jumbolen - 2] != '\0') { | |
2213 | DBUSERR(("%s: Bad Jumbo NVRAM file format\n", __FUNCTION__)); | |
2214 | return DBUS_JUMBO_BAD_FORMAT; | |
2215 | } | |
2216 | ||
2217 | dhd_bus->nvram_nontxt = DBUS_NVRAM_NONTXT; | |
2218 | ||
2219 | nvram_start = jumbonvram; | |
2220 | ||
2221 | while (*nvram_start != BCM_JUMBO_NVRAM_DELIMIT && len < jumbolen) { | |
2222 | ||
2223 | /* consume the first file info line | |
2224 | * \nBroadcom Jumbo Nvram file\nfile1\n ... | |
2225 | */ | |
2226 | len ++; | |
2227 | nvram_start ++; | |
2228 | } | |
2229 | ||
2230 | nvram_end = nvram_start; | |
2231 | ||
2232 | /* search for "boardrev=0xabcd" and "boardtype=0x1234" information in | |
2233 | * the concatenated nvram config files /sets | |
2234 | */ | |
2235 | ||
2236 | while (len < jumbolen) { | |
2237 | ||
2238 | if (*nvram_end == '\0') { | |
2239 | /* end of a config set is marked by multiple null characters */ | |
2240 | len ++; | |
2241 | nvram_end ++; | |
2242 | DBUSTRACE(("%s: NULL chr len = %d char = 0x%x\n", __FUNCTION__, | |
2243 | len, *nvram_end)); | |
2244 | continue; | |
2245 | ||
2246 | } else if (*nvram_end == BCM_JUMBO_NVRAM_DELIMIT) { | |
2247 | ||
2248 | /* config set delimiter is reached */ | |
2249 | /* check if next config set is present or not | |
2250 | * return if next config is not present | |
2251 | */ | |
2252 | ||
2253 | /* start search the next config set */ | |
2254 | nvram_start_prev = nvram_start; | |
2255 | nvram_end_prev = nvram_end; | |
2256 | ||
2257 | nvram_end ++; | |
2258 | nvram_start = nvram_end; | |
2259 | btype = brev = 0; | |
2260 | DBUSTRACE(("%s: going to next record len = %d " | |
2261 | "char = 0x%x \n", __FUNCTION__, len, *nvram_end)); | |
2262 | len ++; | |
2263 | if (len >= jumbolen) { | |
2264 | ||
2265 | *nvram = nvram_start_prev; | |
2266 | *nvram_len = (int)(nvram_end_prev - nvram_start_prev); | |
2267 | ||
2268 | DBUSTRACE(("%s: no more len = %d nvram_end = 0x%p", | |
2269 | __FUNCTION__, len, nvram_end)); | |
2270 | ||
2271 | return DBUS_JUMBO_NOMATCH; | |
2272 | ||
2273 | } else { | |
2274 | continue; | |
2275 | } | |
2276 | ||
2277 | } else { | |
2278 | ||
2279 | DBUSTRACE(("%s: config str = %s\n", __FUNCTION__, nvram_end)); | |
2280 | ||
2281 | if (bcmp(nvram_end, "boardtype", strlen("boardtype")) == 0) { | |
2282 | ||
2283 | field = strchr(nvram_end, '='); | |
2284 | field++; | |
2285 | btype = (uint16)bcm_strtoul(field, NULL, 0); | |
2286 | ||
2287 | DBUSTRACE(("%s: btype = 0x%x boardtype = 0x%x \n", __FUNCTION__, | |
2288 | btype, boardtype)); | |
2289 | } | |
2290 | ||
2291 | if (bcmp(nvram_end, "boardrev", strlen("boardrev")) == 0) { | |
2292 | ||
2293 | field = strchr(nvram_end, '='); | |
2294 | field++; | |
2295 | brev = (uint16)bcm_strtoul(field, NULL, 0); | |
2296 | ||
2297 | DBUSTRACE(("%s: brev = 0x%x boardrev = 0x%x \n", __FUNCTION__, | |
2298 | brev, boardrev)); | |
2299 | } | |
2300 | if (btype == boardtype && brev == boardrev) { | |
2301 | /* locate nvram config set end - ie.find '\r' char */ | |
2302 | while (*nvram_end != BCM_JUMBO_NVRAM_DELIMIT) | |
2303 | nvram_end ++; | |
2304 | *nvram = nvram_start; | |
2305 | *nvram_len = (int) (nvram_end - nvram_start); | |
2306 | DBUSTRACE(("found len = %d nvram_start = 0x%p " | |
2307 | "nvram_end = 0x%p\n", *nvram_len, nvram_start, nvram_end)); | |
2308 | return DBUS_OK; | |
2309 | } | |
2310 | ||
2311 | len += (strlen(nvram_end) + 1); | |
2312 | nvram_end += (strlen(nvram_end) + 1); | |
2313 | } | |
2314 | } | |
2315 | return DBUS_JUMBO_NOMATCH; | |
2316 | } /* dbus_select_nvram */ | |
2317 | ||
2318 | #endif | |
2319 | ||
2320 | #define DBUS_NRXQ 50 | |
2321 | #define DBUS_NTXQ 100 | |
2322 | ||
2323 | static void | |
2324 | dhd_dbus_send_complete(void *handle, void *info, int status) | |
2325 | { | |
2326 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2327 | void *pkt = info; | |
2328 | ||
2329 | if ((dhd == NULL) || (pkt == NULL)) { | |
2330 | DBUSERR(("dhd or pkt is NULL\n")); | |
2331 | return; | |
2332 | } | |
2333 | ||
2334 | if (status == DBUS_OK) { | |
2335 | dhd->dstats.tx_packets++; | |
2336 | } else { | |
2337 | DBUSERR(("TX error=%d\n", status)); | |
2338 | dhd->dstats.tx_errors++; | |
2339 | } | |
2340 | #ifdef PROP_TXSTATUS | |
2341 | if (DHD_PKTTAG_WLFCPKT(PKTTAG(pkt)) && | |
2342 | (dhd_wlfc_txcomplete(dhd, pkt, status == 0) != WLFC_UNSUPPORTED)) { | |
2343 | return; | |
2344 | } | |
2345 | #endif /* PROP_TXSTATUS */ | |
2346 | PKTFREE(dhd->osh, pkt, TRUE); | |
2347 | } | |
2348 | ||
2349 | static void | |
2350 | dhd_dbus_recv_pkt(void *handle, void *pkt) | |
2351 | { | |
2352 | uchar reorder_info_buf[WLHOST_REORDERDATA_TOTLEN]; | |
2353 | uint reorder_info_len; | |
2354 | uint pkt_count; | |
2355 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2356 | int ifidx = 0; | |
2357 | ||
2358 | if (dhd == NULL) { | |
2359 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2360 | return; | |
2361 | } | |
2362 | ||
2363 | /* If the protocol uses a data header, check and remove it */ | |
2364 | if (dhd_prot_hdrpull(dhd, &ifidx, pkt, reorder_info_buf, | |
2365 | &reorder_info_len) != 0) { | |
2366 | DBUSERR(("rx protocol error\n")); | |
2367 | PKTFREE(dhd->osh, pkt, FALSE); | |
2368 | dhd->rx_errors++; | |
2369 | return; | |
2370 | } | |
2371 | ||
2372 | if (reorder_info_len) { | |
2373 | /* Reordering info from the firmware */ | |
2374 | dhd_process_pkt_reorder_info(dhd, reorder_info_buf, reorder_info_len, | |
2375 | &pkt, &pkt_count); | |
2376 | if (pkt_count == 0) | |
2377 | return; | |
2378 | } | |
2379 | else { | |
2380 | pkt_count = 1; | |
2381 | } | |
2382 | dhd_rx_frame(dhd, ifidx, pkt, pkt_count, 0); | |
2383 | } | |
2384 | ||
2385 | static void | |
2386 | dhd_dbus_recv_buf(void *handle, uint8 *buf, int len) | |
2387 | { | |
2388 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2389 | void *pkt; | |
2390 | ||
2391 | if (dhd == NULL) { | |
2392 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2393 | return; | |
2394 | } | |
2395 | ||
2396 | if ((pkt = PKTGET(dhd->osh, len, FALSE)) == NULL) { | |
2397 | DBUSERR(("PKTGET (rx) failed=%d\n", len)); | |
2398 | return; | |
2399 | } | |
2400 | ||
2401 | bcopy(buf, PKTDATA(dhd->osh, pkt), len); | |
2402 | dhd_dbus_recv_pkt(dhd, pkt); | |
2403 | } | |
2404 | ||
2405 | static void | |
2406 | dhd_dbus_txflowcontrol(void *handle, bool onoff) | |
2407 | { | |
2408 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2409 | bool wlfc_enabled = FALSE; | |
2410 | ||
2411 | if (dhd == NULL) { | |
2412 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2413 | return; | |
2414 | } | |
2415 | ||
2416 | #ifdef PROP_TXSTATUS | |
2417 | wlfc_enabled = (dhd_wlfc_flowcontrol(dhd, onoff, !onoff) != WLFC_UNSUPPORTED); | |
2418 | #endif | |
2419 | ||
2420 | if (!wlfc_enabled) { | |
2421 | dhd_txflowcontrol(dhd, ALL_INTERFACES, onoff); | |
2422 | } | |
2423 | } | |
2424 | ||
2425 | static void | |
2426 | dhd_dbus_errhandler(void *handle, int err) | |
2427 | { | |
2428 | } | |
2429 | ||
2430 | static void | |
2431 | dhd_dbus_ctl_complete(void *handle, int type, int status) | |
2432 | { | |
2433 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2434 | ||
2435 | if (dhd == NULL) { | |
2436 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2437 | return; | |
2438 | } | |
2439 | ||
2440 | if (type == DBUS_CBCTL_READ) { | |
2441 | if (status == DBUS_OK) | |
2442 | dhd->rx_ctlpkts++; | |
2443 | else | |
2444 | dhd->rx_ctlerrs++; | |
2445 | } else if (type == DBUS_CBCTL_WRITE) { | |
2446 | if (status == DBUS_OK) | |
2447 | dhd->tx_ctlpkts++; | |
2448 | else | |
2449 | dhd->tx_ctlerrs++; | |
2450 | } | |
2451 | ||
2452 | dhd_prot_ctl_complete(dhd); | |
2453 | } | |
2454 | ||
2455 | static void | |
2456 | dhd_dbus_state_change(void *handle, int state) | |
2457 | { | |
2458 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2459 | ||
2460 | if (dhd == NULL) { | |
2461 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2462 | return; | |
2463 | } | |
2464 | ||
2465 | switch (state) { | |
2466 | ||
2467 | case DBUS_STATE_DL_NEEDED: | |
2468 | DBUSERR(("%s: firmware request cannot be handled\n", __FUNCTION__)); | |
2469 | break; | |
2470 | case DBUS_STATE_DOWN: | |
2471 | DBUSTRACE(("%s: DBUS is down\n", __FUNCTION__)); | |
2472 | dhd->busstate = DHD_BUS_DOWN; | |
2473 | break; | |
2474 | case DBUS_STATE_UP: | |
2475 | DBUSTRACE(("%s: DBUS is up\n", __FUNCTION__)); | |
2476 | dhd->busstate = DHD_BUS_DATA; | |
2477 | break; | |
2478 | default: | |
2479 | break; | |
2480 | } | |
2481 | ||
2482 | DBUSERR(("%s: DBUS current state=%d\n", __FUNCTION__, state)); | |
2483 | } | |
2484 | ||
2485 | static void * | |
2486 | dhd_dbus_pktget(void *handle, uint len, bool send) | |
2487 | { | |
2488 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2489 | void *p = NULL; | |
2490 | ||
2491 | if (dhd == NULL) { | |
2492 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2493 | return NULL; | |
2494 | } | |
2495 | ||
2496 | if (send == TRUE) { | |
2497 | dhd_os_sdlock_txq(dhd); | |
2498 | p = PKTGET(dhd->osh, len, TRUE); | |
2499 | dhd_os_sdunlock_txq(dhd); | |
2500 | } else { | |
2501 | dhd_os_sdlock_rxq(dhd); | |
2502 | p = PKTGET(dhd->osh, len, FALSE); | |
2503 | dhd_os_sdunlock_rxq(dhd); | |
2504 | } | |
2505 | ||
2506 | return p; | |
2507 | } | |
2508 | ||
2509 | static void | |
2510 | dhd_dbus_pktfree(void *handle, void *p, bool send) | |
2511 | { | |
2512 | dhd_pub_t *dhd = (dhd_pub_t *)handle; | |
2513 | ||
2514 | if (dhd == NULL) { | |
2515 | DBUSERR(("%s: dhd is NULL\n", __FUNCTION__)); | |
2516 | return; | |
2517 | } | |
2518 | ||
2519 | if (send == TRUE) { | |
2520 | #ifdef PROP_TXSTATUS | |
2521 | if (DHD_PKTTAG_WLFCPKT(PKTTAG(p)) && | |
2522 | (dhd_wlfc_txcomplete(dhd, p, FALSE) != WLFC_UNSUPPORTED)) { | |
2523 | return; | |
2524 | } | |
2525 | #endif /* PROP_TXSTATUS */ | |
2526 | ||
2527 | dhd_os_sdlock_txq(dhd); | |
2528 | PKTFREE(dhd->osh, p, TRUE); | |
2529 | dhd_os_sdunlock_txq(dhd); | |
2530 | } else { | |
2531 | dhd_os_sdlock_rxq(dhd); | |
2532 | PKTFREE(dhd->osh, p, FALSE); | |
2533 | dhd_os_sdunlock_rxq(dhd); | |
2534 | } | |
2535 | } | |
2536 | ||
2537 | ||
2538 | static dbus_callbacks_t dhd_dbus_cbs = { | |
2539 | dhd_dbus_send_complete, | |
2540 | dhd_dbus_recv_buf, | |
2541 | dhd_dbus_recv_pkt, | |
2542 | dhd_dbus_txflowcontrol, | |
2543 | dhd_dbus_errhandler, | |
2544 | dhd_dbus_ctl_complete, | |
2545 | dhd_dbus_state_change, | |
2546 | dhd_dbus_pktget, | |
2547 | dhd_dbus_pktfree | |
2548 | }; | |
2549 | ||
2550 | uint | |
2551 | dhd_bus_chip(struct dhd_bus *bus) | |
2552 | { | |
2553 | ASSERT(bus != NULL); | |
2554 | return bus->pub.attrib.devid; | |
2555 | } | |
2556 | ||
2557 | uint | |
2558 | dhd_bus_chiprev(struct dhd_bus *bus) | |
2559 | { | |
2560 | ASSERT(bus); | |
2561 | ASSERT(bus != NULL); | |
2562 | return bus->pub.attrib.chiprev; | |
2563 | } | |
2564 | ||
2565 | void | |
2566 | dhd_bus_dump(dhd_pub_t *dhdp, struct bcmstrbuf *strbuf) | |
2567 | { | |
2568 | bcm_bprintf(strbuf, "Bus USB\n"); | |
2569 | } | |
2570 | ||
2571 | void | |
2572 | dhd_bus_clearcounts(dhd_pub_t *dhdp) | |
2573 | { | |
2574 | } | |
2575 | ||
2576 | int | |
2577 | dhd_bus_txdata(struct dhd_bus *bus, void *pktbuf) | |
2578 | { | |
2579 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
2580 | if (bus->txoff) { | |
2581 | DBUSTRACE(("txoff\n")); | |
2582 | return BCME_EPERM; | |
2583 | } | |
2584 | return dbus_send_txdata(&bus->pub, pktbuf); | |
2585 | } | |
2586 | ||
2587 | static void | |
2588 | dhd_dbus_advertise_bus_cleanup(dhd_pub_t *dhdp) | |
2589 | { | |
2590 | unsigned long flags; | |
2591 | int timeleft; | |
2592 | ||
2593 | DHD_LINUX_GENERAL_LOCK(dhdp, flags); | |
2594 | dhdp->busstate = DHD_BUS_DOWN_IN_PROGRESS; | |
2595 | DHD_LINUX_GENERAL_UNLOCK(dhdp, flags); | |
2596 | ||
2597 | timeleft = dhd_os_busbusy_wait_negation(dhdp, &dhdp->dhd_bus_busy_state); | |
2598 | if ((timeleft == 0) || (timeleft == 1)) { | |
2599 | DBUSERR(("%s : Timeout due to dhd_bus_busy_state=0x%x\n", | |
2600 | __FUNCTION__, dhdp->dhd_bus_busy_state)); | |
2601 | ASSERT(0); | |
2602 | } | |
2603 | ||
2604 | return; | |
2605 | } | |
2606 | ||
2607 | static void | |
2608 | dhd_dbus_advertise_bus_remove(dhd_pub_t *dhdp) | |
2609 | { | |
2610 | unsigned long flags; | |
2611 | int timeleft; | |
2612 | ||
2613 | DHD_LINUX_GENERAL_LOCK(dhdp, flags); | |
2614 | dhdp->busstate = DHD_BUS_REMOVE; | |
2615 | DHD_LINUX_GENERAL_UNLOCK(dhdp, flags); | |
2616 | ||
2617 | timeleft = dhd_os_busbusy_wait_negation(dhdp, &dhdp->dhd_bus_busy_state); | |
2618 | if ((timeleft == 0) || (timeleft == 1)) { | |
2619 | DBUSERR(("%s : Timeout due to dhd_bus_busy_state=0x%x\n", | |
2620 | __FUNCTION__, dhdp->dhd_bus_busy_state)); | |
2621 | ASSERT(0); | |
2622 | } | |
2623 | ||
2624 | return; | |
2625 | } | |
2626 | ||
2627 | int | |
2628 | dhd_bus_devreset(dhd_pub_t *dhdp, uint8 flag) | |
2629 | { | |
2630 | int bcmerror = 0; | |
2631 | unsigned long flags; | |
2632 | wifi_adapter_info_t *adapter = (wifi_adapter_info_t *)dhdp->adapter; | |
2633 | ||
2634 | if (flag == TRUE) { | |
2635 | if (!dhdp->dongle_reset) { | |
2636 | DBUSERR(("%s: == Power OFF ==\n", __FUNCTION__)); | |
2637 | dhd_dbus_advertise_bus_cleanup(dhdp); | |
2638 | dhd_os_wd_timer(dhdp, 0); | |
2639 | #if !defined(IGNORE_ETH0_DOWN) | |
2640 | /* Force flow control as protection when stop come before ifconfig_down */ | |
2641 | dhd_txflowcontrol(dhdp, ALL_INTERFACES, ON); | |
2642 | #endif /* !defined(IGNORE_ETH0_DOWN) */ | |
2643 | dbus_stop(dhdp->bus); | |
2644 | ||
2645 | dhdp->dongle_reset = TRUE; | |
2646 | dhdp->up = FALSE; | |
2647 | ||
2648 | DHD_LINUX_GENERAL_LOCK(dhdp, flags); | |
2649 | dhdp->busstate = DHD_BUS_DOWN; | |
2650 | DHD_LINUX_GENERAL_UNLOCK(dhdp, flags); | |
2651 | wifi_clr_adapter_status(adapter, WIFI_STATUS_FW_READY); | |
2652 | ||
2653 | printf("%s: WLAN OFF DONE\n", __FUNCTION__); | |
2654 | /* App can now remove power from device */ | |
2655 | } else | |
2656 | bcmerror = BCME_ERROR; | |
2657 | } else { | |
2658 | /* App must have restored power to device before calling */ | |
2659 | printf("\n\n%s: == WLAN ON ==\n", __FUNCTION__); | |
2660 | if (dhdp->dongle_reset) { | |
2661 | /* Turn on WLAN */ | |
2662 | DHD_MUTEX_UNLOCK(); | |
2663 | wait_event_interruptible_timeout(adapter->status_event, | |
2664 | wifi_get_adapter_status(adapter, WIFI_STATUS_FW_READY), | |
2665 | msecs_to_jiffies(DHD_FW_READY_TIMEOUT)); | |
2666 | DHD_MUTEX_LOCK(); | |
2667 | bcmerror = dbus_up(dhdp->bus); | |
2668 | if (bcmerror == BCME_OK) { | |
2669 | dhdp->dongle_reset = FALSE; | |
2670 | dhdp->up = TRUE; | |
2671 | #if !defined(IGNORE_ETH0_DOWN) | |
2672 | /* Restore flow control */ | |
2673 | dhd_txflowcontrol(dhdp, ALL_INTERFACES, OFF); | |
2674 | #endif | |
2675 | dhd_os_wd_timer(dhdp, dhd_watchdog_ms); | |
2676 | ||
2677 | DBUSTRACE(("%s: WLAN ON DONE\n", __FUNCTION__)); | |
2678 | } else { | |
2679 | DBUSERR(("%s: failed to dbus_up with code %d\n", __FUNCTION__, bcmerror)); | |
2680 | } | |
2681 | } | |
2682 | } | |
2683 | ||
2684 | #ifdef PKT_STATICS | |
2685 | memset((uint8*) &tx_statics, 0, sizeof(pkt_statics_t)); | |
2686 | #endif | |
2687 | return bcmerror; | |
2688 | } | |
2689 | ||
d2839953 RC |
2690 | void |
2691 | dhd_bus_update_fw_nv_path(struct dhd_bus *bus, char *pfw_path, | |
2692 | char *pnv_path, char *pclm_path, char *pconf_path) | |
2693 | { | |
2694 | DBUSTRACE(("%s\n", __FUNCTION__)); | |
2695 | ||
2696 | if (bus == NULL) { | |
2697 | DBUSERR(("%s: bus is NULL\n", __FUNCTION__)); | |
2698 | return; | |
2699 | } | |
2700 | ||
2701 | bus->fw_path = pfw_path; | |
2702 | bus->nv_path = pnv_path; | |
2703 | bus->dhd->clm_path = pclm_path; | |
2704 | bus->dhd->conf_path = pconf_path; | |
2705 | ||
3910ce8e | 2706 | dhd_conf_set_path_params(bus->dhd, bus->fw_path, bus->nv_path); |
d2839953 RC |
2707 | |
2708 | } | |
2709 | ||
2710 | /* | |
2711 | * hdrlen is space to reserve in pkt headroom for DBUS | |
2712 | */ | |
2713 | void * | |
2714 | dhd_dbus_probe_cb(void *arg, const char *desc, uint32 bustype, | |
2715 | uint16 bus_no, uint16 slot, uint32 hdrlen) | |
2716 | { | |
2717 | osl_t *osh = NULL; | |
2718 | dhd_bus_t *bus = NULL; | |
2719 | dhd_pub_t *pub = NULL; | |
2720 | uint rxsz; | |
2721 | int dlneeded = 0; | |
2722 | wifi_adapter_info_t *adapter = NULL; | |
2723 | ||
2724 | DBUSTRACE(("%s: Enter\n", __FUNCTION__)); | |
2725 | ||
2726 | adapter = dhd_wifi_platform_get_adapter(bustype, bus_no, slot); | |
2727 | ||
2728 | if (!g_pub) { | |
2729 | /* Ask the OS interface part for an OSL handle */ | |
2730 | if (!(osh = osl_attach(NULL, bustype, TRUE))) { | |
2731 | DBUSERR(("%s: OSL attach failed\n", __FUNCTION__)); | |
2732 | goto fail; | |
2733 | } | |
2734 | ||
2735 | /* Attach to the dhd/OS interface */ | |
2736 | if (!(pub = dhd_attach(osh, bus, hdrlen, adapter))) { | |
2737 | DBUSERR(("%s: dhd_attach failed\n", __FUNCTION__)); | |
2738 | goto fail; | |
2739 | } | |
2740 | } else { | |
2741 | pub = g_pub; | |
2742 | osh = pub->osh; | |
2743 | } | |
2744 | ||
2745 | if (pub->bus) { | |
2746 | DBUSERR(("%s: wrong probe\n", __FUNCTION__)); | |
2747 | goto fail; | |
2748 | } | |
2749 | ||
2750 | rxsz = dhd_get_rxsz(pub); | |
2751 | bus = dbus_attach(osh, rxsz, DBUS_NRXQ, DBUS_NTXQ, pub, &dhd_dbus_cbs, NULL, NULL); | |
2752 | if (bus) { | |
2753 | pub->bus = bus; | |
2754 | bus->dhd = pub; | |
2755 | ||
2756 | dlneeded = dbus_dlneeded(bus); | |
2757 | if (dlneeded >= 0) { | |
2758 | if (!g_pub) { | |
2759 | dhd_conf_reset(pub); | |
2760 | dhd_conf_set_chiprev(pub, bus->pub.attrib.devid, bus->pub.attrib.chiprev); | |
2761 | dhd_conf_preinit(pub); | |
2762 | } | |
2763 | } | |
2764 | ||
2765 | if (g_pub || dhd_download_fw_on_driverload) { | |
2766 | if (dlneeded == 0) { | |
2767 | wifi_set_adapter_status(adapter, WIFI_STATUS_FW_READY); | |
2768 | #ifdef BCM_REQUEST_FW | |
2769 | } else if (dlneeded > 0) { | |
2770 | dhd_set_path(bus->dhd); | |
2771 | if (dbus_download_firmware(bus, bus->fw_path, bus->nv_path) != DBUS_OK) | |
2772 | goto fail; | |
2773 | #endif | |
965f77c4 RC |
2774 | } else { |
2775 | goto fail; | |
d2839953 RC |
2776 | } |
2777 | } | |
2778 | } else { | |
2779 | DBUSERR(("%s: dbus_attach failed\n", __FUNCTION__)); | |
2780 | } | |
2781 | ||
2782 | if (!g_pub) { | |
2783 | /* Ok, finish the attach to the OS network interface */ | |
2784 | if (dhd_register_if(pub, 0, TRUE) != 0) { | |
2785 | DBUSERR(("%s: dhd_register_if failed\n", __FUNCTION__)); | |
2786 | goto fail; | |
2787 | } | |
2788 | pub->hang_report = TRUE; | |
2789 | #if defined(MULTIPLE_SUPPLICANT) | |
2790 | wl_android_post_init(); // terence 20120530: fix critical section in dhd_open and dhdsdio_probe | |
2791 | #endif | |
2792 | g_pub = pub; | |
2793 | } | |
2794 | ||
2795 | DBUSTRACE(("%s: Exit\n", __FUNCTION__)); | |
2796 | wifi_clr_adapter_status(adapter, WIFI_STATUS_DETTACH); | |
2797 | wifi_set_adapter_status(adapter, WIFI_STATUS_ATTACH); | |
2798 | wake_up_interruptible(&adapter->status_event); | |
2799 | /* This is passed to dhd_dbus_disconnect_cb */ | |
2800 | return bus; | |
2801 | ||
2802 | fail: | |
2803 | if (pub && pub->bus) { | |
2804 | dbus_detach(pub->bus); | |
2805 | pub->bus = NULL; | |
2806 | } | |
2807 | /* Release resources in reverse order */ | |
2808 | if (!g_pub) { | |
2809 | if (pub) { | |
2810 | dhd_detach(pub); | |
2811 | dhd_free(pub); | |
2812 | } | |
2813 | if (osh) { | |
2814 | osl_detach(osh); | |
2815 | } | |
2816 | } | |
2817 | ||
2818 | printf("%s: Failed\n", __FUNCTION__); | |
2819 | return NULL; | |
2820 | } | |
2821 | ||
2822 | void | |
2823 | dhd_dbus_disconnect_cb(void *arg) | |
2824 | { | |
2825 | dhd_bus_t *bus = (dhd_bus_t *)arg; | |
2826 | dhd_pub_t *pub = g_pub; | |
2827 | osl_t *osh; | |
2828 | wifi_adapter_info_t *adapter = NULL; | |
2829 | ||
2830 | adapter = (wifi_adapter_info_t *)pub->adapter; | |
2831 | ||
2832 | if (pub && !pub->dhd_remove && bus == NULL) { | |
2833 | DBUSERR(("%s: bus is NULL\n", __FUNCTION__)); | |
2834 | return; | |
2835 | } | |
2836 | if (!adapter) { | |
2837 | DBUSERR(("%s: adapter is NULL\n", __FUNCTION__)); | |
2838 | return; | |
2839 | } | |
2840 | ||
2841 | printf("%s: Enter dhd_remove=%d on %s\n", __FUNCTION__, | |
2842 | pub->dhd_remove, adapter->name); | |
2843 | if (!pub->dhd_remove) { | |
2844 | /* Advertise bus remove during rmmod */ | |
2845 | dhd_dbus_advertise_bus_remove(bus->dhd); | |
2846 | dbus_detach(pub->bus); | |
2847 | pub->bus = NULL; | |
2848 | wifi_clr_adapter_status(adapter, WIFI_STATUS_ATTACH); | |
2849 | wifi_set_adapter_status(adapter, WIFI_STATUS_DETTACH); | |
2850 | wake_up_interruptible(&adapter->status_event); | |
2851 | } else { | |
2852 | osh = pub->osh; | |
2853 | dhd_detach(pub); | |
2854 | if (pub->bus) { | |
2855 | dbus_detach(pub->bus); | |
2856 | pub->bus = NULL; | |
2857 | } | |
2858 | dhd_free(pub); | |
2859 | g_pub = NULL; | |
2860 | if (MALLOCED(osh)) { | |
2861 | DBUSERR(("%s: MEMORY LEAK %d bytes\n", __FUNCTION__, MALLOCED(osh))); | |
2862 | } | |
2863 | osl_detach(osh); | |
2864 | } | |
2865 | ||
2866 | DBUSTRACE(("%s: Exit\n", __FUNCTION__)); | |
2867 | } | |
2868 | ||
2869 | #ifdef LINUX_EXTERNAL_MODULE_DBUS | |
2870 | ||
2871 | static int __init | |
2872 | bcm_dbus_module_init(void) | |
2873 | { | |
2874 | printf("Inserting bcm_dbus module \n"); | |
2875 | return 0; | |
2876 | } | |
2877 | ||
2878 | static void __exit | |
2879 | bcm_dbus_module_exit(void) | |
2880 | { | |
2881 | printf("Removing bcm_dbus module \n"); | |
2882 | return; | |
2883 | } | |
2884 | ||
2885 | EXPORT_SYMBOL(dbus_pnp_sleep); | |
2886 | EXPORT_SYMBOL(dbus_get_devinfo); | |
2887 | EXPORT_SYMBOL(dbus_detach); | |
2888 | EXPORT_SYMBOL(dbus_get_attrib); | |
2889 | EXPORT_SYMBOL(dbus_down); | |
2890 | EXPORT_SYMBOL(dbus_pnp_resume); | |
2891 | EXPORT_SYMBOL(dbus_set_config); | |
2892 | EXPORT_SYMBOL(dbus_flowctrl_rx); | |
2893 | EXPORT_SYMBOL(dbus_up); | |
2894 | EXPORT_SYMBOL(dbus_get_device_speed); | |
2895 | EXPORT_SYMBOL(dbus_send_pkt); | |
2896 | EXPORT_SYMBOL(dbus_recv_ctl); | |
2897 | EXPORT_SYMBOL(dbus_attach); | |
2898 | ||
2899 | MODULE_LICENSE("GPL"); | |
2900 | ||
2901 | module_init(bcm_dbus_module_init); | |
2902 | module_exit(bcm_dbus_module_exit); | |
2903 | ||
2904 | #endif /* #ifdef LINUX_EXTERNAL_MODULE_DBUS */ |