qla_os.c revision 330897
1/*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright (c) 2011-2013 Qlogic Corporation
5 * All rights reserved.
6 *
7 *  Redistribution and use in source and binary forms, with or without
8 *  modification, are permitted provided that the following conditions
9 *  are met:
10 *
11 *  1. Redistributions of source code must retain the above copyright
12 *     notice, this list of conditions and the following disclaimer.
13 *  2. Redistributions in binary form must reproduce the above copyright
14 *     notice, this list of conditions and the following disclaimer in the
15 *     documentation and/or other materials provided with the distribution.
16 *
17 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
18 *  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 *  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
21 *  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22 *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23 *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24 *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
25 *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26 *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27 *  POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/*
31 * File: qla_os.c
32 * Author : David C Somayajulu, Qlogic Corporation, Aliso Viejo, CA 92656.
33 */
34
35#include <sys/cdefs.h>
36__FBSDID("$FreeBSD: stable/11/sys/dev/qlxgb/qla_os.c 330897 2018-03-14 03:19:51Z eadler $");
37
38#include "qla_os.h"
39#include "qla_reg.h"
40#include "qla_hw.h"
41#include "qla_def.h"
42#include "qla_inline.h"
43#include "qla_ver.h"
44#include "qla_glbl.h"
45#include "qla_dbg.h"
46
47/*
48 * Some PCI Configuration Space Related Defines
49 */
50
51#ifndef PCI_VENDOR_QLOGIC
52#define PCI_VENDOR_QLOGIC	0x1077
53#endif
54
55#ifndef PCI_PRODUCT_QLOGIC_ISP8020
56#define PCI_PRODUCT_QLOGIC_ISP8020	0x8020
57#endif
58
59#define PCI_QLOGIC_ISP8020 \
60	((PCI_PRODUCT_QLOGIC_ISP8020 << 16) | PCI_VENDOR_QLOGIC)
61
62/*
63 * static functions
64 */
65static int qla_alloc_parent_dma_tag(qla_host_t *ha);
66static void qla_free_parent_dma_tag(qla_host_t *ha);
67static int qla_alloc_xmt_bufs(qla_host_t *ha);
68static void qla_free_xmt_bufs(qla_host_t *ha);
69static int qla_alloc_rcv_bufs(qla_host_t *ha);
70static void qla_free_rcv_bufs(qla_host_t *ha);
71
72static void qla_init_ifnet(device_t dev, qla_host_t *ha);
73static int qla_sysctl_get_stats(SYSCTL_HANDLER_ARGS);
74static void qla_release(qla_host_t *ha);
75static void qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs,
76		int error);
77static void qla_stop(qla_host_t *ha);
78static int qla_send(qla_host_t *ha, struct mbuf **m_headp);
79static void qla_tx_done(void *context, int pending);
80
81/*
82 * Hooks to the Operating Systems
83 */
84static int qla_pci_probe (device_t);
85static int qla_pci_attach (device_t);
86static int qla_pci_detach (device_t);
87
88static void qla_init(void *arg);
89static int qla_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
90static int qla_media_change(struct ifnet *ifp);
91static void qla_media_status(struct ifnet *ifp, struct ifmediareq *ifmr);
92
93static device_method_t qla_pci_methods[] = {
94	/* Device interface */
95	DEVMETHOD(device_probe, qla_pci_probe),
96	DEVMETHOD(device_attach, qla_pci_attach),
97	DEVMETHOD(device_detach, qla_pci_detach),
98	{ 0, 0 }
99};
100
101static driver_t qla_pci_driver = {
102	"ql", qla_pci_methods, sizeof (qla_host_t),
103};
104
105static devclass_t qla80xx_devclass;
106
107DRIVER_MODULE(qla80xx, pci, qla_pci_driver, qla80xx_devclass, 0, 0);
108
109MODULE_DEPEND(qla80xx, pci, 1, 1, 1);
110MODULE_DEPEND(qla80xx, ether, 1, 1, 1);
111
112MALLOC_DEFINE(M_QLA8XXXBUF, "qla80xxbuf", "Buffers for qla80xx driver");
113
114uint32_t std_replenish = 8;
115uint32_t jumbo_replenish = 2;
116uint32_t rcv_pkt_thres = 128;
117uint32_t rcv_pkt_thres_d = 32;
118uint32_t snd_pkt_thres = 16;
119uint32_t free_pkt_thres = (NUM_TX_DESCRIPTORS / 2);
120
121static char dev_str[64];
122
123/*
124 * Name:	qla_pci_probe
125 * Function:	Validate the PCI device to be a QLA80XX device
126 */
127static int
128qla_pci_probe(device_t dev)
129{
130        switch ((pci_get_device(dev) << 16) | (pci_get_vendor(dev))) {
131        case PCI_QLOGIC_ISP8020:
132		snprintf(dev_str, sizeof(dev_str), "%s v%d.%d.%d",
133			"Qlogic ISP 80xx PCI CNA Adapter-Ethernet Function",
134			QLA_VERSION_MAJOR, QLA_VERSION_MINOR,
135			QLA_VERSION_BUILD);
136                device_set_desc(dev, dev_str);
137                break;
138        default:
139                return (ENXIO);
140        }
141
142        if (bootverbose)
143                printf("%s: %s\n ", __func__, dev_str);
144
145        return (BUS_PROBE_DEFAULT);
146}
147
148static void
149qla_add_sysctls(qla_host_t *ha)
150{
151        device_t dev = ha->pci_dev;
152
153        SYSCTL_ADD_PROC(device_get_sysctl_ctx(dev),
154                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
155                OID_AUTO, "stats", CTLTYPE_INT | CTLFLAG_RD,
156                (void *)ha, 0,
157                qla_sysctl_get_stats, "I", "Statistics");
158
159	SYSCTL_ADD_STRING(device_get_sysctl_ctx(dev),
160		SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
161		OID_AUTO, "fw_version", CTLFLAG_RD,
162		ha->fw_ver_str, 0, "firmware version");
163
164	dbg_level = 0;
165        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
166                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
167                OID_AUTO, "debug", CTLFLAG_RW,
168                &dbg_level, dbg_level, "Debug Level");
169
170        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
171                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
172                OID_AUTO, "std_replenish", CTLFLAG_RW,
173                &std_replenish, std_replenish,
174                "Threshold for Replenishing Standard Frames");
175
176        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
177                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
178                OID_AUTO, "jumbo_replenish", CTLFLAG_RW,
179                &jumbo_replenish, jumbo_replenish,
180                "Threshold for Replenishing Jumbo Frames");
181
182        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
183                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
184                OID_AUTO, "rcv_pkt_thres",  CTLFLAG_RW,
185                &rcv_pkt_thres, rcv_pkt_thres,
186                "Threshold for # of rcv pkts to trigger indication isr");
187
188        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
189                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
190                OID_AUTO, "rcv_pkt_thres_d",  CTLFLAG_RW,
191                &rcv_pkt_thres_d, rcv_pkt_thres_d,
192                "Threshold for # of rcv pkts to trigger indication defered");
193
194        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
195                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
196                OID_AUTO, "snd_pkt_thres",  CTLFLAG_RW,
197                &snd_pkt_thres, snd_pkt_thres,
198                "Threshold for # of snd packets");
199
200        SYSCTL_ADD_UINT(device_get_sysctl_ctx(dev),
201                SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
202                OID_AUTO, "free_pkt_thres",  CTLFLAG_RW,
203                &free_pkt_thres, free_pkt_thres,
204                "Threshold for # of packets to free at a time");
205
206        return;
207}
208
209static void
210qla_watchdog(void *arg)
211{
212	qla_host_t *ha = arg;
213	qla_hw_t *hw;
214	struct ifnet *ifp;
215
216	hw = &ha->hw;
217	ifp = ha->ifp;
218
219        if (ha->flags.qla_watchdog_exit)
220		return;
221
222	if (!ha->flags.qla_watchdog_pause) {
223		if (qla_le32_to_host(*(hw->tx_cons)) != hw->txr_comp) {
224			taskqueue_enqueue(ha->tx_tq, &ha->tx_task);
225		} else if ((ifp->if_snd.ifq_head != NULL) && QL_RUNNING(ifp)) {
226			taskqueue_enqueue(ha->tx_tq, &ha->tx_task);
227		}
228	}
229	ha->watchdog_ticks = ha->watchdog_ticks++ % 1000;
230	callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
231		qla_watchdog, ha);
232}
233
234/*
235 * Name:	qla_pci_attach
236 * Function:	attaches the device to the operating system
237 */
238static int
239qla_pci_attach(device_t dev)
240{
241	qla_host_t *ha = NULL;
242	uint32_t rsrc_len, i;
243
244	QL_DPRINT2((dev, "%s: enter\n", __func__));
245
246        if ((ha = device_get_softc(dev)) == NULL) {
247                device_printf(dev, "cannot get softc\n");
248                return (ENOMEM);
249        }
250
251        memset(ha, 0, sizeof (qla_host_t));
252
253        if (pci_get_device(dev) != PCI_PRODUCT_QLOGIC_ISP8020) {
254                device_printf(dev, "device is not ISP8020\n");
255                return (ENXIO);
256	}
257
258        ha->pci_func = pci_get_function(dev);
259
260        ha->pci_dev = dev;
261
262	pci_enable_busmaster(dev);
263
264	ha->reg_rid = PCIR_BAR(0);
265	ha->pci_reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &ha->reg_rid,
266				RF_ACTIVE);
267
268        if (ha->pci_reg == NULL) {
269                device_printf(dev, "unable to map any ports\n");
270                goto qla_pci_attach_err;
271        }
272
273	rsrc_len = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
274					ha->reg_rid);
275
276	mtx_init(&ha->hw_lock, "qla80xx_hw_lock", MTX_NETWORK_LOCK, MTX_DEF);
277	mtx_init(&ha->tx_lock, "qla80xx_tx_lock", MTX_NETWORK_LOCK, MTX_DEF);
278	mtx_init(&ha->rx_lock, "qla80xx_rx_lock", MTX_NETWORK_LOCK, MTX_DEF);
279	mtx_init(&ha->rxj_lock, "qla80xx_rxj_lock", MTX_NETWORK_LOCK, MTX_DEF);
280	ha->flags.lock_init = 1;
281
282	ha->msix_count = pci_msix_count(dev);
283
284	if (ha->msix_count < qla_get_msix_count(ha)) {
285		device_printf(dev, "%s: msix_count[%d] not enough\n", __func__,
286			ha->msix_count);
287		goto qla_pci_attach_err;
288	}
289
290	QL_DPRINT2((dev, "%s: ha %p irq %p pci_func 0x%x rsrc_count 0x%08x"
291		" msix_count 0x%x pci_reg %p\n", __func__, ha,
292		ha->irq, ha->pci_func, rsrc_len, ha->msix_count, ha->pci_reg));
293
294	ha->msix_count = qla_get_msix_count(ha);
295
296	if (pci_alloc_msix(dev, &ha->msix_count)) {
297		device_printf(dev, "%s: pci_alloc_msi[%d] failed\n", __func__,
298			ha->msix_count);
299		ha->msix_count = 0;
300		goto qla_pci_attach_err;
301	}
302
303	TASK_INIT(&ha->tx_task, 0, qla_tx_done, ha);
304	ha->tx_tq = taskqueue_create_fast("qla_txq", M_NOWAIT,
305			taskqueue_thread_enqueue, &ha->tx_tq);
306	taskqueue_start_threads(&ha->tx_tq, 1, PI_NET, "%s txq",
307		device_get_nameunit(ha->pci_dev));
308
309        for (i = 0; i < ha->msix_count; i++) {
310                ha->irq_vec[i].irq_rid = i+1;
311                ha->irq_vec[i].ha = ha;
312
313                ha->irq_vec[i].irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
314                                        &ha->irq_vec[i].irq_rid,
315                                        (RF_ACTIVE | RF_SHAREABLE));
316
317                if (ha->irq_vec[i].irq == NULL) {
318                        device_printf(dev, "could not allocate interrupt\n");
319                        goto qla_pci_attach_err;
320                }
321
322                if (bus_setup_intr(dev, ha->irq_vec[i].irq,
323                        (INTR_TYPE_NET | INTR_MPSAFE),
324                        NULL, qla_isr, &ha->irq_vec[i],
325                        &ha->irq_vec[i].handle)) {
326                        device_printf(dev, "could not setup interrupt\n");
327                        goto qla_pci_attach_err;
328                }
329
330		TASK_INIT(&ha->irq_vec[i].rcv_task, 0, qla_rcv,\
331			&ha->irq_vec[i]);
332
333		ha->irq_vec[i].rcv_tq = taskqueue_create_fast("qla_rcvq",
334			M_NOWAIT, taskqueue_thread_enqueue,
335			&ha->irq_vec[i].rcv_tq);
336
337		taskqueue_start_threads(&ha->irq_vec[i].rcv_tq, 1, PI_NET,
338			"%s rcvq",
339			device_get_nameunit(ha->pci_dev));
340        }
341
342	qla_add_sysctls(ha);
343
344	/* add hardware specific sysctls */
345	qla_hw_add_sysctls(ha);
346
347	/* initialize hardware */
348	if (qla_init_hw(ha)) {
349		device_printf(dev, "%s: qla_init_hw failed\n", __func__);
350		goto qla_pci_attach_err;
351	}
352
353	device_printf(dev, "%s: firmware[%d.%d.%d.%d]\n", __func__,
354		ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
355		ha->fw_ver_build);
356
357	snprintf(ha->fw_ver_str, sizeof(ha->fw_ver_str), "%d.%d.%d.%d",
358			ha->fw_ver_major, ha->fw_ver_minor, ha->fw_ver_sub,
359			ha->fw_ver_build);
360
361	//qla_get_hw_caps(ha);
362	qla_read_mac_addr(ha);
363
364	/* allocate parent dma tag */
365	if (qla_alloc_parent_dma_tag(ha)) {
366		device_printf(dev, "%s: qla_alloc_parent_dma_tag failed\n",
367			__func__);
368		goto qla_pci_attach_err;
369	}
370
371	/* alloc all dma buffers */
372	if (qla_alloc_dma(ha)) {
373		device_printf(dev, "%s: qla_alloc_dma failed\n", __func__);
374		goto qla_pci_attach_err;
375	}
376
377	/* create the o.s ethernet interface */
378	qla_init_ifnet(dev, ha);
379
380	ha->flags.qla_watchdog_active = 1;
381	ha->flags.qla_watchdog_pause = 1;
382
383	callout_init(&ha->tx_callout, 1);
384
385	/* create ioctl device interface */
386	if (qla_make_cdev(ha)) {
387		device_printf(dev, "%s: qla_make_cdev failed\n", __func__);
388		goto qla_pci_attach_err;
389	}
390
391	callout_reset(&ha->tx_callout, QLA_WATCHDOG_CALLOUT_TICKS,
392		qla_watchdog, ha);
393
394	QL_DPRINT2((dev, "%s: exit 0\n", __func__));
395        return (0);
396
397qla_pci_attach_err:
398
399	qla_release(ha);
400
401	QL_DPRINT2((dev, "%s: exit ENXIO\n", __func__));
402        return (ENXIO);
403}
404
405/*
406 * Name:	qla_pci_detach
407 * Function:	Unhooks the device from the operating system
408 */
409static int
410qla_pci_detach(device_t dev)
411{
412	qla_host_t *ha = NULL;
413	struct ifnet *ifp;
414	int i;
415
416	QL_DPRINT2((dev, "%s: enter\n", __func__));
417
418        if ((ha = device_get_softc(dev)) == NULL) {
419                device_printf(dev, "cannot get softc\n");
420                return (ENOMEM);
421        }
422
423	ifp = ha->ifp;
424
425	QLA_LOCK(ha, __func__);
426	qla_stop(ha);
427	QLA_UNLOCK(ha, __func__);
428
429	if (ha->tx_tq) {
430		taskqueue_drain(ha->tx_tq, &ha->tx_task);
431		taskqueue_free(ha->tx_tq);
432	}
433
434        for (i = 0; i < ha->msix_count; i++) {
435		taskqueue_drain(ha->irq_vec[i].rcv_tq,
436			&ha->irq_vec[i].rcv_task);
437		taskqueue_free(ha->irq_vec[i].rcv_tq);
438	}
439
440	qla_release(ha);
441
442	QL_DPRINT2((dev, "%s: exit\n", __func__));
443
444        return (0);
445}
446
447/*
448 * SYSCTL Related Callbacks
449 */
450static int
451qla_sysctl_get_stats(SYSCTL_HANDLER_ARGS)
452{
453	int err, ret = 0;
454	qla_host_t *ha;
455
456	err = sysctl_handle_int(oidp, &ret, 0, req);
457
458	if (err)
459		return (err);
460
461	ha = (qla_host_t *)arg1;
462	//qla_get_stats(ha);
463	QL_DPRINT2((ha->pci_dev, "%s: called ret %d\n", __func__, ret));
464	return (err);
465}
466
467
468/*
469 * Name:	qla_release
470 * Function:	Releases the resources allocated for the device
471 */
472static void
473qla_release(qla_host_t *ha)
474{
475	device_t dev;
476	int i;
477
478	dev = ha->pci_dev;
479
480	qla_del_cdev(ha);
481
482	if (ha->flags.qla_watchdog_active)
483		ha->flags.qla_watchdog_exit = 1;
484
485	callout_stop(&ha->tx_callout);
486	qla_mdelay(__func__, 100);
487
488	if (ha->ifp != NULL)
489		ether_ifdetach(ha->ifp);
490
491	qla_free_dma(ha);
492	qla_free_parent_dma_tag(ha);
493
494	for (i = 0; i < ha->msix_count; i++) {
495		if (ha->irq_vec[i].handle)
496			(void)bus_teardown_intr(dev, ha->irq_vec[i].irq,
497				ha->irq_vec[i].handle);
498		if (ha->irq_vec[i].irq)
499			(void) bus_release_resource(dev, SYS_RES_IRQ,
500				ha->irq_vec[i].irq_rid,
501				ha->irq_vec[i].irq);
502	}
503	if (ha->msix_count)
504		pci_release_msi(dev);
505
506	if (ha->flags.lock_init) {
507		mtx_destroy(&ha->tx_lock);
508		mtx_destroy(&ha->rx_lock);
509		mtx_destroy(&ha->rxj_lock);
510		mtx_destroy(&ha->hw_lock);
511	}
512
513        if (ha->pci_reg)
514                (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid,
515				ha->pci_reg);
516}
517
518/*
519 * DMA Related Functions
520 */
521
522static void
523qla_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
524{
525        *((bus_addr_t *)arg) = 0;
526
527        if (error) {
528                printf("%s: bus_dmamap_load failed (%d)\n", __func__, error);
529                return;
530	}
531
532        QL_ASSERT((nsegs == 1), ("%s: %d segments returned!", __func__, nsegs));
533
534        *((bus_addr_t *)arg) = segs[0].ds_addr;
535
536	return;
537}
538
539int
540qla_alloc_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
541{
542        int             ret = 0;
543        device_t        dev;
544        bus_addr_t      b_addr;
545
546        dev = ha->pci_dev;
547
548        QL_DPRINT2((dev, "%s: enter\n", __func__));
549
550        ret = bus_dma_tag_create(
551                        ha->parent_tag,/* parent */
552                        dma_buf->alignment,
553                        ((bus_size_t)(1ULL << 32)),/* boundary */
554                        BUS_SPACE_MAXADDR,      /* lowaddr */
555                        BUS_SPACE_MAXADDR,      /* highaddr */
556                        NULL, NULL,             /* filter, filterarg */
557                        dma_buf->size,          /* maxsize */
558                        1,                      /* nsegments */
559                        dma_buf->size,          /* maxsegsize */
560                        0,                      /* flags */
561                        NULL, NULL,             /* lockfunc, lockarg */
562                        &dma_buf->dma_tag);
563
564        if (ret) {
565                device_printf(dev, "%s: could not create dma tag\n", __func__);
566                goto qla_alloc_dmabuf_exit;
567        }
568        ret = bus_dmamem_alloc(dma_buf->dma_tag,
569                        (void **)&dma_buf->dma_b,
570                        (BUS_DMA_ZERO | BUS_DMA_COHERENT | BUS_DMA_NOWAIT),
571                        &dma_buf->dma_map);
572        if (ret) {
573                bus_dma_tag_destroy(dma_buf->dma_tag);
574                device_printf(dev, "%s: bus_dmamem_alloc failed\n", __func__);
575                goto qla_alloc_dmabuf_exit;
576        }
577
578        ret = bus_dmamap_load(dma_buf->dma_tag,
579                        dma_buf->dma_map,
580                        dma_buf->dma_b,
581                        dma_buf->size,
582                        qla_dmamap_callback,
583                        &b_addr, BUS_DMA_NOWAIT);
584
585        if (ret || !b_addr) {
586                bus_dma_tag_destroy(dma_buf->dma_tag);
587                bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b,
588                        dma_buf->dma_map);
589                ret = -1;
590                goto qla_alloc_dmabuf_exit;
591        }
592
593        dma_buf->dma_addr = b_addr;
594
595qla_alloc_dmabuf_exit:
596        QL_DPRINT2((dev, "%s: exit ret 0x%08x tag %p map %p b %p sz 0x%x\n",
597                __func__, ret, (void *)dma_buf->dma_tag,
598                (void *)dma_buf->dma_map, (void *)dma_buf->dma_b,
599		dma_buf->size));
600
601        return ret;
602}
603
604void
605qla_free_dmabuf(qla_host_t *ha, qla_dma_t *dma_buf)
606{
607        bus_dmamap_unload(dma_buf->dma_tag, dma_buf->dma_map);
608        bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b, dma_buf->dma_map);
609        bus_dma_tag_destroy(dma_buf->dma_tag);
610}
611
612static int
613qla_alloc_parent_dma_tag(qla_host_t *ha)
614{
615	int		ret;
616	device_t	dev;
617
618	dev = ha->pci_dev;
619
620        /*
621         * Allocate parent DMA Tag
622         */
623        ret = bus_dma_tag_create(
624                        bus_get_dma_tag(dev),   /* parent */
625                        1,((bus_size_t)(1ULL << 32)),/* alignment, boundary */
626                        BUS_SPACE_MAXADDR,      /* lowaddr */
627                        BUS_SPACE_MAXADDR,      /* highaddr */
628                        NULL, NULL,             /* filter, filterarg */
629                        BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
630                        0,                      /* nsegments */
631                        BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
632                        0,                      /* flags */
633                        NULL, NULL,             /* lockfunc, lockarg */
634                        &ha->parent_tag);
635
636        if (ret) {
637                device_printf(dev, "%s: could not create parent dma tag\n",
638                        __func__);
639		return (-1);
640        }
641
642        ha->flags.parent_tag = 1;
643
644	return (0);
645}
646
647static void
648qla_free_parent_dma_tag(qla_host_t *ha)
649{
650        if (ha->flags.parent_tag) {
651                bus_dma_tag_destroy(ha->parent_tag);
652                ha->flags.parent_tag = 0;
653        }
654}
655
656/*
657 * Name: qla_init_ifnet
658 * Function: Creates the Network Device Interface and Registers it with the O.S
659 */
660
661static void
662qla_init_ifnet(device_t dev, qla_host_t *ha)
663{
664	struct ifnet *ifp;
665
666	QL_DPRINT2((dev, "%s: enter\n", __func__));
667
668	ifp = ha->ifp = if_alloc(IFT_ETHER);
669
670	if (ifp == NULL)
671		panic("%s: cannot if_alloc()\n", device_get_nameunit(dev));
672
673	if_initname(ifp, device_get_name(dev), device_get_unit(dev));
674
675	ifp->if_baudrate = IF_Gbps(10);
676	ifp->if_init = qla_init;
677	ifp->if_softc = ha;
678	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
679	ifp->if_ioctl = qla_ioctl;
680	ifp->if_start = qla_start;
681
682	IFQ_SET_MAXLEN(&ifp->if_snd, qla_get_ifq_snd_maxlen(ha));
683	ifp->if_snd.ifq_drv_maxlen = qla_get_ifq_snd_maxlen(ha);
684	IFQ_SET_READY(&ifp->if_snd);
685
686	ha->max_frame_size = ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
687
688	ether_ifattach(ifp, qla_get_mac_addr(ha));
689
690	ifp->if_capabilities = IFCAP_HWCSUM |
691				IFCAP_TSO4 |
692				IFCAP_JUMBO_MTU;
693
694	ifp->if_capabilities |= IFCAP_VLAN_HWTAGGING | IFCAP_VLAN_MTU;
695	ifp->if_capabilities |= IFCAP_LINKSTATE;
696
697#if defined(__FreeBSD_version) && (__FreeBSD_version < 900002)
698	ifp->if_timer = 0;
699	ifp->if_watchdog = NULL;
700#endif /* #if defined(__FreeBSD_version) && (__FreeBSD_version < 900002) */
701
702	ifp->if_capenable = ifp->if_capabilities;
703
704	ifp->if_hdrlen = sizeof(struct ether_vlan_header);
705
706	ifmedia_init(&ha->media, IFM_IMASK, qla_media_change, qla_media_status);
707
708	ifmedia_add(&ha->media, (IFM_ETHER | qla_get_optics(ha) | IFM_FDX), 0,
709		NULL);
710	ifmedia_add(&ha->media, (IFM_ETHER | IFM_AUTO), 0, NULL);
711
712	ifmedia_set(&ha->media, (IFM_ETHER | IFM_AUTO));
713
714	QL_DPRINT2((dev, "%s: exit\n", __func__));
715
716	return;
717}
718
719static void
720qla_init_locked(qla_host_t *ha)
721{
722	struct ifnet *ifp = ha->ifp;
723
724	qla_stop(ha);
725
726	if (qla_alloc_xmt_bufs(ha) != 0)
727		return;
728
729	if (qla_alloc_rcv_bufs(ha) != 0)
730		return;
731
732	if (qla_config_lro(ha))
733		return;
734
735	bcopy(IF_LLADDR(ha->ifp), ha->hw.mac_addr, ETHER_ADDR_LEN);
736
737	ifp->if_hwassist = CSUM_TCP | CSUM_UDP | CSUM_TSO;
738
739	ha->flags.stop_rcv = 0;
740	if (qla_init_hw_if(ha) == 0) {
741		ifp = ha->ifp;
742		ifp->if_drv_flags |= IFF_DRV_RUNNING;
743		ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
744		ha->flags.qla_watchdog_pause = 0;
745	}
746
747	return;
748}
749
750static void
751qla_init(void *arg)
752{
753	qla_host_t *ha;
754
755	ha = (qla_host_t *)arg;
756
757	QL_DPRINT2((ha->pci_dev, "%s: enter\n", __func__));
758
759	QLA_LOCK(ha, __func__);
760	qla_init_locked(ha);
761	QLA_UNLOCK(ha, __func__);
762
763	QL_DPRINT2((ha->pci_dev, "%s: exit\n", __func__));
764}
765
766static void
767qla_set_multi(qla_host_t *ha, uint32_t add_multi)
768{
769	uint8_t mta[Q8_MAX_NUM_MULTICAST_ADDRS * Q8_MAC_ADDR_LEN];
770	struct ifmultiaddr *ifma;
771	int mcnt = 0;
772	struct ifnet *ifp = ha->ifp;
773
774	if_maddr_rlock(ifp);
775
776	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
777
778		if (ifma->ifma_addr->sa_family != AF_LINK)
779			continue;
780
781		if (mcnt == Q8_MAX_NUM_MULTICAST_ADDRS)
782			break;
783
784		bcopy(LLADDR((struct sockaddr_dl *) ifma->ifma_addr),
785			&mta[mcnt * Q8_MAC_ADDR_LEN], Q8_MAC_ADDR_LEN);
786
787		mcnt++;
788	}
789
790	if_maddr_runlock(ifp);
791
792	qla_hw_set_multi(ha, mta, mcnt, add_multi);
793
794	return;
795}
796
797static int
798qla_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
799{
800	int ret = 0;
801	struct ifreq *ifr = (struct ifreq *)data;
802	struct ifaddr *ifa = (struct ifaddr *)data;
803	qla_host_t *ha;
804
805	ha = (qla_host_t *)ifp->if_softc;
806
807	switch (cmd) {
808	case SIOCSIFADDR:
809		QL_DPRINT4((ha->pci_dev, "%s: SIOCSIFADDR (0x%lx)\n",
810			__func__, cmd));
811
812		if (ifa->ifa_addr->sa_family == AF_INET) {
813			ifp->if_flags |= IFF_UP;
814			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
815				QLA_LOCK(ha, __func__);
816				qla_init_locked(ha);
817				QLA_UNLOCK(ha, __func__);
818			}
819		QL_DPRINT4((ha->pci_dev,
820			"%s: SIOCSIFADDR (0x%lx) ipv4 [0x%08x]\n",
821			__func__, cmd, ntohl(IA_SIN(ifa)->sin_addr.s_addr)));
822
823			arp_ifinit(ifp, ifa);
824			if (ntohl(IA_SIN(ifa)->sin_addr.s_addr) != INADDR_ANY) {
825				qla_config_ipv4_addr(ha,
826					(IA_SIN(ifa)->sin_addr.s_addr));
827			}
828		} else {
829			ether_ioctl(ifp, cmd, data);
830		}
831		break;
832
833	case SIOCSIFMTU:
834		QL_DPRINT4((ha->pci_dev, "%s: SIOCSIFMTU (0x%lx)\n",
835			__func__, cmd));
836
837		if (ifr->ifr_mtu > QLA_MAX_FRAME_SIZE - ETHER_HDR_LEN) {
838			ret = EINVAL;
839		} else {
840			QLA_LOCK(ha, __func__);
841			ifp->if_mtu = ifr->ifr_mtu;
842			ha->max_frame_size =
843				ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
844			if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
845				ret = qla_set_max_mtu(ha, ha->max_frame_size,
846					(ha->hw.rx_cntxt_rsp)->rx_rsp.cntxt_id);
847			}
848			QLA_UNLOCK(ha, __func__);
849
850			if (ret)
851				ret = EINVAL;
852		}
853
854		break;
855
856	case SIOCSIFFLAGS:
857		QL_DPRINT4((ha->pci_dev, "%s: SIOCSIFFLAGS (0x%lx)\n",
858			__func__, cmd));
859
860		if (ifp->if_flags & IFF_UP) {
861			if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
862				if ((ifp->if_flags ^ ha->if_flags) &
863					IFF_PROMISC) {
864					qla_set_promisc(ha);
865				} else if ((ifp->if_flags ^ ha->if_flags) &
866					IFF_ALLMULTI) {
867					qla_set_allmulti(ha);
868				}
869			} else {
870				QLA_LOCK(ha, __func__);
871				qla_init_locked(ha);
872				ha->max_frame_size = ifp->if_mtu +
873					ETHER_HDR_LEN + ETHER_CRC_LEN;
874				ret = qla_set_max_mtu(ha, ha->max_frame_size,
875					(ha->hw.rx_cntxt_rsp)->rx_rsp.cntxt_id);
876				QLA_UNLOCK(ha, __func__);
877			}
878		} else {
879			QLA_LOCK(ha, __func__);
880			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
881				qla_stop(ha);
882			ha->if_flags = ifp->if_flags;
883			QLA_UNLOCK(ha, __func__);
884		}
885		break;
886
887	case SIOCADDMULTI:
888		QL_DPRINT4((ha->pci_dev,
889			"%s: %s (0x%lx)\n", __func__, "SIOCADDMULTI", cmd));
890
891		if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
892			qla_set_multi(ha, 1);
893		}
894		break;
895
896	case SIOCDELMULTI:
897		QL_DPRINT4((ha->pci_dev,
898			"%s: %s (0x%lx)\n", __func__, "SIOCDELMULTI", cmd));
899
900		if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
901			qla_set_multi(ha, 0);
902		}
903		break;
904
905	case SIOCSIFMEDIA:
906	case SIOCGIFMEDIA:
907		QL_DPRINT4((ha->pci_dev,
908			"%s: SIOCSIFMEDIA/SIOCGIFMEDIA (0x%lx)\n",
909			__func__, cmd));
910		ret = ifmedia_ioctl(ifp, ifr, &ha->media, cmd);
911		break;
912
913	case SIOCSIFCAP:
914	{
915		int mask = ifr->ifr_reqcap ^ ifp->if_capenable;
916
917		QL_DPRINT4((ha->pci_dev, "%s: SIOCSIFCAP (0x%lx)\n",
918			__func__, cmd));
919
920		if (mask & IFCAP_HWCSUM)
921			ifp->if_capenable ^= IFCAP_HWCSUM;
922		if (mask & IFCAP_TSO4)
923			ifp->if_capenable ^= IFCAP_TSO4;
924		if (mask & IFCAP_TSO6)
925			ifp->if_capenable ^= IFCAP_TSO6;
926		if (mask & IFCAP_VLAN_HWTAGGING)
927			ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING;
928
929		if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
930			qla_init(ha);
931
932		VLAN_CAPABILITIES(ifp);
933		break;
934	}
935
936	default:
937		QL_DPRINT4((ha->pci_dev, "%s: default (0x%lx)\n",
938			__func__, cmd));
939		ret = ether_ioctl(ifp, cmd, data);
940		break;
941	}
942
943	return (ret);
944}
945
946static int
947qla_media_change(struct ifnet *ifp)
948{
949	qla_host_t *ha;
950	struct ifmedia *ifm;
951	int ret = 0;
952
953	ha = (qla_host_t *)ifp->if_softc;
954
955	QL_DPRINT2((ha->pci_dev, "%s: enter\n", __func__));
956
957	ifm = &ha->media;
958
959	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
960		ret = EINVAL;
961
962	QL_DPRINT2((ha->pci_dev, "%s: exit\n", __func__));
963
964	return (ret);
965}
966
967static void
968qla_media_status(struct ifnet *ifp, struct ifmediareq *ifmr)
969{
970	qla_host_t *ha;
971
972	ha = (qla_host_t *)ifp->if_softc;
973
974	QL_DPRINT2((ha->pci_dev, "%s: enter\n", __func__));
975
976	ifmr->ifm_status = IFM_AVALID;
977	ifmr->ifm_active = IFM_ETHER;
978
979	qla_update_link_state(ha);
980	if (ha->hw.flags.link_up) {
981		ifmr->ifm_status |= IFM_ACTIVE;
982		ifmr->ifm_active |= (IFM_FDX | qla_get_optics(ha));
983	}
984
985	QL_DPRINT2((ha->pci_dev, "%s: exit (%s)\n", __func__,\
986		(ha->hw.flags.link_up ? "link_up" : "link_down")));
987
988	return;
989}
990
991void
992qla_start(struct ifnet *ifp)
993{
994	struct mbuf    *m_head;
995	qla_host_t *ha = (qla_host_t *)ifp->if_softc;
996
997	QL_DPRINT8((ha->pci_dev, "%s: enter\n", __func__));
998
999	if (!mtx_trylock(&ha->tx_lock)) {
1000		QL_DPRINT8((ha->pci_dev,
1001			"%s: mtx_trylock(&ha->tx_lock) failed\n", __func__));
1002		return;
1003	}
1004
1005	if ((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
1006		IFF_DRV_RUNNING) {
1007		QL_DPRINT8((ha->pci_dev, "%s: !IFF_DRV_RUNNING\n", __func__));
1008		QLA_TX_UNLOCK(ha);
1009		return;
1010	}
1011
1012	if (!ha->watchdog_ticks)
1013		qla_update_link_state(ha);
1014
1015	if (!ha->hw.flags.link_up) {
1016		QL_DPRINT8((ha->pci_dev, "%s: link down\n", __func__));
1017		QLA_TX_UNLOCK(ha);
1018		return;
1019	}
1020
1021	while (ifp->if_snd.ifq_head != NULL) {
1022		IF_DEQUEUE(&ifp->if_snd, m_head);
1023
1024		if (m_head == NULL) {
1025			QL_DPRINT8((ha->pci_dev, "%s: m_head == NULL\n",
1026				__func__));
1027			break;
1028		}
1029
1030		if (qla_send(ha, &m_head)) {
1031			if (m_head == NULL)
1032				break;
1033			QL_DPRINT8((ha->pci_dev, "%s: PREPEND\n", __func__));
1034			ifp->if_drv_flags |= IFF_DRV_OACTIVE;
1035			IF_PREPEND(&ifp->if_snd, m_head);
1036			break;
1037		}
1038		/* Send a copy of the frame to the BPF listener */
1039		ETHER_BPF_MTAP(ifp, m_head);
1040	}
1041	QLA_TX_UNLOCK(ha);
1042	QL_DPRINT8((ha->pci_dev, "%s: exit\n", __func__));
1043	return;
1044}
1045
1046static int
1047qla_send(qla_host_t *ha, struct mbuf **m_headp)
1048{
1049	bus_dma_segment_t	segs[QLA_MAX_SEGMENTS];
1050	bus_dmamap_t		map;
1051	int			nsegs;
1052	int			ret = -1;
1053	uint32_t		tx_idx;
1054	struct mbuf *m_head = *m_headp;
1055
1056	QL_DPRINT8((ha->pci_dev, "%s: enter\n", __func__));
1057
1058	if ((ret = bus_dmamap_create(ha->tx_tag, BUS_DMA_NOWAIT, &map))) {
1059		ha->err_tx_dmamap_create++;
1060		device_printf(ha->pci_dev,
1061			"%s: bus_dmamap_create failed[%d, %d]\n",
1062			__func__, ret, m_head->m_pkthdr.len);
1063		return (ret);
1064	}
1065
1066	ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head, segs, &nsegs,
1067			BUS_DMA_NOWAIT);
1068
1069	if (ret == EFBIG) {
1070
1071		struct mbuf *m;
1072
1073		QL_DPRINT8((ha->pci_dev, "%s: EFBIG [%d]\n", __func__,
1074			m_head->m_pkthdr.len));
1075
1076		m = m_defrag(m_head, M_NOWAIT);
1077		if (m == NULL) {
1078			ha->err_tx_defrag++;
1079			m_freem(m_head);
1080			*m_headp = NULL;
1081			device_printf(ha->pci_dev,
1082				"%s: m_defrag() = NULL [%d]\n",
1083				__func__, ret);
1084			return (ENOBUFS);
1085		}
1086		m_head = m;
1087
1088		if ((ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head,
1089					segs, &nsegs, BUS_DMA_NOWAIT))) {
1090
1091			ha->err_tx_dmamap_load++;
1092
1093			device_printf(ha->pci_dev,
1094				"%s: bus_dmamap_load_mbuf_sg failed0[%d, %d]\n",
1095				__func__, ret, m_head->m_pkthdr.len);
1096
1097			bus_dmamap_destroy(ha->tx_tag, map);
1098			if (ret != ENOMEM) {
1099				m_freem(m_head);
1100				*m_headp = NULL;
1101			}
1102			return (ret);
1103		}
1104	} else if (ret) {
1105		ha->err_tx_dmamap_load++;
1106
1107		device_printf(ha->pci_dev,
1108			"%s: bus_dmamap_load_mbuf_sg failed1[%d, %d]\n",
1109			__func__, ret, m_head->m_pkthdr.len);
1110
1111		bus_dmamap_destroy(ha->tx_tag, map);
1112
1113		if (ret != ENOMEM) {
1114			m_freem(m_head);
1115			*m_headp = NULL;
1116		}
1117		return (ret);
1118	}
1119
1120	QL_ASSERT((nsegs != 0), ("qla_send: empty packet"));
1121
1122	bus_dmamap_sync(ha->tx_tag, map, BUS_DMASYNC_PREWRITE);
1123
1124	if (!(ret = qla_hw_send(ha, segs, nsegs, &tx_idx, m_head))) {
1125		ha->tx_buf[tx_idx].m_head = m_head;
1126		ha->tx_buf[tx_idx].map = map;
1127	} else {
1128		if (ret == EINVAL) {
1129			m_freem(m_head);
1130			*m_headp = NULL;
1131		}
1132	}
1133
1134	QL_DPRINT8((ha->pci_dev, "%s: exit\n", __func__));
1135	return (ret);
1136}
1137
1138static void
1139qla_stop(qla_host_t *ha)
1140{
1141	struct ifnet *ifp = ha->ifp;
1142	device_t	dev;
1143
1144	dev = ha->pci_dev;
1145
1146	ha->flags.qla_watchdog_pause = 1;
1147	qla_mdelay(__func__, 100);
1148
1149	ha->flags.stop_rcv = 1;
1150	qla_hw_stop_rcv(ha);
1151
1152	qla_del_hw_if(ha);
1153
1154	qla_free_lro(ha);
1155
1156	qla_free_xmt_bufs(ha);
1157	qla_free_rcv_bufs(ha);
1158
1159	ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE | IFF_DRV_RUNNING);
1160
1161	return;
1162}
1163
1164/*
1165 * Buffer Management Functions for Transmit and Receive Rings
1166 */
1167static int
1168qla_alloc_xmt_bufs(qla_host_t *ha)
1169{
1170	if (bus_dma_tag_create(NULL,    /* parent */
1171		1, 0,    /* alignment, bounds */
1172		BUS_SPACE_MAXADDR,       /* lowaddr */
1173		BUS_SPACE_MAXADDR,       /* highaddr */
1174		NULL, NULL,      /* filter, filterarg */
1175		QLA_MAX_TSO_FRAME_SIZE,     /* maxsize */
1176		QLA_MAX_SEGMENTS,        /* nsegments */
1177		PAGE_SIZE,        /* maxsegsize */
1178		BUS_DMA_ALLOCNOW,        /* flags */
1179		NULL,    /* lockfunc */
1180		NULL,    /* lockfuncarg */
1181		&ha->tx_tag)) {
1182		device_printf(ha->pci_dev, "%s: tx_tag alloc failed\n",
1183			__func__);
1184		return (ENOMEM);
1185	}
1186	bzero((void *)ha->tx_buf, (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1187
1188	return 0;
1189}
1190
1191/*
1192 * Release mbuf after it sent on the wire
1193 */
1194static void
1195qla_clear_tx_buf(qla_host_t *ha, qla_tx_buf_t *txb)
1196{
1197	QL_DPRINT2((ha->pci_dev, "%s: enter\n", __func__));
1198
1199	if (txb->m_head) {
1200
1201		bus_dmamap_unload(ha->tx_tag, txb->map);
1202		bus_dmamap_destroy(ha->tx_tag, txb->map);
1203
1204		m_freem(txb->m_head);
1205		txb->m_head = NULL;
1206	}
1207
1208	QL_DPRINT2((ha->pci_dev, "%s: exit\n", __func__));
1209}
1210
1211static void
1212qla_free_xmt_bufs(qla_host_t *ha)
1213{
1214	int		i;
1215
1216	for (i = 0; i < NUM_TX_DESCRIPTORS; i++)
1217		qla_clear_tx_buf(ha, &ha->tx_buf[i]);
1218
1219	if (ha->tx_tag != NULL) {
1220		bus_dma_tag_destroy(ha->tx_tag);
1221		ha->tx_tag = NULL;
1222	}
1223	bzero((void *)ha->tx_buf, (sizeof(qla_tx_buf_t) * NUM_TX_DESCRIPTORS));
1224
1225	return;
1226}
1227
1228
1229static int
1230qla_alloc_rcv_bufs(qla_host_t *ha)
1231{
1232	int		i, j, ret = 0;
1233	qla_rx_buf_t	*rxb;
1234
1235	if (bus_dma_tag_create(NULL,    /* parent */
1236			1, 0,    /* alignment, bounds */
1237			BUS_SPACE_MAXADDR,       /* lowaddr */
1238			BUS_SPACE_MAXADDR,       /* highaddr */
1239			NULL, NULL,      /* filter, filterarg */
1240			MJUM9BYTES,     /* maxsize */
1241			1,        /* nsegments */
1242			MJUM9BYTES,        /* maxsegsize */
1243			BUS_DMA_ALLOCNOW,        /* flags */
1244			NULL,    /* lockfunc */
1245			NULL,    /* lockfuncarg */
1246			&ha->rx_tag)) {
1247
1248		device_printf(ha->pci_dev, "%s: rx_tag alloc failed\n",
1249			__func__);
1250
1251		return (ENOMEM);
1252	}
1253
1254	bzero((void *)ha->rx_buf, (sizeof(qla_rx_buf_t) * NUM_RX_DESCRIPTORS));
1255	bzero((void *)ha->rx_jbuf,
1256		(sizeof(qla_rx_buf_t) * NUM_RX_JUMBO_DESCRIPTORS));
1257
1258	for (i = 0; i < MAX_SDS_RINGS; i++) {
1259		ha->hw.sds[i].sdsr_next = 0;
1260		ha->hw.sds[i].rxb_free = NULL;
1261		ha->hw.sds[i].rx_free = 0;
1262		ha->hw.sds[i].rxjb_free = NULL;
1263		ha->hw.sds[i].rxj_free = 0;
1264	}
1265
1266	for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1267
1268		rxb = &ha->rx_buf[i];
1269
1270		ret = bus_dmamap_create(ha->rx_tag, BUS_DMA_NOWAIT, &rxb->map);
1271
1272		if (ret) {
1273			device_printf(ha->pci_dev,
1274				"%s: dmamap[%d] failed\n", __func__, i);
1275
1276			for (j = 0; j < i; j++) {
1277				bus_dmamap_destroy(ha->rx_tag,
1278					ha->rx_buf[j].map);
1279			}
1280			goto qla_alloc_rcv_bufs_failed;
1281		}
1282	}
1283
1284	qla_init_hw_rcv_descriptors(ha, RDS_RING_INDEX_NORMAL);
1285
1286	for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1287		rxb = &ha->rx_buf[i];
1288		rxb->handle = i;
1289		if (!(ret = qla_get_mbuf(ha, rxb, NULL, 0))) {
1290			/*
1291		 	 * set the physical address in the corresponding
1292			 * descriptor entry in the receive ring/queue for the
1293			 * hba
1294			 */
1295			qla_set_hw_rcv_desc(ha, RDS_RING_INDEX_NORMAL, i,
1296				rxb->handle, rxb->paddr,
1297				(rxb->m_head)->m_pkthdr.len);
1298		} else {
1299			device_printf(ha->pci_dev,
1300				"%s: qla_get_mbuf [standard(%d)] failed\n",
1301				__func__, i);
1302			bus_dmamap_destroy(ha->rx_tag, rxb->map);
1303			goto qla_alloc_rcv_bufs_failed;
1304		}
1305	}
1306
1307
1308	for (i = 0; i < NUM_RX_JUMBO_DESCRIPTORS; i++) {
1309
1310		rxb = &ha->rx_jbuf[i];
1311
1312		ret = bus_dmamap_create(ha->rx_tag, BUS_DMA_NOWAIT, &rxb->map);
1313
1314		if (ret) {
1315			device_printf(ha->pci_dev,
1316				"%s: dmamap[%d] failed\n", __func__, i);
1317
1318			for (j = 0; j < i; j++) {
1319				bus_dmamap_destroy(ha->rx_tag,
1320					ha->rx_jbuf[j].map);
1321			}
1322			goto qla_alloc_rcv_bufs_failed;
1323		}
1324	}
1325
1326	qla_init_hw_rcv_descriptors(ha, RDS_RING_INDEX_JUMBO);
1327
1328	for (i = 0; i < NUM_RX_JUMBO_DESCRIPTORS; i++) {
1329		rxb = &ha->rx_jbuf[i];
1330		rxb->handle = i;
1331		if (!(ret = qla_get_mbuf(ha, rxb, NULL, 1))) {
1332			/*
1333		 	 * set the physical address in the corresponding
1334			 * descriptor entry in the receive ring/queue for the
1335			 * hba
1336			 */
1337			qla_set_hw_rcv_desc(ha, RDS_RING_INDEX_JUMBO, i,
1338				rxb->handle, rxb->paddr,
1339				(rxb->m_head)->m_pkthdr.len);
1340		} else {
1341			device_printf(ha->pci_dev,
1342				"%s: qla_get_mbuf [jumbo(%d)] failed\n",
1343				__func__, i);
1344			bus_dmamap_destroy(ha->rx_tag, rxb->map);
1345			goto qla_alloc_rcv_bufs_failed;
1346		}
1347	}
1348
1349	return (0);
1350
1351qla_alloc_rcv_bufs_failed:
1352	qla_free_rcv_bufs(ha);
1353	return (ret);
1354}
1355
1356static void
1357qla_free_rcv_bufs(qla_host_t *ha)
1358{
1359	int		i;
1360	qla_rx_buf_t	*rxb;
1361
1362	for (i = 0; i < NUM_RX_DESCRIPTORS; i++) {
1363		rxb = &ha->rx_buf[i];
1364		if (rxb->m_head != NULL) {
1365			bus_dmamap_unload(ha->rx_tag, rxb->map);
1366			bus_dmamap_destroy(ha->rx_tag, rxb->map);
1367			m_freem(rxb->m_head);
1368			rxb->m_head = NULL;
1369		}
1370	}
1371
1372	for (i = 0; i < NUM_RX_JUMBO_DESCRIPTORS; i++) {
1373		rxb = &ha->rx_jbuf[i];
1374		if (rxb->m_head != NULL) {
1375			bus_dmamap_unload(ha->rx_tag, rxb->map);
1376			bus_dmamap_destroy(ha->rx_tag, rxb->map);
1377			m_freem(rxb->m_head);
1378			rxb->m_head = NULL;
1379		}
1380	}
1381
1382	if (ha->rx_tag != NULL) {
1383		bus_dma_tag_destroy(ha->rx_tag);
1384		ha->rx_tag = NULL;
1385	}
1386
1387	bzero((void *)ha->rx_buf, (sizeof(qla_rx_buf_t) * NUM_RX_DESCRIPTORS));
1388	bzero((void *)ha->rx_jbuf,
1389		(sizeof(qla_rx_buf_t) * NUM_RX_JUMBO_DESCRIPTORS));
1390
1391	for (i = 0; i < MAX_SDS_RINGS; i++) {
1392		ha->hw.sds[i].sdsr_next = 0;
1393		ha->hw.sds[i].rxb_free = NULL;
1394		ha->hw.sds[i].rx_free = 0;
1395		ha->hw.sds[i].rxjb_free = NULL;
1396		ha->hw.sds[i].rxj_free = 0;
1397	}
1398
1399	return;
1400}
1401
1402int
1403qla_get_mbuf(qla_host_t *ha, qla_rx_buf_t *rxb, struct mbuf *nmp,
1404	uint32_t jumbo)
1405{
1406	register struct mbuf *mp = nmp;
1407	struct ifnet   *ifp;
1408	int             ret = 0;
1409	uint32_t	offset;
1410
1411	QL_DPRINT2((ha->pci_dev, "%s: jumbo(0x%x) enter\n", __func__, jumbo));
1412
1413	ifp = ha->ifp;
1414
1415	if (mp == NULL) {
1416
1417		if (!jumbo) {
1418			mp = m_getcl(M_NOWAIT, MT_DATA, M_PKTHDR);
1419
1420			if (mp == NULL) {
1421				ha->err_m_getcl++;
1422				ret = ENOBUFS;
1423				device_printf(ha->pci_dev,
1424					"%s: m_getcl failed\n", __func__);
1425				goto exit_qla_get_mbuf;
1426			}
1427			mp->m_len = mp->m_pkthdr.len = MCLBYTES;
1428		} else {
1429			mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR,
1430				MJUM9BYTES);
1431			if (mp == NULL) {
1432				ha->err_m_getjcl++;
1433				ret = ENOBUFS;
1434				device_printf(ha->pci_dev,
1435					"%s: m_getjcl failed\n", __func__);
1436				goto exit_qla_get_mbuf;
1437			}
1438			mp->m_len = mp->m_pkthdr.len = MJUM9BYTES;
1439		}
1440	} else {
1441		if (!jumbo)
1442			mp->m_len = mp->m_pkthdr.len = MCLBYTES;
1443		else
1444			mp->m_len = mp->m_pkthdr.len = MJUM9BYTES;
1445
1446		mp->m_data = mp->m_ext.ext_buf;
1447		mp->m_next = NULL;
1448	}
1449
1450
1451	offset = (uint32_t)((unsigned long long)mp->m_data & 0x7ULL);
1452	if (offset) {
1453		offset = 8 - offset;
1454		m_adj(mp, offset);
1455	}
1456
1457	/*
1458	 * Using memory from the mbuf cluster pool, invoke the bus_dma
1459	 * machinery to arrange the memory mapping.
1460	 */
1461	ret = bus_dmamap_load(ha->rx_tag, rxb->map,
1462				mtod(mp, void *), mp->m_len,
1463				qla_dmamap_callback, &rxb->paddr,
1464				BUS_DMA_NOWAIT);
1465	if (ret || !rxb->paddr) {
1466		m_free(mp);
1467		rxb->m_head = NULL;
1468		device_printf(ha->pci_dev,
1469			"%s: bus_dmamap_load failed\n", __func__);
1470                ret = -1;
1471		goto exit_qla_get_mbuf;
1472	}
1473	rxb->m_head = mp;
1474	bus_dmamap_sync(ha->rx_tag, rxb->map, BUS_DMASYNC_PREREAD);
1475
1476exit_qla_get_mbuf:
1477	QL_DPRINT2((ha->pci_dev, "%s: exit ret = 0x%08x\n", __func__, ret));
1478	return (ret);
1479}
1480
1481static void
1482qla_tx_done(void *context, int pending)
1483{
1484	qla_host_t *ha = context;
1485
1486	qla_hw_tx_done(ha);
1487	qla_start(ha->ifp);
1488}
1489
1490