xref: /freebsd/sys/dev/sfxge/sfxge_ev.c (revision 4f52dfbb)
1 /*-
2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3  *
4  * Copyright (c) 2010-2016 Solarflare Communications Inc.
5  * All rights reserved.
6  *
7  * This software was developed in part by Philip Paeps under contract for
8  * Solarflare Communications, Inc.
9  *
10  * Redistribution and use in source and binary forms, with or without
11  * modification, are permitted provided that the following conditions are met:
12  *
13  * 1. Redistributions of source code must retain the above copyright notice,
14  *    this list of conditions and the following disclaimer.
15  * 2. Redistributions in binary form must reproduce the above copyright notice,
16  *    this list of conditions and the following disclaimer in the documentation
17  *    and/or other materials provided with the distribution.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
20  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
21  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
23  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
24  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
25  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
26  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
27  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
28  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
29  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30  *
31  * The views and conclusions contained in the software and documentation are
32  * those of the authors and should not be interpreted as representing official
33  * policies, either expressed or implied, of the FreeBSD Project.
34  */
35 
36 #include <sys/cdefs.h>
37 __FBSDID("$FreeBSD$");
38 
39 #include <sys/param.h>
40 #include <sys/kernel.h>
41 #include <sys/malloc.h>
42 #include <sys/param.h>
43 #include <sys/queue.h>
44 #include <sys/systm.h>
45 #include <sys/taskqueue.h>
46 
47 #include "common/efx.h"
48 
49 #include "sfxge.h"
50 
51 static void
52 sfxge_ev_qcomplete(struct sfxge_evq *evq, boolean_t eop)
53 {
54 	struct sfxge_softc *sc;
55 	unsigned int index;
56 	struct sfxge_rxq *rxq;
57 	struct sfxge_txq *txq;
58 
59 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
60 
61 	sc = evq->sc;
62 	index = evq->index;
63 	rxq = sc->rxq[index];
64 
65 	if ((txq = evq->txq) != NULL) {
66 		evq->txq = NULL;
67 		evq->txqs = &(evq->txq);
68 
69 		do {
70 			struct sfxge_txq *next;
71 
72 			next = txq->next;
73 			txq->next = NULL;
74 
75 			KASSERT(txq->evq_index == index,
76 			    ("txq->evq_index != index"));
77 
78 			if (txq->pending != txq->completed)
79 				sfxge_tx_qcomplete(txq, evq);
80 
81 			txq = next;
82 		} while (txq != NULL);
83 	}
84 
85 	if (rxq->pending != rxq->completed)
86 		sfxge_rx_qcomplete(rxq, eop);
87 }
88 
89 static struct sfxge_rxq *
90 sfxge_get_rxq_by_label(struct sfxge_evq *evq, uint32_t label)
91 {
92 	struct sfxge_rxq *rxq;
93 
94 	KASSERT(label == 0, ("unexpected rxq label != 0"));
95 
96 	rxq = evq->sc->rxq[evq->index];
97 
98 	KASSERT(rxq != NULL, ("rxq == NULL"));
99 	KASSERT(evq->index == rxq->index, ("evq->index != rxq->index"));
100 
101 	return (rxq);
102 }
103 
104 static boolean_t
105 sfxge_ev_rx(void *arg, uint32_t label, uint32_t id, uint32_t size,
106 	    uint16_t flags)
107 {
108 	struct sfxge_evq *evq;
109 	struct sfxge_softc *sc;
110 	struct sfxge_rxq *rxq;
111 	unsigned int stop;
112 	unsigned int delta;
113 	struct sfxge_rx_sw_desc *rx_desc;
114 
115 	evq = arg;
116 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
117 
118 	sc = evq->sc;
119 
120 	if (evq->exception)
121 		goto done;
122 
123 	rxq = sfxge_get_rxq_by_label(evq, label);
124 	if (__predict_false(rxq->init_state != SFXGE_RXQ_STARTED))
125 		goto done;
126 
127 	stop = (id + 1) & rxq->ptr_mask;
128 	id = rxq->pending & rxq->ptr_mask;
129 	delta = (stop >= id) ? (stop - id) : (rxq->entries - id + stop);
130 	rxq->pending += delta;
131 
132 	if (delta != 1) {
133 		if ((delta <= 0) ||
134 		    (delta > efx_nic_cfg_get(sc->enp)->enc_rx_batch_max)) {
135 			evq->exception = B_TRUE;
136 
137 			device_printf(sc->dev, "RX completion out of order"
138 						  " (id=%#x delta=%u flags=%#x); resetting\n",
139 						  id, delta, flags);
140 			sfxge_schedule_reset(sc);
141 
142 			goto done;
143 		}
144 	}
145 
146 	rx_desc = &rxq->queue[id];
147 
148 	prefetch_read_many(rx_desc->mbuf);
149 
150 	for (; id != stop; id = (id + 1) & rxq->ptr_mask) {
151 		rx_desc = &rxq->queue[id];
152 		KASSERT(rx_desc->flags == EFX_DISCARD,
153 				("rx_desc->flags != EFX_DISCARD"));
154 		rx_desc->flags = flags;
155 
156 		KASSERT(size < (1 << 16), ("size > (1 << 16)"));
157 		rx_desc->size = (uint16_t)size;
158 	}
159 
160 	evq->rx_done++;
161 
162 	if (rxq->pending - rxq->completed >= SFXGE_RX_BATCH)
163 		sfxge_ev_qcomplete(evq, B_FALSE);
164 
165 done:
166 	return (evq->rx_done >= SFXGE_EV_BATCH);
167 }
168 
169 static boolean_t
170 sfxge_ev_exception(void *arg, uint32_t code, uint32_t data)
171 {
172 	struct sfxge_evq *evq;
173 	struct sfxge_softc *sc;
174 
175 	evq = (struct sfxge_evq *)arg;
176 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
177 
178 	sc = evq->sc;
179 
180 	DBGPRINT(sc->dev, "[%d] %s", evq->index,
181 			  (code == EFX_EXCEPTION_RX_RECOVERY) ? "RX_RECOVERY" :
182 			  (code == EFX_EXCEPTION_RX_DSC_ERROR) ? "RX_DSC_ERROR" :
183 			  (code == EFX_EXCEPTION_TX_DSC_ERROR) ? "TX_DSC_ERROR" :
184 			  (code == EFX_EXCEPTION_UNKNOWN_SENSOREVT) ? "UNKNOWN_SENSOREVT" :
185 			  (code == EFX_EXCEPTION_FWALERT_SRAM) ? "FWALERT_SRAM" :
186 			  (code == EFX_EXCEPTION_UNKNOWN_FWALERT) ? "UNKNOWN_FWALERT" :
187 			  (code == EFX_EXCEPTION_RX_ERROR) ? "RX_ERROR" :
188 			  (code == EFX_EXCEPTION_TX_ERROR) ? "TX_ERROR" :
189 			  (code == EFX_EXCEPTION_EV_ERROR) ? "EV_ERROR" :
190 			  "UNKNOWN");
191 
192 	evq->exception = B_TRUE;
193 
194 	if (code != EFX_EXCEPTION_UNKNOWN_SENSOREVT) {
195 		device_printf(sc->dev,
196 			      "hardware exception (code=%u); resetting\n",
197 			      code);
198 		sfxge_schedule_reset(sc);
199 	}
200 
201 	return (B_FALSE);
202 }
203 
204 static boolean_t
205 sfxge_ev_rxq_flush_done(void *arg, uint32_t rxq_index)
206 {
207 	struct sfxge_evq *evq;
208 	struct sfxge_softc *sc;
209 	struct sfxge_rxq *rxq;
210 	unsigned int index;
211 	uint16_t magic;
212 
213 	evq = (struct sfxge_evq *)arg;
214 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
215 
216 	sc = evq->sc;
217 	rxq = sc->rxq[rxq_index];
218 
219 	KASSERT(rxq != NULL, ("rxq == NULL"));
220 
221 	/* Resend a software event on the correct queue */
222 	index = rxq->index;
223 	if (index == evq->index) {
224 		sfxge_rx_qflush_done(rxq);
225 		return (B_FALSE);
226 	}
227 
228 	evq = sc->evq[index];
229 	magic = sfxge_sw_ev_rxq_magic(SFXGE_SW_EV_RX_QFLUSH_DONE, rxq);
230 
231 	KASSERT(evq->init_state == SFXGE_EVQ_STARTED,
232 	    ("evq not started"));
233 	efx_ev_qpost(evq->common, magic);
234 
235 	return (B_FALSE);
236 }
237 
238 static boolean_t
239 sfxge_ev_rxq_flush_failed(void *arg, uint32_t rxq_index)
240 {
241 	struct sfxge_evq *evq;
242 	struct sfxge_softc *sc;
243 	struct sfxge_rxq *rxq;
244 	unsigned int index;
245 	uint16_t magic;
246 
247 	evq = (struct sfxge_evq *)arg;
248 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
249 
250 	sc = evq->sc;
251 	rxq = sc->rxq[rxq_index];
252 
253 	KASSERT(rxq != NULL, ("rxq == NULL"));
254 
255 	/* Resend a software event on the correct queue */
256 	index = rxq->index;
257 	evq = sc->evq[index];
258 	magic = sfxge_sw_ev_rxq_magic(SFXGE_SW_EV_RX_QFLUSH_FAILED, rxq);
259 
260 	KASSERT(evq->init_state == SFXGE_EVQ_STARTED,
261 	    ("evq not started"));
262 	efx_ev_qpost(evq->common, magic);
263 
264 	return (B_FALSE);
265 }
266 
267 static struct sfxge_txq *
268 sfxge_get_txq_by_label(struct sfxge_evq *evq, enum sfxge_txq_type label)
269 {
270 	unsigned int index;
271 
272 	KASSERT((evq->index == 0 && label < SFXGE_TXQ_NTYPES) ||
273 	    (label == SFXGE_TXQ_IP_TCP_UDP_CKSUM), ("unexpected txq label"));
274 	index = (evq->index == 0) ? label : (evq->index - 1 + SFXGE_TXQ_NTYPES);
275 	return (evq->sc->txq[index]);
276 }
277 
278 static boolean_t
279 sfxge_ev_tx(void *arg, uint32_t label, uint32_t id)
280 {
281 	struct sfxge_evq *evq;
282 	struct sfxge_txq *txq;
283 	unsigned int stop;
284 	unsigned int delta;
285 
286 	evq = (struct sfxge_evq *)arg;
287 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
288 
289 	txq = sfxge_get_txq_by_label(evq, label);
290 
291 	KASSERT(txq != NULL, ("txq == NULL"));
292 	KASSERT(evq->index == txq->evq_index,
293 	    ("evq->index != txq->evq_index"));
294 
295 	if (__predict_false(txq->init_state != SFXGE_TXQ_STARTED))
296 		goto done;
297 
298 	stop = (id + 1) & txq->ptr_mask;
299 	id = txq->pending & txq->ptr_mask;
300 
301 	delta = (stop >= id) ? (stop - id) : (txq->entries - id + stop);
302 	txq->pending += delta;
303 
304 	evq->tx_done++;
305 
306 	if (txq->next == NULL &&
307 	    evq->txqs != &(txq->next)) {
308 		*(evq->txqs) = txq;
309 		evq->txqs = &(txq->next);
310 	}
311 
312 	if (txq->pending - txq->completed >= SFXGE_TX_BATCH)
313 		sfxge_tx_qcomplete(txq, evq);
314 
315 done:
316 	return (evq->tx_done >= SFXGE_EV_BATCH);
317 }
318 
319 static boolean_t
320 sfxge_ev_txq_flush_done(void *arg, uint32_t txq_index)
321 {
322 	struct sfxge_evq *evq;
323 	struct sfxge_softc *sc;
324 	struct sfxge_txq *txq;
325 	uint16_t magic;
326 
327 	evq = (struct sfxge_evq *)arg;
328 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
329 
330 	sc = evq->sc;
331 	txq = sc->txq[txq_index];
332 
333 	KASSERT(txq != NULL, ("txq == NULL"));
334 	KASSERT(txq->init_state == SFXGE_TXQ_INITIALIZED,
335 	    ("txq not initialized"));
336 
337 	if (txq->evq_index == evq->index) {
338 		sfxge_tx_qflush_done(txq);
339 		return (B_FALSE);
340 	}
341 
342 	/* Resend a software event on the correct queue */
343 	evq = sc->evq[txq->evq_index];
344 	magic = sfxge_sw_ev_txq_magic(SFXGE_SW_EV_TX_QFLUSH_DONE, txq);
345 
346 	KASSERT(evq->init_state == SFXGE_EVQ_STARTED,
347 	    ("evq not started"));
348 	efx_ev_qpost(evq->common, magic);
349 
350 	return (B_FALSE);
351 }
352 
353 static boolean_t
354 sfxge_ev_software(void *arg, uint16_t magic)
355 {
356 	struct sfxge_evq *evq;
357 	struct sfxge_softc *sc;
358 	unsigned int label;
359 
360 	evq = (struct sfxge_evq *)arg;
361 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
362 
363 	sc = evq->sc;
364 
365 	label = magic & SFXGE_MAGIC_DMAQ_LABEL_MASK;
366 	magic &= ~SFXGE_MAGIC_DMAQ_LABEL_MASK;
367 
368 	switch (magic) {
369 	case SFXGE_SW_EV_MAGIC(SFXGE_SW_EV_RX_QFLUSH_DONE):
370 		sfxge_rx_qflush_done(sfxge_get_rxq_by_label(evq, label));
371 		break;
372 
373 	case SFXGE_SW_EV_MAGIC(SFXGE_SW_EV_RX_QFLUSH_FAILED):
374 		sfxge_rx_qflush_failed(sfxge_get_rxq_by_label(evq, label));
375 		break;
376 
377 	case SFXGE_SW_EV_MAGIC(SFXGE_SW_EV_RX_QREFILL):
378 		sfxge_rx_qrefill(sfxge_get_rxq_by_label(evq, label));
379 		break;
380 
381 	case SFXGE_SW_EV_MAGIC(SFXGE_SW_EV_TX_QFLUSH_DONE): {
382 		struct sfxge_txq *txq = sfxge_get_txq_by_label(evq, label);
383 
384 		KASSERT(txq != NULL, ("txq == NULL"));
385 		KASSERT(evq->index == txq->evq_index,
386 		    ("evq->index != txq->evq_index"));
387 
388 		sfxge_tx_qflush_done(txq);
389 		break;
390 	}
391 	default:
392 		break;
393 	}
394 
395 	return (B_FALSE);
396 }
397 
398 static boolean_t
399 sfxge_ev_sram(void *arg, uint32_t code)
400 {
401 	(void)arg;
402 	(void)code;
403 
404 	switch (code) {
405 	case EFX_SRAM_UPDATE:
406 		EFSYS_PROBE(sram_update);
407 		break;
408 
409 	case EFX_SRAM_CLEAR:
410 		EFSYS_PROBE(sram_clear);
411 		break;
412 
413 	case EFX_SRAM_ILLEGAL_CLEAR:
414 		EFSYS_PROBE(sram_illegal_clear);
415 		break;
416 
417 	default:
418 		KASSERT(B_FALSE, ("Impossible SRAM event"));
419 		break;
420 	}
421 
422 	return (B_FALSE);
423 }
424 
425 static boolean_t
426 sfxge_ev_timer(void *arg, uint32_t index)
427 {
428 	(void)arg;
429 	(void)index;
430 
431 	return (B_FALSE);
432 }
433 
434 static boolean_t
435 sfxge_ev_wake_up(void *arg, uint32_t index)
436 {
437 	(void)arg;
438 	(void)index;
439 
440 	return (B_FALSE);
441 }
442 
443 #if EFSYS_OPT_QSTATS
444 
445 static void
446 sfxge_ev_stat_update(struct sfxge_softc *sc)
447 {
448 	struct sfxge_evq *evq;
449 	unsigned int index;
450 	clock_t now;
451 
452 	SFXGE_ADAPTER_LOCK(sc);
453 
454 	if (__predict_false(sc->evq[0]->init_state != SFXGE_EVQ_STARTED))
455 		goto out;
456 
457 	now = ticks;
458 	if ((unsigned int)(now - sc->ev_stats_update_time) < (unsigned int)hz)
459 		goto out;
460 
461 	sc->ev_stats_update_time = now;
462 
463 	/* Add event counts from each event queue in turn */
464 	for (index = 0; index < sc->evq_count; index++) {
465 		evq = sc->evq[index];
466 		SFXGE_EVQ_LOCK(evq);
467 		efx_ev_qstats_update(evq->common, sc->ev_stats);
468 		SFXGE_EVQ_UNLOCK(evq);
469 	}
470 out:
471 	SFXGE_ADAPTER_UNLOCK(sc);
472 }
473 
474 static int
475 sfxge_ev_stat_handler(SYSCTL_HANDLER_ARGS)
476 {
477 	struct sfxge_softc *sc = arg1;
478 	unsigned int id = arg2;
479 
480 	sfxge_ev_stat_update(sc);
481 
482 	return (SYSCTL_OUT(req, &sc->ev_stats[id], sizeof(sc->ev_stats[id])));
483 }
484 
485 static void
486 sfxge_ev_stat_init(struct sfxge_softc *sc)
487 {
488 	struct sysctl_ctx_list *ctx = device_get_sysctl_ctx(sc->dev);
489 	struct sysctl_oid_list *stat_list;
490 	unsigned int id;
491 	char name[40];
492 
493 	stat_list = SYSCTL_CHILDREN(sc->stats_node);
494 
495 	for (id = 0; id < EV_NQSTATS; id++) {
496 		snprintf(name, sizeof(name), "ev_%s",
497 			 efx_ev_qstat_name(sc->enp, id));
498 		SYSCTL_ADD_PROC(
499 			ctx, stat_list,
500 			OID_AUTO, name, CTLTYPE_U64|CTLFLAG_RD,
501 			sc, id, sfxge_ev_stat_handler, "Q",
502 			"");
503 	}
504 }
505 
506 #endif /* EFSYS_OPT_QSTATS */
507 
508 static void
509 sfxge_ev_qmoderate(struct sfxge_softc *sc, unsigned int idx, unsigned int us)
510 {
511 	struct sfxge_evq *evq;
512 	efx_evq_t *eep;
513 
514 	evq = sc->evq[idx];
515 	eep = evq->common;
516 
517 	KASSERT(evq->init_state == SFXGE_EVQ_STARTED,
518 	    ("evq->init_state != SFXGE_EVQ_STARTED"));
519 
520 	(void)efx_ev_qmoderate(eep, us);
521 }
522 
523 static int
524 sfxge_int_mod_handler(SYSCTL_HANDLER_ARGS)
525 {
526 	struct sfxge_softc *sc = arg1;
527 	struct sfxge_intr *intr = &sc->intr;
528 	unsigned int moderation;
529 	int error;
530 	unsigned int index;
531 
532 	SFXGE_ADAPTER_LOCK(sc);
533 
534 	if (req->newptr != NULL) {
535 		if ((error = SYSCTL_IN(req, &moderation, sizeof(moderation)))
536 		    != 0)
537 			goto out;
538 
539 		/* We may not be calling efx_ev_qmoderate() now,
540 		 * so we have to range-check the value ourselves.
541 		 */
542 		if (moderation >
543 		    efx_nic_cfg_get(sc->enp)->enc_evq_timer_max_us) {
544 			error = EINVAL;
545 			goto out;
546 		}
547 
548 		sc->ev_moderation = moderation;
549 		if (intr->state == SFXGE_INTR_STARTED) {
550 			for (index = 0; index < sc->evq_count; index++)
551 				sfxge_ev_qmoderate(sc, index, moderation);
552 		}
553 	} else {
554 		error = SYSCTL_OUT(req, &sc->ev_moderation,
555 				   sizeof(sc->ev_moderation));
556 	}
557 
558 out:
559 	SFXGE_ADAPTER_UNLOCK(sc);
560 
561 	return (error);
562 }
563 
564 static boolean_t
565 sfxge_ev_initialized(void *arg)
566 {
567 	struct sfxge_evq *evq;
568 
569 	evq = (struct sfxge_evq *)arg;
570 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
571 
572 	/* Init done events may be duplicated on 7xxx */
573 	KASSERT(evq->init_state == SFXGE_EVQ_STARTING ||
574 		evq->init_state == SFXGE_EVQ_STARTED,
575 	    ("evq not starting"));
576 
577 	evq->init_state = SFXGE_EVQ_STARTED;
578 
579 	return (0);
580 }
581 
582 static boolean_t
583 sfxge_ev_link_change(void *arg, efx_link_mode_t	link_mode)
584 {
585 	struct sfxge_evq *evq;
586 	struct sfxge_softc *sc;
587 
588 	evq = (struct sfxge_evq *)arg;
589 	SFXGE_EVQ_LOCK_ASSERT_OWNED(evq);
590 
591 	sc = evq->sc;
592 
593 	sfxge_mac_link_update(sc, link_mode);
594 
595 	return (0);
596 }
597 
598 static const efx_ev_callbacks_t sfxge_ev_callbacks = {
599 	.eec_initialized	= sfxge_ev_initialized,
600 	.eec_rx			= sfxge_ev_rx,
601 	.eec_tx			= sfxge_ev_tx,
602 	.eec_exception		= sfxge_ev_exception,
603 	.eec_rxq_flush_done	= sfxge_ev_rxq_flush_done,
604 	.eec_rxq_flush_failed	= sfxge_ev_rxq_flush_failed,
605 	.eec_txq_flush_done	= sfxge_ev_txq_flush_done,
606 	.eec_software		= sfxge_ev_software,
607 	.eec_sram		= sfxge_ev_sram,
608 	.eec_wake_up		= sfxge_ev_wake_up,
609 	.eec_timer		= sfxge_ev_timer,
610 	.eec_link_change	= sfxge_ev_link_change,
611 };
612 
613 
614 int
615 sfxge_ev_qpoll(struct sfxge_evq *evq)
616 {
617 	int rc;
618 
619 	SFXGE_EVQ_LOCK(evq);
620 
621 	if (__predict_false(evq->init_state != SFXGE_EVQ_STARTING &&
622 			    evq->init_state != SFXGE_EVQ_STARTED)) {
623 		rc = EINVAL;
624 		goto fail;
625 	}
626 
627 	/* Synchronize the DMA memory for reading */
628 	bus_dmamap_sync(evq->mem.esm_tag, evq->mem.esm_map,
629 	    BUS_DMASYNC_POSTREAD);
630 
631 	KASSERT(evq->rx_done == 0, ("evq->rx_done != 0"));
632 	KASSERT(evq->tx_done == 0, ("evq->tx_done != 0"));
633 	KASSERT(evq->txq == NULL, ("evq->txq != NULL"));
634 	KASSERT(evq->txqs == &evq->txq, ("evq->txqs != &evq->txq"));
635 
636 	/* Poll the queue */
637 	efx_ev_qpoll(evq->common, &evq->read_ptr, &sfxge_ev_callbacks, evq);
638 
639 	evq->rx_done = 0;
640 	evq->tx_done = 0;
641 
642 	/* Perform any pending completion processing */
643 	sfxge_ev_qcomplete(evq, B_TRUE);
644 
645 	/* Re-prime the event queue for interrupts */
646 	if ((rc = efx_ev_qprime(evq->common, evq->read_ptr)) != 0)
647 		goto fail;
648 
649 	SFXGE_EVQ_UNLOCK(evq);
650 
651 	return (0);
652 
653 fail:
654 	SFXGE_EVQ_UNLOCK(evq);
655 	return (rc);
656 }
657 
658 static void
659 sfxge_ev_qstop(struct sfxge_softc *sc, unsigned int index)
660 {
661 	struct sfxge_evq *evq;
662 
663 	evq = sc->evq[index];
664 
665 	KASSERT(evq->init_state == SFXGE_EVQ_STARTED,
666 	    ("evq->init_state != SFXGE_EVQ_STARTED"));
667 
668 	SFXGE_EVQ_LOCK(evq);
669 	evq->init_state = SFXGE_EVQ_INITIALIZED;
670 	evq->read_ptr = 0;
671 	evq->exception = B_FALSE;
672 
673 #if EFSYS_OPT_QSTATS
674 	/* Add event counts before discarding the common evq state */
675 	efx_ev_qstats_update(evq->common, sc->ev_stats);
676 #endif
677 
678 	efx_ev_qdestroy(evq->common);
679 	efx_sram_buf_tbl_clear(sc->enp, evq->buf_base_id,
680 	    EFX_EVQ_NBUFS(evq->entries));
681 	SFXGE_EVQ_UNLOCK(evq);
682 }
683 
684 static int
685 sfxge_ev_qstart(struct sfxge_softc *sc, unsigned int index)
686 {
687 	struct sfxge_evq *evq;
688 	efsys_mem_t *esmp;
689 	int count;
690 	int rc;
691 
692 	evq = sc->evq[index];
693 	esmp = &evq->mem;
694 
695 	KASSERT(evq->init_state == SFXGE_EVQ_INITIALIZED,
696 	    ("evq->init_state != SFXGE_EVQ_INITIALIZED"));
697 
698 	/* Clear all events. */
699 	(void)memset(esmp->esm_base, 0xff, EFX_EVQ_SIZE(evq->entries));
700 
701 	/* Program the buffer table. */
702 	if ((rc = efx_sram_buf_tbl_set(sc->enp, evq->buf_base_id, esmp,
703 	    EFX_EVQ_NBUFS(evq->entries))) != 0)
704 		return (rc);
705 
706 	/* Create the common code event queue. */
707 	if ((rc = efx_ev_qcreate(sc->enp, index, esmp, evq->entries,
708 	    evq->buf_base_id, sc->ev_moderation, EFX_EVQ_FLAGS_TYPE_AUTO,
709 	    &evq->common)) != 0)
710 		goto fail;
711 
712 	SFXGE_EVQ_LOCK(evq);
713 
714 	/* Prime the event queue for interrupts */
715 	if ((rc = efx_ev_qprime(evq->common, evq->read_ptr)) != 0)
716 		goto fail2;
717 
718 	evq->init_state = SFXGE_EVQ_STARTING;
719 
720 	SFXGE_EVQ_UNLOCK(evq);
721 
722 	/* Wait for the initialization event */
723 	count = 0;
724 	do {
725 		/* Pause for 100 ms */
726 		pause("sfxge evq init", hz / 10);
727 
728 		/* Check to see if the test event has been processed */
729 		if (evq->init_state == SFXGE_EVQ_STARTED)
730 			goto done;
731 
732 	} while (++count < 20);
733 
734 	rc = ETIMEDOUT;
735 	goto fail3;
736 
737 done:
738 	return (0);
739 
740 fail3:
741 	SFXGE_EVQ_LOCK(evq);
742 	evq->init_state = SFXGE_EVQ_INITIALIZED;
743 fail2:
744 	SFXGE_EVQ_UNLOCK(evq);
745 	efx_ev_qdestroy(evq->common);
746 fail:
747 	efx_sram_buf_tbl_clear(sc->enp, evq->buf_base_id,
748 	    EFX_EVQ_NBUFS(evq->entries));
749 
750 	return (rc);
751 }
752 
753 void
754 sfxge_ev_stop(struct sfxge_softc *sc)
755 {
756 	struct sfxge_intr *intr;
757 	efx_nic_t *enp;
758 	int index;
759 
760 	intr = &sc->intr;
761 	enp = sc->enp;
762 
763 	KASSERT(intr->state == SFXGE_INTR_STARTED,
764 	    ("Interrupts not started"));
765 
766 	/* Stop the event queue(s) */
767 	index = sc->evq_count;
768 	while (--index >= 0)
769 		sfxge_ev_qstop(sc, index);
770 
771 	/* Tear down the event module */
772 	efx_ev_fini(enp);
773 }
774 
775 int
776 sfxge_ev_start(struct sfxge_softc *sc)
777 {
778 	struct sfxge_intr *intr;
779 	int index;
780 	int rc;
781 
782 	intr = &sc->intr;
783 
784 	KASSERT(intr->state == SFXGE_INTR_STARTED,
785 	    ("intr->state != SFXGE_INTR_STARTED"));
786 
787 	/* Initialize the event module */
788 	if ((rc = efx_ev_init(sc->enp)) != 0)
789 		return (rc);
790 
791 	/* Start the event queues */
792 	for (index = 0; index < sc->evq_count; index++) {
793 		if ((rc = sfxge_ev_qstart(sc, index)) != 0)
794 			goto fail;
795 	}
796 
797 	return (0);
798 
799 fail:
800 	/* Stop the event queue(s) */
801 	while (--index >= 0)
802 		sfxge_ev_qstop(sc, index);
803 
804 	/* Tear down the event module */
805 	efx_ev_fini(sc->enp);
806 
807 	return (rc);
808 }
809 
810 static void
811 sfxge_ev_qfini(struct sfxge_softc *sc, unsigned int index)
812 {
813 	struct sfxge_evq *evq;
814 
815 	evq = sc->evq[index];
816 
817 	KASSERT(evq->init_state == SFXGE_EVQ_INITIALIZED,
818 	    ("evq->init_state != SFXGE_EVQ_INITIALIZED"));
819 	KASSERT(evq->txqs == &evq->txq, ("evq->txqs != &evq->txq"));
820 
821 	sfxge_dma_free(&evq->mem);
822 
823 	sc->evq[index] = NULL;
824 
825 	SFXGE_EVQ_LOCK_DESTROY(evq);
826 
827 	free(evq, M_SFXGE);
828 }
829 
830 static int
831 sfxge_ev_qinit(struct sfxge_softc *sc, unsigned int index)
832 {
833 	struct sfxge_evq *evq;
834 	efsys_mem_t *esmp;
835 	int rc;
836 
837 	KASSERT(index < SFXGE_RX_SCALE_MAX, ("index >= SFXGE_RX_SCALE_MAX"));
838 
839 	evq = malloc(sizeof(struct sfxge_evq), M_SFXGE, M_ZERO | M_WAITOK);
840 	evq->sc = sc;
841 	evq->index = index;
842 	sc->evq[index] = evq;
843 	esmp = &evq->mem;
844 
845 	/* Build an event queue with room for one event per tx and rx buffer,
846 	 * plus some extra for link state events and MCDI completions.
847 	 * There are three tx queues in the first event queue and one in
848 	 * other.
849 	 */
850 	if (index == 0)
851 		evq->entries =
852 			ROUNDUP_POW_OF_TWO(sc->rxq_entries +
853 					   3 * sc->txq_entries +
854 					   128);
855 	else
856 		evq->entries =
857 			ROUNDUP_POW_OF_TWO(sc->rxq_entries +
858 					   sc->txq_entries +
859 					   128);
860 
861 	/* Initialise TX completion list */
862 	evq->txqs = &evq->txq;
863 
864 	/* Allocate DMA space. */
865 	if ((rc = sfxge_dma_alloc(sc, EFX_EVQ_SIZE(evq->entries), esmp)) != 0)
866 		return (rc);
867 
868 	/* Allocate buffer table entries. */
869 	sfxge_sram_buf_tbl_alloc(sc, EFX_EVQ_NBUFS(evq->entries),
870 				 &evq->buf_base_id);
871 
872 	SFXGE_EVQ_LOCK_INIT(evq, device_get_nameunit(sc->dev), index);
873 
874 	evq->init_state = SFXGE_EVQ_INITIALIZED;
875 
876 	return (0);
877 }
878 
879 void
880 sfxge_ev_fini(struct sfxge_softc *sc)
881 {
882 	struct sfxge_intr *intr;
883 	int index;
884 
885 	intr = &sc->intr;
886 
887 	KASSERT(intr->state == SFXGE_INTR_INITIALIZED,
888 	    ("intr->state != SFXGE_INTR_INITIALIZED"));
889 
890 	sc->ev_moderation = 0;
891 
892 	/* Tear down the event queue(s). */
893 	index = sc->evq_count;
894 	while (--index >= 0)
895 		sfxge_ev_qfini(sc, index);
896 
897 	sc->evq_count = 0;
898 }
899 
900 int
901 sfxge_ev_init(struct sfxge_softc *sc)
902 {
903 	struct sysctl_ctx_list *sysctl_ctx = device_get_sysctl_ctx(sc->dev);
904 	struct sysctl_oid *sysctl_tree = device_get_sysctl_tree(sc->dev);
905 	struct sfxge_intr *intr;
906 	int index;
907 	int rc;
908 
909 	intr = &sc->intr;
910 
911 	sc->evq_count = intr->n_alloc;
912 
913 	KASSERT(intr->state == SFXGE_INTR_INITIALIZED,
914 	    ("intr->state != SFXGE_INTR_INITIALIZED"));
915 
916 	/* Set default interrupt moderation; add a sysctl to
917 	 * read and change it.
918 	 */
919 	sc->ev_moderation = SFXGE_MODERATION;
920 	SYSCTL_ADD_PROC(sysctl_ctx, SYSCTL_CHILDREN(sysctl_tree),
921 			OID_AUTO, "int_mod", CTLTYPE_UINT|CTLFLAG_RW,
922 			sc, 0, sfxge_int_mod_handler, "IU",
923 			"sfxge interrupt moderation (us)");
924 
925 	/*
926 	 * Initialize the event queue(s) - one per interrupt.
927 	 */
928 	for (index = 0; index < sc->evq_count; index++) {
929 		if ((rc = sfxge_ev_qinit(sc, index)) != 0)
930 			goto fail;
931 	}
932 
933 #if EFSYS_OPT_QSTATS
934 	sfxge_ev_stat_init(sc);
935 #endif
936 
937 	return (0);
938 
939 fail:
940 	while (--index >= 0)
941 		sfxge_ev_qfini(sc, index);
942 
943 	sc->evq_count = 0;
944 	return (rc);
945 }
946