?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / net / ethernet / brocade / bna / bna_tx_rx.c
blob85e63546abe3311c2902a5a93cd422942b714b24
1 /*
2 * Linux network driver for Brocade Converged Network Adapter.
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of the GNU General Public License (GPL) Version 2 as
6 * published by the Free Software Foundation
7 *
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
12 */
13 /*
14 * Copyright (c) 2005-2011 Brocade Communications Systems, Inc.
15 * All rights reserved
16 * www.brocade.com
17 */
18 #include "bna.h"
19 #include "bfi.h"
20
21 /* IB */
22 static void
23 bna_ib_coalescing_timeo_set(struct bna_ib *ib, u8 coalescing_timeo)
24 {
25 ib->coalescing_timeo = coalescing_timeo;
26 ib->door_bell.doorbell_ack = BNA_DOORBELL_IB_INT_ACK(
27 (u32)ib->coalescing_timeo, 0);
28 }
29
30 /* RXF */
31
32 #define bna_rxf_vlan_cfg_soft_reset(rxf) \
33 do { \
34 (rxf)->vlan_pending_bitmask = (u8)BFI_VLAN_BMASK_ALL; \
35 (rxf)->vlan_strip_pending = true; \
36 } while (0)
37
38 #define bna_rxf_rss_cfg_soft_reset(rxf) \
39 do { \
40 if ((rxf)->rss_status == BNA_STATUS_T_ENABLED) \
41 (rxf)->rss_pending = (BNA_RSS_F_RIT_PENDING | \
42 BNA_RSS_F_CFG_PENDING | \
43 BNA_RSS_F_STATUS_PENDING); \
44 } while (0)
45
46 static int bna_rxf_cfg_apply(struct bna_rxf *rxf);
47 static void bna_rxf_cfg_reset(struct bna_rxf *rxf);
48 static int bna_rxf_fltr_clear(struct bna_rxf *rxf);
49 static int bna_rxf_ucast_cfg_apply(struct bna_rxf *rxf);
50 static int bna_rxf_promisc_cfg_apply(struct bna_rxf *rxf);
51 static int bna_rxf_allmulti_cfg_apply(struct bna_rxf *rxf);
52 static int bna_rxf_vlan_strip_cfg_apply(struct bna_rxf *rxf);
53 static int bna_rxf_ucast_cfg_reset(struct bna_rxf *rxf,
54 enum bna_cleanup_type cleanup);
55 static int bna_rxf_promisc_cfg_reset(struct bna_rxf *rxf,
56 enum bna_cleanup_type cleanup);
57 static int bna_rxf_allmulti_cfg_reset(struct bna_rxf *rxf,
58 enum bna_cleanup_type cleanup);
59
60 bfa_fsm_state_decl(bna_rxf, stopped, struct bna_rxf,
61 enum bna_rxf_event);
62 bfa_fsm_state_decl(bna_rxf, paused, struct bna_rxf,
63 enum bna_rxf_event);
64 bfa_fsm_state_decl(bna_rxf, cfg_wait, struct bna_rxf,
65 enum bna_rxf_event);
66 bfa_fsm_state_decl(bna_rxf, started, struct bna_rxf,
67 enum bna_rxf_event);
68 bfa_fsm_state_decl(bna_rxf, fltr_clr_wait, struct bna_rxf,
69 enum bna_rxf_event);
70 bfa_fsm_state_decl(bna_rxf, last_resp_wait, struct bna_rxf,
71 enum bna_rxf_event);
72
73 static void
74 bna_rxf_sm_stopped_entry(struct bna_rxf *rxf)
75 {
76 call_rxf_stop_cbfn(rxf);
77 }
78
79 static void
80 bna_rxf_sm_stopped(struct bna_rxf *rxf, enum bna_rxf_event event)
81 {
82 switch (event) {
83 case RXF_E_START:
84 if (rxf->flags & BNA_RXF_F_PAUSED) {
85 bfa_fsm_set_state(rxf, bna_rxf_sm_paused);
86 call_rxf_start_cbfn(rxf);
87 } else
88 bfa_fsm_set_state(rxf, bna_rxf_sm_cfg_wait);
89 break;
90
91 case RXF_E_STOP:
92 call_rxf_stop_cbfn(rxf);
93 break;
94
95 case RXF_E_FAIL:
96 /* No-op */
97 break;
98
99 case RXF_E_CONFIG:
100 call_rxf_cam_fltr_cbfn(rxf);
101 break;
102
103 case RXF_E_PAUSE:
104 rxf->flags |= BNA_RXF_F_PAUSED;
105 call_rxf_pause_cbfn(rxf);
106 break;
107
108 case RXF_E_RESUME:
109 rxf->flags &= ~BNA_RXF_F_PAUSED;
110 call_rxf_resume_cbfn(rxf);
111 break;
112
113 default:
114 bfa_sm_fault(event);
115 }
116 }
117
118 static void
119 bna_rxf_sm_paused_entry(struct bna_rxf *rxf)
120 {
121 call_rxf_pause_cbfn(rxf);
122 }
123
124 static void
125 bna_rxf_sm_paused(struct bna_rxf *rxf, enum bna_rxf_event event)
126 {
127 switch (event) {
128 case RXF_E_STOP:
129 case RXF_E_FAIL:
130 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
131 break;
132
133 case RXF_E_CONFIG:
134 call_rxf_cam_fltr_cbfn(rxf);
135 break;
136
137 case RXF_E_RESUME:
138 rxf->flags &= ~BNA_RXF_F_PAUSED;
139 bfa_fsm_set_state(rxf, bna_rxf_sm_cfg_wait);
140 break;
141
142 default:
143 bfa_sm_fault(event);
144 }
145 }
146
147 static void
148 bna_rxf_sm_cfg_wait_entry(struct bna_rxf *rxf)
149 {
150 if (!bna_rxf_cfg_apply(rxf)) {
151 /* No more pending config updates */
152 bfa_fsm_set_state(rxf, bna_rxf_sm_started);
153 }
154 }
155
156 static void
157 bna_rxf_sm_cfg_wait(struct bna_rxf *rxf, enum bna_rxf_event event)
158 {
159 switch (event) {
160 case RXF_E_STOP:
161 bfa_fsm_set_state(rxf, bna_rxf_sm_last_resp_wait);
162 break;
163
164 case RXF_E_FAIL:
165 bna_rxf_cfg_reset(rxf);
166 call_rxf_start_cbfn(rxf);
167 call_rxf_cam_fltr_cbfn(rxf);
168 call_rxf_resume_cbfn(rxf);
169 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
170 break;
171
172 case RXF_E_CONFIG:
173 /* No-op */
174 break;
175
176 case RXF_E_PAUSE:
177 rxf->flags |= BNA_RXF_F_PAUSED;
178 call_rxf_start_cbfn(rxf);
179 bfa_fsm_set_state(rxf, bna_rxf_sm_fltr_clr_wait);
180 break;
181
182 case RXF_E_FW_RESP:
183 if (!bna_rxf_cfg_apply(rxf)) {
184 /* No more pending config updates */
185 bfa_fsm_set_state(rxf, bna_rxf_sm_started);
186 }
187 break;
188
189 default:
190 bfa_sm_fault(event);
191 }
192 }
193
194 static void
195 bna_rxf_sm_started_entry(struct bna_rxf *rxf)
196 {
197 call_rxf_start_cbfn(rxf);
198 call_rxf_cam_fltr_cbfn(rxf);
199 call_rxf_resume_cbfn(rxf);
200 }
201
202 static void
203 bna_rxf_sm_started(struct bna_rxf *rxf, enum bna_rxf_event event)
204 {
205 switch (event) {
206 case RXF_E_STOP:
207 case RXF_E_FAIL:
208 bna_rxf_cfg_reset(rxf);
209 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
210 break;
211
212 case RXF_E_CONFIG:
213 bfa_fsm_set_state(rxf, bna_rxf_sm_cfg_wait);
214 break;
215
216 case RXF_E_PAUSE:
217 rxf->flags |= BNA_RXF_F_PAUSED;
218 if (!bna_rxf_fltr_clear(rxf))
219 bfa_fsm_set_state(rxf, bna_rxf_sm_paused);
220 else
221 bfa_fsm_set_state(rxf, bna_rxf_sm_fltr_clr_wait);
222 break;
223
224 default:
225 bfa_sm_fault(event);
226 }
227 }
228
229 static void
230 bna_rxf_sm_fltr_clr_wait_entry(struct bna_rxf *rxf)
231 {
232 }
233
234 static void
235 bna_rxf_sm_fltr_clr_wait(struct bna_rxf *rxf, enum bna_rxf_event event)
236 {
237 switch (event) {
238 case RXF_E_FAIL:
239 bna_rxf_cfg_reset(rxf);
240 call_rxf_pause_cbfn(rxf);
241 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
242 break;
243
244 case RXF_E_FW_RESP:
245 if (!bna_rxf_fltr_clear(rxf)) {
246 /* No more pending CAM entries to clear */
247 bfa_fsm_set_state(rxf, bna_rxf_sm_paused);
248 }
249 break;
250
251 default:
252 bfa_sm_fault(event);
253 }
254 }
255
256 static void
257 bna_rxf_sm_last_resp_wait_entry(struct bna_rxf *rxf)
258 {
259 }
260
261 static void
262 bna_rxf_sm_last_resp_wait(struct bna_rxf *rxf, enum bna_rxf_event event)
263 {
264 switch (event) {
265 case RXF_E_FAIL:
266 case RXF_E_FW_RESP:
267 bna_rxf_cfg_reset(rxf);
268 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
269 break;
270
271 default:
272 bfa_sm_fault(event);
273 }
274 }
275
276 static void
277 bna_bfi_ucast_req(struct bna_rxf *rxf, struct bna_mac *mac,
278 enum bfi_enet_h2i_msgs req_type)
279 {
280 struct bfi_enet_ucast_req *req = &rxf->bfi_enet_cmd.ucast_req;
281
282 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET, req_type, 0, rxf->rx->rid);
283 req->mh.num_entries = htons(
284 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_ucast_req)));
285 memcpy(&req->mac_addr, &mac->addr, sizeof(mac_t));
286 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
287 sizeof(struct bfi_enet_ucast_req), &req->mh);
288 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
289 }
290
291 static void
292 bna_bfi_mcast_add_req(struct bna_rxf *rxf, struct bna_mac *mac)
293 {
294 struct bfi_enet_mcast_add_req *req =
295 &rxf->bfi_enet_cmd.mcast_add_req;
296
297 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET, BFI_ENET_H2I_MAC_MCAST_ADD_REQ,
298 0, rxf->rx->rid);
299 req->mh.num_entries = htons(
300 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_mcast_add_req)));
301 memcpy(&req->mac_addr, &mac->addr, sizeof(mac_t));
302 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
303 sizeof(struct bfi_enet_mcast_add_req), &req->mh);
304 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
305 }
306
307 static void
308 bna_bfi_mcast_del_req(struct bna_rxf *rxf, u16 handle)
309 {
310 struct bfi_enet_mcast_del_req *req =
311 &rxf->bfi_enet_cmd.mcast_del_req;
312
313 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET, BFI_ENET_H2I_MAC_MCAST_DEL_REQ,
314 0, rxf->rx->rid);
315 req->mh.num_entries = htons(
316 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_mcast_del_req)));
317 req->handle = htons(handle);
318 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
319 sizeof(struct bfi_enet_mcast_del_req), &req->mh);
320 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
321 }
322
323 static void
324 bna_bfi_mcast_filter_req(struct bna_rxf *rxf, enum bna_status status)
325 {
326 struct bfi_enet_enable_req *req = &rxf->bfi_enet_cmd.req;
327
328 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
329 BFI_ENET_H2I_MAC_MCAST_FILTER_REQ, 0, rxf->rx->rid);
330 req->mh.num_entries = htons(
331 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_enable_req)));
332 req->enable = status;
333 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
334 sizeof(struct bfi_enet_enable_req), &req->mh);
335 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
336 }
337
338 static void
339 bna_bfi_rx_promisc_req(struct bna_rxf *rxf, enum bna_status status)
340 {
341 struct bfi_enet_enable_req *req = &rxf->bfi_enet_cmd.req;
342
343 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
344 BFI_ENET_H2I_RX_PROMISCUOUS_REQ, 0, rxf->rx->rid);
345 req->mh.num_entries = htons(
346 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_enable_req)));
347 req->enable = status;
348 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
349 sizeof(struct bfi_enet_enable_req), &req->mh);
350 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
351 }
352
353 static void
354 bna_bfi_rx_vlan_filter_set(struct bna_rxf *rxf, u8 block_idx)
355 {
356 struct bfi_enet_rx_vlan_req *req = &rxf->bfi_enet_cmd.vlan_req;
357 int i;
358 int j;
359
360 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
361 BFI_ENET_H2I_RX_VLAN_SET_REQ, 0, rxf->rx->rid);
362 req->mh.num_entries = htons(
363 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_rx_vlan_req)));
364 req->block_idx = block_idx;
365 for (i = 0; i < (BFI_ENET_VLAN_BLOCK_SIZE / 32); i++) {
366 j = (block_idx * (BFI_ENET_VLAN_BLOCK_SIZE / 32)) + i;
367 if (rxf->vlan_filter_status == BNA_STATUS_T_ENABLED)
368 req->bit_mask[i] =
369 htonl(rxf->vlan_filter_table[j]);
370 else
371 req->bit_mask[i] = 0xFFFFFFFF;
372 }
373 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
374 sizeof(struct bfi_enet_rx_vlan_req), &req->mh);
375 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
376 }
377
378 static void
379 bna_bfi_vlan_strip_enable(struct bna_rxf *rxf)
380 {
381 struct bfi_enet_enable_req *req = &rxf->bfi_enet_cmd.req;
382
383 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
384 BFI_ENET_H2I_RX_VLAN_STRIP_ENABLE_REQ, 0, rxf->rx->rid);
385 req->mh.num_entries = htons(
386 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_enable_req)));
387 req->enable = rxf->vlan_strip_status;
388 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
389 sizeof(struct bfi_enet_enable_req), &req->mh);
390 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
391 }
392
393 static void
394 bna_bfi_rit_cfg(struct bna_rxf *rxf)
395 {
396 struct bfi_enet_rit_req *req = &rxf->bfi_enet_cmd.rit_req;
397
398 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
399 BFI_ENET_H2I_RIT_CFG_REQ, 0, rxf->rx->rid);
400 req->mh.num_entries = htons(
401 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_rit_req)));
402 req->size = htons(rxf->rit_size);
403 memcpy(&req->table[0], rxf->rit, rxf->rit_size);
404 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
405 sizeof(struct bfi_enet_rit_req), &req->mh);
406 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
407 }
408
409 static void
410 bna_bfi_rss_cfg(struct bna_rxf *rxf)
411 {
412 struct bfi_enet_rss_cfg_req *req = &rxf->bfi_enet_cmd.rss_req;
413 int i;
414
415 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
416 BFI_ENET_H2I_RSS_CFG_REQ, 0, rxf->rx->rid);
417 req->mh.num_entries = htons(
418 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_rss_cfg_req)));
419 req->cfg.type = rxf->rss_cfg.hash_type;
420 req->cfg.mask = rxf->rss_cfg.hash_mask;
421 for (i = 0; i < BFI_ENET_RSS_KEY_LEN; i++)
422 req->cfg.key[i] =
423 htonl(rxf->rss_cfg.toeplitz_hash_key[i]);
424 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
425 sizeof(struct bfi_enet_rss_cfg_req), &req->mh);
426 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
427 }
428
429 static void
430 bna_bfi_rss_enable(struct bna_rxf *rxf)
431 {
432 struct bfi_enet_enable_req *req = &rxf->bfi_enet_cmd.req;
433
434 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
435 BFI_ENET_H2I_RSS_ENABLE_REQ, 0, rxf->rx->rid);
436 req->mh.num_entries = htons(
437 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_enable_req)));
438 req->enable = rxf->rss_status;
439 bfa_msgq_cmd_set(&rxf->msgq_cmd, NULL, NULL,
440 sizeof(struct bfi_enet_enable_req), &req->mh);
441 bfa_msgq_cmd_post(&rxf->rx->bna->msgq, &rxf->msgq_cmd);
442 }
443
444 /* This function gets the multicast MAC that has already been added to CAM */
445 static struct bna_mac *
446 bna_rxf_mcmac_get(struct bna_rxf *rxf, u8 *mac_addr)
447 {
448 struct bna_mac *mac;
449 struct list_head *qe;
450
451 list_for_each(qe, &rxf->mcast_active_q) {
452 mac = (struct bna_mac *)qe;
453 if (BNA_MAC_IS_EQUAL(&mac->addr, mac_addr))
454 return mac;
455 }
456
457 list_for_each(qe, &rxf->mcast_pending_del_q) {
458 mac = (struct bna_mac *)qe;
459 if (BNA_MAC_IS_EQUAL(&mac->addr, mac_addr))
460 return mac;
461 }
462
463 return NULL;
464 }
465
466 static struct bna_mcam_handle *
467 bna_rxf_mchandle_get(struct bna_rxf *rxf, int handle)
468 {
469 struct bna_mcam_handle *mchandle;
470 struct list_head *qe;
471
472 list_for_each(qe, &rxf->mcast_handle_q) {
473 mchandle = (struct bna_mcam_handle *)qe;
474 if (mchandle->handle == handle)
475 return mchandle;
476 }
477
478 return NULL;
479 }
480
481 static void
482 bna_rxf_mchandle_attach(struct bna_rxf *rxf, u8 *mac_addr, int handle)
483 {
484 struct bna_mac *mcmac;
485 struct bna_mcam_handle *mchandle;
486
487 mcmac = bna_rxf_mcmac_get(rxf, mac_addr);
488 mchandle = bna_rxf_mchandle_get(rxf, handle);
489 if (mchandle == NULL) {
490 mchandle = bna_mcam_mod_handle_get(&rxf->rx->bna->mcam_mod);
491 mchandle->handle = handle;
492 mchandle->refcnt = 0;
493 list_add_tail(&mchandle->qe, &rxf->mcast_handle_q);
494 }
495 mchandle->refcnt++;
496 mcmac->handle = mchandle;
497 }
498
499 static int
500 bna_rxf_mcast_del(struct bna_rxf *rxf, struct bna_mac *mac,
501 enum bna_cleanup_type cleanup)
502 {
503 struct bna_mcam_handle *mchandle;
504 int ret = 0;
505
506 mchandle = mac->handle;
507 if (mchandle == NULL)
508 return ret;
509
510 mchandle->refcnt--;
511 if (mchandle->refcnt == 0) {
512 if (cleanup == BNA_HARD_CLEANUP) {
513 bna_bfi_mcast_del_req(rxf, mchandle->handle);
514 ret = 1;
515 }
516 list_del(&mchandle->qe);
517 bfa_q_qe_init(&mchandle->qe);
518 bna_mcam_mod_handle_put(&rxf->rx->bna->mcam_mod, mchandle);
519 }
520 mac->handle = NULL;
521
522 return ret;
523 }
524
525 static int
526 bna_rxf_mcast_cfg_apply(struct bna_rxf *rxf)
527 {
528 struct bna_mac *mac = NULL;
529 struct list_head *qe;
530 int ret;
531
532 /* First delete multicast entries to maintain the count */
533 while (!list_empty(&rxf->mcast_pending_del_q)) {
534 bfa_q_deq(&rxf->mcast_pending_del_q, &qe);
535 bfa_q_qe_init(qe);
536 mac = (struct bna_mac *)qe;
537 ret = bna_rxf_mcast_del(rxf, mac, BNA_HARD_CLEANUP);
538 bna_cam_mod_mac_put(bna_mcam_mod_del_q(rxf->rx->bna), mac);
539 if (ret)
540 return ret;
541 }
542
543 /* Add multicast entries */
544 if (!list_empty(&rxf->mcast_pending_add_q)) {
545 bfa_q_deq(&rxf->mcast_pending_add_q, &qe);
546 bfa_q_qe_init(qe);
547 mac = (struct bna_mac *)qe;
548 list_add_tail(&mac->qe, &rxf->mcast_active_q);
549 bna_bfi_mcast_add_req(rxf, mac);
550 return 1;
551 }
552
553 return 0;
554 }
555
556 static int
557 bna_rxf_vlan_cfg_apply(struct bna_rxf *rxf)
558 {
559 u8 vlan_pending_bitmask;
560 int block_idx = 0;
561
562 if (rxf->vlan_pending_bitmask) {
563 vlan_pending_bitmask = rxf->vlan_pending_bitmask;
564 while (!(vlan_pending_bitmask & 0x1)) {
565 block_idx++;
566 vlan_pending_bitmask >>= 1;
567 }
568 rxf->vlan_pending_bitmask &= ~(1 << block_idx);
569 bna_bfi_rx_vlan_filter_set(rxf, block_idx);
570 return 1;
571 }
572
573 return 0;
574 }
575
576 static int
577 bna_rxf_mcast_cfg_reset(struct bna_rxf *rxf, enum bna_cleanup_type cleanup)
578 {
579 struct list_head *qe;
580 struct bna_mac *mac;
581 int ret;
582
583 /* Throw away delete pending mcast entries */
584 while (!list_empty(&rxf->mcast_pending_del_q)) {
585 bfa_q_deq(&rxf->mcast_pending_del_q, &qe);
586 bfa_q_qe_init(qe);
587 mac = (struct bna_mac *)qe;
588 ret = bna_rxf_mcast_del(rxf, mac, cleanup);
589 bna_cam_mod_mac_put(bna_mcam_mod_del_q(rxf->rx->bna), mac);
590 if (ret)
591 return ret;
592 }
593
594 /* Move active mcast entries to pending_add_q */
595 while (!list_empty(&rxf->mcast_active_q)) {
596 bfa_q_deq(&rxf->mcast_active_q, &qe);
597 bfa_q_qe_init(qe);
598 list_add_tail(qe, &rxf->mcast_pending_add_q);
599 mac = (struct bna_mac *)qe;
600 if (bna_rxf_mcast_del(rxf, mac, cleanup))
601 return 1;
602 }
603
604 return 0;
605 }
606
607 static int
608 bna_rxf_rss_cfg_apply(struct bna_rxf *rxf)
609 {
610 if (rxf->rss_pending) {
611 if (rxf->rss_pending & BNA_RSS_F_RIT_PENDING) {
612 rxf->rss_pending &= ~BNA_RSS_F_RIT_PENDING;
613 bna_bfi_rit_cfg(rxf);
614 return 1;
615 }
616
617 if (rxf->rss_pending & BNA_RSS_F_CFG_PENDING) {
618 rxf->rss_pending &= ~BNA_RSS_F_CFG_PENDING;
619 bna_bfi_rss_cfg(rxf);
620 return 1;
621 }
622
623 if (rxf->rss_pending & BNA_RSS_F_STATUS_PENDING) {
624 rxf->rss_pending &= ~BNA_RSS_F_STATUS_PENDING;
625 bna_bfi_rss_enable(rxf);
626 return 1;
627 }
628 }
629
630 return 0;
631 }
632
633 static int
634 bna_rxf_cfg_apply(struct bna_rxf *rxf)
635 {
636 if (bna_rxf_ucast_cfg_apply(rxf))
637 return 1;
638
639 if (bna_rxf_mcast_cfg_apply(rxf))
640 return 1;
641
642 if (bna_rxf_promisc_cfg_apply(rxf))
643 return 1;
644
645 if (bna_rxf_allmulti_cfg_apply(rxf))
646 return 1;
647
648 if (bna_rxf_vlan_cfg_apply(rxf))
649 return 1;
650
651 if (bna_rxf_vlan_strip_cfg_apply(rxf))
652 return 1;
653
654 if (bna_rxf_rss_cfg_apply(rxf))
655 return 1;
656
657 return 0;
658 }
659
660 /* Only software reset */
661 static int
662 bna_rxf_fltr_clear(struct bna_rxf *rxf)
663 {
664 if (bna_rxf_ucast_cfg_reset(rxf, BNA_HARD_CLEANUP))
665 return 1;
666
667 if (bna_rxf_mcast_cfg_reset(rxf, BNA_HARD_CLEANUP))
668 return 1;
669
670 if (bna_rxf_promisc_cfg_reset(rxf, BNA_HARD_CLEANUP))
671 return 1;
672
673 if (bna_rxf_allmulti_cfg_reset(rxf, BNA_HARD_CLEANUP))
674 return 1;
675
676 return 0;
677 }
678
679 static void
680 bna_rxf_cfg_reset(struct bna_rxf *rxf)
681 {
682 bna_rxf_ucast_cfg_reset(rxf, BNA_SOFT_CLEANUP);
683 bna_rxf_mcast_cfg_reset(rxf, BNA_SOFT_CLEANUP);
684 bna_rxf_promisc_cfg_reset(rxf, BNA_SOFT_CLEANUP);
685 bna_rxf_allmulti_cfg_reset(rxf, BNA_SOFT_CLEANUP);
686 bna_rxf_vlan_cfg_soft_reset(rxf);
687 bna_rxf_rss_cfg_soft_reset(rxf);
688 }
689
690 static void
691 bna_rit_init(struct bna_rxf *rxf, int rit_size)
692 {
693 struct bna_rx *rx = rxf->rx;
694 struct bna_rxp *rxp;
695 struct list_head *qe;
696 int offset = 0;
697
698 rxf->rit_size = rit_size;
699 list_for_each(qe, &rx->rxp_q) {
700 rxp = (struct bna_rxp *)qe;
701 rxf->rit[offset] = rxp->cq.ccb->id;
702 offset++;
703 }
704
705 }
706
707 void
708 bna_bfi_rxf_cfg_rsp(struct bna_rxf *rxf, struct bfi_msgq_mhdr *msghdr)
709 {
710 bfa_fsm_send_event(rxf, RXF_E_FW_RESP);
711 }
712
713 void
714 bna_bfi_rxf_ucast_set_rsp(struct bna_rxf *rxf,
715 struct bfi_msgq_mhdr *msghdr)
716 {
717 struct bfi_enet_rsp *rsp =
718 (struct bfi_enet_rsp *)msghdr;
719
720 if (rsp->error) {
721 /* Clear ucast from cache */
722 rxf->ucast_active_set = 0;
723 }
724
725 bfa_fsm_send_event(rxf, RXF_E_FW_RESP);
726 }
727
728 void
729 bna_bfi_rxf_mcast_add_rsp(struct bna_rxf *rxf,
730 struct bfi_msgq_mhdr *msghdr)
731 {
732 struct bfi_enet_mcast_add_req *req =
733 &rxf->bfi_enet_cmd.mcast_add_req;
734 struct bfi_enet_mcast_add_rsp *rsp =
735 (struct bfi_enet_mcast_add_rsp *)msghdr;
736
737 bna_rxf_mchandle_attach(rxf, (u8 *)&req->mac_addr,
738 ntohs(rsp->handle));
739 bfa_fsm_send_event(rxf, RXF_E_FW_RESP);
740 }
741
742 static void
743 bna_rxf_init(struct bna_rxf *rxf,
744 struct bna_rx *rx,
745 struct bna_rx_config *q_config,
746 struct bna_res_info *res_info)
747 {
748 rxf->rx = rx;
749
750 INIT_LIST_HEAD(&rxf->ucast_pending_add_q);
751 INIT_LIST_HEAD(&rxf->ucast_pending_del_q);
752 rxf->ucast_pending_set = 0;
753 rxf->ucast_active_set = 0;
754 INIT_LIST_HEAD(&rxf->ucast_active_q);
755 rxf->ucast_pending_mac = NULL;
756
757 INIT_LIST_HEAD(&rxf->mcast_pending_add_q);
758 INIT_LIST_HEAD(&rxf->mcast_pending_del_q);
759 INIT_LIST_HEAD(&rxf->mcast_active_q);
760 INIT_LIST_HEAD(&rxf->mcast_handle_q);
761
762 if (q_config->paused)
763 rxf->flags |= BNA_RXF_F_PAUSED;
764
765 rxf->rit = (u8 *)
766 res_info[BNA_RX_RES_MEM_T_RIT].res_u.mem_info.mdl[0].kva;
767 bna_rit_init(rxf, q_config->num_paths);
768
769 rxf->rss_status = q_config->rss_status;
770 if (rxf->rss_status == BNA_STATUS_T_ENABLED) {
771 rxf->rss_cfg = q_config->rss_config;
772 rxf->rss_pending |= BNA_RSS_F_CFG_PENDING;
773 rxf->rss_pending |= BNA_RSS_F_RIT_PENDING;
774 rxf->rss_pending |= BNA_RSS_F_STATUS_PENDING;
775 }
776
777 rxf->vlan_filter_status = BNA_STATUS_T_DISABLED;
778 memset(rxf->vlan_filter_table, 0,
779 (sizeof(u32) * (BFI_ENET_VLAN_ID_MAX / 32)));
780 rxf->vlan_filter_table[0] |= 1; /* for pure priority tagged frames */
781 rxf->vlan_pending_bitmask = (u8)BFI_VLAN_BMASK_ALL;
782
783 rxf->vlan_strip_status = q_config->vlan_strip_status;
784
785 bfa_fsm_set_state(rxf, bna_rxf_sm_stopped);
786 }
787
788 static void
789 bna_rxf_uninit(struct bna_rxf *rxf)
790 {
791 struct bna_mac *mac;
792
793 rxf->ucast_pending_set = 0;
794 rxf->ucast_active_set = 0;
795
796 while (!list_empty(&rxf->ucast_pending_add_q)) {
797 bfa_q_deq(&rxf->ucast_pending_add_q, &mac);
798 bfa_q_qe_init(&mac->qe);
799 bna_cam_mod_mac_put(bna_ucam_mod_free_q(rxf->rx->bna), mac);
800 }
801
802 if (rxf->ucast_pending_mac) {
803 bfa_q_qe_init(&rxf->ucast_pending_mac->qe);
804 bna_cam_mod_mac_put(bna_ucam_mod_free_q(rxf->rx->bna),
805 rxf->ucast_pending_mac);
806 rxf->ucast_pending_mac = NULL;
807 }
808
809 while (!list_empty(&rxf->mcast_pending_add_q)) {
810 bfa_q_deq(&rxf->mcast_pending_add_q, &mac);
811 bfa_q_qe_init(&mac->qe);
812 bna_cam_mod_mac_put(bna_mcam_mod_free_q(rxf->rx->bna), mac);
813 }
814
815 rxf->rxmode_pending = 0;
816 rxf->rxmode_pending_bitmask = 0;
817 if (rxf->rx->bna->promisc_rid == rxf->rx->rid)
818 rxf->rx->bna->promisc_rid = BFI_INVALID_RID;
819 if (rxf->rx->bna->default_mode_rid == rxf->rx->rid)
820 rxf->rx->bna->default_mode_rid = BFI_INVALID_RID;
821
822 rxf->rss_pending = 0;
823 rxf->vlan_strip_pending = false;
824
825 rxf->flags = 0;
826
827 rxf->rx = NULL;
828 }
829
830 static void
831 bna_rx_cb_rxf_started(struct bna_rx *rx)
832 {
833 bfa_fsm_send_event(rx, RX_E_RXF_STARTED);
834 }
835
836 static void
837 bna_rxf_start(struct bna_rxf *rxf)
838 {
839 rxf->start_cbfn = bna_rx_cb_rxf_started;
840 rxf->start_cbarg = rxf->rx;
841 bfa_fsm_send_event(rxf, RXF_E_START);
842 }
843
844 static void
845 bna_rx_cb_rxf_stopped(struct bna_rx *rx)
846 {
847 bfa_fsm_send_event(rx, RX_E_RXF_STOPPED);
848 }
849
850 static void
851 bna_rxf_stop(struct bna_rxf *rxf)
852 {
853 rxf->stop_cbfn = bna_rx_cb_rxf_stopped;
854 rxf->stop_cbarg = rxf->rx;
855 bfa_fsm_send_event(rxf, RXF_E_STOP);
856 }
857
858 static void
859 bna_rxf_fail(struct bna_rxf *rxf)
860 {
861 bfa_fsm_send_event(rxf, RXF_E_FAIL);
862 }
863
864 enum bna_cb_status
865 bna_rx_ucast_set(struct bna_rx *rx, u8 *ucmac,
866 void (*cbfn)(struct bnad *, struct bna_rx *))
867 {
868 struct bna_rxf *rxf = &rx->rxf;
869
870 if (rxf->ucast_pending_mac == NULL) {
871 rxf->ucast_pending_mac =
872 bna_cam_mod_mac_get(bna_ucam_mod_free_q(rxf->rx->bna));
873 if (rxf->ucast_pending_mac == NULL)
874 return BNA_CB_UCAST_CAM_FULL;
875 bfa_q_qe_init(&rxf->ucast_pending_mac->qe);
876 }
877
878 memcpy(rxf->ucast_pending_mac->addr, ucmac, ETH_ALEN);
879 rxf->ucast_pending_set = 1;
880 rxf->cam_fltr_cbfn = cbfn;
881 rxf->cam_fltr_cbarg = rx->bna->bnad;
882
883 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
884
885 return BNA_CB_SUCCESS;
886 }
887
888 enum bna_cb_status
889 bna_rx_mcast_add(struct bna_rx *rx, u8 *addr,
890 void (*cbfn)(struct bnad *, struct bna_rx *))
891 {
892 struct bna_rxf *rxf = &rx->rxf;
893 struct bna_mac *mac;
894
895 /* Check if already added or pending addition */
896 if (bna_mac_find(&rxf->mcast_active_q, addr) ||
897 bna_mac_find(&rxf->mcast_pending_add_q, addr)) {
898 if (cbfn)
899 cbfn(rx->bna->bnad, rx);
900 return BNA_CB_SUCCESS;
901 }
902
903 mac = bna_cam_mod_mac_get(bna_mcam_mod_free_q(rxf->rx->bna));
904 if (mac == NULL)
905 return BNA_CB_MCAST_LIST_FULL;
906 bfa_q_qe_init(&mac->qe);
907 memcpy(mac->addr, addr, ETH_ALEN);
908 list_add_tail(&mac->qe, &rxf->mcast_pending_add_q);
909
910 rxf->cam_fltr_cbfn = cbfn;
911 rxf->cam_fltr_cbarg = rx->bna->bnad;
912
913 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
914
915 return BNA_CB_SUCCESS;
916 }
917
918 enum bna_cb_status
919 bna_rx_ucast_listset(struct bna_rx *rx, int count, u8 *uclist,
920 void (*cbfn)(struct bnad *, struct bna_rx *))
921 {
922 struct bna_ucam_mod *ucam_mod = &rx->bna->ucam_mod;
923 struct bna_rxf *rxf = &rx->rxf;
924 struct list_head list_head;
925 struct list_head *qe;
926 u8 *mcaddr;
927 struct bna_mac *mac, *del_mac;
928 int i;
929
930 /* Purge the pending_add_q */
931 while (!list_empty(&rxf->ucast_pending_add_q)) {
932 bfa_q_deq(&rxf->ucast_pending_add_q, &qe);
933 bfa_q_qe_init(qe);
934 mac = (struct bna_mac *)qe;
935 bna_cam_mod_mac_put(&ucam_mod->free_q, mac);
936 }
937
938 /* Schedule active_q entries for deletion */
939 while (!list_empty(&rxf->ucast_active_q)) {
940 bfa_q_deq(&rxf->ucast_active_q, &qe);
941 mac = (struct bna_mac *)qe;
942 bfa_q_qe_init(&mac->qe);
943
944 del_mac = bna_cam_mod_mac_get(&ucam_mod->del_q);
945 memcpy(del_mac, mac, sizeof(*del_mac));
946 list_add_tail(&del_mac->qe, &rxf->ucast_pending_del_q);
947 bna_cam_mod_mac_put(&ucam_mod->free_q, mac);
948 }
949
950 /* Allocate nodes */
951 INIT_LIST_HEAD(&list_head);
952 for (i = 0, mcaddr = uclist; i < count; i++) {
953 mac = bna_cam_mod_mac_get(&ucam_mod->free_q);
954 if (mac == NULL)
955 goto err_return;
956 bfa_q_qe_init(&mac->qe);
957 memcpy(mac->addr, mcaddr, ETH_ALEN);
958 list_add_tail(&mac->qe, &list_head);
959 mcaddr += ETH_ALEN;
960 }
961
962 /* Add the new entries */
963 while (!list_empty(&list_head)) {
964 bfa_q_deq(&list_head, &qe);
965 mac = (struct bna_mac *)qe;
966 bfa_q_qe_init(&mac->qe);
967 list_add_tail(&mac->qe, &rxf->ucast_pending_add_q);
968 }
969
970 rxf->cam_fltr_cbfn = cbfn;
971 rxf->cam_fltr_cbarg = rx->bna->bnad;
972 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
973
974 return BNA_CB_SUCCESS;
975
976 err_return:
977 while (!list_empty(&list_head)) {
978 bfa_q_deq(&list_head, &qe);
979 mac = (struct bna_mac *)qe;
980 bfa_q_qe_init(&mac->qe);
981 bna_cam_mod_mac_put(&ucam_mod->free_q, mac);
982 }
983
984 return BNA_CB_UCAST_CAM_FULL;
985 }
986
987 enum bna_cb_status
988 bna_rx_mcast_listset(struct bna_rx *rx, int count, u8 *mclist,
989 void (*cbfn)(struct bnad *, struct bna_rx *))
990 {
991 struct bna_mcam_mod *mcam_mod = &rx->bna->mcam_mod;
992 struct bna_rxf *rxf = &rx->rxf;
993 struct list_head list_head;
994 struct list_head *qe;
995 u8 *mcaddr;
996 struct bna_mac *mac, *del_mac;
997 int i;
998
999 /* Purge the pending_add_q */
1000 while (!list_empty(&rxf->mcast_pending_add_q)) {
1001 bfa_q_deq(&rxf->mcast_pending_add_q, &qe);
1002 bfa_q_qe_init(qe);
1003 mac = (struct bna_mac *)qe;
1004 bna_cam_mod_mac_put(&mcam_mod->free_q, mac);
1005 }
1006
1007 /* Schedule active_q entries for deletion */
1008 while (!list_empty(&rxf->mcast_active_q)) {
1009 bfa_q_deq(&rxf->mcast_active_q, &qe);
1010 mac = (struct bna_mac *)qe;
1011 bfa_q_qe_init(&mac->qe);
1012
1013 del_mac = bna_cam_mod_mac_get(&mcam_mod->del_q);
1014
1015 memcpy(del_mac, mac, sizeof(*del_mac));
1016 list_add_tail(&del_mac->qe, &rxf->mcast_pending_del_q);
1017 mac->handle = NULL;
1018 bna_cam_mod_mac_put(&mcam_mod->free_q, mac);
1019 }
1020
1021 /* Allocate nodes */
1022 INIT_LIST_HEAD(&list_head);
1023 for (i = 0, mcaddr = mclist; i < count; i++) {
1024 mac = bna_cam_mod_mac_get(&mcam_mod->free_q);
1025 if (mac == NULL)
1026 goto err_return;
1027 bfa_q_qe_init(&mac->qe);
1028 memcpy(mac->addr, mcaddr, ETH_ALEN);
1029 list_add_tail(&mac->qe, &list_head);
1030
1031 mcaddr += ETH_ALEN;
1032 }
1033
1034 /* Add the new entries */
1035 while (!list_empty(&list_head)) {
1036 bfa_q_deq(&list_head, &qe);
1037 mac = (struct bna_mac *)qe;
1038 bfa_q_qe_init(&mac->qe);
1039 list_add_tail(&mac->qe, &rxf->mcast_pending_add_q);
1040 }
1041
1042 rxf->cam_fltr_cbfn = cbfn;
1043 rxf->cam_fltr_cbarg = rx->bna->bnad;
1044 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
1045
1046 return BNA_CB_SUCCESS;
1047
1048 err_return:
1049 while (!list_empty(&list_head)) {
1050 bfa_q_deq(&list_head, &qe);
1051 mac = (struct bna_mac *)qe;
1052 bfa_q_qe_init(&mac->qe);
1053 bna_cam_mod_mac_put(&mcam_mod->free_q, mac);
1054 }
1055
1056 return BNA_CB_MCAST_LIST_FULL;
1057 }
1058
1059 void
1060 bna_rx_mcast_delall(struct bna_rx *rx,
1061 void (*cbfn)(struct bnad *, struct bna_rx *))
1062 {
1063 struct bna_rxf *rxf = &rx->rxf;
1064 struct list_head *qe;
1065 struct bna_mac *mac, *del_mac;
1066 int need_hw_config = 0;
1067
1068 /* Purge all entries from pending_add_q */
1069 while (!list_empty(&rxf->mcast_pending_add_q)) {
1070 bfa_q_deq(&rxf->mcast_pending_add_q, &qe);
1071 mac = (struct bna_mac *)qe;
1072 bfa_q_qe_init(&mac->qe);
1073 bna_cam_mod_mac_put(bna_mcam_mod_free_q(rxf->rx->bna), mac);
1074 }
1075
1076 /* Schedule all entries in active_q for deletion */
1077 while (!list_empty(&rxf->mcast_active_q)) {
1078 bfa_q_deq(&rxf->mcast_active_q, &qe);
1079 mac = (struct bna_mac *)qe;
1080 bfa_q_qe_init(&mac->qe);
1081
1082 del_mac = bna_cam_mod_mac_get(bna_mcam_mod_del_q(rxf->rx->bna));
1083
1084 memcpy(del_mac, mac, sizeof(*del_mac));
1085 list_add_tail(&del_mac->qe, &rxf->mcast_pending_del_q);
1086 mac->handle = NULL;
1087 bna_cam_mod_mac_put(bna_mcam_mod_free_q(rxf->rx->bna), mac);
1088 need_hw_config = 1;
1089 }
1090
1091 if (need_hw_config) {
1092 rxf->cam_fltr_cbfn = cbfn;
1093 rxf->cam_fltr_cbarg = rx->bna->bnad;
1094 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
1095 return;
1096 }
1097
1098 if (cbfn)
1099 (*cbfn)(rx->bna->bnad, rx);
1100 }
1101
1102 void
1103 bna_rx_vlan_add(struct bna_rx *rx, int vlan_id)
1104 {
1105 struct bna_rxf *rxf = &rx->rxf;
1106 int index = (vlan_id >> BFI_VLAN_WORD_SHIFT);
1107 int bit = (1 << (vlan_id & BFI_VLAN_WORD_MASK));
1108 int group_id = (vlan_id >> BFI_VLAN_BLOCK_SHIFT);
1109
1110 rxf->vlan_filter_table[index] |= bit;
1111 if (rxf->vlan_filter_status == BNA_STATUS_T_ENABLED) {
1112 rxf->vlan_pending_bitmask |= (1 << group_id);
1113 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
1114 }
1115 }
1116
1117 void
1118 bna_rx_vlan_del(struct bna_rx *rx, int vlan_id)
1119 {
1120 struct bna_rxf *rxf = &rx->rxf;
1121 int index = (vlan_id >> BFI_VLAN_WORD_SHIFT);
1122 int bit = (1 << (vlan_id & BFI_VLAN_WORD_MASK));
1123 int group_id = (vlan_id >> BFI_VLAN_BLOCK_SHIFT);
1124
1125 rxf->vlan_filter_table[index] &= ~bit;
1126 if (rxf->vlan_filter_status == BNA_STATUS_T_ENABLED) {
1127 rxf->vlan_pending_bitmask |= (1 << group_id);
1128 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
1129 }
1130 }
1131
1132 static int
1133 bna_rxf_ucast_cfg_apply(struct bna_rxf *rxf)
1134 {
1135 struct bna_mac *mac = NULL;
1136 struct list_head *qe;
1137
1138 /* Delete MAC addresses previousely added */
1139 if (!list_empty(&rxf->ucast_pending_del_q)) {
1140 bfa_q_deq(&rxf->ucast_pending_del_q, &qe);
1141 bfa_q_qe_init(qe);
1142 mac = (struct bna_mac *)qe;
1143 bna_bfi_ucast_req(rxf, mac, BFI_ENET_H2I_MAC_UCAST_DEL_REQ);
1144 bna_cam_mod_mac_put(bna_ucam_mod_del_q(rxf->rx->bna), mac);
1145 return 1;
1146 }
1147
1148 /* Set default unicast MAC */
1149 if (rxf->ucast_pending_set) {
1150 rxf->ucast_pending_set = 0;
1151 memcpy(rxf->ucast_active_mac.addr,
1152 rxf->ucast_pending_mac->addr, ETH_ALEN);
1153 rxf->ucast_active_set = 1;
1154 bna_bfi_ucast_req(rxf, &rxf->ucast_active_mac,
1155 BFI_ENET_H2I_MAC_UCAST_SET_REQ);
1156 return 1;
1157 }
1158
1159 /* Add additional MAC entries */
1160 if (!list_empty(&rxf->ucast_pending_add_q)) {
1161 bfa_q_deq(&rxf->ucast_pending_add_q, &qe);
1162 bfa_q_qe_init(qe);
1163 mac = (struct bna_mac *)qe;
1164 list_add_tail(&mac->qe, &rxf->ucast_active_q);
1165 bna_bfi_ucast_req(rxf, mac, BFI_ENET_H2I_MAC_UCAST_ADD_REQ);
1166 return 1;
1167 }
1168
1169 return 0;
1170 }
1171
1172 static int
1173 bna_rxf_ucast_cfg_reset(struct bna_rxf *rxf, enum bna_cleanup_type cleanup)
1174 {
1175 struct list_head *qe;
1176 struct bna_mac *mac;
1177
1178 /* Throw away delete pending ucast entries */
1179 while (!list_empty(&rxf->ucast_pending_del_q)) {
1180 bfa_q_deq(&rxf->ucast_pending_del_q, &qe);
1181 bfa_q_qe_init(qe);
1182 mac = (struct bna_mac *)qe;
1183 if (cleanup == BNA_SOFT_CLEANUP)
1184 bna_cam_mod_mac_put(bna_ucam_mod_del_q(rxf->rx->bna),
1185 mac);
1186 else {
1187 bna_bfi_ucast_req(rxf, mac,
1188 BFI_ENET_H2I_MAC_UCAST_DEL_REQ);
1189 bna_cam_mod_mac_put(bna_ucam_mod_del_q(rxf->rx->bna),
1190 mac);
1191 return 1;
1192 }
1193 }
1194
1195 /* Move active ucast entries to pending_add_q */
1196 while (!list_empty(&rxf->ucast_active_q)) {
1197 bfa_q_deq(&rxf->ucast_active_q, &qe);
1198 bfa_q_qe_init(qe);
1199 list_add_tail(qe, &rxf->ucast_pending_add_q);
1200 if (cleanup == BNA_HARD_CLEANUP) {
1201 mac = (struct bna_mac *)qe;
1202 bna_bfi_ucast_req(rxf, mac,
1203 BFI_ENET_H2I_MAC_UCAST_DEL_REQ);
1204 return 1;
1205 }
1206 }
1207
1208 if (rxf->ucast_active_set) {
1209 rxf->ucast_pending_set = 1;
1210 rxf->ucast_active_set = 0;
1211 if (cleanup == BNA_HARD_CLEANUP) {
1212 bna_bfi_ucast_req(rxf, &rxf->ucast_active_mac,
1213 BFI_ENET_H2I_MAC_UCAST_CLR_REQ);
1214 return 1;
1215 }
1216 }
1217
1218 return 0;
1219 }
1220
1221 static int
1222 bna_rxf_promisc_cfg_apply(struct bna_rxf *rxf)
1223 {
1224 struct bna *bna = rxf->rx->bna;
1225
1226 /* Enable/disable promiscuous mode */
1227 if (is_promisc_enable(rxf->rxmode_pending,
1228 rxf->rxmode_pending_bitmask)) {
1229 /* move promisc configuration from pending -> active */
1230 promisc_inactive(rxf->rxmode_pending,
1231 rxf->rxmode_pending_bitmask);
1232 rxf->rxmode_active |= BNA_RXMODE_PROMISC;
1233 bna_bfi_rx_promisc_req(rxf, BNA_STATUS_T_ENABLED);
1234 return 1;
1235 } else if (is_promisc_disable(rxf->rxmode_pending,
1236 rxf->rxmode_pending_bitmask)) {
1237 /* move promisc configuration from pending -> active */
1238 promisc_inactive(rxf->rxmode_pending,
1239 rxf->rxmode_pending_bitmask);
1240 rxf->rxmode_active &= ~BNA_RXMODE_PROMISC;
1241 bna->promisc_rid = BFI_INVALID_RID;
1242 bna_bfi_rx_promisc_req(rxf, BNA_STATUS_T_DISABLED);
1243 return 1;
1244 }
1245
1246 return 0;
1247 }
1248
1249 static int
1250 bna_rxf_promisc_cfg_reset(struct bna_rxf *rxf, enum bna_cleanup_type cleanup)
1251 {
1252 struct bna *bna = rxf->rx->bna;
1253
1254 /* Clear pending promisc mode disable */
1255 if (is_promisc_disable(rxf->rxmode_pending,
1256 rxf->rxmode_pending_bitmask)) {
1257 promisc_inactive(rxf->rxmode_pending,
1258 rxf->rxmode_pending_bitmask);
1259 rxf->rxmode_active &= ~BNA_RXMODE_PROMISC;
1260 bna->promisc_rid = BFI_INVALID_RID;
1261 if (cleanup == BNA_HARD_CLEANUP) {
1262 bna_bfi_rx_promisc_req(rxf, BNA_STATUS_T_DISABLED);
1263 return 1;
1264 }
1265 }
1266
1267 /* Move promisc mode config from active -> pending */
1268 if (rxf->rxmode_active & BNA_RXMODE_PROMISC) {
1269 promisc_enable(rxf->rxmode_pending,
1270 rxf->rxmode_pending_bitmask);
1271 rxf->rxmode_active &= ~BNA_RXMODE_PROMISC;
1272 if (cleanup == BNA_HARD_CLEANUP) {
1273 bna_bfi_rx_promisc_req(rxf, BNA_STATUS_T_DISABLED);
1274 return 1;
1275 }
1276 }
1277
1278 return 0;
1279 }
1280
1281 static int
1282 bna_rxf_allmulti_cfg_apply(struct bna_rxf *rxf)
1283 {
1284 /* Enable/disable allmulti mode */
1285 if (is_allmulti_enable(rxf->rxmode_pending,
1286 rxf->rxmode_pending_bitmask)) {
1287 /* move allmulti configuration from pending -> active */
1288 allmulti_inactive(rxf->rxmode_pending,
1289 rxf->rxmode_pending_bitmask);
1290 rxf->rxmode_active |= BNA_RXMODE_ALLMULTI;
1291 bna_bfi_mcast_filter_req(rxf, BNA_STATUS_T_DISABLED);
1292 return 1;
1293 } else if (is_allmulti_disable(rxf->rxmode_pending,
1294 rxf->rxmode_pending_bitmask)) {
1295 /* move allmulti configuration from pending -> active */
1296 allmulti_inactive(rxf->rxmode_pending,
1297 rxf->rxmode_pending_bitmask);
1298 rxf->rxmode_active &= ~BNA_RXMODE_ALLMULTI;
1299 bna_bfi_mcast_filter_req(rxf, BNA_STATUS_T_ENABLED);
1300 return 1;
1301 }
1302
1303 return 0;
1304 }
1305
1306 static int
1307 bna_rxf_allmulti_cfg_reset(struct bna_rxf *rxf, enum bna_cleanup_type cleanup)
1308 {
1309 /* Clear pending allmulti mode disable */
1310 if (is_allmulti_disable(rxf->rxmode_pending,
1311 rxf->rxmode_pending_bitmask)) {
1312 allmulti_inactive(rxf->rxmode_pending,
1313 rxf->rxmode_pending_bitmask);
1314 rxf->rxmode_active &= ~BNA_RXMODE_ALLMULTI;
1315 if (cleanup == BNA_HARD_CLEANUP) {
1316 bna_bfi_mcast_filter_req(rxf, BNA_STATUS_T_ENABLED);
1317 return 1;
1318 }
1319 }
1320
1321 /* Move allmulti mode config from active -> pending */
1322 if (rxf->rxmode_active & BNA_RXMODE_ALLMULTI) {
1323 allmulti_enable(rxf->rxmode_pending,
1324 rxf->rxmode_pending_bitmask);
1325 rxf->rxmode_active &= ~BNA_RXMODE_ALLMULTI;
1326 if (cleanup == BNA_HARD_CLEANUP) {
1327 bna_bfi_mcast_filter_req(rxf, BNA_STATUS_T_ENABLED);
1328 return 1;
1329 }
1330 }
1331
1332 return 0;
1333 }
1334
1335 static int
1336 bna_rxf_promisc_enable(struct bna_rxf *rxf)
1337 {
1338 struct bna *bna = rxf->rx->bna;
1339 int ret = 0;
1340
1341 if (is_promisc_enable(rxf->rxmode_pending,
1342 rxf->rxmode_pending_bitmask) ||
1343 (rxf->rxmode_active & BNA_RXMODE_PROMISC)) {
1344 /* Do nothing if pending enable or already enabled */
1345 } else if (is_promisc_disable(rxf->rxmode_pending,
1346 rxf->rxmode_pending_bitmask)) {
1347 /* Turn off pending disable command */
1348 promisc_inactive(rxf->rxmode_pending,
1349 rxf->rxmode_pending_bitmask);
1350 } else {
1351 /* Schedule enable */
1352 promisc_enable(rxf->rxmode_pending,
1353 rxf->rxmode_pending_bitmask);
1354 bna->promisc_rid = rxf->rx->rid;
1355 ret = 1;
1356 }
1357
1358 return ret;
1359 }
1360
1361 static int
1362 bna_rxf_promisc_disable(struct bna_rxf *rxf)
1363 {
1364 struct bna *bna = rxf->rx->bna;
1365 int ret = 0;
1366
1367 if (is_promisc_disable(rxf->rxmode_pending,
1368 rxf->rxmode_pending_bitmask) ||
1369 (!(rxf->rxmode_active & BNA_RXMODE_PROMISC))) {
1370 /* Do nothing if pending disable or already disabled */
1371 } else if (is_promisc_enable(rxf->rxmode_pending,
1372 rxf->rxmode_pending_bitmask)) {
1373 /* Turn off pending enable command */
1374 promisc_inactive(rxf->rxmode_pending,
1375 rxf->rxmode_pending_bitmask);
1376 bna->promisc_rid = BFI_INVALID_RID;
1377 } else if (rxf->rxmode_active & BNA_RXMODE_PROMISC) {
1378 /* Schedule disable */
1379 promisc_disable(rxf->rxmode_pending,
1380 rxf->rxmode_pending_bitmask);
1381 ret = 1;
1382 }
1383
1384 return ret;
1385 }
1386
1387 static int
1388 bna_rxf_allmulti_enable(struct bna_rxf *rxf)
1389 {
1390 int ret = 0;
1391
1392 if (is_allmulti_enable(rxf->rxmode_pending,
1393 rxf->rxmode_pending_bitmask) ||
1394 (rxf->rxmode_active & BNA_RXMODE_ALLMULTI)) {
1395 /* Do nothing if pending enable or already enabled */
1396 } else if (is_allmulti_disable(rxf->rxmode_pending,
1397 rxf->rxmode_pending_bitmask)) {
1398 /* Turn off pending disable command */
1399 allmulti_inactive(rxf->rxmode_pending,
1400 rxf->rxmode_pending_bitmask);
1401 } else {
1402 /* Schedule enable */
1403 allmulti_enable(rxf->rxmode_pending,
1404 rxf->rxmode_pending_bitmask);
1405 ret = 1;
1406 }
1407
1408 return ret;
1409 }
1410
1411 static int
1412 bna_rxf_allmulti_disable(struct bna_rxf *rxf)
1413 {
1414 int ret = 0;
1415
1416 if (is_allmulti_disable(rxf->rxmode_pending,
1417 rxf->rxmode_pending_bitmask) ||
1418 (!(rxf->rxmode_active & BNA_RXMODE_ALLMULTI))) {
1419 /* Do nothing if pending disable or already disabled */
1420 } else if (is_allmulti_enable(rxf->rxmode_pending,
1421 rxf->rxmode_pending_bitmask)) {
1422 /* Turn off pending enable command */
1423 allmulti_inactive(rxf->rxmode_pending,
1424 rxf->rxmode_pending_bitmask);
1425 } else if (rxf->rxmode_active & BNA_RXMODE_ALLMULTI) {
1426 /* Schedule disable */
1427 allmulti_disable(rxf->rxmode_pending,
1428 rxf->rxmode_pending_bitmask);
1429 ret = 1;
1430 }
1431
1432 return ret;
1433 }
1434
1435 static int
1436 bna_rxf_vlan_strip_cfg_apply(struct bna_rxf *rxf)
1437 {
1438 if (rxf->vlan_strip_pending) {
1439 rxf->vlan_strip_pending = false;
1440 bna_bfi_vlan_strip_enable(rxf);
1441 return 1;
1442 }
1443
1444 return 0;
1445 }
1446
1447 /* RX */
1448
1449 #define BNA_GET_RXQS(qcfg) (((qcfg)->rxp_type == BNA_RXP_SINGLE) ? \
1450 (qcfg)->num_paths : ((qcfg)->num_paths * 2))
1451
1452 #define SIZE_TO_PAGES(size) (((size) >> PAGE_SHIFT) + ((((size) &\
1453 (PAGE_SIZE - 1)) + (PAGE_SIZE - 1)) >> PAGE_SHIFT))
1454
1455 #define call_rx_stop_cbfn(rx) \
1456 do { \
1457 if ((rx)->stop_cbfn) { \
1458 void (*cbfn)(void *, struct bna_rx *); \
1459 void *cbarg; \
1460 cbfn = (rx)->stop_cbfn; \
1461 cbarg = (rx)->stop_cbarg; \
1462 (rx)->stop_cbfn = NULL; \
1463 (rx)->stop_cbarg = NULL; \
1464 cbfn(cbarg, rx); \
1465 } \
1466 } while (0)
1467
1468 #define call_rx_stall_cbfn(rx) \
1469 do { \
1470 if ((rx)->rx_stall_cbfn) \
1471 (rx)->rx_stall_cbfn((rx)->bna->bnad, (rx)); \
1472 } while (0)
1473
1474 #define bfi_enet_datapath_q_init(bfi_q, bna_qpt) \
1475 do { \
1476 struct bna_dma_addr cur_q_addr = \
1477 *((struct bna_dma_addr *)((bna_qpt)->kv_qpt_ptr)); \
1478 (bfi_q)->pg_tbl.a32.addr_lo = (bna_qpt)->hw_qpt_ptr.lsb; \
1479 (bfi_q)->pg_tbl.a32.addr_hi = (bna_qpt)->hw_qpt_ptr.msb; \
1480 (bfi_q)->first_entry.a32.addr_lo = cur_q_addr.lsb; \
1481 (bfi_q)->first_entry.a32.addr_hi = cur_q_addr.msb; \
1482 (bfi_q)->pages = htons((u16)(bna_qpt)->page_count); \
1483 (bfi_q)->page_sz = htons((u16)(bna_qpt)->page_size);\
1484 } while (0)
1485
1486 static void bna_bfi_rx_enet_start(struct bna_rx *rx);
1487 static void bna_rx_enet_stop(struct bna_rx *rx);
1488 static void bna_rx_mod_cb_rx_stopped(void *arg, struct bna_rx *rx);
1489
1490 bfa_fsm_state_decl(bna_rx, stopped,
1491 struct bna_rx, enum bna_rx_event);
1492 bfa_fsm_state_decl(bna_rx, start_wait,
1493 struct bna_rx, enum bna_rx_event);
1494 bfa_fsm_state_decl(bna_rx, start_stop_wait,
1495 struct bna_rx, enum bna_rx_event);
1496 bfa_fsm_state_decl(bna_rx, rxf_start_wait,
1497 struct bna_rx, enum bna_rx_event);
1498 bfa_fsm_state_decl(bna_rx, started,
1499 struct bna_rx, enum bna_rx_event);
1500 bfa_fsm_state_decl(bna_rx, rxf_stop_wait,
1501 struct bna_rx, enum bna_rx_event);
1502 bfa_fsm_state_decl(bna_rx, stop_wait,
1503 struct bna_rx, enum bna_rx_event);
1504 bfa_fsm_state_decl(bna_rx, cleanup_wait,
1505 struct bna_rx, enum bna_rx_event);
1506 bfa_fsm_state_decl(bna_rx, failed,
1507 struct bna_rx, enum bna_rx_event);
1508 bfa_fsm_state_decl(bna_rx, quiesce_wait,
1509 struct bna_rx, enum bna_rx_event);
1510
1511 static void bna_rx_sm_stopped_entry(struct bna_rx *rx)
1512 {
1513 call_rx_stop_cbfn(rx);
1514 }
1515
1516 static void bna_rx_sm_stopped(struct bna_rx *rx,
1517 enum bna_rx_event event)
1518 {
1519 switch (event) {
1520 case RX_E_START:
1521 bfa_fsm_set_state(rx, bna_rx_sm_start_wait);
1522 break;
1523
1524 case RX_E_STOP:
1525 call_rx_stop_cbfn(rx);
1526 break;
1527
1528 case RX_E_FAIL:
1529 /* no-op */
1530 break;
1531
1532 default:
1533 bfa_sm_fault(event);
1534 break;
1535 }
1536 }
1537
1538 static void bna_rx_sm_start_wait_entry(struct bna_rx *rx)
1539 {
1540 bna_bfi_rx_enet_start(rx);
1541 }
1542
1543 static void
1544 bna_rx_sm_stop_wait_entry(struct bna_rx *rx)
1545 {
1546 }
1547
1548 static void
1549 bna_rx_sm_stop_wait(struct bna_rx *rx, enum bna_rx_event event)
1550 {
1551 switch (event) {
1552 case RX_E_FAIL:
1553 case RX_E_STOPPED:
1554 bfa_fsm_set_state(rx, bna_rx_sm_cleanup_wait);
1555 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
1556 break;
1557
1558 case RX_E_STARTED:
1559 bna_rx_enet_stop(rx);
1560 break;
1561
1562 default:
1563 bfa_sm_fault(event);
1564 break;
1565 }
1566 }
1567
1568 static void bna_rx_sm_start_wait(struct bna_rx *rx,
1569 enum bna_rx_event event)
1570 {
1571 switch (event) {
1572 case RX_E_STOP:
1573 bfa_fsm_set_state(rx, bna_rx_sm_start_stop_wait);
1574 break;
1575
1576 case RX_E_FAIL:
1577 bfa_fsm_set_state(rx, bna_rx_sm_stopped);
1578 break;
1579
1580 case RX_E_STARTED:
1581 bfa_fsm_set_state(rx, bna_rx_sm_rxf_start_wait);
1582 break;
1583
1584 default:
1585 bfa_sm_fault(event);
1586 break;
1587 }
1588 }
1589
1590 static void bna_rx_sm_rxf_start_wait_entry(struct bna_rx *rx)
1591 {
1592 rx->rx_post_cbfn(rx->bna->bnad, rx);
1593 bna_rxf_start(&rx->rxf);
1594 }
1595
1596 static void
1597 bna_rx_sm_rxf_stop_wait_entry(struct bna_rx *rx)
1598 {
1599 }
1600
1601 static void
1602 bna_rx_sm_rxf_stop_wait(struct bna_rx *rx, enum bna_rx_event event)
1603 {
1604 switch (event) {
1605 case RX_E_FAIL:
1606 bfa_fsm_set_state(rx, bna_rx_sm_cleanup_wait);
1607 bna_rxf_fail(&rx->rxf);
1608 call_rx_stall_cbfn(rx);
1609 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
1610 break;
1611
1612 case RX_E_RXF_STARTED:
1613 bna_rxf_stop(&rx->rxf);
1614 break;
1615
1616 case RX_E_RXF_STOPPED:
1617 bfa_fsm_set_state(rx, bna_rx_sm_stop_wait);
1618 call_rx_stall_cbfn(rx);
1619 bna_rx_enet_stop(rx);
1620 break;
1621
1622 default:
1623 bfa_sm_fault(event);
1624 break;
1625 }
1626
1627 }
1628
1629 static void
1630 bna_rx_sm_start_stop_wait_entry(struct bna_rx *rx)
1631 {
1632 }
1633
1634 static void
1635 bna_rx_sm_start_stop_wait(struct bna_rx *rx, enum bna_rx_event event)
1636 {
1637 switch (event) {
1638 case RX_E_FAIL:
1639 case RX_E_STOPPED:
1640 bfa_fsm_set_state(rx, bna_rx_sm_stopped);
1641 break;
1642
1643 case RX_E_STARTED:
1644 bna_rx_enet_stop(rx);
1645 break;
1646
1647 default:
1648 bfa_sm_fault(event);
1649 }
1650 }
1651
1652 static void
1653 bna_rx_sm_started_entry(struct bna_rx *rx)
1654 {
1655 struct bna_rxp *rxp;
1656 struct list_head *qe_rxp;
1657 int is_regular = (rx->type == BNA_RX_T_REGULAR);
1658
1659 /* Start IB */
1660 list_for_each(qe_rxp, &rx->rxp_q) {
1661 rxp = (struct bna_rxp *)qe_rxp;
1662 bna_ib_start(rx->bna, &rxp->cq.ib, is_regular);
1663 }
1664
1665 bna_ethport_cb_rx_started(&rx->bna->ethport);
1666 }
1667
1668 static void
1669 bna_rx_sm_started(struct bna_rx *rx, enum bna_rx_event event)
1670 {
1671 switch (event) {
1672 case RX_E_STOP:
1673 bfa_fsm_set_state(rx, bna_rx_sm_rxf_stop_wait);
1674 bna_ethport_cb_rx_stopped(&rx->bna->ethport);
1675 bna_rxf_stop(&rx->rxf);
1676 break;
1677
1678 case RX_E_FAIL:
1679 bfa_fsm_set_state(rx, bna_rx_sm_failed);
1680 bna_ethport_cb_rx_stopped(&rx->bna->ethport);
1681 bna_rxf_fail(&rx->rxf);
1682 call_rx_stall_cbfn(rx);
1683 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
1684 break;
1685
1686 default:
1687 bfa_sm_fault(event);
1688 break;
1689 }
1690 }
1691
1692 static void bna_rx_sm_rxf_start_wait(struct bna_rx *rx,
1693 enum bna_rx_event event)
1694 {
1695 switch (event) {
1696 case RX_E_STOP:
1697 bfa_fsm_set_state(rx, bna_rx_sm_rxf_stop_wait);
1698 break;
1699
1700 case RX_E_FAIL:
1701 bfa_fsm_set_state(rx, bna_rx_sm_failed);
1702 bna_rxf_fail(&rx->rxf);
1703 call_rx_stall_cbfn(rx);
1704 rx->rx_cleanup_cbfn(rx->bna->bnad, rx);
1705 break;
1706
1707 case RX_E_RXF_STARTED:
1708 bfa_fsm_set_state(rx, bna_rx_sm_started);
1709 break;
1710
1711 default:
1712 bfa_sm_fault(event);
1713 break;
1714 }
1715 }
1716
1717 static void
1718 bna_rx_sm_cleanup_wait_entry(struct bna_rx *rx)
1719 {
1720 }
1721
1722 static void
1723 bna_rx_sm_cleanup_wait(struct bna_rx *rx, enum bna_rx_event event)
1724 {
1725 switch (event) {
1726 case RX_E_FAIL:
1727 case RX_E_RXF_STOPPED:
1728 /* No-op */
1729 break;
1730
1731 case RX_E_CLEANUP_DONE:
1732 bfa_fsm_set_state(rx, bna_rx_sm_stopped);
1733 break;
1734
1735 default:
1736 bfa_sm_fault(event);
1737 break;
1738 }
1739 }
1740
1741 static void
1742 bna_rx_sm_failed_entry(struct bna_rx *rx)
1743 {
1744 }
1745
1746 static void
1747 bna_rx_sm_failed(struct bna_rx *rx, enum bna_rx_event event)
1748 {
1749 switch (event) {
1750 case RX_E_START:
1751 bfa_fsm_set_state(rx, bna_rx_sm_quiesce_wait);
1752 break;
1753
1754 case RX_E_STOP:
1755 bfa_fsm_set_state(rx, bna_rx_sm_cleanup_wait);
1756 break;
1757
1758 case RX_E_FAIL:
1759 case RX_E_RXF_STARTED:
1760 case RX_E_RXF_STOPPED:
1761 /* No-op */
1762 break;
1763
1764 case RX_E_CLEANUP_DONE:
1765 bfa_fsm_set_state(rx, bna_rx_sm_stopped);
1766 break;
1767
1768 default:
1769 bfa_sm_fault(event);
1770 break;
1771 } }
1772
1773 static void
1774 bna_rx_sm_quiesce_wait_entry(struct bna_rx *rx)
1775 {
1776 }
1777
1778 static void
1779 bna_rx_sm_quiesce_wait(struct bna_rx *rx, enum bna_rx_event event)
1780 {
1781 switch (event) {
1782 case RX_E_STOP:
1783 bfa_fsm_set_state(rx, bna_rx_sm_cleanup_wait);
1784 break;
1785
1786 case RX_E_FAIL:
1787 bfa_fsm_set_state(rx, bna_rx_sm_failed);
1788 break;
1789
1790 case RX_E_CLEANUP_DONE:
1791 bfa_fsm_set_state(rx, bna_rx_sm_start_wait);
1792 break;
1793
1794 default:
1795 bfa_sm_fault(event);
1796 break;
1797 }
1798 }
1799
1800 static void
1801 bna_bfi_rx_enet_start(struct bna_rx *rx)
1802 {
1803 struct bfi_enet_rx_cfg_req *cfg_req = &rx->bfi_enet_cmd.cfg_req;
1804 struct bna_rxp *rxp = NULL;
1805 struct bna_rxq *q0 = NULL, *q1 = NULL;
1806 struct list_head *rxp_qe;
1807 int i;
1808
1809 bfi_msgq_mhdr_set(cfg_req->mh, BFI_MC_ENET,
1810 BFI_ENET_H2I_RX_CFG_SET_REQ, 0, rx->rid);
1811 cfg_req->mh.num_entries = htons(
1812 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_rx_cfg_req)));
1813
1814 cfg_req->rx_cfg.frame_size = bna_enet_mtu_get(&rx->bna->enet);
1815 cfg_req->num_queue_sets = rx->num_paths;
1816 for (i = 0, rxp_qe = bfa_q_first(&rx->rxp_q);
1817 i < rx->num_paths;
1818 i++, rxp_qe = bfa_q_next(rxp_qe)) {
1819 rxp = (struct bna_rxp *)rxp_qe;
1820
1821 GET_RXQS(rxp, q0, q1);
1822 switch (rxp->type) {
1823 case BNA_RXP_SLR:
1824 case BNA_RXP_HDS:
1825 /* Small RxQ */
1826 bfi_enet_datapath_q_init(&cfg_req->q_cfg[i].qs.q,
1827 &q1->qpt);
1828 cfg_req->q_cfg[i].qs.rx_buffer_size =
1829 htons((u16)q1->buffer_size);
1830 /* Fall through */
1831
1832 case BNA_RXP_SINGLE:
1833 /* Large/Single RxQ */
1834 bfi_enet_datapath_q_init(&cfg_req->q_cfg[i].ql.q,
1835 &q0->qpt);
1836 if (q0->multi_buffer)
1837 /* multi-buffer is enabled by allocating
1838 * a new rx with new set of resources.
1839 * q0->buffer_size should be initialized to
1840 * fragment size.
1841 */
1842 cfg_req->rx_cfg.multi_buffer =
1843 BNA_STATUS_T_ENABLED;
1844 else
1845 q0->buffer_size =
1846 bna_enet_mtu_get(&rx->bna->enet);
1847 cfg_req->q_cfg[i].ql.rx_buffer_size =
1848 htons((u16)q0->buffer_size);
1849 break;
1850
1851 default:
1852 BUG_ON(1);
1853 }
1854
1855 bfi_enet_datapath_q_init(&cfg_req->q_cfg[i].cq.q,
1856 &rxp->cq.qpt);
1857
1858 cfg_req->q_cfg[i].ib.index_addr.a32.addr_lo =
1859 rxp->cq.ib.ib_seg_host_addr.lsb;
1860 cfg_req->q_cfg[i].ib.index_addr.a32.addr_hi =
1861 rxp->cq.ib.ib_seg_host_addr.msb;
1862 cfg_req->q_cfg[i].ib.intr.msix_index =
1863 htons((u16)rxp->cq.ib.intr_vector);
1864 }
1865
1866 cfg_req->ib_cfg.int_pkt_dma = BNA_STATUS_T_DISABLED;
1867 cfg_req->ib_cfg.int_enabled = BNA_STATUS_T_ENABLED;
1868 cfg_req->ib_cfg.int_pkt_enabled = BNA_STATUS_T_DISABLED;
1869 cfg_req->ib_cfg.continuous_coalescing = BNA_STATUS_T_DISABLED;
1870 cfg_req->ib_cfg.msix = (rxp->cq.ib.intr_type == BNA_INTR_T_MSIX)
1871 ? BNA_STATUS_T_ENABLED :
1872 BNA_STATUS_T_DISABLED;
1873 cfg_req->ib_cfg.coalescing_timeout =
1874 htonl((u32)rxp->cq.ib.coalescing_timeo);
1875 cfg_req->ib_cfg.inter_pkt_timeout =
1876 htonl((u32)rxp->cq.ib.interpkt_timeo);
1877 cfg_req->ib_cfg.inter_pkt_count = (u8)rxp->cq.ib.interpkt_count;
1878
1879 switch (rxp->type) {
1880 case BNA_RXP_SLR:
1881 cfg_req->rx_cfg.rxq_type = BFI_ENET_RXQ_LARGE_SMALL;
1882 break;
1883
1884 case BNA_RXP_HDS:
1885 cfg_req->rx_cfg.rxq_type = BFI_ENET_RXQ_HDS;
1886 cfg_req->rx_cfg.hds.type = rx->hds_cfg.hdr_type;
1887 cfg_req->rx_cfg.hds.force_offset = rx->hds_cfg.forced_offset;
1888 cfg_req->rx_cfg.hds.max_header_size = rx->hds_cfg.forced_offset;
1889 break;
1890
1891 case BNA_RXP_SINGLE:
1892 cfg_req->rx_cfg.rxq_type = BFI_ENET_RXQ_SINGLE;
1893 break;
1894
1895 default:
1896 BUG_ON(1);
1897 }
1898 cfg_req->rx_cfg.strip_vlan = rx->rxf.vlan_strip_status;
1899
1900 bfa_msgq_cmd_set(&rx->msgq_cmd, NULL, NULL,
1901 sizeof(struct bfi_enet_rx_cfg_req), &cfg_req->mh);
1902 bfa_msgq_cmd_post(&rx->bna->msgq, &rx->msgq_cmd);
1903 }
1904
1905 static void
1906 bna_bfi_rx_enet_stop(struct bna_rx *rx)
1907 {
1908 struct bfi_enet_req *req = &rx->bfi_enet_cmd.req;
1909
1910 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
1911 BFI_ENET_H2I_RX_CFG_CLR_REQ, 0, rx->rid);
1912 req->mh.num_entries = htons(
1913 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_req)));
1914 bfa_msgq_cmd_set(&rx->msgq_cmd, NULL, NULL, sizeof(struct bfi_enet_req),
1915 &req->mh);
1916 bfa_msgq_cmd_post(&rx->bna->msgq, &rx->msgq_cmd);
1917 }
1918
1919 static void
1920 bna_rx_enet_stop(struct bna_rx *rx)
1921 {
1922 struct bna_rxp *rxp;
1923 struct list_head *qe_rxp;
1924
1925 /* Stop IB */
1926 list_for_each(qe_rxp, &rx->rxp_q) {
1927 rxp = (struct bna_rxp *)qe_rxp;
1928 bna_ib_stop(rx->bna, &rxp->cq.ib);
1929 }
1930
1931 bna_bfi_rx_enet_stop(rx);
1932 }
1933
1934 static int
1935 bna_rx_res_check(struct bna_rx_mod *rx_mod, struct bna_rx_config *rx_cfg)
1936 {
1937 if ((rx_mod->rx_free_count == 0) ||
1938 (rx_mod->rxp_free_count == 0) ||
1939 (rx_mod->rxq_free_count == 0))
1940 return 0;
1941
1942 if (rx_cfg->rxp_type == BNA_RXP_SINGLE) {
1943 if ((rx_mod->rxp_free_count < rx_cfg->num_paths) ||
1944 (rx_mod->rxq_free_count < rx_cfg->num_paths))
1945 return 0;
1946 } else {
1947 if ((rx_mod->rxp_free_count < rx_cfg->num_paths) ||
1948 (rx_mod->rxq_free_count < (2 * rx_cfg->num_paths)))
1949 return 0;
1950 }
1951
1952 return 1;
1953 }
1954
1955 static struct bna_rxq *
1956 bna_rxq_get(struct bna_rx_mod *rx_mod)
1957 {
1958 struct bna_rxq *rxq = NULL;
1959 struct list_head *qe = NULL;
1960
1961 bfa_q_deq(&rx_mod->rxq_free_q, &qe);
1962 rx_mod->rxq_free_count--;
1963 rxq = (struct bna_rxq *)qe;
1964 bfa_q_qe_init(&rxq->qe);
1965
1966 return rxq;
1967 }
1968
1969 static void
1970 bna_rxq_put(struct bna_rx_mod *rx_mod, struct bna_rxq *rxq)
1971 {
1972 bfa_q_qe_init(&rxq->qe);
1973 list_add_tail(&rxq->qe, &rx_mod->rxq_free_q);
1974 rx_mod->rxq_free_count++;
1975 }
1976
1977 static struct bna_rxp *
1978 bna_rxp_get(struct bna_rx_mod *rx_mod)
1979 {
1980 struct list_head *qe = NULL;
1981 struct bna_rxp *rxp = NULL;
1982
1983 bfa_q_deq(&rx_mod->rxp_free_q, &qe);
1984 rx_mod->rxp_free_count--;
1985 rxp = (struct bna_rxp *)qe;
1986 bfa_q_qe_init(&rxp->qe);
1987
1988 return rxp;
1989 }
1990
1991 static void
1992 bna_rxp_put(struct bna_rx_mod *rx_mod, struct bna_rxp *rxp)
1993 {
1994 bfa_q_qe_init(&rxp->qe);
1995 list_add_tail(&rxp->qe, &rx_mod->rxp_free_q);
1996 rx_mod->rxp_free_count++;
1997 }
1998
1999 static struct bna_rx *
2000 bna_rx_get(struct bna_rx_mod *rx_mod, enum bna_rx_type type)
2001 {
2002 struct list_head *qe = NULL;
2003 struct bna_rx *rx = NULL;
2004
2005 if (type == BNA_RX_T_REGULAR) {
2006 bfa_q_deq(&rx_mod->rx_free_q, &qe);
2007 } else
2008 bfa_q_deq_tail(&rx_mod->rx_free_q, &qe);
2009
2010 rx_mod->rx_free_count--;
2011 rx = (struct bna_rx *)qe;
2012 bfa_q_qe_init(&rx->qe);
2013 list_add_tail(&rx->qe, &rx_mod->rx_active_q);
2014 rx->type = type;
2015
2016 return rx;
2017 }
2018
2019 static void
2020 bna_rx_put(struct bna_rx_mod *rx_mod, struct bna_rx *rx)
2021 {
2022 struct list_head *prev_qe = NULL;
2023 struct list_head *qe;
2024
2025 bfa_q_qe_init(&rx->qe);
2026
2027 list_for_each(qe, &rx_mod->rx_free_q) {
2028 if (((struct bna_rx *)qe)->rid < rx->rid)
2029 prev_qe = qe;
2030 else
2031 break;
2032 }
2033
2034 if (prev_qe == NULL) {
2035 /* This is the first entry */
2036 bfa_q_enq_head(&rx_mod->rx_free_q, &rx->qe);
2037 } else if (bfa_q_next(prev_qe) == &rx_mod->rx_free_q) {
2038 /* This is the last entry */
2039 list_add_tail(&rx->qe, &rx_mod->rx_free_q);
2040 } else {
2041 /* Somewhere in the middle */
2042 bfa_q_next(&rx->qe) = bfa_q_next(prev_qe);
2043 bfa_q_prev(&rx->qe) = prev_qe;
2044 bfa_q_next(prev_qe) = &rx->qe;
2045 bfa_q_prev(bfa_q_next(&rx->qe)) = &rx->qe;
2046 }
2047
2048 rx_mod->rx_free_count++;
2049 }
2050
2051 static void
2052 bna_rxp_add_rxqs(struct bna_rxp *rxp, struct bna_rxq *q0,
2053 struct bna_rxq *q1)
2054 {
2055 switch (rxp->type) {
2056 case BNA_RXP_SINGLE:
2057 rxp->rxq.single.only = q0;
2058 rxp->rxq.single.reserved = NULL;
2059 break;
2060 case BNA_RXP_SLR:
2061 rxp->rxq.slr.large = q0;
2062 rxp->rxq.slr.small = q1;
2063 break;
2064 case BNA_RXP_HDS:
2065 rxp->rxq.hds.data = q0;
2066 rxp->rxq.hds.hdr = q1;
2067 break;
2068 default:
2069 break;
2070 }
2071 }
2072
2073 static void
2074 bna_rxq_qpt_setup(struct bna_rxq *rxq,
2075 struct bna_rxp *rxp,
2076 u32 page_count,
2077 u32 page_size,
2078 struct bna_mem_descr *qpt_mem,
2079 struct bna_mem_descr *swqpt_mem,
2080 struct bna_mem_descr *page_mem)
2081 {
2082 u8 *kva;
2083 u64 dma;
2084 struct bna_dma_addr bna_dma;
2085 int i;
2086
2087 rxq->qpt.hw_qpt_ptr.lsb = qpt_mem->dma.lsb;
2088 rxq->qpt.hw_qpt_ptr.msb = qpt_mem->dma.msb;
2089 rxq->qpt.kv_qpt_ptr = qpt_mem->kva;
2090 rxq->qpt.page_count = page_count;
2091 rxq->qpt.page_size = page_size;
2092
2093 rxq->rcb->sw_qpt = (void **) swqpt_mem->kva;
2094 rxq->rcb->sw_q = page_mem->kva;
2095
2096 kva = page_mem->kva;
2097 BNA_GET_DMA_ADDR(&page_mem->dma, dma);
2098
2099 for (i = 0; i < rxq->qpt.page_count; i++) {
2100 rxq->rcb->sw_qpt[i] = kva;
2101 kva += PAGE_SIZE;
2102
2103 BNA_SET_DMA_ADDR(dma, &bna_dma);
2104 ((struct bna_dma_addr *)rxq->qpt.kv_qpt_ptr)[i].lsb =
2105 bna_dma.lsb;
2106 ((struct bna_dma_addr *)rxq->qpt.kv_qpt_ptr)[i].msb =
2107 bna_dma.msb;
2108 dma += PAGE_SIZE;
2109 }
2110 }
2111
2112 static void
2113 bna_rxp_cqpt_setup(struct bna_rxp *rxp,
2114 u32 page_count,
2115 u32 page_size,
2116 struct bna_mem_descr *qpt_mem,
2117 struct bna_mem_descr *swqpt_mem,
2118 struct bna_mem_descr *page_mem)
2119 {
2120 u8 *kva;
2121 u64 dma;
2122 struct bna_dma_addr bna_dma;
2123 int i;
2124
2125 rxp->cq.qpt.hw_qpt_ptr.lsb = qpt_mem->dma.lsb;
2126 rxp->cq.qpt.hw_qpt_ptr.msb = qpt_mem->dma.msb;
2127 rxp->cq.qpt.kv_qpt_ptr = qpt_mem->kva;
2128 rxp->cq.qpt.page_count = page_count;
2129 rxp->cq.qpt.page_size = page_size;
2130
2131 rxp->cq.ccb->sw_qpt = (void **) swqpt_mem->kva;
2132 rxp->cq.ccb->sw_q = page_mem->kva;
2133
2134 kva = page_mem->kva;
2135 BNA_GET_DMA_ADDR(&page_mem->dma, dma);
2136
2137 for (i = 0; i < rxp->cq.qpt.page_count; i++) {
2138 rxp->cq.ccb->sw_qpt[i] = kva;
2139 kva += PAGE_SIZE;
2140
2141 BNA_SET_DMA_ADDR(dma, &bna_dma);
2142 ((struct bna_dma_addr *)rxp->cq.qpt.kv_qpt_ptr)[i].lsb =
2143 bna_dma.lsb;
2144 ((struct bna_dma_addr *)rxp->cq.qpt.kv_qpt_ptr)[i].msb =
2145 bna_dma.msb;
2146 dma += PAGE_SIZE;
2147 }
2148 }
2149
2150 static void
2151 bna_rx_mod_cb_rx_stopped(void *arg, struct bna_rx *rx)
2152 {
2153 struct bna_rx_mod *rx_mod = (struct bna_rx_mod *)arg;
2154
2155 bfa_wc_down(&rx_mod->rx_stop_wc);
2156 }
2157
2158 static void
2159 bna_rx_mod_cb_rx_stopped_all(void *arg)
2160 {
2161 struct bna_rx_mod *rx_mod = (struct bna_rx_mod *)arg;
2162
2163 if (rx_mod->stop_cbfn)
2164 rx_mod->stop_cbfn(&rx_mod->bna->enet);
2165 rx_mod->stop_cbfn = NULL;
2166 }
2167
2168 static void
2169 bna_rx_start(struct bna_rx *rx)
2170 {
2171 rx->rx_flags |= BNA_RX_F_ENET_STARTED;
2172 if (rx->rx_flags & BNA_RX_F_ENABLED)
2173 bfa_fsm_send_event(rx, RX_E_START);
2174 }
2175
2176 static void
2177 bna_rx_stop(struct bna_rx *rx)
2178 {
2179 rx->rx_flags &= ~BNA_RX_F_ENET_STARTED;
2180 if (rx->fsm == (bfa_fsm_t) bna_rx_sm_stopped)
2181 bna_rx_mod_cb_rx_stopped(&rx->bna->rx_mod, rx);
2182 else {
2183 rx->stop_cbfn = bna_rx_mod_cb_rx_stopped;
2184 rx->stop_cbarg = &rx->bna->rx_mod;
2185 bfa_fsm_send_event(rx, RX_E_STOP);
2186 }
2187 }
2188
2189 static void
2190 bna_rx_fail(struct bna_rx *rx)
2191 {
2192 /* Indicate Enet is not enabled, and failed */
2193 rx->rx_flags &= ~BNA_RX_F_ENET_STARTED;
2194 bfa_fsm_send_event(rx, RX_E_FAIL);
2195 }
2196
2197 void
2198 bna_rx_mod_start(struct bna_rx_mod *rx_mod, enum bna_rx_type type)
2199 {
2200 struct bna_rx *rx;
2201 struct list_head *qe;
2202
2203 rx_mod->flags |= BNA_RX_MOD_F_ENET_STARTED;
2204 if (type == BNA_RX_T_LOOPBACK)
2205 rx_mod->flags |= BNA_RX_MOD_F_ENET_LOOPBACK;
2206
2207 list_for_each(qe, &rx_mod->rx_active_q) {
2208 rx = (struct bna_rx *)qe;
2209 if (rx->type == type)
2210 bna_rx_start(rx);
2211 }
2212 }
2213
2214 void
2215 bna_rx_mod_stop(struct bna_rx_mod *rx_mod, enum bna_rx_type type)
2216 {
2217 struct bna_rx *rx;
2218 struct list_head *qe;
2219
2220 rx_mod->flags &= ~BNA_RX_MOD_F_ENET_STARTED;
2221 rx_mod->flags &= ~BNA_RX_MOD_F_ENET_LOOPBACK;
2222
2223 rx_mod->stop_cbfn = bna_enet_cb_rx_stopped;
2224
2225 bfa_wc_init(&rx_mod->rx_stop_wc, bna_rx_mod_cb_rx_stopped_all, rx_mod);
2226
2227 list_for_each(qe, &rx_mod->rx_active_q) {
2228 rx = (struct bna_rx *)qe;
2229 if (rx->type == type) {
2230 bfa_wc_up(&rx_mod->rx_stop_wc);
2231 bna_rx_stop(rx);
2232 }
2233 }
2234
2235 bfa_wc_wait(&rx_mod->rx_stop_wc);
2236 }
2237
2238 void
2239 bna_rx_mod_fail(struct bna_rx_mod *rx_mod)
2240 {
2241 struct bna_rx *rx;
2242 struct list_head *qe;
2243
2244 rx_mod->flags &= ~BNA_RX_MOD_F_ENET_STARTED;
2245 rx_mod->flags &= ~BNA_RX_MOD_F_ENET_LOOPBACK;
2246
2247 list_for_each(qe, &rx_mod->rx_active_q) {
2248 rx = (struct bna_rx *)qe;
2249 bna_rx_fail(rx);
2250 }
2251 }
2252
2253 void bna_rx_mod_init(struct bna_rx_mod *rx_mod, struct bna *bna,
2254 struct bna_res_info *res_info)
2255 {
2256 int index;
2257 struct bna_rx *rx_ptr;
2258 struct bna_rxp *rxp_ptr;
2259 struct bna_rxq *rxq_ptr;
2260
2261 rx_mod->bna = bna;
2262 rx_mod->flags = 0;
2263
2264 rx_mod->rx = (struct bna_rx *)
2265 res_info[BNA_MOD_RES_MEM_T_RX_ARRAY].res_u.mem_info.mdl[0].kva;
2266 rx_mod->rxp = (struct bna_rxp *)
2267 res_info[BNA_MOD_RES_MEM_T_RXP_ARRAY].res_u.mem_info.mdl[0].kva;
2268 rx_mod->rxq = (struct bna_rxq *)
2269 res_info[BNA_MOD_RES_MEM_T_RXQ_ARRAY].res_u.mem_info.mdl[0].kva;
2270
2271 /* Initialize the queues */
2272 INIT_LIST_HEAD(&rx_mod->rx_free_q);
2273 rx_mod->rx_free_count = 0;
2274 INIT_LIST_HEAD(&rx_mod->rxq_free_q);
2275 rx_mod->rxq_free_count = 0;
2276 INIT_LIST_HEAD(&rx_mod->rxp_free_q);
2277 rx_mod->rxp_free_count = 0;
2278 INIT_LIST_HEAD(&rx_mod->rx_active_q);
2279
2280 /* Build RX queues */
2281 for (index = 0; index < bna->ioceth.attr.num_rxp; index++) {
2282 rx_ptr = &rx_mod->rx[index];
2283
2284 bfa_q_qe_init(&rx_ptr->qe);
2285 INIT_LIST_HEAD(&rx_ptr->rxp_q);
2286 rx_ptr->bna = NULL;
2287 rx_ptr->rid = index;
2288 rx_ptr->stop_cbfn = NULL;
2289 rx_ptr->stop_cbarg = NULL;
2290
2291 list_add_tail(&rx_ptr->qe, &rx_mod->rx_free_q);
2292 rx_mod->rx_free_count++;
2293 }
2294
2295 /* build RX-path queue */
2296 for (index = 0; index < bna->ioceth.attr.num_rxp; index++) {
2297 rxp_ptr = &rx_mod->rxp[index];
2298 bfa_q_qe_init(&rxp_ptr->qe);
2299 list_add_tail(&rxp_ptr->qe, &rx_mod->rxp_free_q);
2300 rx_mod->rxp_free_count++;
2301 }
2302
2303 /* build RXQ queue */
2304 for (index = 0; index < (bna->ioceth.attr.num_rxp * 2); index++) {
2305 rxq_ptr = &rx_mod->rxq[index];
2306 bfa_q_qe_init(&rxq_ptr->qe);
2307 list_add_tail(&rxq_ptr->qe, &rx_mod->rxq_free_q);
2308 rx_mod->rxq_free_count++;
2309 }
2310 }
2311
2312 void
2313 bna_rx_mod_uninit(struct bna_rx_mod *rx_mod)
2314 {
2315 struct list_head *qe;
2316 int i;
2317
2318 i = 0;
2319 list_for_each(qe, &rx_mod->rx_free_q)
2320 i++;
2321
2322 i = 0;
2323 list_for_each(qe, &rx_mod->rxp_free_q)
2324 i++;
2325
2326 i = 0;
2327 list_for_each(qe, &rx_mod->rxq_free_q)
2328 i++;
2329
2330 rx_mod->bna = NULL;
2331 }
2332
2333 void
2334 bna_bfi_rx_enet_start_rsp(struct bna_rx *rx, struct bfi_msgq_mhdr *msghdr)
2335 {
2336 struct bfi_enet_rx_cfg_rsp *cfg_rsp = &rx->bfi_enet_cmd.cfg_rsp;
2337 struct bna_rxp *rxp = NULL;
2338 struct bna_rxq *q0 = NULL, *q1 = NULL;
2339 struct list_head *rxp_qe;
2340 int i;
2341
2342 bfa_msgq_rsp_copy(&rx->bna->msgq, (u8 *)cfg_rsp,
2343 sizeof(struct bfi_enet_rx_cfg_rsp));
2344
2345 rx->hw_id = cfg_rsp->hw_id;
2346
2347 for (i = 0, rxp_qe = bfa_q_first(&rx->rxp_q);
2348 i < rx->num_paths;
2349 i++, rxp_qe = bfa_q_next(rxp_qe)) {
2350 rxp = (struct bna_rxp *)rxp_qe;
2351 GET_RXQS(rxp, q0, q1);
2352
2353 /* Setup doorbells */
2354 rxp->cq.ccb->i_dbell->doorbell_addr =
2355 rx->bna->pcidev.pci_bar_kva
2356 + ntohl(cfg_rsp->q_handles[i].i_dbell);
2357 rxp->hw_id = cfg_rsp->q_handles[i].hw_cqid;
2358 q0->rcb->q_dbell =
2359 rx->bna->pcidev.pci_bar_kva
2360 + ntohl(cfg_rsp->q_handles[i].ql_dbell);
2361 q0->hw_id = cfg_rsp->q_handles[i].hw_lqid;
2362 if (q1) {
2363 q1->rcb->q_dbell =
2364 rx->bna->pcidev.pci_bar_kva
2365 + ntohl(cfg_rsp->q_handles[i].qs_dbell);
2366 q1->hw_id = cfg_rsp->q_handles[i].hw_sqid;
2367 }
2368
2369 /* Initialize producer/consumer indexes */
2370 (*rxp->cq.ccb->hw_producer_index) = 0;
2371 rxp->cq.ccb->producer_index = 0;
2372 q0->rcb->producer_index = q0->rcb->consumer_index = 0;
2373 if (q1)
2374 q1->rcb->producer_index = q1->rcb->consumer_index = 0;
2375 }
2376
2377 bfa_fsm_send_event(rx, RX_E_STARTED);
2378 }
2379
2380 void
2381 bna_bfi_rx_enet_stop_rsp(struct bna_rx *rx, struct bfi_msgq_mhdr *msghdr)
2382 {
2383 bfa_fsm_send_event(rx, RX_E_STOPPED);
2384 }
2385
2386 void
2387 bna_rx_res_req(struct bna_rx_config *q_cfg, struct bna_res_info *res_info)
2388 {
2389 u32 cq_size, hq_size, dq_size;
2390 u32 cpage_count, hpage_count, dpage_count;
2391 struct bna_mem_info *mem_info;
2392 u32 cq_depth;
2393 u32 hq_depth;
2394 u32 dq_depth;
2395
2396 dq_depth = q_cfg->q0_depth;
2397 hq_depth = ((q_cfg->rxp_type == BNA_RXP_SINGLE) ? 0 : q_cfg->q1_depth);
2398 cq_depth = dq_depth + hq_depth;
2399
2400 BNA_TO_POWER_OF_2_HIGH(cq_depth);
2401 cq_size = cq_depth * BFI_CQ_WI_SIZE;
2402 cq_size = ALIGN(cq_size, PAGE_SIZE);
2403 cpage_count = SIZE_TO_PAGES(cq_size);
2404
2405 BNA_TO_POWER_OF_2_HIGH(dq_depth);
2406 dq_size = dq_depth * BFI_RXQ_WI_SIZE;
2407 dq_size = ALIGN(dq_size, PAGE_SIZE);
2408 dpage_count = SIZE_TO_PAGES(dq_size);
2409
2410 if (BNA_RXP_SINGLE != q_cfg->rxp_type) {
2411 BNA_TO_POWER_OF_2_HIGH(hq_depth);
2412 hq_size = hq_depth * BFI_RXQ_WI_SIZE;
2413 hq_size = ALIGN(hq_size, PAGE_SIZE);
2414 hpage_count = SIZE_TO_PAGES(hq_size);
2415 } else
2416 hpage_count = 0;
2417
2418 res_info[BNA_RX_RES_MEM_T_CCB].res_type = BNA_RES_T_MEM;
2419 mem_info = &res_info[BNA_RX_RES_MEM_T_CCB].res_u.mem_info;
2420 mem_info->mem_type = BNA_MEM_T_KVA;
2421 mem_info->len = sizeof(struct bna_ccb);
2422 mem_info->num = q_cfg->num_paths;
2423
2424 res_info[BNA_RX_RES_MEM_T_RCB].res_type = BNA_RES_T_MEM;
2425 mem_info = &res_info[BNA_RX_RES_MEM_T_RCB].res_u.mem_info;
2426 mem_info->mem_type = BNA_MEM_T_KVA;
2427 mem_info->len = sizeof(struct bna_rcb);
2428 mem_info->num = BNA_GET_RXQS(q_cfg);
2429
2430 res_info[BNA_RX_RES_MEM_T_CQPT].res_type = BNA_RES_T_MEM;
2431 mem_info = &res_info[BNA_RX_RES_MEM_T_CQPT].res_u.mem_info;
2432 mem_info->mem_type = BNA_MEM_T_DMA;
2433 mem_info->len = cpage_count * sizeof(struct bna_dma_addr);
2434 mem_info->num = q_cfg->num_paths;
2435
2436 res_info[BNA_RX_RES_MEM_T_CSWQPT].res_type = BNA_RES_T_MEM;
2437 mem_info = &res_info[BNA_RX_RES_MEM_T_CSWQPT].res_u.mem_info;
2438 mem_info->mem_type = BNA_MEM_T_KVA;
2439 mem_info->len = cpage_count * sizeof(void *);
2440 mem_info->num = q_cfg->num_paths;
2441
2442 res_info[BNA_RX_RES_MEM_T_CQPT_PAGE].res_type = BNA_RES_T_MEM;
2443 mem_info = &res_info[BNA_RX_RES_MEM_T_CQPT_PAGE].res_u.mem_info;
2444 mem_info->mem_type = BNA_MEM_T_DMA;
2445 mem_info->len = PAGE_SIZE * cpage_count;
2446 mem_info->num = q_cfg->num_paths;
2447
2448 res_info[BNA_RX_RES_MEM_T_DQPT].res_type = BNA_RES_T_MEM;
2449 mem_info = &res_info[BNA_RX_RES_MEM_T_DQPT].res_u.mem_info;
2450 mem_info->mem_type = BNA_MEM_T_DMA;
2451 mem_info->len = dpage_count * sizeof(struct bna_dma_addr);
2452 mem_info->num = q_cfg->num_paths;
2453
2454 res_info[BNA_RX_RES_MEM_T_DSWQPT].res_type = BNA_RES_T_MEM;
2455 mem_info = &res_info[BNA_RX_RES_MEM_T_DSWQPT].res_u.mem_info;
2456 mem_info->mem_type = BNA_MEM_T_KVA;
2457 mem_info->len = dpage_count * sizeof(void *);
2458 mem_info->num = q_cfg->num_paths;
2459
2460 res_info[BNA_RX_RES_MEM_T_DPAGE].res_type = BNA_RES_T_MEM;
2461 mem_info = &res_info[BNA_RX_RES_MEM_T_DPAGE].res_u.mem_info;
2462 mem_info->mem_type = BNA_MEM_T_DMA;
2463 mem_info->len = PAGE_SIZE * dpage_count;
2464 mem_info->num = q_cfg->num_paths;
2465
2466 res_info[BNA_RX_RES_MEM_T_HQPT].res_type = BNA_RES_T_MEM;
2467 mem_info = &res_info[BNA_RX_RES_MEM_T_HQPT].res_u.mem_info;
2468 mem_info->mem_type = BNA_MEM_T_DMA;
2469 mem_info->len = hpage_count * sizeof(struct bna_dma_addr);
2470 mem_info->num = (hpage_count ? q_cfg->num_paths : 0);
2471
2472 res_info[BNA_RX_RES_MEM_T_HSWQPT].res_type = BNA_RES_T_MEM;
2473 mem_info = &res_info[BNA_RX_RES_MEM_T_HSWQPT].res_u.mem_info;
2474 mem_info->mem_type = BNA_MEM_T_KVA;
2475 mem_info->len = hpage_count * sizeof(void *);
2476 mem_info->num = (hpage_count ? q_cfg->num_paths : 0);
2477
2478 res_info[BNA_RX_RES_MEM_T_HPAGE].res_type = BNA_RES_T_MEM;
2479 mem_info = &res_info[BNA_RX_RES_MEM_T_HPAGE].res_u.mem_info;
2480 mem_info->mem_type = BNA_MEM_T_DMA;
2481 mem_info->len = PAGE_SIZE * hpage_count;
2482 mem_info->num = (hpage_count ? q_cfg->num_paths : 0);
2483
2484 res_info[BNA_RX_RES_MEM_T_IBIDX].res_type = BNA_RES_T_MEM;
2485 mem_info = &res_info[BNA_RX_RES_MEM_T_IBIDX].res_u.mem_info;
2486 mem_info->mem_type = BNA_MEM_T_DMA;
2487 mem_info->len = BFI_IBIDX_SIZE;
2488 mem_info->num = q_cfg->num_paths;
2489
2490 res_info[BNA_RX_RES_MEM_T_RIT].res_type = BNA_RES_T_MEM;
2491 mem_info = &res_info[BNA_RX_RES_MEM_T_RIT].res_u.mem_info;
2492 mem_info->mem_type = BNA_MEM_T_KVA;
2493 mem_info->len = BFI_ENET_RSS_RIT_MAX;
2494 mem_info->num = 1;
2495
2496 res_info[BNA_RX_RES_T_INTR].res_type = BNA_RES_T_INTR;
2497 res_info[BNA_RX_RES_T_INTR].res_u.intr_info.intr_type = BNA_INTR_T_MSIX;
2498 res_info[BNA_RX_RES_T_INTR].res_u.intr_info.num = q_cfg->num_paths;
2499 }
2500
2501 struct bna_rx *
2502 bna_rx_create(struct bna *bna, struct bnad *bnad,
2503 struct bna_rx_config *rx_cfg,
2504 const struct bna_rx_event_cbfn *rx_cbfn,
2505 struct bna_res_info *res_info,
2506 void *priv)
2507 {
2508 struct bna_rx_mod *rx_mod = &bna->rx_mod;
2509 struct bna_rx *rx;
2510 struct bna_rxp *rxp;
2511 struct bna_rxq *q0;
2512 struct bna_rxq *q1;
2513 struct bna_intr_info *intr_info;
2514 struct bna_mem_descr *hqunmap_mem;
2515 struct bna_mem_descr *dqunmap_mem;
2516 struct bna_mem_descr *ccb_mem;
2517 struct bna_mem_descr *rcb_mem;
2518 struct bna_mem_descr *cqpt_mem;
2519 struct bna_mem_descr *cswqpt_mem;
2520 struct bna_mem_descr *cpage_mem;
2521 struct bna_mem_descr *hqpt_mem;
2522 struct bna_mem_descr *dqpt_mem;
2523 struct bna_mem_descr *hsqpt_mem;
2524 struct bna_mem_descr *dsqpt_mem;
2525 struct bna_mem_descr *hpage_mem;
2526 struct bna_mem_descr *dpage_mem;
2527 u32 dpage_count, hpage_count;
2528 u32 hq_idx, dq_idx, rcb_idx;
2529 u32 cq_depth, i;
2530 u32 page_count;
2531
2532 if (!bna_rx_res_check(rx_mod, rx_cfg))
2533 return NULL;
2534
2535 intr_info = &res_info[BNA_RX_RES_T_INTR].res_u.intr_info;
2536 ccb_mem = &res_info[BNA_RX_RES_MEM_T_CCB].res_u.mem_info.mdl[0];
2537 rcb_mem = &res_info[BNA_RX_RES_MEM_T_RCB].res_u.mem_info.mdl[0];
2538 dqunmap_mem = &res_info[BNA_RX_RES_MEM_T_UNMAPDQ].res_u.mem_info.mdl[0];
2539 hqunmap_mem = &res_info[BNA_RX_RES_MEM_T_UNMAPHQ].res_u.mem_info.mdl[0];
2540 cqpt_mem = &res_info[BNA_RX_RES_MEM_T_CQPT].res_u.mem_info.mdl[0];
2541 cswqpt_mem = &res_info[BNA_RX_RES_MEM_T_CSWQPT].res_u.mem_info.mdl[0];
2542 cpage_mem = &res_info[BNA_RX_RES_MEM_T_CQPT_PAGE].res_u.mem_info.mdl[0];
2543 hqpt_mem = &res_info[BNA_RX_RES_MEM_T_HQPT].res_u.mem_info.mdl[0];
2544 dqpt_mem = &res_info[BNA_RX_RES_MEM_T_DQPT].res_u.mem_info.mdl[0];
2545 hsqpt_mem = &res_info[BNA_RX_RES_MEM_T_HSWQPT].res_u.mem_info.mdl[0];
2546 dsqpt_mem = &res_info[BNA_RX_RES_MEM_T_DSWQPT].res_u.mem_info.mdl[0];
2547 hpage_mem = &res_info[BNA_RX_RES_MEM_T_HPAGE].res_u.mem_info.mdl[0];
2548 dpage_mem = &res_info[BNA_RX_RES_MEM_T_DPAGE].res_u.mem_info.mdl[0];
2549
2550 page_count = res_info[BNA_RX_RES_MEM_T_CQPT_PAGE].res_u.mem_info.len /
2551 PAGE_SIZE;
2552
2553 dpage_count = res_info[BNA_RX_RES_MEM_T_DPAGE].res_u.mem_info.len /
2554 PAGE_SIZE;
2555
2556 hpage_count = res_info[BNA_RX_RES_MEM_T_HPAGE].res_u.mem_info.len /
2557 PAGE_SIZE;
2558
2559 rx = bna_rx_get(rx_mod, rx_cfg->rx_type);
2560 rx->bna = bna;
2561 rx->rx_flags = 0;
2562 INIT_LIST_HEAD(&rx->rxp_q);
2563 rx->stop_cbfn = NULL;
2564 rx->stop_cbarg = NULL;
2565 rx->priv = priv;
2566
2567 rx->rcb_setup_cbfn = rx_cbfn->rcb_setup_cbfn;
2568 rx->rcb_destroy_cbfn = rx_cbfn->rcb_destroy_cbfn;
2569 rx->ccb_setup_cbfn = rx_cbfn->ccb_setup_cbfn;
2570 rx->ccb_destroy_cbfn = rx_cbfn->ccb_destroy_cbfn;
2571 rx->rx_stall_cbfn = rx_cbfn->rx_stall_cbfn;
2572 /* Following callbacks are mandatory */
2573 rx->rx_cleanup_cbfn = rx_cbfn->rx_cleanup_cbfn;
2574 rx->rx_post_cbfn = rx_cbfn->rx_post_cbfn;
2575
2576 if (rx->bna->rx_mod.flags & BNA_RX_MOD_F_ENET_STARTED) {
2577 switch (rx->type) {
2578 case BNA_RX_T_REGULAR:
2579 if (!(rx->bna->rx_mod.flags &
2580 BNA_RX_MOD_F_ENET_LOOPBACK))
2581 rx->rx_flags |= BNA_RX_F_ENET_STARTED;
2582 break;
2583 case BNA_RX_T_LOOPBACK:
2584 if (rx->bna->rx_mod.flags & BNA_RX_MOD_F_ENET_LOOPBACK)
2585 rx->rx_flags |= BNA_RX_F_ENET_STARTED;
2586 break;
2587 }
2588 }
2589
2590 rx->num_paths = rx_cfg->num_paths;
2591 for (i = 0, hq_idx = 0, dq_idx = 0, rcb_idx = 0;
2592 i < rx->num_paths; i++) {
2593 rxp = bna_rxp_get(rx_mod);
2594 list_add_tail(&rxp->qe, &rx->rxp_q);
2595 rxp->type = rx_cfg->rxp_type;
2596 rxp->rx = rx;
2597 rxp->cq.rx = rx;
2598
2599 q0 = bna_rxq_get(rx_mod);
2600 if (BNA_RXP_SINGLE == rx_cfg->rxp_type)
2601 q1 = NULL;
2602 else
2603 q1 = bna_rxq_get(rx_mod);
2604
2605 if (1 == intr_info->num)
2606 rxp->vector = intr_info->idl[0].vector;
2607 else
2608 rxp->vector = intr_info->idl[i].vector;
2609
2610 /* Setup IB */
2611
2612 rxp->cq.ib.ib_seg_host_addr.lsb =
2613 res_info[BNA_RX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].dma.lsb;
2614 rxp->cq.ib.ib_seg_host_addr.msb =
2615 res_info[BNA_RX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].dma.msb;
2616 rxp->cq.ib.ib_seg_host_addr_kva =
2617 res_info[BNA_RX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].kva;
2618 rxp->cq.ib.intr_type = intr_info->intr_type;
2619 if (intr_info->intr_type == BNA_INTR_T_MSIX)
2620 rxp->cq.ib.intr_vector = rxp->vector;
2621 else
2622 rxp->cq.ib.intr_vector = (1 << rxp->vector);
2623 rxp->cq.ib.coalescing_timeo = rx_cfg->coalescing_timeo;
2624 rxp->cq.ib.interpkt_count = BFI_RX_INTERPKT_COUNT;
2625 rxp->cq.ib.interpkt_timeo = BFI_RX_INTERPKT_TIMEO;
2626
2627 bna_rxp_add_rxqs(rxp, q0, q1);
2628
2629 /* Setup large Q */
2630
2631 q0->rx = rx;
2632 q0->rxp = rxp;
2633
2634 q0->rcb = (struct bna_rcb *) rcb_mem[rcb_idx].kva;
2635 q0->rcb->unmap_q = (void *)dqunmap_mem[dq_idx].kva;
2636 rcb_idx++; dq_idx++;
2637 q0->rcb->q_depth = rx_cfg->q0_depth;
2638 q0->q_depth = rx_cfg->q0_depth;
2639 q0->multi_buffer = rx_cfg->q0_multi_buf;
2640 q0->buffer_size = rx_cfg->q0_buf_size;
2641 q0->num_vecs = rx_cfg->q0_num_vecs;
2642 q0->rcb->rxq = q0;
2643 q0->rcb->bnad = bna->bnad;
2644 q0->rcb->id = 0;
2645 q0->rx_packets = q0->rx_bytes = 0;
2646 q0->rx_packets_with_error = q0->rxbuf_alloc_failed = 0;
2647
2648 bna_rxq_qpt_setup(q0, rxp, dpage_count, PAGE_SIZE,
2649 &dqpt_mem[i], &dsqpt_mem[i], &dpage_mem[i]);
2650
2651 if (rx->rcb_setup_cbfn)
2652 rx->rcb_setup_cbfn(bnad, q0->rcb);
2653
2654 /* Setup small Q */
2655
2656 if (q1) {
2657 q1->rx = rx;
2658 q1->rxp = rxp;
2659
2660 q1->rcb = (struct bna_rcb *) rcb_mem[rcb_idx].kva;
2661 q1->rcb->unmap_q = (void *)hqunmap_mem[hq_idx].kva;
2662 rcb_idx++; hq_idx++;
2663 q1->rcb->q_depth = rx_cfg->q1_depth;
2664 q1->q_depth = rx_cfg->q1_depth;
2665 q1->multi_buffer = BNA_STATUS_T_DISABLED;
2666 q1->num_vecs = 1;
2667 q1->rcb->rxq = q1;
2668 q1->rcb->bnad = bna->bnad;
2669 q1->rcb->id = 1;
2670 q1->buffer_size = (rx_cfg->rxp_type == BNA_RXP_HDS) ?
2671 rx_cfg->hds_config.forced_offset
2672 : rx_cfg->q1_buf_size;
2673 q1->rx_packets = q1->rx_bytes = 0;
2674 q1->rx_packets_with_error = q1->rxbuf_alloc_failed = 0;
2675
2676 bna_rxq_qpt_setup(q1, rxp, hpage_count, PAGE_SIZE,
2677 &hqpt_mem[i], &hsqpt_mem[i],
2678 &hpage_mem[i]);
2679
2680 if (rx->rcb_setup_cbfn)
2681 rx->rcb_setup_cbfn(bnad, q1->rcb);
2682 }
2683
2684 /* Setup CQ */
2685
2686 rxp->cq.ccb = (struct bna_ccb *) ccb_mem[i].kva;
2687 cq_depth = rx_cfg->q0_depth +
2688 ((rx_cfg->rxp_type == BNA_RXP_SINGLE) ?
2689 0 : rx_cfg->q1_depth);
2690 /* if multi-buffer is enabled sum of q0_depth
2691 * and q1_depth need not be a power of 2
2692 */
2693 BNA_TO_POWER_OF_2_HIGH(cq_depth);
2694 rxp->cq.ccb->q_depth = cq_depth;
2695 rxp->cq.ccb->cq = &rxp->cq;
2696 rxp->cq.ccb->rcb[0] = q0->rcb;
2697 q0->rcb->ccb = rxp->cq.ccb;
2698 if (q1) {
2699 rxp->cq.ccb->rcb[1] = q1->rcb;
2700 q1->rcb->ccb = rxp->cq.ccb;
2701 }
2702 rxp->cq.ccb->hw_producer_index =
2703 (u32 *)rxp->cq.ib.ib_seg_host_addr_kva;
2704 rxp->cq.ccb->i_dbell = &rxp->cq.ib.door_bell;
2705 rxp->cq.ccb->intr_type = rxp->cq.ib.intr_type;
2706 rxp->cq.ccb->intr_vector = rxp->cq.ib.intr_vector;
2707 rxp->cq.ccb->rx_coalescing_timeo =
2708 rxp->cq.ib.coalescing_timeo;
2709 rxp->cq.ccb->pkt_rate.small_pkt_cnt = 0;
2710 rxp->cq.ccb->pkt_rate.large_pkt_cnt = 0;
2711 rxp->cq.ccb->bnad = bna->bnad;
2712 rxp->cq.ccb->id = i;
2713
2714 bna_rxp_cqpt_setup(rxp, page_count, PAGE_SIZE,
2715 &cqpt_mem[i], &cswqpt_mem[i], &cpage_mem[i]);
2716
2717 if (rx->ccb_setup_cbfn)
2718 rx->ccb_setup_cbfn(bnad, rxp->cq.ccb);
2719 }
2720
2721 rx->hds_cfg = rx_cfg->hds_config;
2722
2723 bna_rxf_init(&rx->rxf, rx, rx_cfg, res_info);
2724
2725 bfa_fsm_set_state(rx, bna_rx_sm_stopped);
2726
2727 rx_mod->rid_mask |= (1 << rx->rid);
2728
2729 return rx;
2730 }
2731
2732 void
2733 bna_rx_destroy(struct bna_rx *rx)
2734 {
2735 struct bna_rx_mod *rx_mod = &rx->bna->rx_mod;
2736 struct bna_rxq *q0 = NULL;
2737 struct bna_rxq *q1 = NULL;
2738 struct bna_rxp *rxp;
2739 struct list_head *qe;
2740
2741 bna_rxf_uninit(&rx->rxf);
2742
2743 while (!list_empty(&rx->rxp_q)) {
2744 bfa_q_deq(&rx->rxp_q, &rxp);
2745 GET_RXQS(rxp, q0, q1);
2746 if (rx->rcb_destroy_cbfn)
2747 rx->rcb_destroy_cbfn(rx->bna->bnad, q0->rcb);
2748 q0->rcb = NULL;
2749 q0->rxp = NULL;
2750 q0->rx = NULL;
2751 bna_rxq_put(rx_mod, q0);
2752
2753 if (q1) {
2754 if (rx->rcb_destroy_cbfn)
2755 rx->rcb_destroy_cbfn(rx->bna->bnad, q1->rcb);
2756 q1->rcb = NULL;
2757 q1->rxp = NULL;
2758 q1->rx = NULL;
2759 bna_rxq_put(rx_mod, q1);
2760 }
2761 rxp->rxq.slr.large = NULL;
2762 rxp->rxq.slr.small = NULL;
2763
2764 if (rx->ccb_destroy_cbfn)
2765 rx->ccb_destroy_cbfn(rx->bna->bnad, rxp->cq.ccb);
2766 rxp->cq.ccb = NULL;
2767 rxp->rx = NULL;
2768 bna_rxp_put(rx_mod, rxp);
2769 }
2770
2771 list_for_each(qe, &rx_mod->rx_active_q) {
2772 if (qe == &rx->qe) {
2773 list_del(&rx->qe);
2774 bfa_q_qe_init(&rx->qe);
2775 break;
2776 }
2777 }
2778
2779 rx_mod->rid_mask &= ~(1 << rx->rid);
2780
2781 rx->bna = NULL;
2782 rx->priv = NULL;
2783 bna_rx_put(rx_mod, rx);
2784 }
2785
2786 void
2787 bna_rx_enable(struct bna_rx *rx)
2788 {
2789 if (rx->fsm != (bfa_sm_t)bna_rx_sm_stopped)
2790 return;
2791
2792 rx->rx_flags |= BNA_RX_F_ENABLED;
2793 if (rx->rx_flags & BNA_RX_F_ENET_STARTED)
2794 bfa_fsm_send_event(rx, RX_E_START);
2795 }
2796
2797 void
2798 bna_rx_disable(struct bna_rx *rx, enum bna_cleanup_type type,
2799 void (*cbfn)(void *, struct bna_rx *))
2800 {
2801 if (type == BNA_SOFT_CLEANUP) {
2802 /* h/w should not be accessed. Treat we're stopped */
2803 (*cbfn)(rx->bna->bnad, rx);
2804 } else {
2805 rx->stop_cbfn = cbfn;
2806 rx->stop_cbarg = rx->bna->bnad;
2807
2808 rx->rx_flags &= ~BNA_RX_F_ENABLED;
2809
2810 bfa_fsm_send_event(rx, RX_E_STOP);
2811 }
2812 }
2813
2814 void
2815 bna_rx_cleanup_complete(struct bna_rx *rx)
2816 {
2817 bfa_fsm_send_event(rx, RX_E_CLEANUP_DONE);
2818 }
2819
2820 void
2821 bna_rx_vlan_strip_enable(struct bna_rx *rx)
2822 {
2823 struct bna_rxf *rxf = &rx->rxf;
2824
2825 if (rxf->vlan_strip_status == BNA_STATUS_T_DISABLED) {
2826 rxf->vlan_strip_status = BNA_STATUS_T_ENABLED;
2827 rxf->vlan_strip_pending = true;
2828 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
2829 }
2830 }
2831
2832 void
2833 bna_rx_vlan_strip_disable(struct bna_rx *rx)
2834 {
2835 struct bna_rxf *rxf = &rx->rxf;
2836
2837 if (rxf->vlan_strip_status != BNA_STATUS_T_DISABLED) {
2838 rxf->vlan_strip_status = BNA_STATUS_T_DISABLED;
2839 rxf->vlan_strip_pending = true;
2840 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
2841 }
2842 }
2843
2844 enum bna_cb_status
2845 bna_rx_mode_set(struct bna_rx *rx, enum bna_rxmode new_mode,
2846 enum bna_rxmode bitmask,
2847 void (*cbfn)(struct bnad *, struct bna_rx *))
2848 {
2849 struct bna_rxf *rxf = &rx->rxf;
2850 int need_hw_config = 0;
2851
2852 /* Error checks */
2853
2854 if (is_promisc_enable(new_mode, bitmask)) {
2855 /* If promisc mode is already enabled elsewhere in the system */
2856 if ((rx->bna->promisc_rid != BFI_INVALID_RID) &&
2857 (rx->bna->promisc_rid != rxf->rx->rid))
2858 goto err_return;
2859
2860 /* If default mode is already enabled in the system */
2861 if (rx->bna->default_mode_rid != BFI_INVALID_RID)
2862 goto err_return;
2863
2864 /* Trying to enable promiscuous and default mode together */
2865 if (is_default_enable(new_mode, bitmask))
2866 goto err_return;
2867 }
2868
2869 if (is_default_enable(new_mode, bitmask)) {
2870 /* If default mode is already enabled elsewhere in the system */
2871 if ((rx->bna->default_mode_rid != BFI_INVALID_RID) &&
2872 (rx->bna->default_mode_rid != rxf->rx->rid)) {
2873 goto err_return;
2874 }
2875
2876 /* If promiscuous mode is already enabled in the system */
2877 if (rx->bna->promisc_rid != BFI_INVALID_RID)
2878 goto err_return;
2879 }
2880
2881 /* Process the commands */
2882
2883 if (is_promisc_enable(new_mode, bitmask)) {
2884 if (bna_rxf_promisc_enable(rxf))
2885 need_hw_config = 1;
2886 } else if (is_promisc_disable(new_mode, bitmask)) {
2887 if (bna_rxf_promisc_disable(rxf))
2888 need_hw_config = 1;
2889 }
2890
2891 if (is_allmulti_enable(new_mode, bitmask)) {
2892 if (bna_rxf_allmulti_enable(rxf))
2893 need_hw_config = 1;
2894 } else if (is_allmulti_disable(new_mode, bitmask)) {
2895 if (bna_rxf_allmulti_disable(rxf))
2896 need_hw_config = 1;
2897 }
2898
2899 /* Trigger h/w if needed */
2900
2901 if (need_hw_config) {
2902 rxf->cam_fltr_cbfn = cbfn;
2903 rxf->cam_fltr_cbarg = rx->bna->bnad;
2904 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
2905 } else if (cbfn)
2906 (*cbfn)(rx->bna->bnad, rx);
2907
2908 return BNA_CB_SUCCESS;
2909
2910 err_return:
2911 return BNA_CB_FAIL;
2912 }
2913
2914 void
2915 bna_rx_vlanfilter_enable(struct bna_rx *rx)
2916 {
2917 struct bna_rxf *rxf = &rx->rxf;
2918
2919 if (rxf->vlan_filter_status == BNA_STATUS_T_DISABLED) {
2920 rxf->vlan_filter_status = BNA_STATUS_T_ENABLED;
2921 rxf->vlan_pending_bitmask = (u8)BFI_VLAN_BMASK_ALL;
2922 bfa_fsm_send_event(rxf, RXF_E_CONFIG);
2923 }
2924 }
2925
2926 void
2927 bna_rx_coalescing_timeo_set(struct bna_rx *rx, int coalescing_timeo)
2928 {
2929 struct bna_rxp *rxp;
2930 struct list_head *qe;
2931
2932 list_for_each(qe, &rx->rxp_q) {
2933 rxp = (struct bna_rxp *)qe;
2934 rxp->cq.ccb->rx_coalescing_timeo = coalescing_timeo;
2935 bna_ib_coalescing_timeo_set(&rxp->cq.ib, coalescing_timeo);
2936 }
2937 }
2938
2939 void
2940 bna_rx_dim_reconfig(struct bna *bna, const u32 vector[][BNA_BIAS_T_MAX])
2941 {
2942 int i, j;
2943
2944 for (i = 0; i < BNA_LOAD_T_MAX; i++)
2945 for (j = 0; j < BNA_BIAS_T_MAX; j++)
2946 bna->rx_mod.dim_vector[i][j] = vector[i][j];
2947 }
2948
2949 void
2950 bna_rx_dim_update(struct bna_ccb *ccb)
2951 {
2952 struct bna *bna = ccb->cq->rx->bna;
2953 u32 load, bias;
2954 u32 pkt_rt, small_rt, large_rt;
2955 u8 coalescing_timeo;
2956
2957 if ((ccb->pkt_rate.small_pkt_cnt == 0) &&
2958 (ccb->pkt_rate.large_pkt_cnt == 0))
2959 return;
2960
2961 /* Arrive at preconfigured coalescing timeo value based on pkt rate */
2962
2963 small_rt = ccb->pkt_rate.small_pkt_cnt;
2964 large_rt = ccb->pkt_rate.large_pkt_cnt;
2965
2966 pkt_rt = small_rt + large_rt;
2967
2968 if (pkt_rt < BNA_PKT_RATE_10K)
2969 load = BNA_LOAD_T_LOW_4;
2970 else if (pkt_rt < BNA_PKT_RATE_20K)
2971 load = BNA_LOAD_T_LOW_3;
2972 else if (pkt_rt < BNA_PKT_RATE_30K)
2973 load = BNA_LOAD_T_LOW_2;
2974 else if (pkt_rt < BNA_PKT_RATE_40K)
2975 load = BNA_LOAD_T_LOW_1;
2976 else if (pkt_rt < BNA_PKT_RATE_50K)
2977 load = BNA_LOAD_T_HIGH_1;
2978 else if (pkt_rt < BNA_PKT_RATE_60K)
2979 load = BNA_LOAD_T_HIGH_2;
2980 else if (pkt_rt < BNA_PKT_RATE_80K)
2981 load = BNA_LOAD_T_HIGH_3;
2982 else
2983 load = BNA_LOAD_T_HIGH_4;
2984
2985 if (small_rt > (large_rt << 1))
2986 bias = 0;
2987 else
2988 bias = 1;
2989
2990 ccb->pkt_rate.small_pkt_cnt = 0;
2991 ccb->pkt_rate.large_pkt_cnt = 0;
2992
2993 coalescing_timeo = bna->rx_mod.dim_vector[load][bias];
2994 ccb->rx_coalescing_timeo = coalescing_timeo;
2995
2996 /* Set it to IB */
2997 bna_ib_coalescing_timeo_set(&ccb->cq->ib, coalescing_timeo);
2998 }
2999
3000 const u32 bna_napi_dim_vector[BNA_LOAD_T_MAX][BNA_BIAS_T_MAX] = {
3001 {12, 12},
3002 {6, 10},
3003 {5, 10},
3004 {4, 8},
3005 {3, 6},
3006 {3, 6},
3007 {2, 4},
3008 {1, 2},
3009 };
3010
3011 /* TX */
3012
3013 #define call_tx_stop_cbfn(tx) \
3014 do { \
3015 if ((tx)->stop_cbfn) { \
3016 void (*cbfn)(void *, struct bna_tx *); \
3017 void *cbarg; \
3018 cbfn = (tx)->stop_cbfn; \
3019 cbarg = (tx)->stop_cbarg; \
3020 (tx)->stop_cbfn = NULL; \
3021 (tx)->stop_cbarg = NULL; \
3022 cbfn(cbarg, (tx)); \
3023 } \
3024 } while (0)
3025
3026 #define call_tx_prio_change_cbfn(tx) \
3027 do { \
3028 if ((tx)->prio_change_cbfn) { \
3029 void (*cbfn)(struct bnad *, struct bna_tx *); \
3030 cbfn = (tx)->prio_change_cbfn; \
3031 (tx)->prio_change_cbfn = NULL; \
3032 cbfn((tx)->bna->bnad, (tx)); \
3033 } \
3034 } while (0)
3035
3036 static void bna_tx_mod_cb_tx_stopped(void *tx_mod, struct bna_tx *tx);
3037 static void bna_bfi_tx_enet_start(struct bna_tx *tx);
3038 static void bna_tx_enet_stop(struct bna_tx *tx);
3039
3040 enum bna_tx_event {
3041 TX_E_START = 1,
3042 TX_E_STOP = 2,
3043 TX_E_FAIL = 3,
3044 TX_E_STARTED = 4,
3045 TX_E_STOPPED = 5,
3046 TX_E_PRIO_CHANGE = 6,
3047 TX_E_CLEANUP_DONE = 7,
3048 TX_E_BW_UPDATE = 8,
3049 };
3050
3051 bfa_fsm_state_decl(bna_tx, stopped, struct bna_tx, enum bna_tx_event);
3052 bfa_fsm_state_decl(bna_tx, start_wait, struct bna_tx, enum bna_tx_event);
3053 bfa_fsm_state_decl(bna_tx, started, struct bna_tx, enum bna_tx_event);
3054 bfa_fsm_state_decl(bna_tx, stop_wait, struct bna_tx, enum bna_tx_event);
3055 bfa_fsm_state_decl(bna_tx, cleanup_wait, struct bna_tx,
3056 enum bna_tx_event);
3057 bfa_fsm_state_decl(bna_tx, prio_stop_wait, struct bna_tx,
3058 enum bna_tx_event);
3059 bfa_fsm_state_decl(bna_tx, prio_cleanup_wait, struct bna_tx,
3060 enum bna_tx_event);
3061 bfa_fsm_state_decl(bna_tx, failed, struct bna_tx, enum bna_tx_event);
3062 bfa_fsm_state_decl(bna_tx, quiesce_wait, struct bna_tx,
3063 enum bna_tx_event);
3064
3065 static void
3066 bna_tx_sm_stopped_entry(struct bna_tx *tx)
3067 {
3068 call_tx_stop_cbfn(tx);
3069 }
3070
3071 static void
3072 bna_tx_sm_stopped(struct bna_tx *tx, enum bna_tx_event event)
3073 {
3074 switch (event) {
3075 case TX_E_START:
3076 bfa_fsm_set_state(tx, bna_tx_sm_start_wait);
3077 break;
3078
3079 case TX_E_STOP:
3080 call_tx_stop_cbfn(tx);
3081 break;
3082
3083 case TX_E_FAIL:
3084 /* No-op */
3085 break;
3086
3087 case TX_E_PRIO_CHANGE:
3088 call_tx_prio_change_cbfn(tx);
3089 break;
3090
3091 case TX_E_BW_UPDATE:
3092 /* No-op */
3093 break;
3094
3095 default:
3096 bfa_sm_fault(event);
3097 }
3098 }
3099
3100 static void
3101 bna_tx_sm_start_wait_entry(struct bna_tx *tx)
3102 {
3103 bna_bfi_tx_enet_start(tx);
3104 }
3105
3106 static void
3107 bna_tx_sm_start_wait(struct bna_tx *tx, enum bna_tx_event event)
3108 {
3109 switch (event) {
3110 case TX_E_STOP:
3111 tx->flags &= ~(BNA_TX_F_PRIO_CHANGED | BNA_TX_F_BW_UPDATED);
3112 bfa_fsm_set_state(tx, bna_tx_sm_stop_wait);
3113 break;
3114
3115 case TX_E_FAIL:
3116 tx->flags &= ~(BNA_TX_F_PRIO_CHANGED | BNA_TX_F_BW_UPDATED);
3117 bfa_fsm_set_state(tx, bna_tx_sm_stopped);
3118 break;
3119
3120 case TX_E_STARTED:
3121 if (tx->flags & (BNA_TX_F_PRIO_CHANGED | BNA_TX_F_BW_UPDATED)) {
3122 tx->flags &= ~(BNA_TX_F_PRIO_CHANGED |
3123 BNA_TX_F_BW_UPDATED);
3124 bfa_fsm_set_state(tx, bna_tx_sm_prio_stop_wait);
3125 } else
3126 bfa_fsm_set_state(tx, bna_tx_sm_started);
3127 break;
3128
3129 case TX_E_PRIO_CHANGE:
3130 tx->flags |= BNA_TX_F_PRIO_CHANGED;
3131 break;
3132
3133 case TX_E_BW_UPDATE:
3134 tx->flags |= BNA_TX_F_BW_UPDATED;
3135 break;
3136
3137 default:
3138 bfa_sm_fault(event);
3139 }
3140 }
3141
3142 static void
3143 bna_tx_sm_started_entry(struct bna_tx *tx)
3144 {
3145 struct bna_txq *txq;
3146 struct list_head *qe;
3147 int is_regular = (tx->type == BNA_TX_T_REGULAR);
3148
3149 list_for_each(qe, &tx->txq_q) {
3150 txq = (struct bna_txq *)qe;
3151 txq->tcb->priority = txq->priority;
3152 /* Start IB */
3153 bna_ib_start(tx->bna, &txq->ib, is_regular);
3154 }
3155 tx->tx_resume_cbfn(tx->bna->bnad, tx);
3156 }
3157
3158 static void
3159 bna_tx_sm_started(struct bna_tx *tx, enum bna_tx_event event)
3160 {
3161 switch (event) {
3162 case TX_E_STOP:
3163 bfa_fsm_set_state(tx, bna_tx_sm_stop_wait);
3164 tx->tx_stall_cbfn(tx->bna->bnad, tx);
3165 bna_tx_enet_stop(tx);
3166 break;
3167
3168 case TX_E_FAIL:
3169 bfa_fsm_set_state(tx, bna_tx_sm_failed);
3170 tx->tx_stall_cbfn(tx->bna->bnad, tx);
3171 tx->tx_cleanup_cbfn(tx->bna->bnad, tx);
3172 break;
3173
3174 case TX_E_PRIO_CHANGE:
3175 case TX_E_BW_UPDATE:
3176 bfa_fsm_set_state(tx, bna_tx_sm_prio_stop_wait);
3177 break;
3178
3179 default:
3180 bfa_sm_fault(event);
3181 }
3182 }
3183
3184 static void
3185 bna_tx_sm_stop_wait_entry(struct bna_tx *tx)
3186 {
3187 }
3188
3189 static void
3190 bna_tx_sm_stop_wait(struct bna_tx *tx, enum bna_tx_event event)
3191 {
3192 switch (event) {
3193 case TX_E_FAIL:
3194 case TX_E_STOPPED:
3195 bfa_fsm_set_state(tx, bna_tx_sm_cleanup_wait);
3196 tx->tx_cleanup_cbfn(tx->bna->bnad, tx);
3197 break;
3198
3199 case TX_E_STARTED:
3200 /**
3201 * We are here due to start_wait -> stop_wait transition on
3202 * TX_E_STOP event
3203 */
3204 bna_tx_enet_stop(tx);
3205 break;
3206
3207 case TX_E_PRIO_CHANGE:
3208 case TX_E_BW_UPDATE:
3209 /* No-op */
3210 break;
3211
3212 default:
3213 bfa_sm_fault(event);
3214 }
3215 }
3216
3217 static void
3218 bna_tx_sm_cleanup_wait_entry(struct bna_tx *tx)
3219 {
3220 }
3221
3222 static void
3223 bna_tx_sm_cleanup_wait(struct bna_tx *tx, enum bna_tx_event event)
3224 {
3225 switch (event) {
3226 case TX_E_FAIL:
3227 case TX_E_PRIO_CHANGE:
3228 case TX_E_BW_UPDATE:
3229 /* No-op */
3230 break;
3231
3232 case TX_E_CLEANUP_DONE:
3233 bfa_fsm_set_state(tx, bna_tx_sm_stopped);
3234 break;
3235
3236 default:
3237 bfa_sm_fault(event);
3238 }
3239 }
3240
3241 static void
3242 bna_tx_sm_prio_stop_wait_entry(struct bna_tx *tx)
3243 {
3244 tx->tx_stall_cbfn(tx->bna->bnad, tx);
3245 bna_tx_enet_stop(tx);
3246 }
3247
3248 static void
3249 bna_tx_sm_prio_stop_wait(struct bna_tx *tx, enum bna_tx_event event)
3250 {
3251 switch (event) {
3252 case TX_E_STOP:
3253 bfa_fsm_set_state(tx, bna_tx_sm_stop_wait);
3254 break;
3255
3256 case TX_E_FAIL:
3257 bfa_fsm_set_state(tx, bna_tx_sm_failed);
3258 call_tx_prio_change_cbfn(tx);
3259 tx->tx_cleanup_cbfn(tx->bna->bnad, tx);
3260 break;
3261
3262 case TX_E_STOPPED:
3263 bfa_fsm_set_state(tx, bna_tx_sm_prio_cleanup_wait);
3264 break;
3265
3266 case TX_E_PRIO_CHANGE:
3267 case TX_E_BW_UPDATE:
3268 /* No-op */
3269 break;
3270
3271 default:
3272 bfa_sm_fault(event);
3273 }
3274 }
3275
3276 static void
3277 bna_tx_sm_prio_cleanup_wait_entry(struct bna_tx *tx)
3278 {
3279 call_tx_prio_change_cbfn(tx);
3280 tx->tx_cleanup_cbfn(tx->bna->bnad, tx);
3281 }
3282
3283 static void
3284 bna_tx_sm_prio_cleanup_wait(struct bna_tx *tx, enum bna_tx_event event)
3285 {
3286 switch (event) {
3287 case TX_E_STOP:
3288 bfa_fsm_set_state(tx, bna_tx_sm_cleanup_wait);
3289 break;
3290
3291 case TX_E_FAIL:
3292 bfa_fsm_set_state(tx, bna_tx_sm_failed);
3293 break;
3294
3295 case TX_E_PRIO_CHANGE:
3296 case TX_E_BW_UPDATE:
3297 /* No-op */
3298 break;
3299
3300 case TX_E_CLEANUP_DONE:
3301 bfa_fsm_set_state(tx, bna_tx_sm_start_wait);
3302 break;
3303
3304 default:
3305 bfa_sm_fault(event);
3306 }
3307 }
3308
3309 static void
3310 bna_tx_sm_failed_entry(struct bna_tx *tx)
3311 {
3312 }
3313
3314 static void
3315 bna_tx_sm_failed(struct bna_tx *tx, enum bna_tx_event event)
3316 {
3317 switch (event) {
3318 case TX_E_START:
3319 bfa_fsm_set_state(tx, bna_tx_sm_quiesce_wait);
3320 break;
3321
3322 case TX_E_STOP:
3323 bfa_fsm_set_state(tx, bna_tx_sm_cleanup_wait);
3324 break;
3325
3326 case TX_E_FAIL:
3327 /* No-op */
3328 break;
3329
3330 case TX_E_CLEANUP_DONE:
3331 bfa_fsm_set_state(tx, bna_tx_sm_stopped);
3332 break;
3333
3334 default:
3335 bfa_sm_fault(event);
3336 }
3337 }
3338
3339 static void
3340 bna_tx_sm_quiesce_wait_entry(struct bna_tx *tx)
3341 {
3342 }
3343
3344 static void
3345 bna_tx_sm_quiesce_wait(struct bna_tx *tx, enum bna_tx_event event)
3346 {
3347 switch (event) {
3348 case TX_E_STOP:
3349 bfa_fsm_set_state(tx, bna_tx_sm_cleanup_wait);
3350 break;
3351
3352 case TX_E_FAIL:
3353 bfa_fsm_set_state(tx, bna_tx_sm_failed);
3354 break;
3355
3356 case TX_E_CLEANUP_DONE:
3357 bfa_fsm_set_state(tx, bna_tx_sm_start_wait);
3358 break;
3359
3360 case TX_E_BW_UPDATE:
3361 /* No-op */
3362 break;
3363
3364 default:
3365 bfa_sm_fault(event);
3366 }
3367 }
3368
3369 static void
3370 bna_bfi_tx_enet_start(struct bna_tx *tx)
3371 {
3372 struct bfi_enet_tx_cfg_req *cfg_req = &tx->bfi_enet_cmd.cfg_req;
3373 struct bna_txq *txq = NULL;
3374 struct list_head *qe;
3375 int i;
3376
3377 bfi_msgq_mhdr_set(cfg_req->mh, BFI_MC_ENET,
3378 BFI_ENET_H2I_TX_CFG_SET_REQ, 0, tx->rid);
3379 cfg_req->mh.num_entries = htons(
3380 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_tx_cfg_req)));
3381
3382 cfg_req->num_queues = tx->num_txq;
3383 for (i = 0, qe = bfa_q_first(&tx->txq_q);
3384 i < tx->num_txq;
3385 i++, qe = bfa_q_next(qe)) {
3386 txq = (struct bna_txq *)qe;
3387
3388 bfi_enet_datapath_q_init(&cfg_req->q_cfg[i].q.q, &txq->qpt);
3389 cfg_req->q_cfg[i].q.priority = txq->priority;
3390
3391 cfg_req->q_cfg[i].ib.index_addr.a32.addr_lo =
3392 txq->ib.ib_seg_host_addr.lsb;
3393 cfg_req->q_cfg[i].ib.index_addr.a32.addr_hi =
3394 txq->ib.ib_seg_host_addr.msb;
3395 cfg_req->q_cfg[i].ib.intr.msix_index =
3396 htons((u16)txq->ib.intr_vector);
3397 }
3398
3399 cfg_req->ib_cfg.int_pkt_dma = BNA_STATUS_T_ENABLED;
3400 cfg_req->ib_cfg.int_enabled = BNA_STATUS_T_ENABLED;
3401 cfg_req->ib_cfg.int_pkt_enabled = BNA_STATUS_T_DISABLED;
3402 cfg_req->ib_cfg.continuous_coalescing = BNA_STATUS_T_ENABLED;
3403 cfg_req->ib_cfg.msix = (txq->ib.intr_type == BNA_INTR_T_MSIX)
3404 ? BNA_STATUS_T_ENABLED : BNA_STATUS_T_DISABLED;
3405 cfg_req->ib_cfg.coalescing_timeout =
3406 htonl((u32)txq->ib.coalescing_timeo);
3407 cfg_req->ib_cfg.inter_pkt_timeout =
3408 htonl((u32)txq->ib.interpkt_timeo);
3409 cfg_req->ib_cfg.inter_pkt_count = (u8)txq->ib.interpkt_count;
3410
3411 cfg_req->tx_cfg.vlan_mode = BFI_ENET_TX_VLAN_WI;
3412 cfg_req->tx_cfg.vlan_id = htons((u16)tx->txf_vlan_id);
3413 cfg_req->tx_cfg.admit_tagged_frame = BNA_STATUS_T_DISABLED;
3414 cfg_req->tx_cfg.apply_vlan_filter = BNA_STATUS_T_DISABLED;
3415
3416 bfa_msgq_cmd_set(&tx->msgq_cmd, NULL, NULL,
3417 sizeof(struct bfi_enet_tx_cfg_req), &cfg_req->mh);
3418 bfa_msgq_cmd_post(&tx->bna->msgq, &tx->msgq_cmd);
3419 }
3420
3421 static void
3422 bna_bfi_tx_enet_stop(struct bna_tx *tx)
3423 {
3424 struct bfi_enet_req *req = &tx->bfi_enet_cmd.req;
3425
3426 bfi_msgq_mhdr_set(req->mh, BFI_MC_ENET,
3427 BFI_ENET_H2I_TX_CFG_CLR_REQ, 0, tx->rid);
3428 req->mh.num_entries = htons(
3429 bfi_msgq_num_cmd_entries(sizeof(struct bfi_enet_req)));
3430 bfa_msgq_cmd_set(&tx->msgq_cmd, NULL, NULL, sizeof(struct bfi_enet_req),
3431 &req->mh);
3432 bfa_msgq_cmd_post(&tx->bna->msgq, &tx->msgq_cmd);
3433 }
3434
3435 static void
3436 bna_tx_enet_stop(struct bna_tx *tx)
3437 {
3438 struct bna_txq *txq;
3439 struct list_head *qe;
3440
3441 /* Stop IB */
3442 list_for_each(qe, &tx->txq_q) {
3443 txq = (struct bna_txq *)qe;
3444 bna_ib_stop(tx->bna, &txq->ib);
3445 }
3446
3447 bna_bfi_tx_enet_stop(tx);
3448 }
3449
3450 static void
3451 bna_txq_qpt_setup(struct bna_txq *txq, int page_count, int page_size,
3452 struct bna_mem_descr *qpt_mem,
3453 struct bna_mem_descr *swqpt_mem,
3454 struct bna_mem_descr *page_mem)
3455 {
3456 u8 *kva;
3457 u64 dma;
3458 struct bna_dma_addr bna_dma;
3459 int i;
3460
3461 txq->qpt.hw_qpt_ptr.lsb = qpt_mem->dma.lsb;
3462 txq->qpt.hw_qpt_ptr.msb = qpt_mem->dma.msb;
3463 txq->qpt.kv_qpt_ptr = qpt_mem->kva;
3464 txq->qpt.page_count = page_count;
3465 txq->qpt.page_size = page_size;
3466
3467 txq->tcb->sw_qpt = (void **) swqpt_mem->kva;
3468 txq->tcb->sw_q = page_mem->kva;
3469
3470 kva = page_mem->kva;
3471 BNA_GET_DMA_ADDR(&page_mem->dma, dma);
3472
3473 for (i = 0; i < page_count; i++) {
3474 txq->tcb->sw_qpt[i] = kva;
3475 kva += PAGE_SIZE;
3476
3477 BNA_SET_DMA_ADDR(dma, &bna_dma);
3478 ((struct bna_dma_addr *)txq->qpt.kv_qpt_ptr)[i].lsb =
3479 bna_dma.lsb;
3480 ((struct bna_dma_addr *)txq->qpt.kv_qpt_ptr)[i].msb =
3481 bna_dma.msb;
3482 dma += PAGE_SIZE;
3483 }
3484 }
3485
3486 static struct bna_tx *
3487 bna_tx_get(struct bna_tx_mod *tx_mod, enum bna_tx_type type)
3488 {
3489 struct list_head *qe = NULL;
3490 struct bna_tx *tx = NULL;
3491
3492 if (list_empty(&tx_mod->tx_free_q))
3493 return NULL;
3494 if (type == BNA_TX_T_REGULAR) {
3495 bfa_q_deq(&tx_mod->tx_free_q, &qe);
3496 } else {
3497 bfa_q_deq_tail(&tx_mod->tx_free_q, &qe);
3498 }
3499 tx = (struct bna_tx *)qe;
3500 bfa_q_qe_init(&tx->qe);
3501 tx->type = type;
3502
3503 return tx;
3504 }
3505
3506 static void
3507 bna_tx_free(struct bna_tx *tx)
3508 {
3509 struct bna_tx_mod *tx_mod = &tx->bna->tx_mod;
3510 struct bna_txq *txq;
3511 struct list_head *prev_qe;
3512 struct list_head *qe;
3513
3514 while (!list_empty(&tx->txq_q)) {
3515 bfa_q_deq(&tx->txq_q, &txq);
3516 bfa_q_qe_init(&txq->qe);
3517 txq->tcb = NULL;
3518 txq->tx = NULL;
3519 list_add_tail(&txq->qe, &tx_mod->txq_free_q);
3520 }
3521
3522 list_for_each(qe, &tx_mod->tx_active_q) {
3523 if (qe == &tx->qe) {
3524 list_del(&tx->qe);
3525 bfa_q_qe_init(&tx->qe);
3526 break;
3527 }
3528 }
3529
3530 tx->bna = NULL;
3531 tx->priv = NULL;
3532
3533 prev_qe = NULL;
3534 list_for_each(qe, &tx_mod->tx_free_q) {
3535 if (((struct bna_tx *)qe)->rid < tx->rid)
3536 prev_qe = qe;
3537 else {
3538 break;
3539 }
3540 }
3541
3542 if (prev_qe == NULL) {
3543 /* This is the first entry */
3544 bfa_q_enq_head(&tx_mod->tx_free_q, &tx->qe);
3545 } else if (bfa_q_next(prev_qe) == &tx_mod->tx_free_q) {
3546 /* This is the last entry */
3547 list_add_tail(&tx->qe, &tx_mod->tx_free_q);
3548 } else {
3549 /* Somewhere in the middle */
3550 bfa_q_next(&tx->qe) = bfa_q_next(prev_qe);
3551 bfa_q_prev(&tx->qe) = prev_qe;
3552 bfa_q_next(prev_qe) = &tx->qe;
3553 bfa_q_prev(bfa_q_next(&tx->qe)) = &tx->qe;
3554 }
3555 }
3556
3557 static void
3558 bna_tx_start(struct bna_tx *tx)
3559 {
3560 tx->flags |= BNA_TX_F_ENET_STARTED;
3561 if (tx->flags & BNA_TX_F_ENABLED)
3562 bfa_fsm_send_event(tx, TX_E_START);
3563 }
3564
3565 static void
3566 bna_tx_stop(struct bna_tx *tx)
3567 {
3568 tx->stop_cbfn = bna_tx_mod_cb_tx_stopped;
3569 tx->stop_cbarg = &tx->bna->tx_mod;
3570
3571 tx->flags &= ~BNA_TX_F_ENET_STARTED;
3572 bfa_fsm_send_event(tx, TX_E_STOP);
3573 }
3574
3575 static void
3576 bna_tx_fail(struct bna_tx *tx)
3577 {
3578 tx->flags &= ~BNA_TX_F_ENET_STARTED;
3579 bfa_fsm_send_event(tx, TX_E_FAIL);
3580 }
3581
3582 void
3583 bna_bfi_tx_enet_start_rsp(struct bna_tx *tx, struct bfi_msgq_mhdr *msghdr)
3584 {
3585 struct bfi_enet_tx_cfg_rsp *cfg_rsp = &tx->bfi_enet_cmd.cfg_rsp;
3586 struct bna_txq *txq = NULL;
3587 struct list_head *qe;
3588 int i;
3589
3590 bfa_msgq_rsp_copy(&tx->bna->msgq, (u8 *)cfg_rsp,
3591 sizeof(struct bfi_enet_tx_cfg_rsp));
3592
3593 tx->hw_id = cfg_rsp->hw_id;
3594
3595 for (i = 0, qe = bfa_q_first(&tx->txq_q);
3596 i < tx->num_txq; i++, qe = bfa_q_next(qe)) {
3597 txq = (struct bna_txq *)qe;
3598
3599 /* Setup doorbells */
3600 txq->tcb->i_dbell->doorbell_addr =
3601 tx->bna->pcidev.pci_bar_kva
3602 + ntohl(cfg_rsp->q_handles[i].i_dbell);
3603 txq->tcb->q_dbell =
3604 tx->bna->pcidev.pci_bar_kva
3605 + ntohl(cfg_rsp->q_handles[i].q_dbell);
3606 txq->hw_id = cfg_rsp->q_handles[i].hw_qid;
3607
3608 /* Initialize producer/consumer indexes */
3609 (*txq->tcb->hw_consumer_index) = 0;
3610 txq->tcb->producer_index = txq->tcb->consumer_index = 0;
3611 }
3612
3613 bfa_fsm_send_event(tx, TX_E_STARTED);
3614 }
3615
3616 void
3617 bna_bfi_tx_enet_stop_rsp(struct bna_tx *tx, struct bfi_msgq_mhdr *msghdr)
3618 {
3619 bfa_fsm_send_event(tx, TX_E_STOPPED);
3620 }
3621
3622 void
3623 bna_bfi_bw_update_aen(struct bna_tx_mod *tx_mod)
3624 {
3625 struct bna_tx *tx;
3626 struct list_head *qe;
3627
3628 list_for_each(qe, &tx_mod->tx_active_q) {
3629 tx = (struct bna_tx *)qe;
3630 bfa_fsm_send_event(tx, TX_E_BW_UPDATE);
3631 }
3632 }
3633
3634 void
3635 bna_tx_res_req(int num_txq, int txq_depth, struct bna_res_info *res_info)
3636 {
3637 u32 q_size;
3638 u32 page_count;
3639 struct bna_mem_info *mem_info;
3640
3641 res_info[BNA_TX_RES_MEM_T_TCB].res_type = BNA_RES_T_MEM;
3642 mem_info = &res_info[BNA_TX_RES_MEM_T_TCB].res_u.mem_info;
3643 mem_info->mem_type = BNA_MEM_T_KVA;
3644 mem_info->len = sizeof(struct bna_tcb);
3645 mem_info->num = num_txq;
3646
3647 q_size = txq_depth * BFI_TXQ_WI_SIZE;
3648 q_size = ALIGN(q_size, PAGE_SIZE);
3649 page_count = q_size >> PAGE_SHIFT;
3650
3651 res_info[BNA_TX_RES_MEM_T_QPT].res_type = BNA_RES_T_MEM;
3652 mem_info = &res_info[BNA_TX_RES_MEM_T_QPT].res_u.mem_info;
3653 mem_info->mem_type = BNA_MEM_T_DMA;
3654 mem_info->len = page_count * sizeof(struct bna_dma_addr);
3655 mem_info->num = num_txq;
3656
3657 res_info[BNA_TX_RES_MEM_T_SWQPT].res_type = BNA_RES_T_MEM;
3658 mem_info = &res_info[BNA_TX_RES_MEM_T_SWQPT].res_u.mem_info;
3659 mem_info->mem_type = BNA_MEM_T_KVA;
3660 mem_info->len = page_count * sizeof(void *);
3661 mem_info->num = num_txq;
3662
3663 res_info[BNA_TX_RES_MEM_T_PAGE].res_type = BNA_RES_T_MEM;
3664 mem_info = &res_info[BNA_TX_RES_MEM_T_PAGE].res_u.mem_info;
3665 mem_info->mem_type = BNA_MEM_T_DMA;
3666 mem_info->len = PAGE_SIZE * page_count;
3667 mem_info->num = num_txq;
3668
3669 res_info[BNA_TX_RES_MEM_T_IBIDX].res_type = BNA_RES_T_MEM;
3670 mem_info = &res_info[BNA_TX_RES_MEM_T_IBIDX].res_u.mem_info;
3671 mem_info->mem_type = BNA_MEM_T_DMA;
3672 mem_info->len = BFI_IBIDX_SIZE;
3673 mem_info->num = num_txq;
3674
3675 res_info[BNA_TX_RES_INTR_T_TXCMPL].res_type = BNA_RES_T_INTR;
3676 res_info[BNA_TX_RES_INTR_T_TXCMPL].res_u.intr_info.intr_type =
3677 BNA_INTR_T_MSIX;
3678 res_info[BNA_TX_RES_INTR_T_TXCMPL].res_u.intr_info.num = num_txq;
3679 }
3680
3681 struct bna_tx *
3682 bna_tx_create(struct bna *bna, struct bnad *bnad,
3683 struct bna_tx_config *tx_cfg,
3684 const struct bna_tx_event_cbfn *tx_cbfn,
3685 struct bna_res_info *res_info, void *priv)
3686 {
3687 struct bna_intr_info *intr_info;
3688 struct bna_tx_mod *tx_mod = &bna->tx_mod;
3689 struct bna_tx *tx;
3690 struct bna_txq *txq;
3691 struct list_head *qe;
3692 int page_count;
3693 int i;
3694
3695 intr_info = &res_info[BNA_TX_RES_INTR_T_TXCMPL].res_u.intr_info;
3696 page_count = (res_info[BNA_TX_RES_MEM_T_PAGE].res_u.mem_info.len) /
3697 PAGE_SIZE;
3698
3699 /**
3700 * Get resources
3701 */
3702
3703 if ((intr_info->num != 1) && (intr_info->num != tx_cfg->num_txq))
3704 return NULL;
3705
3706 /* Tx */
3707
3708 tx = bna_tx_get(tx_mod, tx_cfg->tx_type);
3709 if (!tx)
3710 return NULL;
3711 tx->bna = bna;
3712 tx->priv = priv;
3713
3714 /* TxQs */
3715
3716 INIT_LIST_HEAD(&tx->txq_q);
3717 for (i = 0; i < tx_cfg->num_txq; i++) {
3718 if (list_empty(&tx_mod->txq_free_q))
3719 goto err_return;
3720
3721 bfa_q_deq(&tx_mod->txq_free_q, &txq);
3722 bfa_q_qe_init(&txq->qe);
3723 list_add_tail(&txq->qe, &tx->txq_q);
3724 txq->tx = tx;
3725 }
3726
3727 /*
3728 * Initialize
3729 */
3730
3731 /* Tx */
3732
3733 tx->tcb_setup_cbfn = tx_cbfn->tcb_setup_cbfn;
3734 tx->tcb_destroy_cbfn = tx_cbfn->tcb_destroy_cbfn;
3735 /* Following callbacks are mandatory */
3736 tx->tx_stall_cbfn = tx_cbfn->tx_stall_cbfn;
3737 tx->tx_resume_cbfn = tx_cbfn->tx_resume_cbfn;
3738 tx->tx_cleanup_cbfn = tx_cbfn->tx_cleanup_cbfn;
3739
3740 list_add_tail(&tx->qe, &tx_mod->tx_active_q);
3741
3742 tx->num_txq = tx_cfg->num_txq;
3743
3744 tx->flags = 0;
3745 if (tx->bna->tx_mod.flags & BNA_TX_MOD_F_ENET_STARTED) {
3746 switch (tx->type) {
3747 case BNA_TX_T_REGULAR:
3748 if (!(tx->bna->tx_mod.flags &
3749 BNA_TX_MOD_F_ENET_LOOPBACK))
3750 tx->flags |= BNA_TX_F_ENET_STARTED;
3751 break;
3752 case BNA_TX_T_LOOPBACK:
3753 if (tx->bna->tx_mod.flags & BNA_TX_MOD_F_ENET_LOOPBACK)
3754 tx->flags |= BNA_TX_F_ENET_STARTED;
3755 break;
3756 }
3757 }
3758
3759 /* TxQ */
3760
3761 i = 0;
3762 list_for_each(qe, &tx->txq_q) {
3763 txq = (struct bna_txq *)qe;
3764 txq->tcb = (struct bna_tcb *)
3765 res_info[BNA_TX_RES_MEM_T_TCB].res_u.mem_info.mdl[i].kva;
3766 txq->tx_packets = 0;
3767 txq->tx_bytes = 0;
3768
3769 /* IB */
3770 txq->ib.ib_seg_host_addr.lsb =
3771 res_info[BNA_TX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].dma.lsb;
3772 txq->ib.ib_seg_host_addr.msb =
3773 res_info[BNA_TX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].dma.msb;
3774 txq->ib.ib_seg_host_addr_kva =
3775 res_info[BNA_TX_RES_MEM_T_IBIDX].res_u.mem_info.mdl[i].kva;
3776 txq->ib.intr_type = intr_info->intr_type;
3777 txq->ib.intr_vector = (intr_info->num == 1) ?
3778 intr_info->idl[0].vector :
3779 intr_info->idl[i].vector;
3780 if (intr_info->intr_type == BNA_INTR_T_INTX)
3781 txq->ib.intr_vector = (1 << txq->ib.intr_vector);
3782 txq->ib.coalescing_timeo = tx_cfg->coalescing_timeo;
3783 txq->ib.interpkt_timeo = BFI_TX_INTERPKT_TIMEO;
3784 txq->ib.interpkt_count = BFI_TX_INTERPKT_COUNT;
3785
3786 /* TCB */
3787
3788 txq->tcb->q_depth = tx_cfg->txq_depth;
3789 txq->tcb->unmap_q = (void *)
3790 res_info[BNA_TX_RES_MEM_T_UNMAPQ].res_u.mem_info.mdl[i].kva;
3791 txq->tcb->hw_consumer_index =
3792 (u32 *)txq->ib.ib_seg_host_addr_kva;
3793 txq->tcb->i_dbell = &txq->ib.door_bell;
3794 txq->tcb->intr_type = txq->ib.intr_type;
3795 txq->tcb->intr_vector = txq->ib.intr_vector;
3796 txq->tcb->txq = txq;
3797 txq->tcb->bnad = bnad;
3798 txq->tcb->id = i;
3799
3800 /* QPT, SWQPT, Pages */
3801 bna_txq_qpt_setup(txq, page_count, PAGE_SIZE,
3802 &res_info[BNA_TX_RES_MEM_T_QPT].res_u.mem_info.mdl[i],
3803 &res_info[BNA_TX_RES_MEM_T_SWQPT].res_u.mem_info.mdl[i],
3804 &res_info[BNA_TX_RES_MEM_T_PAGE].
3805 res_u.mem_info.mdl[i]);
3806
3807 /* Callback to bnad for setting up TCB */
3808 if (tx->tcb_setup_cbfn)
3809 (tx->tcb_setup_cbfn)(bna->bnad, txq->tcb);
3810
3811 if (tx_cfg->num_txq == BFI_TX_MAX_PRIO)
3812 txq->priority = txq->tcb->id;
3813 else
3814 txq->priority = tx_mod->default_prio;
3815
3816 i++;
3817 }
3818
3819 tx->txf_vlan_id = 0;
3820
3821 bfa_fsm_set_state(tx, bna_tx_sm_stopped);
3822
3823 tx_mod->rid_mask |= (1 << tx->rid);
3824
3825 return tx;
3826
3827 err_return:
3828 bna_tx_free(tx);
3829 return NULL;
3830 }
3831
3832 void
3833 bna_tx_destroy(struct bna_tx *tx)
3834 {
3835 struct bna_txq *txq;
3836 struct list_head *qe;
3837
3838 list_for_each(qe, &tx->txq_q) {
3839 txq = (struct bna_txq *)qe;
3840 if (tx->tcb_destroy_cbfn)
3841 (tx->tcb_destroy_cbfn)(tx->bna->bnad, txq->tcb);
3842 }
3843
3844 tx->bna->tx_mod.rid_mask &= ~(1 << tx->rid);
3845 bna_tx_free(tx);
3846 }
3847
3848 void
3849 bna_tx_enable(struct bna_tx *tx)
3850 {
3851 if (tx->fsm != (bfa_sm_t)bna_tx_sm_stopped)
3852 return;
3853
3854 tx->flags |= BNA_TX_F_ENABLED;
3855
3856 if (tx->flags & BNA_TX_F_ENET_STARTED)
3857 bfa_fsm_send_event(tx, TX_E_START);
3858 }
3859
3860 void
3861 bna_tx_disable(struct bna_tx *tx, enum bna_cleanup_type type,
3862 void (*cbfn)(void *, struct bna_tx *))
3863 {
3864 if (type == BNA_SOFT_CLEANUP) {
3865 (*cbfn)(tx->bna->bnad, tx);
3866 return;
3867 }
3868
3869 tx->stop_cbfn = cbfn;
3870 tx->stop_cbarg = tx->bna->bnad;
3871
3872 tx->flags &= ~BNA_TX_F_ENABLED;
3873
3874 bfa_fsm_send_event(tx, TX_E_STOP);
3875 }
3876
3877 void
3878 bna_tx_cleanup_complete(struct bna_tx *tx)
3879 {
3880 bfa_fsm_send_event(tx, TX_E_CLEANUP_DONE);
3881 }
3882
3883 static void
3884 bna_tx_mod_cb_tx_stopped(void *arg, struct bna_tx *tx)
3885 {
3886 struct bna_tx_mod *tx_mod = (struct bna_tx_mod *)arg;
3887
3888 bfa_wc_down(&tx_mod->tx_stop_wc);
3889 }
3890
3891 static void
3892 bna_tx_mod_cb_tx_stopped_all(void *arg)
3893 {
3894 struct bna_tx_mod *tx_mod = (struct bna_tx_mod *)arg;
3895
3896 if (tx_mod->stop_cbfn)
3897 tx_mod->stop_cbfn(&tx_mod->bna->enet);
3898 tx_mod->stop_cbfn = NULL;
3899 }
3900
3901 void
3902 bna_tx_mod_init(struct bna_tx_mod *tx_mod, struct bna *bna,
3903 struct bna_res_info *res_info)
3904 {
3905 int i;
3906
3907 tx_mod->bna = bna;
3908 tx_mod->flags = 0;
3909
3910 tx_mod->tx = (struct bna_tx *)
3911 res_info[BNA_MOD_RES_MEM_T_TX_ARRAY].res_u.mem_info.mdl[0].kva;
3912 tx_mod->txq = (struct bna_txq *)
3913 res_info[BNA_MOD_RES_MEM_T_TXQ_ARRAY].res_u.mem_info.mdl[0].kva;
3914
3915 INIT_LIST_HEAD(&tx_mod->tx_free_q);
3916 INIT_LIST_HEAD(&tx_mod->tx_active_q);
3917
3918 INIT_LIST_HEAD(&tx_mod->txq_free_q);
3919
3920 for (i = 0; i < bna->ioceth.attr.num_txq; i++) {
3921 tx_mod->tx[i].rid = i;
3922 bfa_q_qe_init(&tx_mod->tx[i].qe);
3923 list_add_tail(&tx_mod->tx[i].qe, &tx_mod->tx_free_q);
3924 bfa_q_qe_init(&tx_mod->txq[i].qe);
3925 list_add_tail(&tx_mod->txq[i].qe, &tx_mod->txq_free_q);
3926 }
3927
3928 tx_mod->prio_map = BFI_TX_PRIO_MAP_ALL;
3929 tx_mod->default_prio = 0;
3930 tx_mod->iscsi_over_cee = BNA_STATUS_T_DISABLED;
3931 tx_mod->iscsi_prio = -1;
3932 }
3933
3934 void
3935 bna_tx_mod_uninit(struct bna_tx_mod *tx_mod)
3936 {
3937 struct list_head *qe;
3938 int i;
3939
3940 i = 0;
3941 list_for_each(qe, &tx_mod->tx_free_q)
3942 i++;
3943
3944 i = 0;
3945 list_for_each(qe, &tx_mod->txq_free_q)
3946 i++;
3947
3948 tx_mod->bna = NULL;
3949 }
3950
3951 void
3952 bna_tx_mod_start(struct bna_tx_mod *tx_mod, enum bna_tx_type type)
3953 {
3954 struct bna_tx *tx;
3955 struct list_head *qe;
3956
3957 tx_mod->flags |= BNA_TX_MOD_F_ENET_STARTED;
3958 if (type == BNA_TX_T_LOOPBACK)
3959 tx_mod->flags |= BNA_TX_MOD_F_ENET_LOOPBACK;
3960
3961 list_for_each(qe, &tx_mod->tx_active_q) {
3962 tx = (struct bna_tx *)qe;
3963 if (tx->type == type)
3964 bna_tx_start(tx);
3965 }
3966 }
3967
3968 void
3969 bna_tx_mod_stop(struct bna_tx_mod *tx_mod, enum bna_tx_type type)
3970 {
3971 struct bna_tx *tx;
3972 struct list_head *qe;
3973
3974 tx_mod->flags &= ~BNA_TX_MOD_F_ENET_STARTED;
3975 tx_mod->flags &= ~BNA_TX_MOD_F_ENET_LOOPBACK;
3976
3977 tx_mod->stop_cbfn = bna_enet_cb_tx_stopped;
3978
3979 bfa_wc_init(&tx_mod->tx_stop_wc, bna_tx_mod_cb_tx_stopped_all, tx_mod);
3980
3981 list_for_each(qe, &tx_mod->tx_active_q) {
3982 tx = (struct bna_tx *)qe;
3983 if (tx->type == type) {
3984 bfa_wc_up(&tx_mod->tx_stop_wc);
3985 bna_tx_stop(tx);
3986 }
3987 }
3988
3989 bfa_wc_wait(&tx_mod->tx_stop_wc);
3990 }
3991
3992 void
3993 bna_tx_mod_fail(struct bna_tx_mod *tx_mod)
3994 {
3995 struct bna_tx *tx;
3996 struct list_head *qe;
3997
3998 tx_mod->flags &= ~BNA_TX_MOD_F_ENET_STARTED;
3999 tx_mod->flags &= ~BNA_TX_MOD_F_ENET_LOOPBACK;
4000
4001 list_for_each(qe, &tx_mod->tx_active_q) {
4002 tx = (struct bna_tx *)qe;
4003 bna_tx_fail(tx);
4004 }
4005 }
4006
4007 void
4008 bna_tx_coalescing_timeo_set(struct bna_tx *tx, int coalescing_timeo)
4009 {
4010 struct bna_txq *txq;
4011 struct list_head *qe;
4012
4013 list_for_each(qe, &tx->txq_q) {
4014 txq = (struct bna_txq *)qe;
4015 bna_ib_coalescing_timeo_set(&txq->ib, coalescing_timeo);
4016 }
4017 }
Linux with added FPC-III support