qlnx_os.c revision 316485
1/*
2 * Copyright (c) 2017-2018 Cavium, Inc.
3 * All rights reserved.
4 *
5 *  Redistribution and use in source and binary forms, with or without
6 *  modification, are permitted provided that the following conditions
7 *  are met:
8 *
9 *  1. Redistributions of source code must retain the above copyright
10 *     notice, this list of conditions and the following disclaimer.
11 *  2. Redistributions in binary form must reproduce the above copyright
12 *     notice, this list of conditions and the following disclaimer in the
13 *     documentation and/or other materials provided with the distribution.
14 *
15 *  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
16 *  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 *  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 *  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
19 *  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
20 *  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
21 *  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
22 *  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
23 *  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
24 *  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
25 *  POSSIBILITY OF SUCH DAMAGE.
26 */
27
28
29/*
30 * File: qlnx_os.c
31 * Author : David C Somayajulu, Cavium, Inc., San Jose, CA 95131.
32 */
33
34#include <sys/cdefs.h>
35__FBSDID("$FreeBSD: head/sys/dev/qlnx/qlnxe/qlnx_os.c 316485 2017-04-04 06:16:59Z davidcs $");
36
37#include "qlnx_os.h"
38#include "bcm_osal.h"
39#include "reg_addr.h"
40#include "ecore_gtt_reg_addr.h"
41#include "ecore.h"
42#include "ecore_chain.h"
43#include "ecore_status.h"
44#include "ecore_hw.h"
45#include "ecore_rt_defs.h"
46#include "ecore_init_ops.h"
47#include "ecore_int.h"
48#include "ecore_cxt.h"
49#include "ecore_spq.h"
50#include "ecore_init_fw_funcs.h"
51#include "ecore_sp_commands.h"
52#include "ecore_dev_api.h"
53#include "ecore_l2_api.h"
54#include "ecore_mcp.h"
55#include "ecore_hw_defs.h"
56#include "mcp_public.h"
57#include "ecore_iro.h"
58#include "nvm_cfg.h"
59#include "ecore_dev_api.h"
60#include "ecore_dbg_fw_funcs.h"
61
62#include "qlnx_ioctl.h"
63#include "qlnx_def.h"
64#include "qlnx_ver.h"
65#include <sys/smp.h>
66
67
68/*
69 * static functions
70 */
71/*
72 * ioctl related functions
73 */
74static void qlnx_add_sysctls(qlnx_host_t *ha);
75
76/*
77 * main driver
78 */
79static void qlnx_release(qlnx_host_t *ha);
80static void qlnx_fp_isr(void *arg);
81static void qlnx_init_ifnet(device_t dev, qlnx_host_t *ha);
82static void qlnx_init(void *arg);
83static void qlnx_init_locked(qlnx_host_t *ha);
84static int qlnx_set_multi(qlnx_host_t *ha, uint32_t add_multi);
85static int qlnx_set_promisc(qlnx_host_t *ha);
86static int qlnx_set_allmulti(qlnx_host_t *ha);
87static int qlnx_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data);
88static int qlnx_media_change(struct ifnet *ifp);
89static void qlnx_media_status(struct ifnet *ifp, struct ifmediareq *ifmr);
90static void qlnx_stop(qlnx_host_t *ha);
91static int qlnx_send(qlnx_host_t *ha, struct qlnx_fastpath *fp,
92		struct mbuf **m_headp);
93static int qlnx_get_ifq_snd_maxlen(qlnx_host_t *ha);
94static uint32_t qlnx_get_optics(qlnx_host_t *ha,
95			struct qlnx_link_output *if_link);
96static int qlnx_transmit(struct ifnet *ifp, struct mbuf  *mp);
97static void qlnx_qflush(struct ifnet *ifp);
98
99static int qlnx_alloc_parent_dma_tag(qlnx_host_t *ha);
100static void qlnx_free_parent_dma_tag(qlnx_host_t *ha);
101static int qlnx_alloc_tx_dma_tag(qlnx_host_t *ha);
102static void qlnx_free_tx_dma_tag(qlnx_host_t *ha);
103static int qlnx_alloc_rx_dma_tag(qlnx_host_t *ha);
104static void qlnx_free_rx_dma_tag(qlnx_host_t *ha);
105
106static int qlnx_get_mfw_version(qlnx_host_t *ha, uint32_t *mfw_ver);
107static int qlnx_get_flash_size(qlnx_host_t *ha, uint32_t *flash_size);
108
109static int qlnx_nic_setup(struct ecore_dev *cdev,
110		struct ecore_pf_params *func_params);
111static int qlnx_nic_start(struct ecore_dev *cdev);
112static int qlnx_slowpath_start(qlnx_host_t *ha);
113static int qlnx_slowpath_stop(qlnx_host_t *ha);
114static int qlnx_init_hw(qlnx_host_t *ha);
115static void qlnx_set_id(struct ecore_dev *cdev, char name[NAME_SIZE],
116		char ver_str[VER_SIZE]);
117static void qlnx_unload(qlnx_host_t *ha);
118static int qlnx_load(qlnx_host_t *ha);
119static void qlnx_hw_set_multi(qlnx_host_t *ha, uint8_t *mta, uint32_t mcnt,
120		uint32_t add_mac);
121static void qlnx_dump_buf8(qlnx_host_t *ha, const char *msg, void *dbuf,
122		uint32_t len);
123static int qlnx_alloc_rx_buffer(qlnx_host_t *ha, struct qlnx_rx_queue *rxq);
124static void qlnx_reuse_rx_data(struct qlnx_rx_queue *rxq);
125static void qlnx_update_rx_prod(struct ecore_hwfn *p_hwfn,
126		struct qlnx_rx_queue *rxq);
127static int qlnx_set_rx_accept_filter(qlnx_host_t *ha, uint8_t filter);
128static int qlnx_grc_dumpsize(qlnx_host_t *ha, uint32_t *num_dwords,
129		int hwfn_index);
130static int qlnx_idle_chk_size(qlnx_host_t *ha, uint32_t *num_dwords,
131		int hwfn_index);
132static void qlnx_timer(void *arg);
133static int qlnx_alloc_tx_br(qlnx_host_t *ha, struct qlnx_fastpath *fp);
134static void qlnx_free_tx_br(qlnx_host_t *ha, struct qlnx_fastpath *fp);
135static void qlnx_trigger_dump(qlnx_host_t *ha);
136static void qlnx_tx_int(qlnx_host_t *ha, struct qlnx_fastpath *fp,
137		struct qlnx_tx_queue *txq);
138static int qlnx_rx_int(qlnx_host_t *ha, struct qlnx_fastpath *fp, int budget,
139		int lro_enable);
140static void qlnx_fp_taskqueue(void *context, int pending);
141static void qlnx_sample_storm_stats(qlnx_host_t *ha);
142static int qlnx_alloc_tpa_mbuf(qlnx_host_t *ha, uint16_t rx_buf_size,
143		struct qlnx_agg_info *tpa);
144static void qlnx_free_tpa_mbuf(qlnx_host_t *ha, struct qlnx_agg_info *tpa);
145
146#if __FreeBSD_version >= 1100000
147static uint64_t qlnx_get_counter(if_t ifp, ift_counter cnt);
148#endif
149
150
151/*
152 * Hooks to the Operating Systems
153 */
154static int qlnx_pci_probe (device_t);
155static int qlnx_pci_attach (device_t);
156static int qlnx_pci_detach (device_t);
157
158static device_method_t qlnx_pci_methods[] = {
159	/* Device interface */
160	DEVMETHOD(device_probe, qlnx_pci_probe),
161	DEVMETHOD(device_attach, qlnx_pci_attach),
162	DEVMETHOD(device_detach, qlnx_pci_detach),
163	{ 0, 0 }
164};
165
166static driver_t qlnx_pci_driver = {
167	"ql", qlnx_pci_methods, sizeof (qlnx_host_t),
168};
169
170static devclass_t qlnx_devclass;
171
172MODULE_VERSION(if_qlnxe,1);
173DRIVER_MODULE(if_qlnxe, pci, qlnx_pci_driver, qlnx_devclass, 0, 0);
174
175MODULE_DEPEND(if_qlnxe, pci, 1, 1, 1);
176MODULE_DEPEND(if_qlnxe, ether, 1, 1, 1);
177
178MALLOC_DEFINE(M_QLNXBUF, "qlnxbuf", "Buffers for qlnx driver");
179
180
181char qlnx_dev_str[64];
182char qlnx_ver_str[VER_SIZE];
183char qlnx_name_str[NAME_SIZE];
184
185/*
186 * Some PCI Configuration Space Related Defines
187 */
188
189#ifndef PCI_VENDOR_QLOGIC
190#define PCI_VENDOR_QLOGIC		0x1077
191#endif
192
193/* 40G Adapter QLE45xxx*/
194#ifndef QLOGIC_PCI_DEVICE_ID_1634
195#define QLOGIC_PCI_DEVICE_ID_1634	0x1634
196#endif
197
198/* 100G Adapter QLE45xxx*/
199#ifndef QLOGIC_PCI_DEVICE_ID_1644
200#define QLOGIC_PCI_DEVICE_ID_1644	0x1644
201#endif
202
203/* 25G Adapter QLE45xxx*/
204#ifndef QLOGIC_PCI_DEVICE_ID_1656
205#define QLOGIC_PCI_DEVICE_ID_1656	0x1656
206#endif
207
208/* 50G Adapter QLE45xxx*/
209#ifndef QLOGIC_PCI_DEVICE_ID_1654
210#define QLOGIC_PCI_DEVICE_ID_1654	0x1654
211#endif
212
213static int
214qlnx_valid_device(device_t dev)
215{
216        uint16_t	device_id;
217
218        device_id = pci_get_device(dev);
219
220        if ((device_id == QLOGIC_PCI_DEVICE_ID_1634) ||
221                (device_id == QLOGIC_PCI_DEVICE_ID_1644) ||
222                (device_id == QLOGIC_PCI_DEVICE_ID_1656) ||
223                (device_id == QLOGIC_PCI_DEVICE_ID_1654))
224                return 0;
225
226        return -1;
227}
228
229/*
230 * Name:	qlnx_pci_probe
231 * Function:	Validate the PCI device to be a QLA80XX device
232 */
233static int
234qlnx_pci_probe(device_t dev)
235{
236	snprintf(qlnx_ver_str, sizeof(qlnx_ver_str), "v%d.%d.%d",
237		QLNX_VERSION_MAJOR, QLNX_VERSION_MINOR, QLNX_VERSION_BUILD);
238	snprintf(qlnx_name_str, sizeof(qlnx_name_str), "qlnx");
239
240	if (pci_get_vendor(dev) != PCI_VENDOR_QLOGIC) {
241                return (ENXIO);
242	}
243
244        switch (pci_get_device(dev)) {
245
246        case QLOGIC_PCI_DEVICE_ID_1644:
247		snprintf(qlnx_dev_str, sizeof(qlnx_dev_str), "%s v%d.%d.%d",
248			"Qlogic 100GbE PCI CNA Adapter-Ethernet Function",
249			QLNX_VERSION_MAJOR, QLNX_VERSION_MINOR,
250			QLNX_VERSION_BUILD);
251                device_set_desc_copy(dev, qlnx_dev_str);
252
253                break;
254
255        case QLOGIC_PCI_DEVICE_ID_1634:
256		snprintf(qlnx_dev_str, sizeof(qlnx_dev_str), "%s v%d.%d.%d",
257			"Qlogic 40GbE PCI CNA Adapter-Ethernet Function",
258			QLNX_VERSION_MAJOR, QLNX_VERSION_MINOR,
259			QLNX_VERSION_BUILD);
260                device_set_desc_copy(dev, qlnx_dev_str);
261
262                break;
263
264        case QLOGIC_PCI_DEVICE_ID_1656:
265		snprintf(qlnx_dev_str, sizeof(qlnx_dev_str), "%s v%d.%d.%d",
266			"Qlogic 25GbE PCI CNA Adapter-Ethernet Function",
267			QLNX_VERSION_MAJOR, QLNX_VERSION_MINOR,
268			QLNX_VERSION_BUILD);
269                device_set_desc_copy(dev, qlnx_dev_str);
270
271                break;
272
273        case QLOGIC_PCI_DEVICE_ID_1654:
274		snprintf(qlnx_dev_str, sizeof(qlnx_dev_str), "%s v%d.%d.%d",
275			"Qlogic 50GbE PCI CNA Adapter-Ethernet Function",
276			QLNX_VERSION_MAJOR, QLNX_VERSION_MINOR,
277			QLNX_VERSION_BUILD);
278                device_set_desc_copy(dev, qlnx_dev_str);
279
280                break;
281
282        default:
283                return (ENXIO);
284        }
285
286        return (BUS_PROBE_DEFAULT);
287}
288
289
290static void
291qlnx_sp_intr(void *arg)
292{
293	struct ecore_hwfn	*p_hwfn;
294	qlnx_host_t		*ha;
295	int			i;
296
297	p_hwfn = arg;
298
299	if (p_hwfn == NULL) {
300		printf("%s: spurious slowpath intr\n", __func__);
301		return;
302	}
303
304	ha = (qlnx_host_t *)p_hwfn->p_dev;
305
306	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
307
308	for (i = 0; i < ha->cdev.num_hwfns; i++) {
309		if (&ha->cdev.hwfns[i] == p_hwfn) {
310			taskqueue_enqueue(ha->sp_taskqueue[i], &ha->sp_task[i]);
311			break;
312		}
313	}
314	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
315
316	return;
317}
318
319static void
320qlnx_sp_taskqueue(void *context, int pending)
321{
322	struct ecore_hwfn	*p_hwfn;
323
324	p_hwfn = context;
325
326	if (p_hwfn != NULL) {
327		qlnx_sp_isr(p_hwfn);
328	}
329	return;
330}
331
332static int
333qlnx_create_sp_taskqueues(qlnx_host_t *ha)
334{
335	int	i;
336	uint8_t	tq_name[32];
337
338	for (i = 0; i < ha->cdev.num_hwfns; i++) {
339
340                struct ecore_hwfn *p_hwfn = &ha->cdev.hwfns[i];
341
342		bzero(tq_name, sizeof (tq_name));
343		snprintf(tq_name, sizeof (tq_name), "ql_sp_tq_%d", i);
344
345		TASK_INIT(&ha->sp_task[i], 0, qlnx_sp_taskqueue, p_hwfn);
346
347		ha->sp_taskqueue[i] = taskqueue_create_fast(tq_name, M_NOWAIT,
348			 taskqueue_thread_enqueue, &ha->sp_taskqueue[i]);
349
350		if (ha->sp_taskqueue[i] == NULL)
351			return (-1);
352
353		taskqueue_start_threads(&ha->sp_taskqueue[i], 1, PI_NET, "%s",
354			tq_name);
355
356		QL_DPRINT1(ha, (ha->pci_dev, "%s: %p\n", __func__,
357			ha->sp_taskqueue[i]));
358	}
359
360	return (0);
361}
362
363static void
364qlnx_destroy_sp_taskqueues(qlnx_host_t *ha)
365{
366	int	i;
367
368	for (i = 0; i < ha->cdev.num_hwfns; i++) {
369		if (ha->sp_taskqueue[i] != NULL) {
370			taskqueue_drain(ha->sp_taskqueue[i], &ha->sp_task[i]);
371			taskqueue_free(ha->sp_taskqueue[i]);
372		}
373	}
374	return;
375}
376
377static void
378qlnx_fp_taskqueue(void *context, int pending)
379{
380        struct qlnx_fastpath	*fp;
381        qlnx_host_t		*ha;
382        struct ifnet		*ifp;
383        struct mbuf		*mp;
384        int			ret;
385
386        fp = context;
387
388        if (fp == NULL)
389                return;
390
391        ha = (qlnx_host_t *)fp->edev;
392
393        ifp = ha->ifp;
394
395        mtx_lock(&fp->tx_mtx);
396
397        if (((ifp->if_drv_flags & (IFF_DRV_RUNNING | IFF_DRV_OACTIVE)) !=
398                IFF_DRV_RUNNING) || (!ha->link_up)) {
399
400                mtx_unlock(&fp->tx_mtx);
401                goto qlnx_fp_taskqueue_exit;
402        }
403
404        (void)qlnx_tx_int(ha, fp, fp->txq[0]);
405
406        mp = drbr_peek(ifp, fp->tx_br);
407
408        while (mp != NULL) {
409
410                ret = qlnx_send(ha, fp, &mp);
411
412                if (ret) {
413
414                        if (mp != NULL) {
415                                drbr_putback(ifp, fp->tx_br, mp);
416                        } else {
417                                fp->tx_pkts_processed++;
418                                drbr_advance(ifp, fp->tx_br);
419                        }
420
421                        mtx_unlock(&fp->tx_mtx);
422
423                        goto qlnx_fp_taskqueue_exit;
424
425                } else {
426                        drbr_advance(ifp, fp->tx_br);
427                        fp->tx_pkts_transmitted++;
428                        fp->tx_pkts_processed++;
429                }
430
431                mp = drbr_peek(ifp, fp->tx_br);
432        }
433
434        (void)qlnx_tx_int(ha, fp, fp->txq[0]);
435
436        mtx_unlock(&fp->tx_mtx);
437
438qlnx_fp_taskqueue_exit:
439
440        QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
441        return;
442}
443
444static int
445qlnx_create_fp_taskqueues(qlnx_host_t *ha)
446{
447	int	i;
448	uint8_t	tq_name[32];
449	struct qlnx_fastpath *fp;
450
451	for (i = 0; i < ha->num_rss; i++) {
452
453                fp = &ha->fp_array[i];
454
455		bzero(tq_name, sizeof (tq_name));
456		snprintf(tq_name, sizeof (tq_name), "ql_fp_tq_%d", i);
457
458		TASK_INIT(&fp->fp_task, 0, qlnx_fp_taskqueue, fp);
459
460		fp->fp_taskqueue = taskqueue_create_fast(tq_name, M_NOWAIT,
461					taskqueue_thread_enqueue,
462					&fp->fp_taskqueue);
463
464		if (fp->fp_taskqueue == NULL)
465			return (-1);
466
467		taskqueue_start_threads(&fp->fp_taskqueue, 1, PI_NET, "%s",
468			tq_name);
469
470		QL_DPRINT1(ha, (ha->pci_dev, "%s: %p\n", __func__,
471			fp->fp_taskqueue));
472	}
473
474	return (0);
475}
476
477static void
478qlnx_destroy_fp_taskqueues(qlnx_host_t *ha)
479{
480	int			i;
481	struct qlnx_fastpath	*fp;
482
483	for (i = 0; i < ha->num_rss; i++) {
484
485                fp = &ha->fp_array[i];
486
487		if (fp->fp_taskqueue != NULL) {
488
489			taskqueue_drain(fp->fp_taskqueue, &fp->fp_task);
490			taskqueue_free(fp->fp_taskqueue);
491			fp->fp_taskqueue = NULL;
492		}
493	}
494	return;
495}
496
497static void
498qlnx_drain_fp_taskqueues(qlnx_host_t *ha)
499{
500	int			i;
501	struct qlnx_fastpath	*fp;
502
503	for (i = 0; i < ha->num_rss; i++) {
504                fp = &ha->fp_array[i];
505
506		if (fp->fp_taskqueue != NULL) {
507			taskqueue_drain(fp->fp_taskqueue, &fp->fp_task);
508		}
509	}
510	return;
511}
512
513/*
514 * Name:	qlnx_pci_attach
515 * Function:	attaches the device to the operating system
516 */
517static int
518qlnx_pci_attach(device_t dev)
519{
520	qlnx_host_t	*ha = NULL;
521	uint32_t	rsrc_len_reg = 0;
522	uint32_t	rsrc_len_dbells = 0;
523	uint32_t	rsrc_len_msix = 0;
524	int		i;
525	uint32_t	mfw_ver;
526
527        if ((ha = device_get_softc(dev)) == NULL) {
528                device_printf(dev, "cannot get softc\n");
529                return (ENOMEM);
530        }
531
532        memset(ha, 0, sizeof (qlnx_host_t));
533
534        if (qlnx_valid_device(dev) != 0) {
535                device_printf(dev, "device is not valid device\n");
536                return (ENXIO);
537	}
538        ha->pci_func = pci_get_function(dev);
539
540        ha->pci_dev = dev;
541
542	mtx_init(&ha->hw_lock, "qlnx_hw_lock", MTX_NETWORK_LOCK, MTX_DEF);
543        mtx_init(&ha->tx_lock, "qlnx_tx_lock", MTX_NETWORK_LOCK, MTX_DEF);
544
545        ha->flags.lock_init = 1;
546
547        pci_enable_busmaster(dev);
548
549	/*
550	 * map the PCI BARs
551	 */
552
553        ha->reg_rid = PCIR_BAR(0);
554        ha->pci_reg = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &ha->reg_rid,
555                                RF_ACTIVE);
556
557        if (ha->pci_reg == NULL) {
558                device_printf(dev, "unable to map BAR0\n");
559                goto qlnx_pci_attach_err;
560        }
561
562        rsrc_len_reg = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
563                                        ha->reg_rid);
564
565        ha->dbells_rid = PCIR_BAR(2);
566        ha->pci_dbells = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
567                        &ha->dbells_rid, RF_ACTIVE);
568
569        if (ha->pci_dbells == NULL) {
570                device_printf(dev, "unable to map BAR1\n");
571                goto qlnx_pci_attach_err;
572	}
573
574        rsrc_len_dbells = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
575                                        ha->dbells_rid);
576
577	ha->dbells_phys_addr = (uint64_t)
578		bus_get_resource_start(dev, SYS_RES_MEMORY, ha->dbells_rid);;
579	ha->dbells_size = rsrc_len_dbells;
580
581        ha->msix_rid = PCIR_BAR(4);
582        ha->msix_bar = bus_alloc_resource_any(dev, SYS_RES_MEMORY,
583                        &ha->msix_rid, RF_ACTIVE);
584
585        if (ha->msix_bar == NULL) {
586                device_printf(dev, "unable to map BAR2\n");
587                goto qlnx_pci_attach_err;
588	}
589
590        rsrc_len_msix = (uint32_t) bus_get_resource_count(dev, SYS_RES_MEMORY,
591                                        ha->msix_rid);
592	/*
593	 * allocate dma tags
594	 */
595
596	if (qlnx_alloc_parent_dma_tag(ha))
597                goto qlnx_pci_attach_err;
598
599	if (qlnx_alloc_tx_dma_tag(ha))
600                goto qlnx_pci_attach_err;
601
602	if (qlnx_alloc_rx_dma_tag(ha))
603                goto qlnx_pci_attach_err;
604
605
606	if (qlnx_init_hw(ha) != 0)
607		goto qlnx_pci_attach_err;
608
609	/*
610	 * Allocate MSI-x vectors
611	 */
612	ha->num_rss = QLNX_MAX_RSS;
613	ha->num_tc = QLNX_MAX_TC;
614
615        ha->msix_count = pci_msix_count(dev);
616
617	if (ha->msix_count > (mp_ncpus + ha->cdev.num_hwfns))
618		ha->msix_count = mp_ncpus + ha->cdev.num_hwfns;
619
620        if (!ha->msix_count ||
621		(ha->msix_count < (ha->cdev.num_hwfns + 1 ))) {
622                device_printf(dev, "%s: msix_count[%d] not enough\n", __func__,
623                        ha->msix_count);
624                goto qlnx_pci_attach_err;
625        }
626
627	if (ha->msix_count > (ha->num_rss + ha->cdev.num_hwfns ))
628		ha->msix_count = ha->num_rss + ha->cdev.num_hwfns;
629	else
630		ha->num_rss = ha->msix_count - ha->cdev.num_hwfns;
631
632	QL_DPRINT1(ha, (dev, "%s:\n\t\t\tpci_reg [%p, 0x%08x 0x%08x]"
633		"\n\t\t\tdbells [%p, 0x%08x 0x%08x]"
634		"\n\t\t\tmsix [%p, 0x%08x 0x%08x 0x%x 0x%x]"
635		"\n\t\t\t[ncpus = %d][num_rss = 0x%x] [num_tc = 0x%x]\n",
636		__func__, ha->pci_reg, rsrc_len_reg,
637		ha->reg_rid, ha->pci_dbells, rsrc_len_dbells, ha->dbells_rid,
638		ha->msix_bar, rsrc_len_msix, ha->msix_rid, pci_msix_count(dev),
639		ha->msix_count, mp_ncpus, ha->num_rss, ha->num_tc));
640
641        if (pci_alloc_msix(dev, &ha->msix_count)) {
642                device_printf(dev, "%s: pci_alloc_msix[%d] failed\n", __func__,
643                        ha->msix_count);
644                ha->msix_count = 0;
645                goto qlnx_pci_attach_err;
646        }
647
648	/*
649	 * Initialize slow path interrupt and task queue
650	 */
651	if (qlnx_create_sp_taskqueues(ha) != 0)
652		goto qlnx_pci_attach_err;
653
654	for (i = 0; i < ha->cdev.num_hwfns; i++) {
655
656                struct ecore_hwfn *p_hwfn = &ha->cdev.hwfns[i];
657
658        	ha->sp_irq_rid[i] = i + 1;
659        	ha->sp_irq[i] = bus_alloc_resource_any(dev, SYS_RES_IRQ,
660                                &ha->sp_irq_rid[i],
661                                (RF_ACTIVE | RF_SHAREABLE));
662        	if (ha->sp_irq[i] == NULL) {
663                	device_printf(dev,
664				"could not allocate mbx interrupt\n");
665                	goto qlnx_pci_attach_err;
666        	}
667
668        	if (bus_setup_intr(dev, ha->sp_irq[i],
669				(INTR_TYPE_NET | INTR_MPSAFE), NULL,
670				qlnx_sp_intr, p_hwfn, &ha->sp_handle[i])) {
671                	device_printf(dev,
672				"could not setup slow path interrupt\n");
673			goto qlnx_pci_attach_err;
674		}
675
676		QL_DPRINT1(ha, (dev, "%s: p_hwfn [%p] sp_irq_rid %d"
677			" sp_irq %p sp_handle %p\n", __func__, p_hwfn,
678			ha->sp_irq_rid[i], ha->sp_irq[i], ha->sp_handle[i]));
679
680	}
681
682	/*
683	 * initialize fast path interrupt
684	 */
685	if (qlnx_create_fp_taskqueues(ha) != 0)
686		goto qlnx_pci_attach_err;
687
688        for (i = 0; i < ha->num_rss; i++) {
689                ha->irq_vec[i].rss_idx = i;
690                ha->irq_vec[i].ha = ha;
691                ha->irq_vec[i].irq_rid = (1 + ha->cdev.num_hwfns) + i;
692
693                ha->irq_vec[i].irq = bus_alloc_resource_any(dev, SYS_RES_IRQ,
694                                &ha->irq_vec[i].irq_rid,
695                                (RF_ACTIVE | RF_SHAREABLE));
696
697                if (ha->irq_vec[i].irq == NULL) {
698                        device_printf(dev,
699				"could not allocate interrupt[%d]\n", i);
700                        goto qlnx_pci_attach_err;
701                }
702
703		if (qlnx_alloc_tx_br(ha, &ha->fp_array[i])) {
704                        device_printf(dev, "could not allocate tx_br[%d]\n", i);
705                        goto qlnx_pci_attach_err;
706
707		}
708	}
709
710	callout_init(&ha->qlnx_callout, 1);
711	ha->flags.callout_init = 1;
712
713	for (i = 0; i < ha->cdev.num_hwfns; i++) {
714
715		if (qlnx_grc_dumpsize(ha, &ha->grcdump_size[i], i) != 0)
716			goto qlnx_pci_attach_err;
717		if (ha->grcdump_size[i] == 0)
718			goto qlnx_pci_attach_err;
719
720		ha->grcdump_size[i] = ha->grcdump_size[i] << 2;
721		QL_DPRINT1(ha, (dev, "grcdump_size[%d] = 0x%08x\n",
722			i, ha->grcdump_size[i]));
723
724		ha->grcdump[i] = qlnx_zalloc(ha->grcdump_size[i]);
725		if (ha->grcdump[i] == NULL) {
726			device_printf(dev, "grcdump alloc[%d] failed\n", i);
727			goto qlnx_pci_attach_err;
728		}
729
730		if (qlnx_idle_chk_size(ha, &ha->idle_chk_size[i], i) != 0)
731			goto qlnx_pci_attach_err;
732		if (ha->idle_chk_size[i] == 0)
733			goto qlnx_pci_attach_err;
734
735		ha->idle_chk_size[i] = ha->idle_chk_size[i] << 2;
736		QL_DPRINT1(ha, (dev, "idle_chk_size[%d] = 0x%08x\n",
737			i, ha->idle_chk_size[i]));
738
739		ha->idle_chk[i] = qlnx_zalloc(ha->idle_chk_size[i]);
740
741		if (ha->idle_chk[i] == NULL) {
742			device_printf(dev, "idle_chk alloc failed\n");
743			goto qlnx_pci_attach_err;
744		}
745	}
746
747	if (qlnx_slowpath_start(ha) != 0) {
748
749		qlnx_mdelay(__func__, 1000);
750		qlnx_trigger_dump(ha);
751
752		goto qlnx_pci_attach_err0;
753	} else
754		ha->flags.slowpath_start = 1;
755
756	if (qlnx_get_flash_size(ha, &ha->flash_size) != 0) {
757		qlnx_mdelay(__func__, 1000);
758		qlnx_trigger_dump(ha);
759
760		goto qlnx_pci_attach_err0;
761	}
762
763	if (qlnx_get_mfw_version(ha, &mfw_ver) != 0) {
764		qlnx_mdelay(__func__, 1000);
765		qlnx_trigger_dump(ha);
766
767		goto qlnx_pci_attach_err0;
768	}
769	snprintf(ha->mfw_ver, sizeof(ha->mfw_ver), "%d.%d.%d.%d",
770		((mfw_ver >> 24) & 0xFF), ((mfw_ver >> 16) & 0xFF),
771		((mfw_ver >> 8) & 0xFF), (mfw_ver & 0xFF));
772	snprintf(ha->stormfw_ver, sizeof(ha->stormfw_ver), "%d.%d.%d.%d",
773		FW_MAJOR_VERSION, FW_MINOR_VERSION, FW_REVISION_VERSION,
774		FW_ENGINEERING_VERSION);
775
776	QL_DPRINT1(ha, (dev, "%s: STORM_FW version %s MFW version %s\n",
777		__func__, ha->stormfw_ver, ha->mfw_ver));
778
779	qlnx_init_ifnet(dev, ha);
780
781	/*
782	 * add sysctls
783	 */
784	qlnx_add_sysctls(ha);
785
786qlnx_pci_attach_err0:
787        /*
788	 * create ioctl device interface
789	 */
790        if (qlnx_make_cdev(ha)) {
791                device_printf(dev, "%s: ql_make_cdev failed\n", __func__);
792                goto qlnx_pci_attach_err;
793        }
794
795	QL_DPRINT2(ha, (dev, "%s: success\n", __func__));
796
797        return (0);
798
799qlnx_pci_attach_err:
800
801	qlnx_release(ha);
802
803	return (ENXIO);
804}
805
806/*
807 * Name:	qlnx_pci_detach
808 * Function:	Unhooks the device from the operating system
809 */
810static int
811qlnx_pci_detach(device_t dev)
812{
813	qlnx_host_t	*ha = NULL;
814
815        if ((ha = device_get_softc(dev)) == NULL) {
816                device_printf(dev, "cannot get softc\n");
817                return (ENOMEM);
818        }
819
820	QLNX_LOCK(ha);
821	qlnx_stop(ha);
822	QLNX_UNLOCK(ha);
823
824	qlnx_release(ha);
825
826        return (0);
827}
828
829static int
830qlnx_init_hw(qlnx_host_t *ha)
831{
832	int				rval = 0;
833	struct ecore_hw_prepare_params	params;
834
835	ecore_init_struct(&ha->cdev);
836
837	/* ha->dp_module = ECORE_MSG_PROBE |
838				ECORE_MSG_INTR |
839				ECORE_MSG_SP |
840				ECORE_MSG_LINK |
841				ECORE_MSG_SPQ |
842				ECORE_MSG_RDMA;
843	ha->dp_level = ECORE_LEVEL_VERBOSE;*/
844	ha->dp_level = ECORE_LEVEL_NOTICE;
845
846	ecore_init_dp(&ha->cdev, ha->dp_module, ha->dp_level, ha->pci_dev);
847
848	ha->cdev.regview = ha->pci_reg;
849	ha->cdev.doorbells = ha->pci_dbells;
850	ha->cdev.db_phys_addr = ha->dbells_phys_addr;
851	ha->cdev.db_size = ha->dbells_size;
852
853	bzero(&params, sizeof (struct ecore_hw_prepare_params));
854
855	ha->personality = ECORE_PCI_DEFAULT;
856
857	params.personality = ha->personality;
858
859	params.drv_resc_alloc = false;
860	params.chk_reg_fifo = false;
861	params.initiate_pf_flr = true;
862	params.epoch = 0;
863
864	ecore_hw_prepare(&ha->cdev, &params);
865
866	qlnx_set_id(&ha->cdev, qlnx_name_str, qlnx_ver_str);
867
868	return (rval);
869}
870
871static void
872qlnx_release(qlnx_host_t *ha)
873{
874        device_t	dev;
875        int		i;
876
877        dev = ha->pci_dev;
878
879	QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
880
881	for (i = 0; i < QLNX_MAX_HW_FUNCS; i++) {
882		if (ha->idle_chk[i] != NULL) {
883			free(ha->idle_chk[i], M_QLNXBUF);
884			ha->idle_chk[i] = NULL;
885		}
886
887		if (ha->grcdump[i] != NULL) {
888			free(ha->grcdump[i], M_QLNXBUF);
889			ha->grcdump[i] = NULL;
890		}
891	}
892
893        if (ha->flags.callout_init)
894                callout_drain(&ha->qlnx_callout);
895
896	if (ha->flags.slowpath_start) {
897		qlnx_slowpath_stop(ha);
898	}
899
900	ecore_hw_remove(&ha->cdev);
901
902        qlnx_del_cdev(ha);
903
904        if (ha->ifp != NULL)
905                ether_ifdetach(ha->ifp);
906
907	qlnx_free_tx_dma_tag(ha);
908
909	qlnx_free_rx_dma_tag(ha);
910
911	qlnx_free_parent_dma_tag(ha);
912
913        for (i = 0; i < ha->num_rss; i++) {
914		struct qlnx_fastpath *fp = &ha->fp_array[i];
915
916                if (ha->irq_vec[i].handle) {
917                        (void)bus_teardown_intr(dev, ha->irq_vec[i].irq,
918                                        ha->irq_vec[i].handle);
919                }
920
921                if (ha->irq_vec[i].irq) {
922                        (void)bus_release_resource(dev, SYS_RES_IRQ,
923                                ha->irq_vec[i].irq_rid,
924                                ha->irq_vec[i].irq);
925                }
926
927		qlnx_free_tx_br(ha, fp);
928        }
929	qlnx_destroy_fp_taskqueues(ha);
930
931 	for (i = 0; i < ha->cdev.num_hwfns; i++) {
932        	if (ha->sp_handle[i])
933                	(void)bus_teardown_intr(dev, ha->sp_irq[i],
934				ha->sp_handle[i]);
935
936        	if (ha->sp_irq[i])
937			(void) bus_release_resource(dev, SYS_RES_IRQ,
938				ha->sp_irq_rid[i], ha->sp_irq[i]);
939	}
940
941	qlnx_destroy_sp_taskqueues(ha);
942
943        if (ha->msix_count)
944                pci_release_msi(dev);
945
946        if (ha->flags.lock_init) {
947                mtx_destroy(&ha->tx_lock);
948                mtx_destroy(&ha->hw_lock);
949        }
950
951        if (ha->pci_reg)
952                (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->reg_rid,
953                                ha->pci_reg);
954
955        if (ha->pci_dbells)
956                (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->dbells_rid,
957                                ha->pci_dbells);
958
959        if (ha->msix_bar)
960                (void) bus_release_resource(dev, SYS_RES_MEMORY, ha->msix_rid,
961                                ha->msix_bar);
962
963	QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
964	return;
965}
966
967static void
968qlnx_trigger_dump(qlnx_host_t *ha)
969{
970	int	i;
971
972	if (ha->ifp != NULL)
973		ha->ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE | IFF_DRV_RUNNING);
974
975	QL_DPRINT2(ha, (ha->pci_dev, "%s: start\n", __func__));
976
977	for (i = 0; i < ha->cdev.num_hwfns; i++) {
978		qlnx_grc_dump(ha, &ha->grcdump_dwords[i], i);
979		qlnx_idle_chk(ha, &ha->idle_chk_dwords[i], i);
980	}
981
982	QL_DPRINT2(ha, (ha->pci_dev, "%s: end\n", __func__));
983
984	return;
985}
986
987static int
988qlnx_trigger_dump_sysctl(SYSCTL_HANDLER_ARGS)
989{
990        int		err, ret = 0;
991        qlnx_host_t	*ha;
992
993        err = sysctl_handle_int(oidp, &ret, 0, req);
994
995        if (err || !req->newptr)
996                return (err);
997
998        if (ret == 1) {
999                ha = (qlnx_host_t *)arg1;
1000                qlnx_trigger_dump(ha);
1001        }
1002        return (err);
1003}
1004
1005static int
1006qlnx_set_tx_coalesce(SYSCTL_HANDLER_ARGS)
1007{
1008        int			err, i, ret = 0, usecs = 0;
1009        qlnx_host_t		*ha;
1010	struct ecore_hwfn	*p_hwfn;
1011	struct qlnx_fastpath	*fp;
1012
1013        err = sysctl_handle_int(oidp, &usecs, 0, req);
1014
1015        if (err || !req->newptr || !usecs || (usecs > 255))
1016                return (err);
1017
1018        ha = (qlnx_host_t *)arg1;
1019
1020	for (i = 0; i < ha->num_rss; i++) {
1021
1022		p_hwfn = &ha->cdev.hwfns[(i % ha->cdev.num_hwfns)];
1023
1024        	fp = &ha->fp_array[i];
1025
1026		if (fp->txq[0]->handle != NULL) {
1027			ret = ecore_set_queue_coalesce(p_hwfn, 0,
1028					(uint16_t)usecs, fp->txq[0]->handle);
1029		}
1030        }
1031
1032	if (!ret)
1033		ha->tx_coalesce_usecs = (uint8_t)usecs;
1034
1035        return (err);
1036}
1037
1038static int
1039qlnx_set_rx_coalesce(SYSCTL_HANDLER_ARGS)
1040{
1041        int			err, i, ret = 0, usecs = 0;
1042        qlnx_host_t		*ha;
1043	struct ecore_hwfn	*p_hwfn;
1044	struct qlnx_fastpath	*fp;
1045
1046        err = sysctl_handle_int(oidp, &usecs, 0, req);
1047
1048        if (err || !req->newptr || !usecs || (usecs > 255))
1049                return (err);
1050
1051        ha = (qlnx_host_t *)arg1;
1052
1053	for (i = 0; i < ha->num_rss; i++) {
1054
1055		p_hwfn = &ha->cdev.hwfns[(i % ha->cdev.num_hwfns)];
1056
1057        	fp = &ha->fp_array[i];
1058
1059		if (fp->rxq->handle != NULL) {
1060			ret = ecore_set_queue_coalesce(p_hwfn, (uint16_t)usecs,
1061					 0, fp->rxq->handle);
1062		}
1063	}
1064
1065	if (!ret)
1066		ha->rx_coalesce_usecs = (uint8_t)usecs;
1067
1068        return (err);
1069}
1070
1071static void
1072qlnx_add_sp_stats_sysctls(qlnx_host_t *ha)
1073{
1074        struct sysctl_ctx_list	*ctx;
1075        struct sysctl_oid_list	*children;
1076	struct sysctl_oid	*ctx_oid;
1077
1078        ctx = device_get_sysctl_ctx(ha->pci_dev);
1079	children = SYSCTL_CHILDREN(device_get_sysctl_tree(ha->pci_dev));
1080
1081	ctx_oid = SYSCTL_ADD_NODE(ctx, children, OID_AUTO, "spstat",
1082			CTLFLAG_RD, NULL, "spstat");
1083        children = SYSCTL_CHILDREN(ctx_oid);
1084
1085	SYSCTL_ADD_QUAD(ctx, children,
1086                OID_AUTO, "sp_interrupts",
1087                CTLFLAG_RD, &ha->sp_interrupts,
1088                "No. of slowpath interrupts");
1089
1090	return;
1091}
1092
1093static void
1094qlnx_add_fp_stats_sysctls(qlnx_host_t *ha)
1095{
1096        struct sysctl_ctx_list	*ctx;
1097        struct sysctl_oid_list	*children;
1098        struct sysctl_oid_list	*node_children;
1099	struct sysctl_oid	*ctx_oid;
1100	int			i, j;
1101	uint8_t			name_str[16];
1102
1103        ctx = device_get_sysctl_ctx(ha->pci_dev);
1104	children = SYSCTL_CHILDREN(device_get_sysctl_tree(ha->pci_dev));
1105
1106	ctx_oid = SYSCTL_ADD_NODE(ctx, children, OID_AUTO, "fpstat",
1107			CTLFLAG_RD, NULL, "fpstat");
1108	children = SYSCTL_CHILDREN(ctx_oid);
1109
1110	for (i = 0; i < ha->num_rss; i++) {
1111
1112		bzero(name_str, (sizeof(uint8_t) * sizeof(name_str)));
1113		snprintf(name_str, sizeof(name_str), "%d", i);
1114
1115		ctx_oid = SYSCTL_ADD_NODE(ctx, children, OID_AUTO, name_str,
1116			CTLFLAG_RD, NULL, name_str);
1117		node_children = SYSCTL_CHILDREN(ctx_oid);
1118
1119		/* Tx Related */
1120
1121		SYSCTL_ADD_QUAD(ctx, node_children,
1122			OID_AUTO, "tx_pkts_processed",
1123			CTLFLAG_RD, &ha->fp_array[i].tx_pkts_processed,
1124			"No. of packets processed for transmission");
1125
1126		SYSCTL_ADD_QUAD(ctx, node_children,
1127			OID_AUTO, "tx_pkts_freed",
1128			CTLFLAG_RD, &ha->fp_array[i].tx_pkts_freed,
1129			"No. of freed packets");
1130
1131		SYSCTL_ADD_QUAD(ctx, node_children,
1132			OID_AUTO, "tx_pkts_transmitted",
1133			CTLFLAG_RD, &ha->fp_array[i].tx_pkts_transmitted,
1134			"No. of transmitted packets");
1135
1136		SYSCTL_ADD_QUAD(ctx, node_children,
1137			OID_AUTO, "tx_pkts_completed",
1138			CTLFLAG_RD, &ha->fp_array[i].tx_pkts_completed,
1139			"No. of transmit completions");
1140
1141		SYSCTL_ADD_QUAD(ctx, node_children,
1142			OID_AUTO, "tx_lso_wnd_min_len",
1143			CTLFLAG_RD, &ha->fp_array[i].tx_lso_wnd_min_len,
1144			"tx_lso_wnd_min_len");
1145
1146		SYSCTL_ADD_QUAD(ctx, node_children,
1147			OID_AUTO, "tx_defrag",
1148			CTLFLAG_RD, &ha->fp_array[i].tx_defrag,
1149			"tx_defrag");
1150
1151		SYSCTL_ADD_QUAD(ctx, node_children,
1152			OID_AUTO, "tx_nsegs_gt_elem_left",
1153			CTLFLAG_RD, &ha->fp_array[i].tx_nsegs_gt_elem_left,
1154			"tx_nsegs_gt_elem_left");
1155
1156		SYSCTL_ADD_UINT(ctx, node_children,
1157			OID_AUTO, "tx_tso_max_nsegs",
1158			CTLFLAG_RD, &ha->fp_array[i].tx_tso_max_nsegs,
1159			ha->fp_array[i].tx_tso_max_nsegs, "tx_tso_max_nsegs");
1160
1161		SYSCTL_ADD_UINT(ctx, node_children,
1162			OID_AUTO, "tx_tso_min_nsegs",
1163			CTLFLAG_RD, &ha->fp_array[i].tx_tso_min_nsegs,
1164			ha->fp_array[i].tx_tso_min_nsegs, "tx_tso_min_nsegs");
1165
1166		SYSCTL_ADD_UINT(ctx, node_children,
1167			OID_AUTO, "tx_tso_max_pkt_len",
1168			CTLFLAG_RD, &ha->fp_array[i].tx_tso_max_pkt_len,
1169			ha->fp_array[i].tx_tso_max_pkt_len,
1170			"tx_tso_max_pkt_len");
1171
1172		SYSCTL_ADD_UINT(ctx, node_children,
1173			OID_AUTO, "tx_tso_min_pkt_len",
1174			CTLFLAG_RD, &ha->fp_array[i].tx_tso_min_pkt_len,
1175			ha->fp_array[i].tx_tso_min_pkt_len,
1176			"tx_tso_min_pkt_len");
1177
1178		for (j = 0; j < QLNX_FP_MAX_SEGS; j++) {
1179
1180			bzero(name_str, (sizeof(uint8_t) * sizeof(name_str)));
1181			snprintf(name_str, sizeof(name_str),
1182				"tx_pkts_nseg_%02d", (j+1));
1183
1184			SYSCTL_ADD_QUAD(ctx, node_children,
1185				OID_AUTO, name_str, CTLFLAG_RD,
1186				&ha->fp_array[i].tx_pkts[j], name_str);
1187		}
1188
1189		SYSCTL_ADD_QUAD(ctx, node_children,
1190			OID_AUTO, "err_tx_nsegs_gt_elem_left",
1191			CTLFLAG_RD, &ha->fp_array[i].err_tx_nsegs_gt_elem_left,
1192			"err_tx_nsegs_gt_elem_left");
1193
1194		SYSCTL_ADD_QUAD(ctx, node_children,
1195			OID_AUTO, "err_tx_dmamap_create",
1196			CTLFLAG_RD, &ha->fp_array[i].err_tx_dmamap_create,
1197			"err_tx_dmamap_create");
1198
1199		SYSCTL_ADD_QUAD(ctx, node_children,
1200			OID_AUTO, "err_tx_defrag_dmamap_load",
1201			CTLFLAG_RD, &ha->fp_array[i].err_tx_defrag_dmamap_load,
1202			"err_tx_defrag_dmamap_load");
1203
1204		SYSCTL_ADD_QUAD(ctx, node_children,
1205			OID_AUTO, "err_tx_non_tso_max_seg",
1206			CTLFLAG_RD, &ha->fp_array[i].err_tx_non_tso_max_seg,
1207			"err_tx_non_tso_max_seg");
1208
1209		SYSCTL_ADD_QUAD(ctx, node_children,
1210			OID_AUTO, "err_tx_dmamap_load",
1211			CTLFLAG_RD, &ha->fp_array[i].err_tx_dmamap_load,
1212			"err_tx_dmamap_load");
1213
1214		SYSCTL_ADD_QUAD(ctx, node_children,
1215			OID_AUTO, "err_tx_defrag",
1216			CTLFLAG_RD, &ha->fp_array[i].err_tx_defrag,
1217			"err_tx_defrag");
1218
1219		SYSCTL_ADD_QUAD(ctx, node_children,
1220			OID_AUTO, "err_tx_free_pkt_null",
1221			CTLFLAG_RD, &ha->fp_array[i].err_tx_free_pkt_null,
1222			"err_tx_free_pkt_null");
1223
1224		SYSCTL_ADD_QUAD(ctx, node_children,
1225			OID_AUTO, "err_tx_cons_idx_conflict",
1226			CTLFLAG_RD, &ha->fp_array[i].err_tx_cons_idx_conflict,
1227			"err_tx_cons_idx_conflict");
1228
1229#ifdef QLNX_TRACE_LRO_CNT
1230		SYSCTL_ADD_QUAD(ctx, node_children,
1231			OID_AUTO, "lro_cnt_64",
1232			CTLFLAG_RD, &ha->fp_array[i].lro_cnt_64,
1233			"lro_cnt_64");
1234
1235		SYSCTL_ADD_QUAD(ctx, node_children,
1236			OID_AUTO, "lro_cnt_128",
1237			CTLFLAG_RD, &ha->fp_array[i].lro_cnt_128,
1238			"lro_cnt_128");
1239
1240		SYSCTL_ADD_QUAD(ctx, node_children,
1241			OID_AUTO, "lro_cnt_256",
1242			CTLFLAG_RD, &ha->fp_array[i].lro_cnt_256,
1243			"lro_cnt_256");
1244
1245		SYSCTL_ADD_QUAD(ctx, node_children,
1246			OID_AUTO, "lro_cnt_512",
1247			CTLFLAG_RD, &ha->fp_array[i].lro_cnt_512,
1248			"lro_cnt_512");
1249
1250		SYSCTL_ADD_QUAD(ctx, node_children,
1251			OID_AUTO, "lro_cnt_1024",
1252			CTLFLAG_RD, &ha->fp_array[i].lro_cnt_1024,
1253			"lro_cnt_1024");
1254#endif /* #ifdef QLNX_TRACE_LRO_CNT */
1255
1256		/* Rx Related */
1257
1258		SYSCTL_ADD_QUAD(ctx, node_children,
1259			OID_AUTO, "rx_pkts",
1260			CTLFLAG_RD, &ha->fp_array[i].rx_pkts,
1261			"No. of received packets");
1262
1263		SYSCTL_ADD_QUAD(ctx, node_children,
1264			OID_AUTO, "tpa_start",
1265			CTLFLAG_RD, &ha->fp_array[i].tpa_start,
1266			"No. of tpa_start packets");
1267
1268		SYSCTL_ADD_QUAD(ctx, node_children,
1269			OID_AUTO, "tpa_cont",
1270			CTLFLAG_RD, &ha->fp_array[i].tpa_cont,
1271			"No. of tpa_cont packets");
1272
1273		SYSCTL_ADD_QUAD(ctx, node_children,
1274			OID_AUTO, "tpa_end",
1275			CTLFLAG_RD, &ha->fp_array[i].tpa_end,
1276			"No. of tpa_end packets");
1277
1278		SYSCTL_ADD_QUAD(ctx, node_children,
1279			OID_AUTO, "err_m_getcl",
1280			CTLFLAG_RD, &ha->fp_array[i].err_m_getcl,
1281			"err_m_getcl");
1282
1283		SYSCTL_ADD_QUAD(ctx, node_children,
1284			OID_AUTO, "err_m_getjcl",
1285			CTLFLAG_RD, &ha->fp_array[i].err_m_getjcl,
1286			"err_m_getjcl");
1287
1288		SYSCTL_ADD_QUAD(ctx, node_children,
1289			OID_AUTO, "err_rx_hw_errors",
1290			CTLFLAG_RD, &ha->fp_array[i].err_rx_hw_errors,
1291			"err_rx_hw_errors");
1292
1293		SYSCTL_ADD_QUAD(ctx, node_children,
1294			OID_AUTO, "err_rx_alloc_errors",
1295			CTLFLAG_RD, &ha->fp_array[i].err_rx_alloc_errors,
1296			"err_rx_alloc_errors");
1297	}
1298
1299	return;
1300}
1301
1302static void
1303qlnx_add_hw_stats_sysctls(qlnx_host_t *ha)
1304{
1305        struct sysctl_ctx_list	*ctx;
1306        struct sysctl_oid_list	*children;
1307	struct sysctl_oid	*ctx_oid;
1308
1309        ctx = device_get_sysctl_ctx(ha->pci_dev);
1310	children = SYSCTL_CHILDREN(device_get_sysctl_tree(ha->pci_dev));
1311
1312	ctx_oid = SYSCTL_ADD_NODE(ctx, children, OID_AUTO, "hwstat",
1313			CTLFLAG_RD, NULL, "hwstat");
1314        children = SYSCTL_CHILDREN(ctx_oid);
1315
1316	SYSCTL_ADD_QUAD(ctx, children,
1317                OID_AUTO, "no_buff_discards",
1318                CTLFLAG_RD, &ha->hw_stats.common.no_buff_discards,
1319                "No. of packets discarded due to lack of buffer");
1320
1321	SYSCTL_ADD_QUAD(ctx, children,
1322                OID_AUTO, "packet_too_big_discard",
1323                CTLFLAG_RD, &ha->hw_stats.common.packet_too_big_discard,
1324                "No. of packets discarded because packet was too big");
1325
1326	SYSCTL_ADD_QUAD(ctx, children,
1327                OID_AUTO, "ttl0_discard",
1328                CTLFLAG_RD, &ha->hw_stats.common.ttl0_discard,
1329                "ttl0_discard");
1330
1331	SYSCTL_ADD_QUAD(ctx, children,
1332                OID_AUTO, "rx_ucast_bytes",
1333                CTLFLAG_RD, &ha->hw_stats.common.rx_ucast_bytes,
1334                "rx_ucast_bytes");
1335
1336	SYSCTL_ADD_QUAD(ctx, children,
1337                OID_AUTO, "rx_mcast_bytes",
1338                CTLFLAG_RD, &ha->hw_stats.common.rx_mcast_bytes,
1339                "rx_mcast_bytes");
1340
1341	SYSCTL_ADD_QUAD(ctx, children,
1342                OID_AUTO, "rx_bcast_bytes",
1343                CTLFLAG_RD, &ha->hw_stats.common.rx_bcast_bytes,
1344                "rx_bcast_bytes");
1345
1346	SYSCTL_ADD_QUAD(ctx, children,
1347                OID_AUTO, "rx_ucast_pkts",
1348                CTLFLAG_RD, &ha->hw_stats.common.rx_ucast_pkts,
1349                "rx_ucast_pkts");
1350
1351	SYSCTL_ADD_QUAD(ctx, children,
1352                OID_AUTO, "rx_mcast_pkts",
1353                CTLFLAG_RD, &ha->hw_stats.common.rx_mcast_pkts,
1354                "rx_mcast_pkts");
1355
1356	SYSCTL_ADD_QUAD(ctx, children,
1357                OID_AUTO, "rx_bcast_pkts",
1358                CTLFLAG_RD, &ha->hw_stats.common.rx_bcast_pkts,
1359                "rx_bcast_pkts");
1360
1361	SYSCTL_ADD_QUAD(ctx, children,
1362                OID_AUTO, "mftag_filter_discards",
1363                CTLFLAG_RD, &ha->hw_stats.common.mftag_filter_discards,
1364                "mftag_filter_discards");
1365
1366	SYSCTL_ADD_QUAD(ctx, children,
1367                OID_AUTO, "mac_filter_discards",
1368                CTLFLAG_RD, &ha->hw_stats.common.mac_filter_discards,
1369                "mac_filter_discards");
1370
1371	SYSCTL_ADD_QUAD(ctx, children,
1372                OID_AUTO, "tx_ucast_bytes",
1373                CTLFLAG_RD, &ha->hw_stats.common.tx_ucast_bytes,
1374                "tx_ucast_bytes");
1375
1376	SYSCTL_ADD_QUAD(ctx, children,
1377                OID_AUTO, "tx_mcast_bytes",
1378                CTLFLAG_RD, &ha->hw_stats.common.tx_mcast_bytes,
1379                "tx_mcast_bytes");
1380
1381	SYSCTL_ADD_QUAD(ctx, children,
1382                OID_AUTO, "tx_bcast_bytes",
1383                CTLFLAG_RD, &ha->hw_stats.common.tx_bcast_bytes,
1384                "tx_bcast_bytes");
1385
1386	SYSCTL_ADD_QUAD(ctx, children,
1387                OID_AUTO, "tx_ucast_pkts",
1388                CTLFLAG_RD, &ha->hw_stats.common.tx_ucast_pkts,
1389                "tx_ucast_pkts");
1390
1391	SYSCTL_ADD_QUAD(ctx, children,
1392                OID_AUTO, "tx_mcast_pkts",
1393                CTLFLAG_RD, &ha->hw_stats.common.tx_mcast_pkts,
1394                "tx_mcast_pkts");
1395
1396	SYSCTL_ADD_QUAD(ctx, children,
1397                OID_AUTO, "tx_bcast_pkts",
1398                CTLFLAG_RD, &ha->hw_stats.common.tx_bcast_pkts,
1399                "tx_bcast_pkts");
1400
1401	SYSCTL_ADD_QUAD(ctx, children,
1402                OID_AUTO, "tx_err_drop_pkts",
1403                CTLFLAG_RD, &ha->hw_stats.common.tx_err_drop_pkts,
1404                "tx_err_drop_pkts");
1405
1406	SYSCTL_ADD_QUAD(ctx, children,
1407                OID_AUTO, "tpa_coalesced_pkts",
1408                CTLFLAG_RD, &ha->hw_stats.common.tpa_coalesced_pkts,
1409                "tpa_coalesced_pkts");
1410
1411	SYSCTL_ADD_QUAD(ctx, children,
1412                OID_AUTO, "tpa_coalesced_events",
1413                CTLFLAG_RD, &ha->hw_stats.common.tpa_coalesced_events,
1414                "tpa_coalesced_events");
1415
1416	SYSCTL_ADD_QUAD(ctx, children,
1417                OID_AUTO, "tpa_aborts_num",
1418                CTLFLAG_RD, &ha->hw_stats.common.tpa_aborts_num,
1419                "tpa_aborts_num");
1420
1421	SYSCTL_ADD_QUAD(ctx, children,
1422                OID_AUTO, "tpa_not_coalesced_pkts",
1423                CTLFLAG_RD, &ha->hw_stats.common.tpa_not_coalesced_pkts,
1424                "tpa_not_coalesced_pkts");
1425
1426	SYSCTL_ADD_QUAD(ctx, children,
1427                OID_AUTO, "tpa_coalesced_bytes",
1428                CTLFLAG_RD, &ha->hw_stats.common.tpa_coalesced_bytes,
1429                "tpa_coalesced_bytes");
1430
1431	SYSCTL_ADD_QUAD(ctx, children,
1432                OID_AUTO, "rx_64_byte_packets",
1433                CTLFLAG_RD, &ha->hw_stats.common.rx_64_byte_packets,
1434                "rx_64_byte_packets");
1435
1436	SYSCTL_ADD_QUAD(ctx, children,
1437                OID_AUTO, "rx_65_to_127_byte_packets",
1438                CTLFLAG_RD, &ha->hw_stats.common.rx_65_to_127_byte_packets,
1439                "rx_65_to_127_byte_packets");
1440
1441	SYSCTL_ADD_QUAD(ctx, children,
1442                OID_AUTO, "rx_128_to_255_byte_packets",
1443                CTLFLAG_RD, &ha->hw_stats.common.rx_128_to_255_byte_packets,
1444                "rx_128_to_255_byte_packets");
1445
1446	SYSCTL_ADD_QUAD(ctx, children,
1447                OID_AUTO, "rx_256_to_511_byte_packets",
1448                CTLFLAG_RD, &ha->hw_stats.common.rx_256_to_511_byte_packets,
1449                "rx_256_to_511_byte_packets");
1450
1451	SYSCTL_ADD_QUAD(ctx, children,
1452                OID_AUTO, "rx_512_to_1023_byte_packets",
1453                CTLFLAG_RD, &ha->hw_stats.common.rx_512_to_1023_byte_packets,
1454                "rx_512_to_1023_byte_packets");
1455
1456	SYSCTL_ADD_QUAD(ctx, children,
1457                OID_AUTO, "rx_1024_to_1518_byte_packets",
1458                CTLFLAG_RD, &ha->hw_stats.common.rx_1024_to_1518_byte_packets,
1459                "rx_1024_to_1518_byte_packets");
1460
1461	SYSCTL_ADD_QUAD(ctx, children,
1462                OID_AUTO, "rx_1519_to_1522_byte_packets",
1463                CTLFLAG_RD, &ha->hw_stats.bb.rx_1519_to_1522_byte_packets,
1464                "rx_1519_to_1522_byte_packets");
1465
1466	SYSCTL_ADD_QUAD(ctx, children,
1467                OID_AUTO, "rx_1523_to_2047_byte_packets",
1468                CTLFLAG_RD, &ha->hw_stats.bb.rx_1519_to_2047_byte_packets,
1469                "rx_1523_to_2047_byte_packets");
1470
1471	SYSCTL_ADD_QUAD(ctx, children,
1472                OID_AUTO, "rx_2048_to_4095_byte_packets",
1473                CTLFLAG_RD, &ha->hw_stats.bb.rx_2048_to_4095_byte_packets,
1474                "rx_2048_to_4095_byte_packets");
1475
1476	SYSCTL_ADD_QUAD(ctx, children,
1477                OID_AUTO, "rx_4096_to_9216_byte_packets",
1478                CTLFLAG_RD, &ha->hw_stats.bb.rx_4096_to_9216_byte_packets,
1479                "rx_4096_to_9216_byte_packets");
1480
1481	SYSCTL_ADD_QUAD(ctx, children,
1482                OID_AUTO, "rx_9217_to_16383_byte_packets",
1483                CTLFLAG_RD, &ha->hw_stats.bb.rx_9217_to_16383_byte_packets,
1484                "rx_9217_to_16383_byte_packets");
1485
1486	SYSCTL_ADD_QUAD(ctx, children,
1487                OID_AUTO, "rx_crc_errors",
1488                CTLFLAG_RD, &ha->hw_stats.common.rx_crc_errors,
1489                "rx_crc_errors");
1490
1491	SYSCTL_ADD_QUAD(ctx, children,
1492                OID_AUTO, "rx_mac_crtl_frames",
1493                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_crtl_frames,
1494                "rx_mac_crtl_frames");
1495
1496	SYSCTL_ADD_QUAD(ctx, children,
1497                OID_AUTO, "rx_pause_frames",
1498                CTLFLAG_RD, &ha->hw_stats.common.rx_pause_frames,
1499                "rx_pause_frames");
1500
1501	SYSCTL_ADD_QUAD(ctx, children,
1502                OID_AUTO, "rx_pfc_frames",
1503                CTLFLAG_RD, &ha->hw_stats.common.rx_pfc_frames,
1504                "rx_pfc_frames");
1505
1506	SYSCTL_ADD_QUAD(ctx, children,
1507                OID_AUTO, "rx_align_errors",
1508                CTLFLAG_RD, &ha->hw_stats.common.rx_align_errors,
1509                "rx_align_errors");
1510
1511	SYSCTL_ADD_QUAD(ctx, children,
1512                OID_AUTO, "rx_carrier_errors",
1513                CTLFLAG_RD, &ha->hw_stats.common.rx_carrier_errors,
1514                "rx_carrier_errors");
1515
1516	SYSCTL_ADD_QUAD(ctx, children,
1517                OID_AUTO, "rx_oversize_packets",
1518                CTLFLAG_RD, &ha->hw_stats.common.rx_oversize_packets,
1519                "rx_oversize_packets");
1520
1521	SYSCTL_ADD_QUAD(ctx, children,
1522                OID_AUTO, "rx_jabbers",
1523                CTLFLAG_RD, &ha->hw_stats.common.rx_jabbers,
1524                "rx_jabbers");
1525
1526	SYSCTL_ADD_QUAD(ctx, children,
1527                OID_AUTO, "rx_undersize_packets",
1528                CTLFLAG_RD, &ha->hw_stats.common.rx_undersize_packets,
1529                "rx_undersize_packets");
1530
1531	SYSCTL_ADD_QUAD(ctx, children,
1532                OID_AUTO, "rx_fragments",
1533                CTLFLAG_RD, &ha->hw_stats.common.rx_fragments,
1534                "rx_fragments");
1535
1536	SYSCTL_ADD_QUAD(ctx, children,
1537                OID_AUTO, "tx_64_byte_packets",
1538                CTLFLAG_RD, &ha->hw_stats.common.tx_64_byte_packets,
1539                "tx_64_byte_packets");
1540
1541	SYSCTL_ADD_QUAD(ctx, children,
1542                OID_AUTO, "tx_65_to_127_byte_packets",
1543                CTLFLAG_RD, &ha->hw_stats.common.tx_65_to_127_byte_packets,
1544                "tx_65_to_127_byte_packets");
1545
1546	SYSCTL_ADD_QUAD(ctx, children,
1547                OID_AUTO, "tx_128_to_255_byte_packets",
1548                CTLFLAG_RD, &ha->hw_stats.common.tx_128_to_255_byte_packets,
1549                "tx_128_to_255_byte_packets");
1550
1551	SYSCTL_ADD_QUAD(ctx, children,
1552                OID_AUTO, "tx_256_to_511_byte_packets",
1553                CTLFLAG_RD, &ha->hw_stats.common.tx_256_to_511_byte_packets,
1554                "tx_256_to_511_byte_packets");
1555
1556	SYSCTL_ADD_QUAD(ctx, children,
1557                OID_AUTO, "tx_512_to_1023_byte_packets",
1558                CTLFLAG_RD, &ha->hw_stats.common.tx_512_to_1023_byte_packets,
1559                "tx_512_to_1023_byte_packets");
1560
1561	SYSCTL_ADD_QUAD(ctx, children,
1562                OID_AUTO, "tx_1024_to_1518_byte_packets",
1563                CTLFLAG_RD, &ha->hw_stats.common.tx_1024_to_1518_byte_packets,
1564                "tx_1024_to_1518_byte_packets");
1565
1566	SYSCTL_ADD_QUAD(ctx, children,
1567                OID_AUTO, "tx_1519_to_2047_byte_packets",
1568                CTLFLAG_RD, &ha->hw_stats.bb.tx_1519_to_2047_byte_packets,
1569                "tx_1519_to_2047_byte_packets");
1570
1571	SYSCTL_ADD_QUAD(ctx, children,
1572                OID_AUTO, "tx_2048_to_4095_byte_packets",
1573                CTLFLAG_RD, &ha->hw_stats.bb.tx_2048_to_4095_byte_packets,
1574                "tx_2048_to_4095_byte_packets");
1575
1576	SYSCTL_ADD_QUAD(ctx, children,
1577                OID_AUTO, "tx_4096_to_9216_byte_packets",
1578                CTLFLAG_RD, &ha->hw_stats.bb.tx_4096_to_9216_byte_packets,
1579                "tx_4096_to_9216_byte_packets");
1580
1581	SYSCTL_ADD_QUAD(ctx, children,
1582                OID_AUTO, "tx_9217_to_16383_byte_packets",
1583                CTLFLAG_RD, &ha->hw_stats.bb.tx_9217_to_16383_byte_packets,
1584                "tx_9217_to_16383_byte_packets");
1585
1586	SYSCTL_ADD_QUAD(ctx, children,
1587                OID_AUTO, "tx_pause_frames",
1588                CTLFLAG_RD, &ha->hw_stats.common.tx_pause_frames,
1589                "tx_pause_frames");
1590
1591	SYSCTL_ADD_QUAD(ctx, children,
1592                OID_AUTO, "tx_pfc_frames",
1593                CTLFLAG_RD, &ha->hw_stats.common.tx_pfc_frames,
1594                "tx_pfc_frames");
1595
1596	SYSCTL_ADD_QUAD(ctx, children,
1597                OID_AUTO, "tx_lpi_entry_count",
1598                CTLFLAG_RD, &ha->hw_stats.bb.tx_lpi_entry_count,
1599                "tx_lpi_entry_count");
1600
1601	SYSCTL_ADD_QUAD(ctx, children,
1602                OID_AUTO, "tx_total_collisions",
1603                CTLFLAG_RD, &ha->hw_stats.bb.tx_total_collisions,
1604                "tx_total_collisions");
1605
1606	SYSCTL_ADD_QUAD(ctx, children,
1607                OID_AUTO, "brb_truncates",
1608                CTLFLAG_RD, &ha->hw_stats.common.brb_truncates,
1609                "brb_truncates");
1610
1611	SYSCTL_ADD_QUAD(ctx, children,
1612                OID_AUTO, "brb_discards",
1613                CTLFLAG_RD, &ha->hw_stats.common.brb_discards,
1614                "brb_discards");
1615
1616	SYSCTL_ADD_QUAD(ctx, children,
1617                OID_AUTO, "rx_mac_bytes",
1618                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_bytes,
1619                "rx_mac_bytes");
1620
1621	SYSCTL_ADD_QUAD(ctx, children,
1622                OID_AUTO, "rx_mac_uc_packets",
1623                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_uc_packets,
1624                "rx_mac_uc_packets");
1625
1626	SYSCTL_ADD_QUAD(ctx, children,
1627                OID_AUTO, "rx_mac_mc_packets",
1628                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_mc_packets,
1629                "rx_mac_mc_packets");
1630
1631	SYSCTL_ADD_QUAD(ctx, children,
1632                OID_AUTO, "rx_mac_bc_packets",
1633                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_bc_packets,
1634                "rx_mac_bc_packets");
1635
1636	SYSCTL_ADD_QUAD(ctx, children,
1637                OID_AUTO, "rx_mac_frames_ok",
1638                CTLFLAG_RD, &ha->hw_stats.common.rx_mac_frames_ok,
1639                "rx_mac_frames_ok");
1640
1641	SYSCTL_ADD_QUAD(ctx, children,
1642                OID_AUTO, "tx_mac_bytes",
1643                CTLFLAG_RD, &ha->hw_stats.common.tx_mac_bytes,
1644                "tx_mac_bytes");
1645
1646	SYSCTL_ADD_QUAD(ctx, children,
1647                OID_AUTO, "tx_mac_uc_packets",
1648                CTLFLAG_RD, &ha->hw_stats.common.tx_mac_uc_packets,
1649                "tx_mac_uc_packets");
1650
1651	SYSCTL_ADD_QUAD(ctx, children,
1652                OID_AUTO, "tx_mac_mc_packets",
1653                CTLFLAG_RD, &ha->hw_stats.common.tx_mac_mc_packets,
1654                "tx_mac_mc_packets");
1655
1656	SYSCTL_ADD_QUAD(ctx, children,
1657                OID_AUTO, "tx_mac_bc_packets",
1658                CTLFLAG_RD, &ha->hw_stats.common.tx_mac_bc_packets,
1659                "tx_mac_bc_packets");
1660
1661	SYSCTL_ADD_QUAD(ctx, children,
1662                OID_AUTO, "tx_mac_ctrl_frames",
1663                CTLFLAG_RD, &ha->hw_stats.common.tx_mac_ctrl_frames,
1664                "tx_mac_ctrl_frames");
1665	return;
1666}
1667
1668static void
1669qlnx_add_sysctls(qlnx_host_t *ha)
1670{
1671        device_t		dev = ha->pci_dev;
1672	struct sysctl_ctx_list	*ctx;
1673	struct sysctl_oid_list	*children;
1674
1675	ctx = device_get_sysctl_ctx(dev);
1676	children = SYSCTL_CHILDREN(device_get_sysctl_tree(dev));
1677
1678	qlnx_add_fp_stats_sysctls(ha);
1679	qlnx_add_sp_stats_sysctls(ha);
1680	qlnx_add_hw_stats_sysctls(ha);
1681
1682	SYSCTL_ADD_STRING(ctx, children, OID_AUTO, "Driver_Version",
1683		CTLFLAG_RD, qlnx_ver_str, 0,
1684		"Driver Version");
1685
1686	SYSCTL_ADD_STRING(ctx, children, OID_AUTO, "STORMFW_Version",
1687		CTLFLAG_RD, ha->stormfw_ver, 0,
1688		"STORM Firmware Version");
1689
1690	SYSCTL_ADD_STRING(ctx, children, OID_AUTO, "MFW_Version",
1691		CTLFLAG_RD, ha->mfw_ver, 0,
1692		"Management Firmware Version");
1693
1694        SYSCTL_ADD_UINT(ctx, children,
1695                OID_AUTO, "personality", CTLFLAG_RD,
1696                &ha->personality, ha->personality,
1697		"\tpersonality = 0 => Ethernet Only\n"
1698		"\tpersonality = 3 => Ethernet and RoCE\n"
1699		"\tpersonality = 4 => Ethernet and iWARP\n"
1700		"\tpersonality = 6 => Default in Shared Memory\n");
1701
1702        ha->dbg_level = 0;
1703
1704        SYSCTL_ADD_UINT(ctx, children,
1705                OID_AUTO, "debug", CTLFLAG_RW,
1706                &ha->dbg_level, ha->dbg_level, "Debug Level");
1707
1708        ha->dp_level = 0;
1709        SYSCTL_ADD_UINT(ctx, children,
1710                OID_AUTO, "dp_level", CTLFLAG_RW,
1711                &ha->dp_level, ha->dp_level, "DP Level");
1712
1713        ha->dp_module = 0;
1714        SYSCTL_ADD_UINT(ctx, children,
1715                OID_AUTO, "dp_module", CTLFLAG_RW,
1716                &ha->dp_module, ha->dp_module, "DP Module");
1717
1718        ha->err_inject = 0;
1719
1720        SYSCTL_ADD_UINT(ctx, children,
1721                OID_AUTO, "err_inject", CTLFLAG_RW,
1722                &ha->err_inject, ha->err_inject, "Error Inject");
1723
1724        ha->storm_stats_enable = 0;
1725
1726        SYSCTL_ADD_UINT(ctx, children,
1727                OID_AUTO, "storm_stats_enable", CTLFLAG_RW,
1728                &ha->storm_stats_enable, ha->storm_stats_enable,
1729		"Enable Storm Statistics Gathering");
1730
1731        ha->storm_stats_index = 0;
1732
1733        SYSCTL_ADD_UINT(ctx, children,
1734                OID_AUTO, "storm_stats_index", CTLFLAG_RD,
1735                &ha->storm_stats_index, ha->storm_stats_index,
1736		"Enable Storm Statistics Gathering Current Index");
1737
1738        ha->grcdump_taken = 0;
1739        SYSCTL_ADD_UINT(ctx, children,
1740                OID_AUTO, "grcdump_taken", CTLFLAG_RD,
1741                &ha->grcdump_taken, ha->grcdump_taken, "grcdump_taken");
1742
1743        ha->idle_chk_taken = 0;
1744        SYSCTL_ADD_UINT(ctx, children,
1745                OID_AUTO, "idle_chk_taken", CTLFLAG_RD,
1746                &ha->idle_chk_taken, ha->idle_chk_taken, "idle_chk_taken");
1747
1748        SYSCTL_ADD_UINT(ctx, children,
1749                OID_AUTO, "rx_coalesce_usecs", CTLFLAG_RD,
1750                &ha->rx_coalesce_usecs, ha->rx_coalesce_usecs,
1751		"rx_coalesce_usecs");
1752
1753        SYSCTL_ADD_UINT(ctx, children,
1754                OID_AUTO, "tx_coalesce_usecs", CTLFLAG_RD,
1755                &ha->tx_coalesce_usecs, ha->tx_coalesce_usecs,
1756		"tx_coalesce_usecs");
1757
1758	ha->rx_pkt_threshold = 32;
1759        SYSCTL_ADD_UINT(ctx, children,
1760                OID_AUTO, "rx_pkt_threshold", CTLFLAG_RW,
1761                &ha->rx_pkt_threshold, ha->rx_pkt_threshold,
1762		"No. of Rx Pkts to process at a time");
1763
1764	ha->rx_jumbo_buf_eq_mtu = 0;
1765        SYSCTL_ADD_UINT(ctx, children,
1766                OID_AUTO, "rx_jumbo_buf_eq_mtu", CTLFLAG_RW,
1767                &ha->rx_jumbo_buf_eq_mtu, ha->rx_jumbo_buf_eq_mtu,
1768		"== 0 => Rx Jumbo buffers are capped to 4Kbytes\n"
1769		"otherwise Rx Jumbo buffers are set to >= MTU size\n");
1770
1771	SYSCTL_ADD_PROC(ctx, children,
1772		OID_AUTO, "trigger_dump", CTLTYPE_INT | CTLFLAG_RW,
1773		(void *)ha, 0,
1774		qlnx_trigger_dump_sysctl, "I", "trigger_dump");
1775
1776	SYSCTL_ADD_PROC(ctx, children,
1777		OID_AUTO, "set_rx_coalesce_usecs", CTLTYPE_INT | CTLFLAG_RW,
1778		(void *)ha, 0,
1779		qlnx_set_rx_coalesce, "I",
1780		"rx interrupt coalesce period microseconds");
1781
1782	SYSCTL_ADD_PROC(ctx, children,
1783		OID_AUTO, "set_tx_coalesce_usecs", CTLTYPE_INT | CTLFLAG_RW,
1784		(void *)ha, 0,
1785		qlnx_set_tx_coalesce, "I",
1786		"tx interrupt coalesce period microseconds");
1787
1788	SYSCTL_ADD_QUAD(ctx, children,
1789                OID_AUTO, "err_illegal_intr", CTLFLAG_RD,
1790		&ha->err_illegal_intr, "err_illegal_intr");
1791
1792	SYSCTL_ADD_QUAD(ctx, children,
1793                OID_AUTO, "err_fp_null", CTLFLAG_RD,
1794		&ha->err_fp_null, "err_fp_null");
1795
1796	SYSCTL_ADD_QUAD(ctx, children,
1797                OID_AUTO, "err_get_proto_invalid_type", CTLFLAG_RD,
1798		&ha->err_get_proto_invalid_type, "err_get_proto_invalid_type");
1799	return;
1800}
1801
1802
1803
1804/*****************************************************************************
1805 * Operating System Network Interface Functions
1806 *****************************************************************************/
1807
1808static void
1809qlnx_init_ifnet(device_t dev, qlnx_host_t *ha)
1810{
1811	uint16_t	device_id;
1812        struct ifnet	*ifp;
1813
1814        ifp = ha->ifp = if_alloc(IFT_ETHER);
1815
1816        if (ifp == NULL)
1817                panic("%s: cannot if_alloc()\n", device_get_nameunit(dev));
1818
1819        if_initname(ifp, device_get_name(dev), device_get_unit(dev));
1820
1821	device_id = pci_get_device(ha->pci_dev);
1822
1823#if __FreeBSD_version >= 1000000
1824
1825        if (device_id == QLOGIC_PCI_DEVICE_ID_1634)
1826		ifp->if_baudrate = IF_Gbps(40);
1827        else if (device_id == QLOGIC_PCI_DEVICE_ID_1656)
1828		ifp->if_baudrate = IF_Gbps(25);
1829        else if (device_id == QLOGIC_PCI_DEVICE_ID_1654)
1830		ifp->if_baudrate = IF_Gbps(50);
1831        else if (device_id == QLOGIC_PCI_DEVICE_ID_1644)
1832		ifp->if_baudrate = IF_Gbps(100);
1833
1834        ifp->if_capabilities = IFCAP_LINKSTATE;
1835#else
1836        ifp->if_mtu = ETHERMTU;
1837	ifp->if_baudrate = (1 * 1000 * 1000 *1000);
1838
1839#endif /* #if __FreeBSD_version >= 1000000 */
1840
1841        ifp->if_init = qlnx_init;
1842        ifp->if_softc = ha;
1843        ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
1844        ifp->if_ioctl = qlnx_ioctl;
1845        ifp->if_transmit = qlnx_transmit;
1846        ifp->if_qflush = qlnx_qflush;
1847
1848        IFQ_SET_MAXLEN(&ifp->if_snd, qlnx_get_ifq_snd_maxlen(ha));
1849        ifp->if_snd.ifq_drv_maxlen = qlnx_get_ifq_snd_maxlen(ha);
1850        IFQ_SET_READY(&ifp->if_snd);
1851
1852#if __FreeBSD_version >= 1100036
1853	if_setgetcounterfn(ifp, qlnx_get_counter);
1854#endif
1855
1856        ha->max_frame_size = ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
1857
1858        memcpy(ha->primary_mac, qlnx_get_mac_addr(ha), ETH_ALEN);
1859        ether_ifattach(ifp, ha->primary_mac);
1860	bcopy(IF_LLADDR(ha->ifp), ha->primary_mac, ETHER_ADDR_LEN);
1861
1862	ifp->if_capabilities = IFCAP_HWCSUM;
1863	ifp->if_capabilities |= IFCAP_JUMBO_MTU;
1864
1865	ifp->if_capabilities |= IFCAP_VLAN_MTU;
1866	ifp->if_capabilities |= IFCAP_VLAN_HWTAGGING;
1867	ifp->if_capabilities |= IFCAP_VLAN_HWFILTER;
1868	ifp->if_capabilities |= IFCAP_VLAN_HWCSUM;
1869	ifp->if_capabilities |= IFCAP_VLAN_HWTSO;
1870	ifp->if_capabilities |= IFCAP_TSO4;
1871	ifp->if_capabilities |= IFCAP_TSO6;
1872	ifp->if_capabilities |= IFCAP_LRO;
1873
1874        ifp->if_capenable = ifp->if_capabilities;
1875
1876	ifp->if_hwassist = CSUM_IP;
1877	ifp->if_hwassist |= CSUM_TCP | CSUM_UDP;
1878	ifp->if_hwassist |= CSUM_TCP_IPV6 | CSUM_UDP_IPV6;
1879	ifp->if_hwassist |= CSUM_TSO;
1880
1881	ifp->if_hdrlen = sizeof(struct ether_vlan_header);
1882
1883        ifmedia_init(&ha->media, IFM_IMASK, qlnx_media_change,\
1884		qlnx_media_status);
1885
1886        if (device_id == QLOGIC_PCI_DEVICE_ID_1634) {
1887		ifmedia_add(&ha->media, (IFM_ETHER | IFM_40G_LR4), 0, NULL);
1888		ifmedia_add(&ha->media, (IFM_ETHER | IFM_40G_SR4), 0, NULL);
1889		ifmedia_add(&ha->media, (IFM_ETHER | IFM_40G_CR4), 0, NULL);
1890        } else if (device_id == QLOGIC_PCI_DEVICE_ID_1656) {
1891		ifmedia_add(&ha->media, (IFM_ETHER | QLNX_IFM_25G_SR), 0, NULL);
1892		ifmedia_add(&ha->media, (IFM_ETHER | QLNX_IFM_25G_CR), 0, NULL);
1893        } else if (device_id == QLOGIC_PCI_DEVICE_ID_1654) {
1894		ifmedia_add(&ha->media, (IFM_ETHER | IFM_50G_KR2), 0, NULL);
1895		ifmedia_add(&ha->media, (IFM_ETHER | IFM_50G_CR2), 0, NULL);
1896        } else if (device_id == QLOGIC_PCI_DEVICE_ID_1644) {
1897		ifmedia_add(&ha->media,
1898			(IFM_ETHER | QLNX_IFM_100G_LR4), 0, NULL);
1899		ifmedia_add(&ha->media,
1900			(IFM_ETHER | QLNX_IFM_100G_SR4), 0, NULL);
1901		ifmedia_add(&ha->media,
1902			(IFM_ETHER | QLNX_IFM_100G_CR4), 0, NULL);
1903	}
1904
1905        ifmedia_add(&ha->media, (IFM_ETHER | IFM_FDX), 0, NULL);
1906        ifmedia_add(&ha->media, (IFM_ETHER | IFM_AUTO), 0, NULL);
1907
1908
1909        ifmedia_set(&ha->media, (IFM_ETHER | IFM_AUTO));
1910
1911        QL_DPRINT2(ha, (dev, "%s: exit\n", __func__));
1912
1913        return;
1914}
1915
1916static void
1917qlnx_init_locked(qlnx_host_t *ha)
1918{
1919	struct ifnet	*ifp = ha->ifp;
1920
1921	qlnx_stop(ha);
1922
1923	if (qlnx_load(ha) == 0) {
1924		ifp->if_drv_flags |= IFF_DRV_RUNNING;
1925		ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
1926	}
1927
1928	return;
1929}
1930
1931static void
1932qlnx_init(void *arg)
1933{
1934	qlnx_host_t	*ha;
1935
1936	ha = (qlnx_host_t *)arg;
1937
1938	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
1939
1940	QLNX_LOCK(ha);
1941	qlnx_init_locked(ha);
1942	QLNX_UNLOCK(ha);
1943
1944	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
1945
1946	return;
1947}
1948
1949static int
1950qlnx_config_mcast_mac_addr(qlnx_host_t *ha, uint8_t *mac_addr, uint32_t add_mac)
1951{
1952	struct ecore_filter_mcast	*mcast;
1953	struct ecore_dev		*cdev;
1954	int				rc;
1955
1956	cdev = &ha->cdev;
1957
1958	mcast = &ha->ecore_mcast;
1959	bzero(mcast, sizeof(struct ecore_filter_mcast));
1960
1961	if (add_mac)
1962		mcast->opcode = ECORE_FILTER_ADD;
1963	else
1964		mcast->opcode = ECORE_FILTER_REMOVE;
1965
1966	mcast->num_mc_addrs = 1;
1967	memcpy(mcast->mac, mac_addr, ETH_ALEN);
1968
1969	rc = ecore_filter_mcast_cmd(cdev, mcast, ECORE_SPQ_MODE_CB, NULL);
1970
1971	return (rc);
1972}
1973
1974static int
1975qlnx_hw_add_mcast(qlnx_host_t *ha, uint8_t *mta)
1976{
1977        int	i;
1978
1979        for (i = 0; i < QLNX_MAX_NUM_MULTICAST_ADDRS; i++) {
1980
1981                if (QL_MAC_CMP(ha->mcast[i].addr, mta) == 0)
1982                        return 0; /* its been already added */
1983        }
1984
1985        for (i = 0; i < QLNX_MAX_NUM_MULTICAST_ADDRS; i++) {
1986
1987                if ((ha->mcast[i].addr[0] == 0) &&
1988                        (ha->mcast[i].addr[1] == 0) &&
1989                        (ha->mcast[i].addr[2] == 0) &&
1990                        (ha->mcast[i].addr[3] == 0) &&
1991                        (ha->mcast[i].addr[4] == 0) &&
1992                        (ha->mcast[i].addr[5] == 0)) {
1993
1994                        if (qlnx_config_mcast_mac_addr(ha, mta, 1))
1995                                return (-1);
1996
1997                        bcopy(mta, ha->mcast[i].addr, ETH_ALEN);
1998                        ha->nmcast++;
1999
2000                        return 0;
2001                }
2002        }
2003        return 0;
2004}
2005
2006static int
2007qlnx_hw_del_mcast(qlnx_host_t *ha, uint8_t *mta)
2008{
2009        int	i;
2010
2011        for (i = 0; i < QLNX_MAX_NUM_MULTICAST_ADDRS; i++) {
2012                if (QL_MAC_CMP(ha->mcast[i].addr, mta) == 0) {
2013
2014                        if (qlnx_config_mcast_mac_addr(ha, mta, 0))
2015                                return (-1);
2016
2017                        ha->mcast[i].addr[0] = 0;
2018                        ha->mcast[i].addr[1] = 0;
2019                        ha->mcast[i].addr[2] = 0;
2020                        ha->mcast[i].addr[3] = 0;
2021                        ha->mcast[i].addr[4] = 0;
2022                        ha->mcast[i].addr[5] = 0;
2023
2024                        ha->nmcast--;
2025
2026                        return 0;
2027                }
2028        }
2029        return 0;
2030}
2031
2032/*
2033 * Name: qls_hw_set_multi
2034 * Function: Sets the Multicast Addresses provided the host O.S into the
2035 *      hardware (for the given interface)
2036 */
2037static void
2038qlnx_hw_set_multi(qlnx_host_t *ha, uint8_t *mta, uint32_t mcnt,
2039	uint32_t add_mac)
2040{
2041        int	i;
2042
2043        for (i = 0; i < mcnt; i++) {
2044                if (add_mac) {
2045                        if (qlnx_hw_add_mcast(ha, mta))
2046                                break;
2047                } else {
2048                        if (qlnx_hw_del_mcast(ha, mta))
2049                                break;
2050                }
2051
2052                mta += ETHER_HDR_LEN;
2053        }
2054        return;
2055}
2056
2057
2058#define QLNX_MCAST_ADDRS_SIZE (QLNX_MAX_NUM_MULTICAST_ADDRS * ETHER_HDR_LEN)
2059static int
2060qlnx_set_multi(qlnx_host_t *ha, uint32_t add_multi)
2061{
2062	uint8_t			mta[QLNX_MCAST_ADDRS_SIZE];
2063	struct ifmultiaddr	*ifma;
2064	int			mcnt = 0;
2065	struct ifnet		*ifp = ha->ifp;
2066	int			ret = 0;
2067
2068	if_maddr_rlock(ifp);
2069
2070	TAILQ_FOREACH(ifma, &ifp->if_multiaddrs, ifma_link) {
2071
2072		if (ifma->ifma_addr->sa_family != AF_LINK)
2073			continue;
2074
2075		if (mcnt == QLNX_MAX_NUM_MULTICAST_ADDRS)
2076			break;
2077
2078		bcopy(LLADDR((struct sockaddr_dl *) ifma->ifma_addr),
2079			&mta[mcnt * ETHER_HDR_LEN], ETHER_HDR_LEN);
2080
2081		mcnt++;
2082	}
2083
2084	if_maddr_runlock(ifp);
2085
2086	QLNX_LOCK(ha);
2087	qlnx_hw_set_multi(ha, mta, mcnt, add_multi);
2088	QLNX_UNLOCK(ha);
2089
2090	return (ret);
2091}
2092
2093static int
2094qlnx_set_promisc(qlnx_host_t *ha)
2095{
2096	int	rc = 0;
2097	uint8_t	filter;
2098
2099	filter = ha->filter;
2100	filter |= ECORE_ACCEPT_MCAST_UNMATCHED;
2101	filter |= ECORE_ACCEPT_UCAST_UNMATCHED;
2102
2103	rc = qlnx_set_rx_accept_filter(ha, filter);
2104	return (rc);
2105}
2106
2107static int
2108qlnx_set_allmulti(qlnx_host_t *ha)
2109{
2110	int	rc = 0;
2111	uint8_t	filter;
2112
2113	filter = ha->filter;
2114	filter |= ECORE_ACCEPT_MCAST_UNMATCHED;
2115	rc = qlnx_set_rx_accept_filter(ha, filter);
2116
2117	return (rc);
2118}
2119
2120
2121static int
2122qlnx_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
2123{
2124	int		ret = 0, mask;
2125	struct ifreq	*ifr = (struct ifreq *)data;
2126	struct ifaddr	*ifa = (struct ifaddr *)data;
2127	qlnx_host_t	*ha;
2128
2129	ha = (qlnx_host_t *)ifp->if_softc;
2130
2131	switch (cmd) {
2132	case SIOCSIFADDR:
2133		QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFADDR (0x%lx)\n",
2134			__func__, cmd));
2135
2136		if (ifa->ifa_addr->sa_family == AF_INET) {
2137			ifp->if_flags |= IFF_UP;
2138			if (!(ifp->if_drv_flags & IFF_DRV_RUNNING)) {
2139				QLNX_LOCK(ha);
2140				qlnx_init_locked(ha);
2141				QLNX_UNLOCK(ha);
2142			}
2143			QL_DPRINT4(ha, (ha->pci_dev,
2144				"%s: SIOCSIFADDR (0x%lx) ipv4 [0x%08x]\n",
2145				__func__, cmd,
2146				ntohl(IA_SIN(ifa)->sin_addr.s_addr)));
2147
2148			arp_ifinit(ifp, ifa);
2149		} else {
2150			ether_ioctl(ifp, cmd, data);
2151		}
2152		break;
2153
2154	case SIOCSIFMTU:
2155		QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFMTU (0x%lx)\n",
2156			__func__, cmd));
2157
2158		if (ifr->ifr_mtu > QLNX_MAX_MTU) {
2159			ret = EINVAL;
2160		} else {
2161			QLNX_LOCK(ha);
2162			ifp->if_mtu = ifr->ifr_mtu;
2163			ha->max_frame_size =
2164				ifp->if_mtu + ETHER_HDR_LEN + ETHER_CRC_LEN;
2165			if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
2166				qlnx_init_locked(ha);
2167			}
2168
2169			QLNX_UNLOCK(ha);
2170
2171			if (ret)
2172				ret = EINVAL;
2173		}
2174
2175		break;
2176
2177	case SIOCSIFFLAGS:
2178		QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFFLAGS (0x%lx)\n",
2179			__func__, cmd));
2180
2181		QLNX_LOCK(ha);
2182
2183		if (ifp->if_flags & IFF_UP) {
2184			if ((ifp->if_drv_flags & IFF_DRV_RUNNING)) {
2185				if ((ifp->if_flags ^ ha->if_flags) &
2186					IFF_PROMISC) {
2187					ret = qlnx_set_promisc(ha);
2188				} else if ((ifp->if_flags ^ ha->if_flags) &
2189					IFF_ALLMULTI) {
2190					ret = qlnx_set_allmulti(ha);
2191				}
2192			} else {
2193				ha->max_frame_size = ifp->if_mtu +
2194					ETHER_HDR_LEN + ETHER_CRC_LEN;
2195				qlnx_init_locked(ha);
2196			}
2197		} else {
2198			if (ifp->if_drv_flags & IFF_DRV_RUNNING)
2199				qlnx_stop(ha);
2200			ha->if_flags = ifp->if_flags;
2201		}
2202
2203		QLNX_UNLOCK(ha);
2204		break;
2205
2206	case SIOCADDMULTI:
2207		QL_DPRINT4(ha, (ha->pci_dev,
2208			"%s: %s (0x%lx)\n", __func__, "SIOCADDMULTI", cmd));
2209
2210		if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
2211			if (qlnx_set_multi(ha, 1))
2212				ret = EINVAL;
2213		}
2214		break;
2215
2216	case SIOCDELMULTI:
2217		QL_DPRINT4(ha, (ha->pci_dev,
2218			"%s: %s (0x%lx)\n", __func__, "SIOCDELMULTI", cmd));
2219
2220		if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
2221			if (qlnx_set_multi(ha, 0))
2222				ret = EINVAL;
2223		}
2224		break;
2225
2226	case SIOCSIFMEDIA:
2227	case SIOCGIFMEDIA:
2228		QL_DPRINT4(ha, (ha->pci_dev,
2229			"%s: SIOCSIFMEDIA/SIOCGIFMEDIA (0x%lx)\n",
2230			__func__, cmd));
2231		ret = ifmedia_ioctl(ifp, ifr, &ha->media, cmd);
2232		break;
2233
2234	case SIOCSIFCAP:
2235
2236		mask = ifr->ifr_reqcap ^ ifp->if_capenable;
2237
2238		QL_DPRINT4(ha, (ha->pci_dev, "%s: SIOCSIFCAP (0x%lx)\n",
2239			__func__, cmd));
2240
2241		if (mask & IFCAP_HWCSUM)
2242			ifp->if_capenable ^= IFCAP_HWCSUM;
2243		if (mask & IFCAP_TSO4)
2244			ifp->if_capenable ^= IFCAP_TSO4;
2245		if (mask & IFCAP_TSO6)
2246			ifp->if_capenable ^= IFCAP_TSO6;
2247		if (mask & IFCAP_VLAN_HWTAGGING)
2248			ifp->if_capenable ^= IFCAP_VLAN_HWTAGGING;
2249		if (mask & IFCAP_VLAN_HWTSO)
2250			ifp->if_capenable ^= IFCAP_VLAN_HWTSO;
2251		if (mask & IFCAP_LRO)
2252			ifp->if_capenable ^= IFCAP_LRO;
2253
2254		if (!(ifp->if_drv_flags & IFF_DRV_RUNNING))
2255			qlnx_init(ha);
2256
2257		VLAN_CAPABILITIES(ifp);
2258		break;
2259
2260#if (__FreeBSD_version >= 1100101)
2261
2262	case SIOCGI2C:
2263	{
2264		struct ifi2creq i2c;
2265		struct ecore_hwfn *p_hwfn = &ha->cdev.hwfns[0];
2266		struct ecore_ptt *p_ptt;
2267
2268		ret = copyin(ifr->ifr_data, &i2c, sizeof(i2c));
2269
2270		if (ret)
2271			break;
2272
2273		if ((i2c.len > sizeof (i2c.data)) ||
2274			(i2c.dev_addr != 0xA0 && i2c.dev_addr != 0xA2)) {
2275			ret = EINVAL;
2276			break;
2277		}
2278
2279		p_ptt = ecore_ptt_acquire(p_hwfn);
2280
2281		if (!p_ptt) {
2282			QL_DPRINT1(ha, (ha->pci_dev, "%s :"
2283				" ecore_ptt_acquire failed\n", __func__));
2284			ret = -1;
2285			break;
2286		}
2287
2288		ret = ecore_mcp_phy_sfp_read(p_hwfn, p_ptt,
2289			(ha->pci_func & 0x1), i2c.dev_addr, i2c.offset,
2290			i2c.len, &i2c.data[0]);
2291
2292		ecore_ptt_release(p_hwfn, p_ptt);
2293
2294		if (ret) {
2295			ret = -1;
2296			break;
2297		}
2298
2299		ret = copyout(&i2c, ifr->ifr_data, sizeof(i2c));
2300
2301		QL_DPRINT8(ha, (ha->pci_dev, "SIOCGI2C copyout ret = %d"
2302			" len = %d addr = 0x%02x offset = 0x%04x"
2303			" data[0..7]=0x%02x 0x%02x 0x%02x 0x%02x 0x%02x"
2304			" 0x%02x 0x%02x 0x%02x\n",
2305			ret, i2c.len, i2c.dev_addr, i2c.offset,
2306			i2c.data[0], i2c.data[1], i2c.data[2], i2c.data[3],
2307			i2c.data[4], i2c.data[5], i2c.data[6], i2c.data[7]));
2308		break;
2309	}
2310#endif /* #if (__FreeBSD_version >= 1100101) */
2311
2312	default:
2313		QL_DPRINT4(ha, (ha->pci_dev, "%s: default (0x%lx)\n",
2314			__func__, cmd));
2315		ret = ether_ioctl(ifp, cmd, data);
2316		break;
2317	}
2318
2319	return (ret);
2320}
2321
2322static int
2323qlnx_media_change(struct ifnet *ifp)
2324{
2325	qlnx_host_t	*ha;
2326	struct ifmedia	*ifm;
2327	int		ret = 0;
2328
2329	ha = (qlnx_host_t *)ifp->if_softc;
2330
2331	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
2332
2333	ifm = &ha->media;
2334
2335	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
2336		ret = EINVAL;
2337
2338	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
2339
2340	return (ret);
2341}
2342
2343static void
2344qlnx_media_status(struct ifnet *ifp, struct ifmediareq *ifmr)
2345{
2346	qlnx_host_t		*ha;
2347
2348	ha = (qlnx_host_t *)ifp->if_softc;
2349
2350	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
2351
2352	ifmr->ifm_status = IFM_AVALID;
2353	ifmr->ifm_active = IFM_ETHER;
2354
2355	if (ha->link_up) {
2356		ifmr->ifm_status |= IFM_ACTIVE;
2357		ifmr->ifm_active |=
2358			(IFM_FDX | qlnx_get_optics(ha, &ha->if_link));
2359
2360		if (ha->if_link.link_partner_caps &
2361			(QLNX_LINK_CAP_Pause | QLNX_LINK_CAP_Asym_Pause))
2362			ifmr->ifm_active |=
2363				(IFM_ETH_RXPAUSE | IFM_ETH_TXPAUSE);
2364	}
2365
2366	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit (%s)\n", __func__,
2367		(ha->link_up ? "link_up" : "link_down")));
2368
2369	return;
2370}
2371
2372
2373static void
2374qlnx_free_tx_pkt(qlnx_host_t *ha, struct qlnx_fastpath *fp,
2375	struct qlnx_tx_queue *txq)
2376{
2377	u16			idx;
2378	struct mbuf		*mp;
2379	bus_dmamap_t		map;
2380	int			i;
2381	struct eth_tx_bd	*tx_data_bd;
2382	struct eth_tx_1st_bd	*first_bd;
2383	int			nbds = 0;
2384
2385	idx = txq->sw_tx_cons;
2386	mp = txq->sw_tx_ring[idx].mp;
2387	map = txq->sw_tx_ring[idx].map;
2388
2389	if ((mp == NULL) || QL_ERR_INJECT(ha, QL_ERR_INJCT_TX_INT_MBUF_NULL)){
2390
2391		QL_RESET_ERR_INJECT(ha, QL_ERR_INJCT_TX_INT_MBUF_NULL);
2392
2393		QL_DPRINT1(ha, (ha->pci_dev, "%s: (mp == NULL) "
2394			" tx_idx = 0x%x"
2395			" ecore_prod_idx = 0x%x"
2396			" ecore_cons_idx = 0x%x"
2397			" hw_bd_cons = 0x%x"
2398			" txq_db_last = 0x%x"
2399			" elem_left = 0x%x\n",
2400			__func__,
2401			fp->rss_id,
2402			ecore_chain_get_prod_idx(&txq->tx_pbl),
2403			ecore_chain_get_cons_idx(&txq->tx_pbl),
2404			le16toh(*txq->hw_cons_ptr),
2405			txq->tx_db.raw,
2406			ecore_chain_get_elem_left(&txq->tx_pbl)));
2407
2408		fp->err_tx_free_pkt_null++;
2409
2410		//DEBUG
2411		qlnx_trigger_dump(ha);
2412
2413		return;
2414	} else {
2415
2416		QLNX_INC_OPACKETS((ha->ifp));
2417		QLNX_INC_OBYTES((ha->ifp), (mp->m_pkthdr.len));
2418
2419		bus_dmamap_sync(ha->tx_tag, map, BUS_DMASYNC_POSTWRITE);
2420		bus_dmamap_unload(ha->tx_tag, map);
2421
2422		fp->tx_pkts_freed++;
2423		fp->tx_pkts_completed++;
2424
2425		m_freem(mp);
2426	}
2427
2428	first_bd = (struct eth_tx_1st_bd *)ecore_chain_consume(&txq->tx_pbl);
2429	nbds = first_bd->data.nbds;
2430
2431//	BD_SET_UNMAP_ADDR_LEN(first_bd, 0, 0);
2432
2433	for (i = 1; i < nbds; i++) {
2434		tx_data_bd = ecore_chain_consume(&txq->tx_pbl);
2435//		BD_SET_UNMAP_ADDR_LEN(tx_data_bd, 0, 0);
2436	}
2437	txq->sw_tx_ring[idx].flags = 0;
2438	txq->sw_tx_ring[idx].mp = NULL;
2439	txq->sw_tx_ring[idx].map = (bus_dmamap_t)0;
2440
2441	return;
2442}
2443
2444static void
2445qlnx_tx_int(qlnx_host_t *ha, struct qlnx_fastpath *fp,
2446	struct qlnx_tx_queue *txq)
2447{
2448	u16 hw_bd_cons;
2449	u16 ecore_cons_idx;
2450	uint16_t diff;
2451
2452	hw_bd_cons = le16toh(*txq->hw_cons_ptr);
2453
2454	while (hw_bd_cons !=
2455		(ecore_cons_idx = ecore_chain_get_cons_idx(&txq->tx_pbl))) {
2456
2457		if (hw_bd_cons < ecore_cons_idx) {
2458			diff = (1 << 16) - (ecore_cons_idx - hw_bd_cons);
2459		} else {
2460			diff = hw_bd_cons - ecore_cons_idx;
2461		}
2462		if ((diff > TX_RING_SIZE) ||
2463			QL_ERR_INJECT(ha, QL_ERR_INJCT_TX_INT_DIFF)){
2464
2465			QL_RESET_ERR_INJECT(ha, QL_ERR_INJCT_TX_INT_DIFF);
2466
2467			QL_DPRINT1(ha, (ha->pci_dev, "%s: (diff = 0x%x) "
2468				" tx_idx = 0x%x"
2469				" ecore_prod_idx = 0x%x"
2470				" ecore_cons_idx = 0x%x"
2471				" hw_bd_cons = 0x%x"
2472				" txq_db_last = 0x%x"
2473				" elem_left = 0x%x\n",
2474				__func__, diff,
2475				fp->rss_id,
2476				ecore_chain_get_prod_idx(&txq->tx_pbl),
2477				ecore_chain_get_cons_idx(&txq->tx_pbl),
2478				le16toh(*txq->hw_cons_ptr),
2479				txq->tx_db.raw,
2480				ecore_chain_get_elem_left(&txq->tx_pbl)));
2481
2482			fp->err_tx_cons_idx_conflict++;
2483
2484			//DEBUG
2485			qlnx_trigger_dump(ha);
2486		}
2487
2488		qlnx_free_tx_pkt(ha, fp, txq);
2489
2490		txq->sw_tx_cons = (txq->sw_tx_cons + 1) & (TX_RING_SIZE - 1);
2491	}
2492	return;
2493}
2494
2495static int
2496qlnx_transmit(struct ifnet *ifp, struct mbuf  *mp)
2497{
2498        qlnx_host_t		*ha = (qlnx_host_t *)ifp->if_softc;
2499        struct qlnx_fastpath	*fp;
2500        int			rss_id = 0, ret = 0;
2501
2502        QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
2503
2504#if __FreeBSD_version >= 1100000
2505        if (M_HASHTYPE_GET(mp) != M_HASHTYPE_NONE)
2506#else
2507        if (mp->m_flags & M_FLOWID)
2508#endif
2509                rss_id = (mp->m_pkthdr.flowid % ECORE_RSS_IND_TABLE_SIZE) %
2510					ha->num_rss;
2511
2512        fp = &ha->fp_array[rss_id];
2513
2514        if (fp->tx_br == NULL) {
2515                ret = EINVAL;
2516                goto qlnx_transmit_exit;
2517        }
2518
2519        if (mp != NULL) {
2520                ret = drbr_enqueue(ifp, fp->tx_br, mp);
2521        }
2522
2523        if (fp->fp_taskqueue != NULL)
2524                taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
2525
2526        ret = 0;
2527
2528qlnx_transmit_exit:
2529
2530        QL_DPRINT2(ha, (ha->pci_dev, "%s: exit ret = %d\n", __func__, ret));
2531        return ret;
2532}
2533
2534static void
2535qlnx_qflush(struct ifnet *ifp)
2536{
2537	int			rss_id;
2538	struct qlnx_fastpath	*fp;
2539	struct mbuf		*mp;
2540	qlnx_host_t		*ha;
2541
2542	ha = (qlnx_host_t *)ifp->if_softc;
2543
2544	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
2545
2546	for (rss_id = 0; rss_id < ha->num_rss; rss_id++) {
2547
2548		fp = &ha->fp_array[rss_id];
2549
2550		if (fp == NULL)
2551			continue;
2552
2553		if (fp->tx_br) {
2554			mtx_lock(&fp->tx_mtx);
2555
2556			while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
2557				fp->tx_pkts_freed++;
2558				m_freem(mp);
2559			}
2560			mtx_unlock(&fp->tx_mtx);
2561		}
2562	}
2563	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
2564
2565	return;
2566}
2567
2568static void
2569qlnx_txq_doorbell_wr32(qlnx_host_t *ha, void *reg_addr, uint32_t value)
2570{
2571	struct ecore_dev	*cdev;
2572	uint32_t		offset;
2573
2574	cdev = &ha->cdev;
2575
2576	offset = (uint32_t)((uint8_t *)reg_addr - (uint8_t *)cdev->doorbells);
2577
2578	bus_write_4(ha->pci_dbells, offset, value);
2579	bus_barrier(ha->pci_reg,  0, 0, BUS_SPACE_BARRIER_READ);
2580	bus_barrier(ha->pci_dbells,  0, 0, BUS_SPACE_BARRIER_READ);
2581
2582	return;
2583}
2584
2585static uint32_t
2586qlnx_tcp_offset(qlnx_host_t *ha, struct mbuf *mp)
2587{
2588        struct ether_vlan_header	*eh = NULL;
2589        struct ip			*ip = NULL;
2590        struct ip6_hdr			*ip6 = NULL;
2591        struct tcphdr			*th = NULL;
2592        uint32_t			ehdrlen = 0, ip_hlen = 0, offset = 0;
2593        uint16_t			etype = 0;
2594        device_t			dev;
2595        uint8_t				buf[sizeof(struct ip6_hdr)];
2596
2597        dev = ha->pci_dev;
2598
2599        eh = mtod(mp, struct ether_vlan_header *);
2600
2601        if (eh->evl_encap_proto == htons(ETHERTYPE_VLAN)) {
2602                ehdrlen = ETHER_HDR_LEN + ETHER_VLAN_ENCAP_LEN;
2603                etype = ntohs(eh->evl_proto);
2604        } else {
2605                ehdrlen = ETHER_HDR_LEN;
2606                etype = ntohs(eh->evl_encap_proto);
2607        }
2608
2609        switch (etype) {
2610
2611                case ETHERTYPE_IP:
2612                        ip = (struct ip *)(mp->m_data + ehdrlen);
2613
2614                        ip_hlen = sizeof (struct ip);
2615
2616                        if (mp->m_len < (ehdrlen + ip_hlen)) {
2617                                m_copydata(mp, ehdrlen, sizeof(struct ip), buf);
2618                                ip = (struct ip *)buf;
2619                        }
2620
2621                        th = (struct tcphdr *)(ip + 1);
2622			offset = ip_hlen + ehdrlen + (th->th_off << 2);
2623                break;
2624
2625                case ETHERTYPE_IPV6:
2626                        ip6 = (struct ip6_hdr *)(mp->m_data + ehdrlen);
2627
2628                        ip_hlen = sizeof(struct ip6_hdr);
2629
2630                        if (mp->m_len < (ehdrlen + ip_hlen)) {
2631                                m_copydata(mp, ehdrlen, sizeof (struct ip6_hdr),
2632                                        buf);
2633                                ip6 = (struct ip6_hdr *)buf;
2634                        }
2635                        th = (struct tcphdr *)(ip6 + 1);
2636			offset = ip_hlen + ehdrlen + (th->th_off << 2);
2637                break;
2638
2639                default:
2640                break;
2641        }
2642
2643        return (offset);
2644}
2645
2646static __inline int
2647qlnx_tso_check(struct qlnx_fastpath *fp, bus_dma_segment_t *segs, int nsegs,
2648	uint32_t offset)
2649{
2650	int			i;
2651	uint32_t		sum, nbds_in_hdr = 1;
2652	bus_dma_segment_t	*t_segs = segs;
2653
2654	/* count the number of segments spanned by TCP header */
2655
2656	i = 0;
2657	while ((i < nsegs) && (offset > t_segs->ds_len)) {
2658		nbds_in_hdr++;
2659		offset = offset - t_segs->ds_len;
2660		t_segs++;
2661		i++;
2662	}
2663
2664	while (nsegs >= QLNX_MAX_SEGMENTS_NON_TSO) {
2665
2666		sum = 0;
2667
2668		for (i = 0; i < (ETH_TX_LSO_WINDOW_BDS_NUM - nbds_in_hdr); i++){
2669			sum += segs->ds_len;
2670			segs++;
2671		}
2672
2673		if (sum < ETH_TX_LSO_WINDOW_MIN_LEN) {
2674			fp->tx_lso_wnd_min_len++;
2675			return (-1);
2676		}
2677
2678		nsegs -= QLNX_MAX_SEGMENTS_NON_TSO;
2679	}
2680
2681	return (0);
2682}
2683
2684static int
2685qlnx_send(qlnx_host_t *ha, struct qlnx_fastpath *fp, struct mbuf **m_headp)
2686{
2687	bus_dma_segment_t	*segs;
2688	bus_dmamap_t		map = 0;
2689	uint32_t		nsegs = 0;
2690	int			ret = -1;
2691	struct mbuf		*m_head = *m_headp;
2692	uint16_t		idx = 0;
2693	uint16_t		elem_left;
2694
2695	uint8_t			nbd = 0;
2696	struct qlnx_tx_queue    *txq;
2697
2698	struct eth_tx_1st_bd    *first_bd;
2699	struct eth_tx_2nd_bd    *second_bd;
2700	struct eth_tx_3rd_bd    *third_bd;
2701	struct eth_tx_bd        *tx_data_bd;
2702
2703	int			seg_idx = 0;
2704	uint32_t		nbds_in_hdr = 0;
2705	uint32_t		offset = 0;
2706
2707	QL_DPRINT8(ha, (ha->pci_dev, "%s: enter\n", __func__));
2708
2709	if (!ha->link_up)
2710		return (-1);
2711
2712	first_bd	= NULL;
2713	second_bd	= NULL;
2714	third_bd	= NULL;
2715	tx_data_bd	= NULL;
2716
2717	txq = fp->txq[0];
2718	idx = txq->sw_tx_prod;
2719
2720	map = txq->sw_tx_ring[idx].map;
2721	segs = txq->segs;
2722
2723	ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head, segs, &nsegs,
2724			BUS_DMA_NOWAIT);
2725
2726#ifdef QLNX_TRACE_TSO_PKT_LEN
2727
2728	if (!fp->tx_tso_min_pkt_len) {
2729		fp->tx_tso_min_pkt_len = m_head->m_pkthdr.len;
2730		fp->tx_tso_min_pkt_len = m_head->m_pkthdr.len;
2731	} else {
2732		if (fp->tx_tso_min_pkt_len > m_head->m_pkthdr.len)
2733			fp->tx_tso_min_pkt_len = m_head->m_pkthdr.len;
2734		if (fp->tx_tso_max_pkt_len < m_head->m_pkthdr.len)
2735			fp->tx_tso_max_pkt_len = m_head->m_pkthdr.len;
2736	}
2737
2738#endif /* #ifdef QLNX_TRACE_TSO_PKT_LEN */
2739
2740	if (m_head->m_pkthdr.csum_flags & CSUM_TSO)
2741		offset = qlnx_tcp_offset(ha, m_head);
2742
2743	if ((ret == EFBIG) ||
2744		((nsegs > QLNX_MAX_SEGMENTS_NON_TSO) && (
2745			(!(m_head->m_pkthdr.csum_flags & CSUM_TSO)) ||
2746		((m_head->m_pkthdr.csum_flags & CSUM_TSO) &&
2747			qlnx_tso_check(fp, segs, nsegs, offset))))) {
2748
2749		struct mbuf *m;
2750
2751		QL_DPRINT8(ha, (ha->pci_dev, "%s: EFBIG [%d]\n", __func__,
2752			m_head->m_pkthdr.len));
2753
2754		fp->tx_defrag++;
2755
2756		m = m_defrag(m_head, M_NOWAIT);
2757		if (m == NULL) {
2758			fp->err_tx_defrag++;
2759			fp->tx_pkts_freed++;
2760			m_freem(m_head);
2761			*m_headp = NULL;
2762			QL_DPRINT1(ha, (ha->pci_dev,
2763				"%s: m_defrag() = NULL [%d]\n",
2764				__func__, ret));
2765			return (ENOBUFS);
2766		}
2767
2768		m_head = m;
2769		*m_headp = m_head;
2770
2771		if ((ret = bus_dmamap_load_mbuf_sg(ha->tx_tag, map, m_head,
2772				segs, &nsegs, BUS_DMA_NOWAIT))) {
2773
2774			fp->err_tx_defrag_dmamap_load++;
2775
2776			QL_DPRINT1(ha, (ha->pci_dev,
2777				"%s: bus_dmamap_load_mbuf_sg failed0[%d, %d]\n",
2778				__func__, ret, m_head->m_pkthdr.len));
2779
2780			fp->tx_pkts_freed++;
2781			m_freem(m_head);
2782			*m_headp = NULL;
2783
2784			return (ret);
2785		}
2786
2787		if ((nsegs > QLNX_MAX_SEGMENTS_NON_TSO) &&
2788			!(m_head->m_pkthdr.csum_flags & CSUM_TSO)) {
2789
2790			fp->err_tx_non_tso_max_seg++;
2791
2792			QL_DPRINT1(ha, (ha->pci_dev,
2793				"%s: (%d) nsegs too many for non-TSO[%d, %d]\n",
2794				__func__, ret, nsegs, m_head->m_pkthdr.len));
2795
2796			fp->tx_pkts_freed++;
2797			m_freem(m_head);
2798			*m_headp = NULL;
2799
2800			return (ret);
2801		}
2802		if (m_head->m_pkthdr.csum_flags & CSUM_TSO)
2803			offset = qlnx_tcp_offset(ha, m_head);
2804
2805	} else if (ret) {
2806
2807		fp->err_tx_dmamap_load++;
2808
2809		QL_DPRINT1(ha, (ha->pci_dev,
2810			"%s: bus_dmamap_load_mbuf_sg failed1[%d, %d]\n",
2811			__func__, ret, m_head->m_pkthdr.len));
2812
2813		fp->tx_pkts_freed++;
2814		m_freem(m_head);
2815		*m_headp = NULL;
2816		return (ret);
2817	}
2818
2819	QL_ASSERT(ha, (nsegs != 0), ("qlnx_send: empty packet"));
2820
2821#ifdef QLNX_TRACE_TSO_PKT_LEN
2822
2823	if (nsegs < QLNX_FP_MAX_SEGS)
2824		fp->tx_pkts[(nsegs - 1)]++;
2825	else
2826		fp->tx_pkts[(QLNX_FP_MAX_SEGS - 1)]++;
2827
2828#endif /* #ifdef QLNX_TRACE_TSO_PKT_LEN */
2829
2830	if ((nsegs + QLNX_TX_ELEM_RESERVE) >
2831		(int)(elem_left = ecore_chain_get_elem_left(&txq->tx_pbl))) {
2832
2833		QL_DPRINT1(ha, (ha->pci_dev, "%s: (%d, 0x%x) insuffient BDs"
2834			"in chain[%d] trying to free packets\n",
2835			__func__, nsegs, elem_left, fp->rss_id));
2836
2837		fp->tx_nsegs_gt_elem_left++;
2838
2839		(void)qlnx_tx_int(ha, fp, txq);
2840
2841		if ((nsegs + QLNX_TX_ELEM_RESERVE) > (int)(elem_left =
2842			ecore_chain_get_elem_left(&txq->tx_pbl))) {
2843
2844			QL_DPRINT1(ha, (ha->pci_dev,
2845				"%s: (%d, 0x%x) insuffient BDs in chain[%d]\n",
2846				__func__, nsegs, elem_left, fp->rss_id));
2847
2848			fp->err_tx_nsegs_gt_elem_left++;
2849			ha->storm_stats_enable = 1;
2850			return (ENOBUFS);
2851		}
2852	}
2853
2854	bus_dmamap_sync(ha->tx_tag, map, BUS_DMASYNC_PREWRITE);
2855
2856	txq->sw_tx_ring[idx].mp = m_head;
2857
2858	first_bd = (struct eth_tx_1st_bd *)ecore_chain_produce(&txq->tx_pbl);
2859
2860	memset(first_bd, 0, sizeof(*first_bd));
2861
2862	first_bd->data.bd_flags.bitfields =
2863		1 << ETH_TX_1ST_BD_FLAGS_START_BD_SHIFT;
2864
2865	BD_SET_UNMAP_ADDR_LEN(first_bd, segs->ds_addr, segs->ds_len);
2866
2867	nbd++;
2868
2869	if (m_head->m_pkthdr.csum_flags & CSUM_IP) {
2870		first_bd->data.bd_flags.bitfields |=
2871			(1 << ETH_TX_1ST_BD_FLAGS_IP_CSUM_SHIFT);
2872	}
2873
2874	if (m_head->m_pkthdr.csum_flags & (CSUM_UDP | CSUM_TCP)) {
2875		first_bd->data.bd_flags.bitfields |=
2876			(1 << ETH_TX_1ST_BD_FLAGS_L4_CSUM_SHIFT);
2877	}
2878
2879        if (m_head->m_flags & M_VLANTAG) {
2880                first_bd->data.vlan = m_head->m_pkthdr.ether_vtag;
2881		first_bd->data.bd_flags.bitfields |=
2882			(1 << ETH_TX_1ST_BD_FLAGS_VLAN_INSERTION_SHIFT);
2883        }
2884
2885	if (m_head->m_pkthdr.csum_flags & CSUM_TSO) {
2886
2887                first_bd->data.bd_flags.bitfields |=
2888			(1 << ETH_TX_1ST_BD_FLAGS_LSO_SHIFT);
2889		first_bd->data.bd_flags.bitfields |=
2890			(1 << ETH_TX_1ST_BD_FLAGS_IP_CSUM_SHIFT);
2891
2892		nbds_in_hdr = 1;
2893
2894		if (offset == segs->ds_len) {
2895			BD_SET_UNMAP_ADDR_LEN(first_bd, segs->ds_addr, offset);
2896			segs++;
2897			seg_idx++;
2898
2899			second_bd = (struct eth_tx_2nd_bd *)
2900					ecore_chain_produce(&txq->tx_pbl);
2901			memset(second_bd, 0, sizeof(*second_bd));
2902			nbd++;
2903
2904			if (seg_idx < nsegs) {
2905				BD_SET_UNMAP_ADDR_LEN(second_bd, \
2906					(segs->ds_addr), (segs->ds_len));
2907				segs++;
2908				seg_idx++;
2909			}
2910
2911			third_bd = (struct eth_tx_3rd_bd *)
2912					ecore_chain_produce(&txq->tx_pbl);
2913			memset(third_bd, 0, sizeof(*third_bd));
2914			third_bd->data.lso_mss = m_head->m_pkthdr.tso_segsz;
2915			third_bd->data.bitfields |=
2916				(nbds_in_hdr<<ETH_TX_DATA_3RD_BD_HDR_NBD_SHIFT);
2917			nbd++;
2918
2919			if (seg_idx < nsegs) {
2920				BD_SET_UNMAP_ADDR_LEN(third_bd, \
2921					(segs->ds_addr), (segs->ds_len));
2922				segs++;
2923				seg_idx++;
2924			}
2925
2926			for (; seg_idx < nsegs; seg_idx++) {
2927				tx_data_bd = (struct eth_tx_bd *)
2928					ecore_chain_produce(&txq->tx_pbl);
2929				memset(tx_data_bd, 0, sizeof(*tx_data_bd));
2930				BD_SET_UNMAP_ADDR_LEN(tx_data_bd, \
2931					segs->ds_addr,\
2932					segs->ds_len);
2933				segs++;
2934				nbd++;
2935			}
2936
2937		} else if (offset < segs->ds_len) {
2938			BD_SET_UNMAP_ADDR_LEN(first_bd, segs->ds_addr, offset);
2939
2940			second_bd = (struct eth_tx_2nd_bd *)
2941					ecore_chain_produce(&txq->tx_pbl);
2942			memset(second_bd, 0, sizeof(*second_bd));
2943			BD_SET_UNMAP_ADDR_LEN(second_bd, \
2944				(segs->ds_addr + offset),\
2945				(segs->ds_len - offset));
2946			nbd++;
2947			segs++;
2948
2949			third_bd = (struct eth_tx_3rd_bd *)
2950					ecore_chain_produce(&txq->tx_pbl);
2951			memset(third_bd, 0, sizeof(*third_bd));
2952
2953			BD_SET_UNMAP_ADDR_LEN(third_bd, \
2954					segs->ds_addr,\
2955					segs->ds_len);
2956			third_bd->data.lso_mss = m_head->m_pkthdr.tso_segsz;
2957			third_bd->data.bitfields |=
2958				(nbds_in_hdr<<ETH_TX_DATA_3RD_BD_HDR_NBD_SHIFT);
2959			segs++;
2960			nbd++;
2961
2962			for (seg_idx = 2; seg_idx < nsegs; seg_idx++) {
2963				tx_data_bd = (struct eth_tx_bd *)
2964					ecore_chain_produce(&txq->tx_pbl);
2965				memset(tx_data_bd, 0, sizeof(*tx_data_bd));
2966				BD_SET_UNMAP_ADDR_LEN(tx_data_bd, \
2967					segs->ds_addr,\
2968					segs->ds_len);
2969				segs++;
2970				nbd++;
2971			}
2972
2973		} else {
2974			offset = offset - segs->ds_len;
2975			segs++;
2976
2977			for (seg_idx = 1; seg_idx < nsegs; seg_idx++) {
2978
2979				if (offset)
2980					nbds_in_hdr++;
2981
2982				tx_data_bd = (struct eth_tx_bd *)
2983					ecore_chain_produce(&txq->tx_pbl);
2984				memset(tx_data_bd, 0, sizeof(*tx_data_bd));
2985
2986				if (second_bd == NULL) {
2987					second_bd = (struct eth_tx_2nd_bd *)
2988								tx_data_bd;
2989				} else if (third_bd == NULL) {
2990					third_bd = (struct eth_tx_3rd_bd *)
2991								tx_data_bd;
2992				}
2993
2994				if (offset && (offset < segs->ds_len)) {
2995					BD_SET_UNMAP_ADDR_LEN(tx_data_bd,\
2996						segs->ds_addr, offset);
2997
2998					tx_data_bd = (struct eth_tx_bd *)
2999					ecore_chain_produce(&txq->tx_pbl);
3000
3001					memset(tx_data_bd, 0,
3002						sizeof(*tx_data_bd));
3003
3004					if (second_bd == NULL) {
3005						second_bd =
3006					(struct eth_tx_2nd_bd *)tx_data_bd;
3007					} else if (third_bd == NULL) {
3008						third_bd =
3009					(struct eth_tx_3rd_bd *)tx_data_bd;
3010					}
3011					BD_SET_UNMAP_ADDR_LEN(tx_data_bd,\
3012						(segs->ds_addr + offset), \
3013						(segs->ds_len - offset));
3014					nbd++;
3015					offset = 0;
3016				} else {
3017					if (offset)
3018						offset = offset - segs->ds_len;
3019					BD_SET_UNMAP_ADDR_LEN(tx_data_bd,\
3020						segs->ds_addr, segs->ds_len);
3021				}
3022				segs++;
3023				nbd++;
3024			}
3025
3026			if (third_bd == NULL) {
3027				third_bd = (struct eth_tx_3rd_bd *)
3028					ecore_chain_produce(&txq->tx_pbl);
3029				memset(third_bd, 0, sizeof(*third_bd));
3030			}
3031
3032			third_bd->data.lso_mss = m_head->m_pkthdr.tso_segsz;
3033			third_bd->data.bitfields |=
3034				(nbds_in_hdr<<ETH_TX_DATA_3RD_BD_HDR_NBD_SHIFT);
3035		}
3036	} else {
3037		segs++;
3038		for (seg_idx = 1; seg_idx < nsegs; seg_idx++) {
3039			tx_data_bd = (struct eth_tx_bd *)
3040					ecore_chain_produce(&txq->tx_pbl);
3041			memset(tx_data_bd, 0, sizeof(*tx_data_bd));
3042			BD_SET_UNMAP_ADDR_LEN(tx_data_bd, segs->ds_addr,\
3043				segs->ds_len);
3044			segs++;
3045			nbd++;
3046		}
3047		first_bd->data.bitfields =
3048			(m_head->m_pkthdr.len & ETH_TX_DATA_1ST_BD_PKT_LEN_MASK)
3049				 << ETH_TX_DATA_1ST_BD_PKT_LEN_SHIFT;
3050		first_bd->data.bitfields =
3051			htole16(first_bd->data.bitfields);
3052	}
3053
3054
3055	first_bd->data.nbds = nbd;
3056
3057#ifdef QLNX_TRACE_TSO_PKT_LEN
3058
3059	if (fp->tx_tso_max_nsegs < nsegs)
3060		fp->tx_tso_max_nsegs = nsegs;
3061
3062	if ((nsegs < fp->tx_tso_min_nsegs) || (!fp->tx_tso_min_nsegs))
3063		fp->tx_tso_min_nsegs = nsegs;
3064
3065#endif /* #ifdef QLNX_TRACE_TSO_PKT_LEN */
3066
3067	txq->sw_tx_ring[idx].nsegs = nsegs;
3068	txq->sw_tx_prod = (txq->sw_tx_prod + 1) & (TX_RING_SIZE - 1);
3069
3070	txq->tx_db.data.bd_prod =
3071		htole16(ecore_chain_get_prod_idx(&txq->tx_pbl));
3072
3073	qlnx_txq_doorbell_wr32(ha, txq->doorbell_addr, txq->tx_db.raw);
3074
3075	QL_DPRINT8(ha, (ha->pci_dev, "%s: exit\n", __func__));
3076	return (0);
3077}
3078
3079static void
3080qlnx_stop(qlnx_host_t *ha)
3081{
3082	struct ifnet	*ifp = ha->ifp;
3083	device_t	dev;
3084	int		i;
3085
3086	dev = ha->pci_dev;
3087
3088	ifp->if_drv_flags &= ~(IFF_DRV_OACTIVE | IFF_DRV_RUNNING);
3089
3090	/*
3091	 * We simply lock and unlock each fp->tx_mtx to
3092	 * propagate the if_drv_flags
3093	 * state to each tx thread
3094	 */
3095	if (ha->state == QLNX_STATE_OPEN) {
3096        	for (i = 0; i < ha->num_rss; i++) {
3097			struct qlnx_fastpath *fp = &ha->fp_array[i];
3098
3099			mtx_lock(&fp->tx_mtx);
3100			mtx_unlock(&fp->tx_mtx);
3101
3102			if (fp->fp_taskqueue != NULL)
3103				taskqueue_enqueue(fp->fp_taskqueue,
3104					&fp->fp_task);
3105		}
3106	}
3107
3108	qlnx_unload(ha);
3109
3110	return;
3111}
3112
3113static int
3114qlnx_get_ifq_snd_maxlen(qlnx_host_t *ha)
3115{
3116        return(TX_RING_SIZE - 1);
3117}
3118
3119uint8_t *
3120qlnx_get_mac_addr(qlnx_host_t *ha)
3121{
3122	struct ecore_hwfn	*p_hwfn;
3123
3124	p_hwfn = &ha->cdev.hwfns[0];
3125        return (p_hwfn->hw_info.hw_mac_addr);
3126}
3127
3128static uint32_t
3129qlnx_get_optics(qlnx_host_t *ha, struct qlnx_link_output *if_link)
3130{
3131	uint32_t	ifm_type = 0;
3132
3133	switch (if_link->media_type) {
3134
3135	case MEDIA_MODULE_FIBER:
3136	case MEDIA_UNSPECIFIED:
3137		if (if_link->speed == (100 * 1000))
3138			ifm_type = QLNX_IFM_100G_SR4;
3139		else if (if_link->speed == (40 * 1000))
3140			ifm_type = IFM_40G_SR4;
3141		else if (if_link->speed == (25 * 1000))
3142			ifm_type = QLNX_IFM_25G_SR;
3143		break;
3144
3145	case MEDIA_DA_TWINAX:
3146		if (if_link->speed == (100 * 1000))
3147			ifm_type = QLNX_IFM_100G_CR4;
3148		else if (if_link->speed == (40 * 1000))
3149			ifm_type = IFM_40G_CR4;
3150		else if (if_link->speed == (25 * 1000))
3151			ifm_type = QLNX_IFM_25G_CR;
3152		break;
3153
3154	default :
3155		ifm_type = IFM_UNKNOWN;
3156		break;
3157	}
3158	return (ifm_type);
3159}
3160
3161
3162
3163/*****************************************************************************
3164 * Interrupt Service Functions
3165 *****************************************************************************/
3166
3167static int
3168qlnx_rx_jumbo_chain(qlnx_host_t *ha, struct qlnx_fastpath *fp,
3169	struct mbuf *mp_head, uint16_t len)
3170{
3171	struct mbuf		*mp, *mpf, *mpl;
3172	struct sw_rx_data	*sw_rx_data;
3173	struct qlnx_rx_queue	*rxq;
3174	uint16_t 		len_in_buffer;
3175
3176	rxq = fp->rxq;
3177	mpf = mpl = mp = NULL;
3178
3179	while (len) {
3180
3181        	rxq->sw_rx_cons  = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3182
3183                sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3184                mp = sw_rx_data->data;
3185
3186		if (mp == NULL) {
3187                	QL_DPRINT1(ha, (ha->pci_dev, "%s: mp = NULL\n",
3188				__func__));
3189			fp->err_rx_mp_null++;
3190        		rxq->sw_rx_cons  =
3191				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3192
3193			if (mpf != NULL)
3194				m_freem(mpf);
3195
3196			return (-1);
3197		}
3198		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3199			BUS_DMASYNC_POSTREAD);
3200
3201                if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
3202
3203                        QL_DPRINT1(ha, (ha->pci_dev,
3204				"%s: New buffer allocation failed, dropping"
3205				" incoming packet and reusing its buffer\n",
3206				__func__));
3207
3208                        qlnx_reuse_rx_data(rxq);
3209                        fp->err_rx_alloc_errors++;
3210
3211			if (mpf != NULL)
3212				m_freem(mpf);
3213
3214			return (-1);
3215		}
3216                ecore_chain_consume(&rxq->rx_bd_ring);
3217
3218		if (len > rxq->rx_buf_size)
3219			len_in_buffer = rxq->rx_buf_size;
3220		else
3221			len_in_buffer = len;
3222
3223		len = len - len_in_buffer;
3224
3225		mp->m_flags &= ~M_PKTHDR;
3226		mp->m_next = NULL;
3227		mp->m_len = len_in_buffer;
3228
3229		if (mpf == NULL)
3230			mpf = mpl = mp;
3231		else {
3232			mpl->m_next = mp;
3233			mpl = mp;
3234		}
3235	}
3236
3237	if (mpf != NULL)
3238		mp_head->m_next = mpf;
3239
3240	return (0);
3241}
3242
3243static void
3244qlnx_tpa_start(qlnx_host_t *ha,
3245	struct qlnx_fastpath *fp,
3246	struct qlnx_rx_queue *rxq,
3247	struct eth_fast_path_rx_tpa_start_cqe *cqe)
3248{
3249	uint32_t		agg_index;
3250        struct ifnet		*ifp = ha->ifp;
3251	struct mbuf		*mp;
3252	struct mbuf		*mpf = NULL, *mpl = NULL, *mpc = NULL;
3253	struct sw_rx_data	*sw_rx_data;
3254	dma_addr_t		addr;
3255	bus_dmamap_t		map;
3256	struct eth_rx_bd	*rx_bd;
3257	int			i;
3258	device_t		dev;
3259#if __FreeBSD_version >= 1100000
3260	uint8_t			hash_type;
3261#endif /* #if __FreeBSD_version >= 1100000 */
3262
3263	dev = ha->pci_dev;
3264	agg_index = cqe->tpa_agg_index;
3265
3266        QL_DPRINT7(ha, (dev, "%s[%d]: enter\n "
3267                "\t type = 0x%x\n"
3268                "\t bitfields = 0x%x\n"
3269                "\t seg_len = 0x%x\n"
3270                "\t pars_flags = 0x%x\n"
3271                "\t vlan_tag = 0x%x\n"
3272                "\t rss_hash = 0x%x\n"
3273                "\t len_on_first_bd = 0x%x\n"
3274                "\t placement_offset = 0x%x\n"
3275                "\t tpa_agg_index = 0x%x\n"
3276                "\t header_len = 0x%x\n"
3277                "\t ext_bd_len_list[0] = 0x%x\n"
3278                "\t ext_bd_len_list[1] = 0x%x\n"
3279                "\t ext_bd_len_list[2] = 0x%x\n"
3280                "\t ext_bd_len_list[3] = 0x%x\n"
3281                "\t ext_bd_len_list[4] = 0x%x\n",
3282                __func__, fp->rss_id, cqe->type, cqe->bitfields, cqe->seg_len,
3283                cqe->pars_flags.flags, cqe->vlan_tag,
3284                cqe->rss_hash, cqe->len_on_first_bd, cqe->placement_offset,
3285                cqe->tpa_agg_index, cqe->header_len,
3286                cqe->ext_bd_len_list[0], cqe->ext_bd_len_list[1],
3287                cqe->ext_bd_len_list[2], cqe->ext_bd_len_list[3],
3288                cqe->ext_bd_len_list[4]));
3289
3290	if (agg_index >= ETH_TPA_MAX_AGGS_NUM) {
3291		fp->err_rx_tpa_invalid_agg_num++;
3292		return;
3293	}
3294
3295	sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3296	bus_dmamap_sync(ha->rx_tag, sw_rx_data->map, BUS_DMASYNC_POSTREAD);
3297	mp = sw_rx_data->data;
3298
3299	QL_DPRINT7(ha, (dev, "%s[%d]: mp = %p \n ", __func__, fp->rss_id, mp));
3300
3301	if (mp == NULL) {
3302               	QL_DPRINT7(ha, (dev, "%s[%d]: mp = NULL\n", __func__,
3303			fp->rss_id));
3304		fp->err_rx_mp_null++;
3305       		rxq->sw_rx_cons = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3306
3307		return;
3308	}
3309
3310	if ((le16toh(cqe->pars_flags.flags)) & CQE_FLAGS_ERR) {
3311
3312		QL_DPRINT7(ha, (dev, "%s[%d]: CQE in CONS = %u has error,"
3313			" flags = %x, dropping incoming packet\n", __func__,
3314			fp->rss_id, rxq->sw_rx_cons,
3315			le16toh(cqe->pars_flags.flags)));
3316
3317		fp->err_rx_hw_errors++;
3318
3319		qlnx_reuse_rx_data(rxq);
3320
3321		QLNX_INC_IERRORS(ifp);
3322
3323		return;
3324	}
3325
3326	if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
3327
3328		QL_DPRINT7(ha, (dev, "%s[%d]: New buffer allocation failed,"
3329			" dropping incoming packet and reusing its buffer\n",
3330			__func__, fp->rss_id));
3331
3332		fp->err_rx_alloc_errors++;
3333		QLNX_INC_IQDROPS(ifp);
3334
3335		/*
3336		 * Load the tpa mbuf into the rx ring and save the
3337		 * posted mbuf
3338		 */
3339
3340		map = sw_rx_data->map;
3341		addr = sw_rx_data->dma_addr;
3342
3343		sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_prod];
3344
3345		sw_rx_data->data = rxq->tpa_info[agg_index].rx_buf.data;
3346		sw_rx_data->dma_addr = rxq->tpa_info[agg_index].rx_buf.dma_addr;
3347		sw_rx_data->map = rxq->tpa_info[agg_index].rx_buf.map;
3348
3349		rxq->tpa_info[agg_index].rx_buf.data = mp;
3350		rxq->tpa_info[agg_index].rx_buf.dma_addr = addr;
3351		rxq->tpa_info[agg_index].rx_buf.map = map;
3352
3353		rx_bd = (struct eth_rx_bd *)
3354				ecore_chain_produce(&rxq->rx_bd_ring);
3355
3356		rx_bd->addr.hi = htole32(U64_HI(sw_rx_data->dma_addr));
3357		rx_bd->addr.lo = htole32(U64_LO(sw_rx_data->dma_addr));
3358
3359		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3360			BUS_DMASYNC_PREREAD);
3361
3362		rxq->sw_rx_prod = (rxq->sw_rx_prod + 1) & (RX_RING_SIZE - 1);
3363		rxq->sw_rx_cons = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3364
3365		ecore_chain_consume(&rxq->rx_bd_ring);
3366
3367		/* Now reuse any buffers posted in ext_bd_len_list */
3368		for (i = 0; i < ETH_TPA_CQE_START_LEN_LIST_SIZE; i++) {
3369
3370			if (cqe->ext_bd_len_list[i] == 0)
3371				break;
3372
3373			qlnx_reuse_rx_data(rxq);
3374		}
3375
3376		rxq->tpa_info[agg_index].agg_state = QLNX_AGG_STATE_ERROR;
3377		return;
3378	}
3379
3380	if (rxq->tpa_info[agg_index].agg_state != QLNX_AGG_STATE_NONE) {
3381
3382		QL_DPRINT7(ha, (dev, "%s[%d]: invalid aggregation state,"
3383			" dropping incoming packet and reusing its buffer\n",
3384			__func__, fp->rss_id));
3385
3386		QLNX_INC_IQDROPS(ifp);
3387
3388		/* if we already have mbuf head in aggregation free it */
3389		if (rxq->tpa_info[agg_index].mpf) {
3390			m_freem(rxq->tpa_info[agg_index].mpf);
3391			rxq->tpa_info[agg_index].mpl = NULL;
3392		}
3393		rxq->tpa_info[agg_index].mpf = mp;
3394		rxq->tpa_info[agg_index].mpl = NULL;
3395
3396		rxq->sw_rx_cons = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3397		ecore_chain_consume(&rxq->rx_bd_ring);
3398
3399		/* Now reuse any buffers posted in ext_bd_len_list */
3400		for (i = 0; i < ETH_TPA_CQE_START_LEN_LIST_SIZE; i++) {
3401
3402			if (cqe->ext_bd_len_list[i] == 0)
3403				break;
3404
3405			qlnx_reuse_rx_data(rxq);
3406		}
3407		rxq->tpa_info[agg_index].agg_state = QLNX_AGG_STATE_ERROR;
3408
3409		return;
3410	}
3411
3412	/*
3413	 * first process the ext_bd_len_list
3414	 * if this fails then we simply drop the packet
3415	 */
3416	ecore_chain_consume(&rxq->rx_bd_ring);
3417	rxq->sw_rx_cons  = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3418
3419	for (i = 0; i < ETH_TPA_CQE_START_LEN_LIST_SIZE; i++) {
3420
3421		QL_DPRINT7(ha, (dev, "%s[%d]: 4\n ", __func__, fp->rss_id));
3422
3423		if (cqe->ext_bd_len_list[i] == 0)
3424			break;
3425
3426		sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3427		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3428			BUS_DMASYNC_POSTREAD);
3429
3430		mpc = sw_rx_data->data;
3431
3432		if (mpc == NULL) {
3433			QL_DPRINT7(ha, (ha->pci_dev, "%s[%d]: mpc = NULL\n",
3434				__func__, fp->rss_id));
3435			fp->err_rx_mp_null++;
3436			if (mpf != NULL)
3437				m_freem(mpf);
3438			mpf = mpl = NULL;
3439			rxq->tpa_info[agg_index].agg_state =
3440						QLNX_AGG_STATE_ERROR;
3441			ecore_chain_consume(&rxq->rx_bd_ring);
3442			rxq->sw_rx_cons =
3443				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3444			continue;
3445		}
3446
3447		if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
3448			QL_DPRINT7(ha, (dev,
3449				"%s[%d]: New buffer allocation failed, dropping"
3450				" incoming packet and reusing its buffer\n",
3451				__func__, fp->rss_id));
3452
3453			qlnx_reuse_rx_data(rxq);
3454
3455			if (mpf != NULL)
3456				m_freem(mpf);
3457			mpf = mpl = NULL;
3458
3459			rxq->tpa_info[agg_index].agg_state =
3460						QLNX_AGG_STATE_ERROR;
3461
3462			ecore_chain_consume(&rxq->rx_bd_ring);
3463			rxq->sw_rx_cons =
3464				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3465
3466			continue;
3467		}
3468
3469		mpc->m_flags &= ~M_PKTHDR;
3470		mpc->m_next = NULL;
3471		mpc->m_len = cqe->ext_bd_len_list[i];
3472
3473
3474		if (mpf == NULL) {
3475			mpf = mpl = mpc;
3476		} else {
3477			mpl->m_len = ha->rx_buf_size;
3478			mpl->m_next = mpc;
3479			mpl = mpc;
3480		}
3481
3482		ecore_chain_consume(&rxq->rx_bd_ring);
3483		rxq->sw_rx_cons =
3484			(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3485	}
3486
3487	if (rxq->tpa_info[agg_index].agg_state != QLNX_AGG_STATE_NONE) {
3488
3489		QL_DPRINT7(ha, (dev, "%s[%d]: invalid aggregation state,"
3490			" dropping incoming packet and reusing its buffer\n",
3491			__func__, fp->rss_id));
3492
3493		QLNX_INC_IQDROPS(ifp);
3494
3495		rxq->tpa_info[agg_index].mpf = mp;
3496		rxq->tpa_info[agg_index].mpl = NULL;
3497
3498		return;
3499	}
3500
3501        rxq->tpa_info[agg_index].placement_offset = cqe->placement_offset;
3502
3503        if (mpf != NULL) {
3504                mp->m_len = ha->rx_buf_size;
3505                mp->m_next = mpf;
3506                rxq->tpa_info[agg_index].mpf = mp;
3507                rxq->tpa_info[agg_index].mpl = mpl;
3508        } else {
3509                mp->m_len = cqe->len_on_first_bd + cqe->placement_offset;
3510                rxq->tpa_info[agg_index].mpf = mp;
3511                rxq->tpa_info[agg_index].mpl = mp;
3512                mp->m_next = NULL;
3513        }
3514
3515	mp->m_flags |= M_PKTHDR;
3516
3517	/* assign packet to this interface interface */
3518	mp->m_pkthdr.rcvif = ifp;
3519
3520	/* assume no hardware checksum has complated */
3521	mp->m_pkthdr.csum_flags = 0;
3522
3523	//mp->m_pkthdr.flowid = fp->rss_id;
3524	mp->m_pkthdr.flowid = cqe->rss_hash;
3525
3526#if __FreeBSD_version >= 1100000
3527
3528	hash_type = cqe->bitfields &
3529			(ETH_FAST_PATH_RX_REG_CQE_RSS_HASH_TYPE_MASK <<
3530			ETH_FAST_PATH_RX_REG_CQE_RSS_HASH_TYPE_SHIFT);
3531
3532	switch (hash_type) {
3533
3534	case RSS_HASH_TYPE_IPV4:
3535		M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_IPV4);
3536		break;
3537
3538	case RSS_HASH_TYPE_TCP_IPV4:
3539		M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_TCP_IPV4);
3540		break;
3541
3542	case RSS_HASH_TYPE_IPV6:
3543		M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_IPV6);
3544		break;
3545
3546	case RSS_HASH_TYPE_TCP_IPV6:
3547		M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_TCP_IPV6);
3548		break;
3549
3550	default:
3551		M_HASHTYPE_SET(mp, M_HASHTYPE_OPAQUE);
3552		break;
3553	}
3554
3555#else
3556	mp->m_flags |= M_FLOWID;
3557#endif
3558
3559	mp->m_pkthdr.csum_flags |= (CSUM_IP_CHECKED | CSUM_IP_VALID |
3560					CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
3561
3562	mp->m_pkthdr.csum_data = 0xFFFF;
3563
3564	if (CQE_HAS_VLAN(cqe->pars_flags.flags)) {
3565		mp->m_pkthdr.ether_vtag = le16toh(cqe->vlan_tag);
3566		mp->m_flags |= M_VLANTAG;
3567	}
3568
3569	rxq->tpa_info[agg_index].agg_state = QLNX_AGG_STATE_START;
3570
3571        QL_DPRINT7(ha, (dev, "%s[%d]: 5\n" "\tagg_state = %d\n"
3572                "\t mpf = %p mpl = %p\n", __func__, fp->rss_id,
3573                rxq->tpa_info[agg_index].agg_state,
3574                rxq->tpa_info[agg_index].mpf, rxq->tpa_info[agg_index].mpl));
3575
3576	return;
3577}
3578
3579static void
3580qlnx_tpa_cont(qlnx_host_t *ha, struct qlnx_fastpath *fp,
3581	struct qlnx_rx_queue *rxq,
3582	struct eth_fast_path_rx_tpa_cont_cqe *cqe)
3583{
3584	struct sw_rx_data	*sw_rx_data;
3585	int			i;
3586	struct mbuf		*mpf = NULL, *mpl = NULL, *mpc = NULL;
3587	struct mbuf		*mp;
3588	uint32_t		agg_index;
3589	device_t		dev;
3590
3591	dev = ha->pci_dev;
3592
3593        QL_DPRINT7(ha, (dev, "%s[%d]: enter\n "
3594                "\t type = 0x%x\n"
3595                "\t tpa_agg_index = 0x%x\n"
3596                "\t len_list[0] = 0x%x\n"
3597                "\t len_list[1] = 0x%x\n"
3598                "\t len_list[2] = 0x%x\n"
3599                "\t len_list[3] = 0x%x\n"
3600                "\t len_list[4] = 0x%x\n"
3601                "\t len_list[5] = 0x%x\n",
3602                __func__, fp->rss_id, cqe->type, cqe->tpa_agg_index,
3603                cqe->len_list[0], cqe->len_list[1], cqe->len_list[2],
3604                cqe->len_list[3], cqe->len_list[4], cqe->len_list[5]));
3605
3606	agg_index = cqe->tpa_agg_index;
3607
3608	if (agg_index >= ETH_TPA_MAX_AGGS_NUM) {
3609		QL_DPRINT7(ha, (dev, "%s[%d]: 0\n ", __func__, fp->rss_id));
3610		fp->err_rx_tpa_invalid_agg_num++;
3611		return;
3612	}
3613
3614
3615	for (i = 0; i < ETH_TPA_CQE_CONT_LEN_LIST_SIZE; i++) {
3616
3617		QL_DPRINT7(ha, (dev, "%s[%d]: 1\n ", __func__, fp->rss_id));
3618
3619		if (cqe->len_list[i] == 0)
3620			break;
3621
3622		if (rxq->tpa_info[agg_index].agg_state !=
3623			QLNX_AGG_STATE_START) {
3624			qlnx_reuse_rx_data(rxq);
3625			continue;
3626		}
3627
3628		sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3629		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3630			BUS_DMASYNC_POSTREAD);
3631
3632		mpc = sw_rx_data->data;
3633
3634		if (mpc == NULL) {
3635
3636			QL_DPRINT7(ha, (dev, "%s[%d]: mpc = NULL\n",
3637				__func__, fp->rss_id));
3638
3639			fp->err_rx_mp_null++;
3640			if (mpf != NULL)
3641				m_freem(mpf);
3642			mpf = mpl = NULL;
3643			rxq->tpa_info[agg_index].agg_state =
3644						QLNX_AGG_STATE_ERROR;
3645			ecore_chain_consume(&rxq->rx_bd_ring);
3646			rxq->sw_rx_cons =
3647				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3648			continue;
3649		}
3650
3651		if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
3652
3653			QL_DPRINT7(ha, (dev,
3654				"%s[%d]: New buffer allocation failed, dropping"
3655				" incoming packet and reusing its buffer\n",
3656				__func__, fp->rss_id));
3657
3658			qlnx_reuse_rx_data(rxq);
3659
3660			if (mpf != NULL)
3661				m_freem(mpf);
3662			mpf = mpl = NULL;
3663
3664			rxq->tpa_info[agg_index].agg_state =
3665						QLNX_AGG_STATE_ERROR;
3666
3667			ecore_chain_consume(&rxq->rx_bd_ring);
3668			rxq->sw_rx_cons =
3669				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3670
3671			continue;
3672		}
3673
3674		mpc->m_flags &= ~M_PKTHDR;
3675		mpc->m_next = NULL;
3676		mpc->m_len = cqe->len_list[i];
3677
3678
3679		if (mpf == NULL) {
3680			mpf = mpl = mpc;
3681		} else {
3682			mpl->m_len = ha->rx_buf_size;
3683			mpl->m_next = mpc;
3684			mpl = mpc;
3685		}
3686
3687		ecore_chain_consume(&rxq->rx_bd_ring);
3688		rxq->sw_rx_cons =
3689			(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3690	}
3691
3692        QL_DPRINT7(ha, (dev, "%s[%d]: 2\n" "\tmpf = %p mpl = %p\n",
3693                __func__, fp->rss_id, mpf, mpl));
3694
3695	if (mpf != NULL) {
3696		mp = rxq->tpa_info[agg_index].mpl;
3697		mp->m_len = ha->rx_buf_size;
3698		mp->m_next = mpf;
3699		rxq->tpa_info[agg_index].mpl = mpl;
3700	}
3701
3702	return;
3703}
3704
3705static int
3706qlnx_tpa_end(qlnx_host_t *ha, struct qlnx_fastpath *fp,
3707	struct qlnx_rx_queue *rxq,
3708	struct eth_fast_path_rx_tpa_end_cqe *cqe)
3709{
3710	struct sw_rx_data	*sw_rx_data;
3711	int			i;
3712	struct mbuf		*mpf = NULL, *mpl = NULL, *mpc = NULL;
3713	struct mbuf		*mp;
3714	uint32_t		agg_index;
3715	uint32_t		len = 0;
3716        struct ifnet		*ifp = ha->ifp;
3717	device_t		dev;
3718
3719	dev = ha->pci_dev;
3720
3721        QL_DPRINT7(ha, (dev, "%s[%d]: enter\n "
3722                "\t type = 0x%x\n"
3723                "\t tpa_agg_index = 0x%x\n"
3724                "\t total_packet_len = 0x%x\n"
3725                "\t num_of_bds = 0x%x\n"
3726                "\t end_reason = 0x%x\n"
3727                "\t num_of_coalesced_segs = 0x%x\n"
3728                "\t ts_delta = 0x%x\n"
3729                "\t len_list[0] = 0x%x\n"
3730                "\t len_list[1] = 0x%x\n"
3731                "\t len_list[2] = 0x%x\n"
3732                "\t len_list[3] = 0x%x\n",
3733                __func__, fp->rss_id, cqe->type, cqe->tpa_agg_index,
3734                cqe->total_packet_len, cqe->num_of_bds,
3735                cqe->end_reason, cqe->num_of_coalesced_segs, cqe->ts_delta,
3736                cqe->len_list[0], cqe->len_list[1], cqe->len_list[2],
3737                cqe->len_list[3]));
3738
3739	agg_index = cqe->tpa_agg_index;
3740
3741	if (agg_index >= ETH_TPA_MAX_AGGS_NUM) {
3742
3743		QL_DPRINT7(ha, (dev, "%s[%d]: 0\n ", __func__, fp->rss_id));
3744
3745		fp->err_rx_tpa_invalid_agg_num++;
3746		return (0);
3747	}
3748
3749
3750	for (i = 0; i < ETH_TPA_CQE_END_LEN_LIST_SIZE; i++) {
3751
3752		QL_DPRINT7(ha, (dev, "%s[%d]: 1\n ", __func__, fp->rss_id));
3753
3754		if (cqe->len_list[i] == 0)
3755			break;
3756
3757		if (rxq->tpa_info[agg_index].agg_state !=
3758			QLNX_AGG_STATE_START) {
3759
3760			QL_DPRINT7(ha, (dev, "%s[%d]: 2\n ", __func__,
3761				fp->rss_id));
3762
3763			qlnx_reuse_rx_data(rxq);
3764			continue;
3765		}
3766
3767		sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3768		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3769			BUS_DMASYNC_POSTREAD);
3770
3771		mpc = sw_rx_data->data;
3772
3773		if (mpc == NULL) {
3774
3775			QL_DPRINT7(ha, (dev, "%s[%d]: mpc = NULL\n",
3776				__func__, fp->rss_id));
3777
3778			fp->err_rx_mp_null++;
3779			if (mpf != NULL)
3780				m_freem(mpf);
3781			mpf = mpl = NULL;
3782			rxq->tpa_info[agg_index].agg_state =
3783						QLNX_AGG_STATE_ERROR;
3784			ecore_chain_consume(&rxq->rx_bd_ring);
3785			rxq->sw_rx_cons =
3786				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3787			continue;
3788		}
3789
3790		if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
3791			QL_DPRINT7(ha, (dev,
3792				"%s[%d]: New buffer allocation failed, dropping"
3793				" incoming packet and reusing its buffer\n",
3794				__func__, fp->rss_id));
3795
3796			qlnx_reuse_rx_data(rxq);
3797
3798			if (mpf != NULL)
3799				m_freem(mpf);
3800			mpf = mpl = NULL;
3801
3802			rxq->tpa_info[agg_index].agg_state =
3803						QLNX_AGG_STATE_ERROR;
3804
3805			ecore_chain_consume(&rxq->rx_bd_ring);
3806			rxq->sw_rx_cons =
3807				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3808
3809			continue;
3810		}
3811
3812		mpc->m_flags &= ~M_PKTHDR;
3813		mpc->m_next = NULL;
3814		mpc->m_len = cqe->len_list[i];
3815
3816
3817		if (mpf == NULL) {
3818			mpf = mpl = mpc;
3819		} else {
3820			mpl->m_len = ha->rx_buf_size;
3821			mpl->m_next = mpc;
3822			mpl = mpc;
3823		}
3824
3825		ecore_chain_consume(&rxq->rx_bd_ring);
3826		rxq->sw_rx_cons =
3827			(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3828	}
3829
3830	QL_DPRINT7(ha, (dev, "%s[%d]: 5\n ", __func__, fp->rss_id));
3831
3832	if (mpf != NULL) {
3833
3834		QL_DPRINT7(ha, (dev, "%s[%d]: 6\n ", __func__, fp->rss_id));
3835
3836		mp = rxq->tpa_info[agg_index].mpl;
3837		mp->m_len = ha->rx_buf_size;
3838		mp->m_next = mpf;
3839	}
3840
3841	if (rxq->tpa_info[agg_index].agg_state != QLNX_AGG_STATE_START) {
3842
3843		QL_DPRINT7(ha, (dev, "%s[%d]: 7\n ", __func__, fp->rss_id));
3844
3845		if (rxq->tpa_info[agg_index].mpf != NULL)
3846			m_freem(rxq->tpa_info[agg_index].mpf);
3847		rxq->tpa_info[agg_index].mpf = NULL;
3848		rxq->tpa_info[agg_index].mpl = NULL;
3849		rxq->tpa_info[agg_index].agg_state = QLNX_AGG_STATE_NONE;
3850		return (0);
3851	}
3852
3853	mp = rxq->tpa_info[agg_index].mpf;
3854	m_adj(mp, rxq->tpa_info[agg_index].placement_offset);
3855	mp->m_pkthdr.len = cqe->total_packet_len;
3856
3857	if (mp->m_next  == NULL)
3858		mp->m_len = mp->m_pkthdr.len;
3859	else {
3860		/* compute the total packet length */
3861		mpf = mp;
3862		while (mpf != NULL) {
3863			len += mpf->m_len;
3864			mpf = mpf->m_next;
3865		}
3866
3867		if (cqe->total_packet_len > len) {
3868			mpl = rxq->tpa_info[agg_index].mpl;
3869			mpl->m_len += (cqe->total_packet_len - len);
3870		}
3871	}
3872
3873	QLNX_INC_IPACKETS(ifp);
3874	QLNX_INC_IBYTES(ifp, (cqe->total_packet_len));
3875
3876        QL_DPRINT7(ha, (dev, "%s[%d]: 8 csum_data = 0x%x csum_flags = 0x%lx\n "
3877		"m_len = 0x%x m_pkthdr_len = 0x%x\n",
3878                __func__, fp->rss_id, mp->m_pkthdr.csum_data,
3879                mp->m_pkthdr.csum_flags, mp->m_len, mp->m_pkthdr.len));
3880
3881	(*ifp->if_input)(ifp, mp);
3882
3883	rxq->tpa_info[agg_index].mpf = NULL;
3884	rxq->tpa_info[agg_index].mpl = NULL;
3885	rxq->tpa_info[agg_index].agg_state = QLNX_AGG_STATE_NONE;
3886
3887	return (cqe->num_of_coalesced_segs);
3888}
3889
3890static int
3891qlnx_rx_int(qlnx_host_t *ha, struct qlnx_fastpath *fp, int budget,
3892	int lro_enable)
3893{
3894        uint16_t		hw_comp_cons, sw_comp_cons;
3895        int			rx_pkt = 0;
3896        struct qlnx_rx_queue	*rxq = fp->rxq;
3897        struct ifnet		*ifp = ha->ifp;
3898	struct ecore_dev	*cdev = &ha->cdev;
3899	struct ecore_hwfn       *p_hwfn;
3900
3901#ifdef QLNX_SOFT_LRO
3902	struct lro_ctrl		*lro;
3903
3904	lro = &rxq->lro;
3905#endif /* #ifdef QLNX_SOFT_LRO */
3906
3907        hw_comp_cons = le16toh(*rxq->hw_cons_ptr);
3908        sw_comp_cons = ecore_chain_get_cons_idx(&rxq->rx_comp_ring);
3909
3910	p_hwfn = &ha->cdev.hwfns[(fp->rss_id % cdev->num_hwfns)];
3911
3912        /* Memory barrier to prevent the CPU from doing speculative reads of CQE
3913         * / BD in the while-loop before reading hw_comp_cons. If the CQE is
3914         * read before it is written by FW, then FW writes CQE and SB, and then
3915         * the CPU reads the hw_comp_cons, it will use an old CQE.
3916         */
3917
3918        /* Loop to complete all indicated BDs */
3919        while (sw_comp_cons != hw_comp_cons) {
3920                union eth_rx_cqe		*cqe;
3921                struct eth_fast_path_rx_reg_cqe	*fp_cqe;
3922                struct sw_rx_data		*sw_rx_data;
3923		register struct mbuf		*mp;
3924                enum eth_rx_cqe_type		cqe_type;
3925                uint16_t			len, pad, len_on_first_bd;
3926                uint8_t				*data;
3927#if __FreeBSD_version >= 1100000
3928		uint8_t				hash_type;
3929#endif /* #if __FreeBSD_version >= 1100000 */
3930
3931                /* Get the CQE from the completion ring */
3932                cqe = (union eth_rx_cqe *)
3933                        ecore_chain_consume(&rxq->rx_comp_ring);
3934                cqe_type = cqe->fast_path_regular.type;
3935
3936                if (cqe_type == ETH_RX_CQE_TYPE_SLOW_PATH) {
3937                        QL_DPRINT3(ha, (ha->pci_dev, "Got a slowath CQE\n"));
3938
3939                        ecore_eth_cqe_completion(p_hwfn,
3940                                        (struct eth_slow_path_rx_cqe *)cqe);
3941                        goto next_cqe;
3942                }
3943
3944		if (cqe_type != ETH_RX_CQE_TYPE_REGULAR) {
3945
3946			switch (cqe_type) {
3947
3948			case ETH_RX_CQE_TYPE_TPA_START:
3949				qlnx_tpa_start(ha, fp, rxq,
3950					&cqe->fast_path_tpa_start);
3951				fp->tpa_start++;
3952				break;
3953
3954			case ETH_RX_CQE_TYPE_TPA_CONT:
3955				qlnx_tpa_cont(ha, fp, rxq,
3956					&cqe->fast_path_tpa_cont);
3957				fp->tpa_cont++;
3958				break;
3959
3960			case ETH_RX_CQE_TYPE_TPA_END:
3961				rx_pkt += qlnx_tpa_end(ha, fp, rxq,
3962						&cqe->fast_path_tpa_end);
3963				fp->tpa_end++;
3964				break;
3965
3966			default:
3967				break;
3968			}
3969
3970                        goto next_cqe;
3971		}
3972
3973                /* Get the data from the SW ring */
3974                sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_cons];
3975                mp = sw_rx_data->data;
3976
3977		if (mp == NULL) {
3978                	QL_DPRINT1(ha, (ha->pci_dev, "%s: mp = NULL\n",
3979				__func__));
3980			fp->err_rx_mp_null++;
3981        		rxq->sw_rx_cons  =
3982				(rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
3983			goto next_cqe;
3984		}
3985		bus_dmamap_sync(ha->rx_tag, sw_rx_data->map,
3986			BUS_DMASYNC_POSTREAD);
3987
3988                /* non GRO */
3989                fp_cqe = &cqe->fast_path_regular;/* MK CR TPA check assembly */
3990                len =  le16toh(fp_cqe->pkt_len);
3991                pad = fp_cqe->placement_offset;
3992
3993		QL_DPRINT3(ha,
3994			(ha->pci_dev, "CQE type = %x, flags = %x, vlan = %x,"
3995			" len %u, parsing flags = %d pad  = %d\n",
3996			cqe_type, fp_cqe->bitfields,
3997			le16toh(fp_cqe->vlan_tag),
3998			len, le16toh(fp_cqe->pars_flags.flags), pad));
3999
4000		data = mtod(mp, uint8_t *);
4001		data = data + pad;
4002
4003		if (0)
4004			qlnx_dump_buf8(ha, __func__, data, len);
4005
4006                /* For every Rx BD consumed, we allocate a new BD so the BD ring
4007                 * is always with a fixed size. If allocation fails, we take the
4008                 * consumed BD and return it to the ring in the PROD position.
4009                 * The packet that was received on that BD will be dropped (and
4010                 * not passed to the upper stack).
4011                 */
4012		/* If this is an error packet then drop it */
4013		if ((le16toh(cqe->fast_path_regular.pars_flags.flags)) &
4014			CQE_FLAGS_ERR) {
4015
4016			QL_DPRINT1(ha, (ha->pci_dev,
4017				"CQE in CONS = %u has error, flags = %x,"
4018				" dropping incoming packet\n", sw_comp_cons,
4019			le16toh(cqe->fast_path_regular.pars_flags.flags)));
4020
4021			fp->err_rx_hw_errors++;
4022
4023                        qlnx_reuse_rx_data(rxq);
4024
4025			QLNX_INC_IERRORS(ifp);
4026
4027			goto next_cqe;
4028		}
4029
4030                if (qlnx_alloc_rx_buffer(ha, rxq) != 0) {
4031
4032                        QL_DPRINT1(ha, (ha->pci_dev,
4033				"New buffer allocation failed, dropping"
4034				" incoming packet and reusing its buffer\n"));
4035
4036                        qlnx_reuse_rx_data(rxq);
4037
4038                        fp->err_rx_alloc_errors++;
4039
4040			QLNX_INC_IQDROPS(ifp);
4041
4042                        goto next_cqe;
4043                }
4044
4045                ecore_chain_consume(&rxq->rx_bd_ring);
4046
4047		len_on_first_bd = fp_cqe->len_on_first_bd;
4048		m_adj(mp, pad);
4049		mp->m_pkthdr.len = len;
4050
4051		QL_DPRINT1(ha,
4052			(ha->pci_dev, "%s: len = %d len_on_first_bd = %d\n",
4053			__func__, len, len_on_first_bd));
4054
4055		if ((len > 60 ) && (len > len_on_first_bd)) {
4056
4057			mp->m_len = len_on_first_bd;
4058
4059			if (qlnx_rx_jumbo_chain(ha, fp, mp,
4060				(len - len_on_first_bd)) != 0) {
4061
4062				m_freem(mp);
4063
4064				QLNX_INC_IQDROPS(ifp);
4065
4066                        	goto next_cqe;
4067			}
4068
4069		} else if (len_on_first_bd < len) {
4070			fp->err_rx_jumbo_chain_pkts++;
4071		} else {
4072			mp->m_len = len;
4073		}
4074
4075		mp->m_flags |= M_PKTHDR;
4076
4077		/* assign packet to this interface interface */
4078		mp->m_pkthdr.rcvif = ifp;
4079
4080		/* assume no hardware checksum has complated */
4081		mp->m_pkthdr.csum_flags = 0;
4082
4083		mp->m_pkthdr.flowid = fp_cqe->rss_hash;
4084
4085#if __FreeBSD_version >= 1100000
4086
4087		hash_type = fp_cqe->bitfields &
4088				(ETH_FAST_PATH_RX_REG_CQE_RSS_HASH_TYPE_MASK <<
4089				ETH_FAST_PATH_RX_REG_CQE_RSS_HASH_TYPE_SHIFT);
4090
4091		switch (hash_type) {
4092
4093		case RSS_HASH_TYPE_IPV4:
4094			M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_IPV4);
4095			break;
4096
4097		case RSS_HASH_TYPE_TCP_IPV4:
4098			M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_TCP_IPV4);
4099			break;
4100
4101		case RSS_HASH_TYPE_IPV6:
4102			M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_IPV6);
4103			break;
4104
4105		case RSS_HASH_TYPE_TCP_IPV6:
4106			M_HASHTYPE_SET(mp, M_HASHTYPE_RSS_TCP_IPV6);
4107			break;
4108
4109		default:
4110			M_HASHTYPE_SET(mp, M_HASHTYPE_OPAQUE);
4111			break;
4112		}
4113
4114#else
4115		mp->m_flags |= M_FLOWID;
4116#endif
4117
4118		if (CQE_L3_PACKET(fp_cqe->pars_flags.flags)) {
4119			mp->m_pkthdr.csum_flags |= CSUM_IP_CHECKED;
4120		}
4121
4122		if (!(CQE_IP_HDR_ERR(fp_cqe->pars_flags.flags))) {
4123			mp->m_pkthdr.csum_flags |= CSUM_IP_VALID;
4124		}
4125
4126		if (CQE_L4_HAS_CSUM(fp_cqe->pars_flags.flags)) {
4127			mp->m_pkthdr.csum_data = 0xFFFF;
4128			mp->m_pkthdr.csum_flags |=
4129				(CSUM_DATA_VALID | CSUM_PSEUDO_HDR);
4130		}
4131
4132		if (CQE_HAS_VLAN(fp_cqe->pars_flags.flags)) {
4133			mp->m_pkthdr.ether_vtag = le16toh(fp_cqe->vlan_tag);
4134			mp->m_flags |= M_VLANTAG;
4135		}
4136
4137		QLNX_INC_IPACKETS(ifp);
4138		QLNX_INC_IBYTES(ifp, len);
4139
4140#ifdef QLNX_SOFT_LRO
4141
4142		if (lro_enable) {
4143
4144#if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO)
4145
4146			tcp_lro_queue_mbuf(lro, mp);
4147
4148#else
4149
4150			if (tcp_lro_rx(lro, mp, 0))
4151				(*ifp->if_input)(ifp, mp);
4152
4153#endif /* #if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO) */
4154
4155		} else {
4156			(*ifp->if_input)(ifp, mp);
4157		}
4158#else
4159
4160		(*ifp->if_input)(ifp, mp);
4161
4162#endif /* #ifdef QLNX_SOFT_LRO */
4163
4164                rx_pkt++;
4165
4166        	rxq->sw_rx_cons  = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
4167
4168next_cqe:	/* don't consume bd rx buffer */
4169                ecore_chain_recycle_consumed(&rxq->rx_comp_ring);
4170                sw_comp_cons = ecore_chain_get_cons_idx(&rxq->rx_comp_ring);
4171
4172		/* CR TPA - revisit how to handle budget in TPA perhaps
4173		   increase on "end" */
4174                if (rx_pkt == budget)
4175                        break;
4176        } /* repeat while sw_comp_cons != hw_comp_cons... */
4177
4178        /* Update producers */
4179        qlnx_update_rx_prod(p_hwfn, rxq);
4180
4181        return rx_pkt;
4182}
4183
4184/*
4185 * fast path interrupt
4186 */
4187
4188static void
4189qlnx_fp_isr(void *arg)
4190{
4191        qlnx_ivec_t		*ivec = arg;
4192        qlnx_host_t		*ha;
4193        struct qlnx_fastpath	*fp = NULL;
4194        int			idx, lro_enable, tc;
4195        int			rx_int = 0, total_rx_count = 0;
4196
4197        ha = ivec->ha;
4198        lro_enable = ha->ifp->if_capenable & IFCAP_LRO;
4199
4200        if (ha->state != QLNX_STATE_OPEN) {
4201                return;
4202        }
4203
4204        idx = ivec->rss_idx;
4205
4206        if ((idx = ivec->rss_idx) >= ha->num_rss) {
4207                QL_DPRINT1(ha, (ha->pci_dev, "%s: illegal interrupt[%d]\n",
4208                        __func__, idx));
4209                ha->err_illegal_intr++;
4210                return;
4211        }
4212        fp = &ha->fp_array[idx];
4213
4214        if (fp == NULL) {
4215                QL_DPRINT1(ha, (ha->pci_dev, "%s: fp_array[%d] NULL\n",
4216                        __func__, idx));
4217                ha->err_fp_null++;
4218        } else {
4219                ecore_sb_ack(fp->sb_info, IGU_INT_DISABLE, 0);
4220
4221                do {
4222                        for (tc = 0; tc < ha->num_tc; tc++) {
4223                                if (mtx_trylock(&fp->tx_mtx)) {
4224                                        qlnx_tx_int(ha, fp, fp->txq[tc]);
4225                                        mtx_unlock(&fp->tx_mtx);
4226                                }
4227                        }
4228
4229                        rx_int = qlnx_rx_int(ha, fp, ha->rx_pkt_threshold,
4230                                        lro_enable);
4231
4232                        if (rx_int) {
4233                                fp->rx_pkts += rx_int;
4234				total_rx_count += rx_int;
4235			}
4236
4237                } while (rx_int);
4238
4239
4240#ifdef QLNX_SOFT_LRO
4241                {
4242                        struct lro_ctrl *lro;
4243
4244                        lro = &fp->rxq->lro;
4245
4246                        if (lro_enable && total_rx_count) {
4247
4248#if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO)
4249
4250#ifdef QLNX_TRACE_LRO_CNT
4251				if (lro->lro_mbuf_count & ~1023)
4252					fp->lro_cnt_1024++;
4253				else if (lro->lro_mbuf_count & ~511)
4254					fp->lro_cnt_512++;
4255				else if (lro->lro_mbuf_count & ~255)
4256					fp->lro_cnt_256++;
4257				else if (lro->lro_mbuf_count & ~127)
4258					fp->lro_cnt_128++;
4259				else if (lro->lro_mbuf_count & ~63)
4260					fp->lro_cnt_64++;
4261#endif /* #ifdef QLNX_TRACE_LRO_CNT */
4262
4263                                tcp_lro_flush_all(lro);
4264
4265#else
4266                                struct lro_entry *queued;
4267
4268                                while ((!SLIST_EMPTY(&lro->lro_active))) {
4269                                        queued = SLIST_FIRST(&lro->lro_active);
4270                                        SLIST_REMOVE_HEAD(&lro->lro_active, \
4271						next);
4272                                        tcp_lro_flush(lro, queued);
4273                                }
4274#endif /* #if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO) */
4275                        }
4276                }
4277#endif /* #ifdef QLNX_SOFT_LRO */
4278
4279                if (fp->fp_taskqueue != NULL)
4280                        taskqueue_enqueue(fp->fp_taskqueue, &fp->fp_task);
4281
4282                ecore_sb_update_sb_idx(fp->sb_info);
4283                rmb();
4284                ecore_sb_ack(fp->sb_info, IGU_INT_ENABLE, 1);
4285
4286                return;
4287        }
4288
4289        return;
4290}
4291
4292
4293/*
4294 * slow path interrupt processing function
4295 * can be invoked in polled mode or in interrupt mode via taskqueue.
4296 */
4297void
4298qlnx_sp_isr(void *arg)
4299{
4300	struct ecore_hwfn	*p_hwfn;
4301	qlnx_host_t		*ha;
4302
4303	p_hwfn = arg;
4304
4305	ha = (qlnx_host_t *)p_hwfn->p_dev;
4306
4307	ha->sp_interrupts++;
4308
4309	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
4310
4311	ecore_int_sp_dpc(p_hwfn);
4312
4313	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
4314
4315	return;
4316}
4317
4318/*****************************************************************************
4319 * Support Functions for DMA'able Memory
4320 *****************************************************************************/
4321
4322static void
4323qlnx_dmamap_callback(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
4324{
4325        *((bus_addr_t *)arg) = 0;
4326
4327        if (error) {
4328                printf("%s: bus_dmamap_load failed (%d)\n", __func__, error);
4329                return;
4330        }
4331
4332        *((bus_addr_t *)arg) = segs[0].ds_addr;
4333
4334        return;
4335}
4336
4337static int
4338qlnx_alloc_dmabuf(qlnx_host_t *ha, qlnx_dma_t *dma_buf)
4339{
4340        int             ret = 0;
4341        device_t        dev;
4342        bus_addr_t      b_addr;
4343
4344        dev = ha->pci_dev;
4345
4346        ret = bus_dma_tag_create(
4347                        ha->parent_tag,/* parent */
4348                        dma_buf->alignment,
4349                        ((bus_size_t)(1ULL << 32)),/* boundary */
4350                        BUS_SPACE_MAXADDR,      /* lowaddr */
4351                        BUS_SPACE_MAXADDR,      /* highaddr */
4352                        NULL, NULL,             /* filter, filterarg */
4353                        dma_buf->size,          /* maxsize */
4354                        1,                      /* nsegments */
4355                        dma_buf->size,          /* maxsegsize */
4356                        0,                      /* flags */
4357                        NULL, NULL,             /* lockfunc, lockarg */
4358                        &dma_buf->dma_tag);
4359
4360        if (ret) {
4361                QL_DPRINT1(ha,
4362			(dev, "%s: could not create dma tag\n", __func__));
4363                goto qlnx_alloc_dmabuf_exit;
4364        }
4365        ret = bus_dmamem_alloc(dma_buf->dma_tag,
4366                        (void **)&dma_buf->dma_b,
4367                        (BUS_DMA_ZERO | BUS_DMA_COHERENT | BUS_DMA_NOWAIT),
4368                        &dma_buf->dma_map);
4369        if (ret) {
4370                bus_dma_tag_destroy(dma_buf->dma_tag);
4371                QL_DPRINT1(ha,
4372			(dev, "%s: bus_dmamem_alloc failed\n", __func__));
4373                goto qlnx_alloc_dmabuf_exit;
4374        }
4375
4376        ret = bus_dmamap_load(dma_buf->dma_tag,
4377                        dma_buf->dma_map,
4378                        dma_buf->dma_b,
4379                        dma_buf->size,
4380                        qlnx_dmamap_callback,
4381                        &b_addr, BUS_DMA_NOWAIT);
4382
4383        if (ret || !b_addr) {
4384                bus_dma_tag_destroy(dma_buf->dma_tag);
4385                bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b,
4386                        dma_buf->dma_map);
4387                ret = -1;
4388                goto qlnx_alloc_dmabuf_exit;
4389        }
4390
4391        dma_buf->dma_addr = b_addr;
4392
4393qlnx_alloc_dmabuf_exit:
4394
4395        return ret;
4396}
4397
4398static void
4399qlnx_free_dmabuf(qlnx_host_t *ha, qlnx_dma_t *dma_buf)
4400{
4401	bus_dmamap_unload(dma_buf->dma_tag, dma_buf->dma_map);
4402        bus_dmamem_free(dma_buf->dma_tag, dma_buf->dma_b, dma_buf->dma_map);
4403        bus_dma_tag_destroy(dma_buf->dma_tag);
4404	return;
4405}
4406
4407void *
4408qlnx_dma_alloc_coherent(void *ecore_dev, bus_addr_t *phys, uint32_t size)
4409{
4410	qlnx_dma_t	dma_buf;
4411	qlnx_dma_t	*dma_p;
4412	qlnx_host_t	*ha;
4413	device_t        dev;
4414
4415	ha = (qlnx_host_t *)ecore_dev;
4416	dev = ha->pci_dev;
4417
4418	size = (size + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
4419
4420	memset(&dma_buf, 0, sizeof (qlnx_dma_t));
4421
4422	dma_buf.size = size + PAGE_SIZE;
4423	dma_buf.alignment = 8;
4424
4425	if (qlnx_alloc_dmabuf((qlnx_host_t *)ecore_dev, &dma_buf) != 0)
4426		return (NULL);
4427	bzero((uint8_t *)dma_buf.dma_b, dma_buf.size);
4428
4429	*phys = dma_buf.dma_addr;
4430
4431	dma_p = (qlnx_dma_t *)((uint8_t *)dma_buf.dma_b + size);
4432
4433	memcpy(dma_p, &dma_buf, sizeof(qlnx_dma_t));
4434
4435	QL_DPRINT5(ha, (dev, "%s: [%p %p %p %p 0x%08x ]\n", __func__,
4436		(void *)dma_buf.dma_map, (void *)dma_buf.dma_tag,
4437		dma_buf.dma_b, (void *)dma_buf.dma_addr, size));
4438
4439	return (dma_buf.dma_b);
4440}
4441
4442void
4443qlnx_dma_free_coherent(void *ecore_dev, void *v_addr, bus_addr_t phys,
4444	uint32_t size)
4445{
4446	qlnx_dma_t dma_buf, *dma_p;
4447	qlnx_host_t	*ha;
4448	device_t        dev;
4449
4450	ha = (qlnx_host_t *)ecore_dev;
4451	dev = ha->pci_dev;
4452
4453	if (v_addr == NULL)
4454		return;
4455
4456	size = (size + (PAGE_SIZE - 1)) & ~(PAGE_SIZE - 1);
4457
4458	dma_p = (qlnx_dma_t *)((uint8_t *)v_addr + size);
4459
4460	QL_DPRINT5(ha, (dev, "%s: [%p %p %p %p 0x%08x ]\n", __func__,
4461		(void *)dma_p->dma_map, (void *)dma_p->dma_tag,
4462		dma_p->dma_b, (void *)dma_p->dma_addr, size));
4463
4464	dma_buf = *dma_p;
4465
4466	qlnx_free_dmabuf((qlnx_host_t *)ecore_dev, &dma_buf);
4467	return;
4468}
4469
4470static int
4471qlnx_alloc_parent_dma_tag(qlnx_host_t *ha)
4472{
4473        int             ret;
4474        device_t        dev;
4475
4476        dev = ha->pci_dev;
4477
4478        /*
4479         * Allocate parent DMA Tag
4480         */
4481        ret = bus_dma_tag_create(
4482                        bus_get_dma_tag(dev),   /* parent */
4483                        1,((bus_size_t)(1ULL << 32)),/* alignment, boundary */
4484                        BUS_SPACE_MAXADDR,      /* lowaddr */
4485                        BUS_SPACE_MAXADDR,      /* highaddr */
4486                        NULL, NULL,             /* filter, filterarg */
4487                        BUS_SPACE_MAXSIZE_32BIT,/* maxsize */
4488                        0,                      /* nsegments */
4489                        BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */
4490                        0,                      /* flags */
4491                        NULL, NULL,             /* lockfunc, lockarg */
4492                        &ha->parent_tag);
4493
4494        if (ret) {
4495                QL_DPRINT1(ha, (dev, "%s: could not create parent dma tag\n",
4496                        __func__));
4497                return (-1);
4498        }
4499
4500        ha->flags.parent_tag = 1;
4501
4502        return (0);
4503}
4504
4505static void
4506qlnx_free_parent_dma_tag(qlnx_host_t *ha)
4507{
4508        if (ha->parent_tag != NULL) {
4509                bus_dma_tag_destroy(ha->parent_tag);
4510		ha->parent_tag = NULL;
4511        }
4512	return;
4513}
4514
4515static int
4516qlnx_alloc_tx_dma_tag(qlnx_host_t *ha)
4517{
4518        if (bus_dma_tag_create(NULL,    /* parent */
4519                1, 0,    /* alignment, bounds */
4520                BUS_SPACE_MAXADDR,       /* lowaddr */
4521                BUS_SPACE_MAXADDR,       /* highaddr */
4522                NULL, NULL,      /* filter, filterarg */
4523                QLNX_MAX_TSO_FRAME_SIZE,     /* maxsize */
4524                QLNX_MAX_SEGMENTS,        /* nsegments */
4525                (PAGE_SIZE * 4),        /* maxsegsize */
4526                BUS_DMA_ALLOCNOW,        /* flags */
4527                NULL,    /* lockfunc */
4528                NULL,    /* lockfuncarg */
4529                &ha->tx_tag)) {
4530
4531                QL_DPRINT1(ha, (ha->pci_dev, "%s: tx_tag alloc failed\n",
4532                        __func__));
4533                return (-1);
4534        }
4535
4536	return (0);
4537}
4538
4539static void
4540qlnx_free_tx_dma_tag(qlnx_host_t *ha)
4541{
4542        if (ha->tx_tag != NULL) {
4543                bus_dma_tag_destroy(ha->tx_tag);
4544		ha->tx_tag = NULL;
4545        }
4546	return;
4547}
4548
4549static int
4550qlnx_alloc_rx_dma_tag(qlnx_host_t *ha)
4551{
4552        if (bus_dma_tag_create(NULL,    /* parent */
4553                        1, 0,    /* alignment, bounds */
4554                        BUS_SPACE_MAXADDR,       /* lowaddr */
4555                        BUS_SPACE_MAXADDR,       /* highaddr */
4556                        NULL, NULL,      /* filter, filterarg */
4557                        MJUM9BYTES,     /* maxsize */
4558                        1,        /* nsegments */
4559                        MJUM9BYTES,        /* maxsegsize */
4560                        BUS_DMA_ALLOCNOW,        /* flags */
4561                        NULL,    /* lockfunc */
4562                        NULL,    /* lockfuncarg */
4563                        &ha->rx_tag)) {
4564
4565                QL_DPRINT1(ha, (ha->pci_dev, "%s: rx_tag alloc failed\n",
4566                        __func__));
4567
4568                return (-1);
4569        }
4570	return (0);
4571}
4572
4573static void
4574qlnx_free_rx_dma_tag(qlnx_host_t *ha)
4575{
4576        if (ha->rx_tag != NULL) {
4577                bus_dma_tag_destroy(ha->rx_tag);
4578		ha->rx_tag = NULL;
4579        }
4580	return;
4581}
4582
4583/*********************************
4584 * Exported functions
4585 *********************************/
4586uint32_t
4587qlnx_pci_bus_get_bar_size(void *ecore_dev, uint8_t bar_id)
4588{
4589	uint32_t bar_size;
4590
4591	bar_id = bar_id * 2;
4592
4593	bar_size = bus_get_resource_count(((qlnx_host_t *)ecore_dev)->pci_dev,
4594				SYS_RES_MEMORY,
4595				PCIR_BAR(bar_id));
4596
4597	return (bar_size);
4598}
4599
4600uint32_t
4601qlnx_pci_read_config_byte(void *ecore_dev, uint32_t pci_reg, uint8_t *reg_value)
4602{
4603	*reg_value = pci_read_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4604				pci_reg, 1);
4605	return 0;
4606}
4607
4608uint32_t
4609qlnx_pci_read_config_word(void *ecore_dev, uint32_t pci_reg,
4610	uint16_t *reg_value)
4611{
4612	*reg_value = pci_read_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4613				pci_reg, 2);
4614	return 0;
4615}
4616
4617uint32_t
4618qlnx_pci_read_config_dword(void *ecore_dev, uint32_t pci_reg,
4619	uint32_t *reg_value)
4620{
4621	*reg_value = pci_read_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4622				pci_reg, 4);
4623	return 0;
4624}
4625
4626void
4627qlnx_pci_write_config_byte(void *ecore_dev, uint32_t pci_reg, uint8_t reg_value)
4628{
4629	pci_write_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4630		pci_reg, reg_value, 1);
4631	return;
4632}
4633
4634void
4635qlnx_pci_write_config_word(void *ecore_dev, uint32_t pci_reg,
4636	uint16_t reg_value)
4637{
4638	pci_write_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4639		pci_reg, reg_value, 2);
4640	return;
4641}
4642
4643void
4644qlnx_pci_write_config_dword(void *ecore_dev, uint32_t pci_reg,
4645	uint32_t reg_value)
4646{
4647	pci_write_config(((qlnx_host_t *)ecore_dev)->pci_dev,
4648		pci_reg, reg_value, 4);
4649	return;
4650}
4651
4652
4653int
4654qlnx_pci_find_capability(void *ecore_dev, int cap)
4655{
4656	int reg;
4657
4658	if (pci_find_cap(((qlnx_host_t *)ecore_dev)->pci_dev, PCIY_EXPRESS,
4659			&reg) == 0)
4660		return reg;
4661	else {
4662		QL_DPRINT1(((qlnx_host_t *)ecore_dev),
4663			(((qlnx_host_t *)ecore_dev)->pci_dev,
4664			"%s: failed\n", __func__));
4665		return 0;
4666	}
4667}
4668
4669uint32_t
4670qlnx_reg_rd32(void *hwfn, uint32_t reg_addr)
4671{
4672	uint32_t		data32;
4673	struct ecore_dev	*cdev;
4674	struct ecore_hwfn	*p_hwfn;
4675
4676	p_hwfn = hwfn;
4677
4678	cdev = p_hwfn->p_dev;
4679
4680	reg_addr = (uint32_t)((uint8_t *)(p_hwfn->regview) -
4681			(uint8_t *)(cdev->regview)) + reg_addr;
4682
4683	data32 = bus_read_4(((qlnx_host_t *)cdev)->pci_reg, reg_addr);
4684
4685	return (data32);
4686}
4687
4688void
4689qlnx_reg_wr32(void *hwfn, uint32_t reg_addr, uint32_t value)
4690{
4691	struct ecore_dev	*cdev;
4692	struct ecore_hwfn	*p_hwfn;
4693
4694	p_hwfn = hwfn;
4695
4696	cdev = p_hwfn->p_dev;
4697
4698	reg_addr = (uint32_t)((uint8_t *)(p_hwfn->regview) -
4699			(uint8_t *)(cdev->regview)) + reg_addr;
4700
4701	bus_write_4(((qlnx_host_t *)cdev)->pci_reg, reg_addr, value);
4702
4703	return;
4704}
4705
4706void
4707qlnx_reg_wr16(void *hwfn, uint32_t reg_addr, uint16_t value)
4708{
4709	struct ecore_dev	*cdev;
4710	struct ecore_hwfn	*p_hwfn;
4711
4712	p_hwfn = hwfn;
4713
4714	cdev = p_hwfn->p_dev;
4715
4716	reg_addr = (uint32_t)((uint8_t *)(p_hwfn->regview) -
4717			(uint8_t *)(cdev->regview)) + reg_addr;
4718
4719	bus_write_2(((qlnx_host_t *)cdev)->pci_reg, reg_addr, value);
4720
4721	return;
4722}
4723
4724void
4725qlnx_dbell_wr32(void *hwfn, uint32_t reg_addr, uint32_t value)
4726{
4727	struct ecore_dev	*cdev;
4728	struct ecore_hwfn	*p_hwfn;
4729
4730	p_hwfn = hwfn;
4731
4732	cdev = p_hwfn->p_dev;
4733
4734	reg_addr = (uint32_t)((uint8_t *)(p_hwfn->doorbells) -
4735			(uint8_t *)(cdev->doorbells)) + reg_addr;
4736
4737	bus_write_4(((qlnx_host_t *)cdev)->pci_dbells, reg_addr, value);
4738
4739	return;
4740}
4741
4742uint32_t
4743qlnx_direct_reg_rd32(void *p_hwfn, uint32_t *reg_addr)
4744{
4745	uint32_t		data32;
4746	uint32_t		offset;
4747	struct ecore_dev	*cdev;
4748
4749	cdev = ((struct ecore_hwfn *)p_hwfn)->p_dev;
4750	offset = (uint32_t)((uint8_t *)reg_addr - (uint8_t *)(cdev->regview));
4751
4752	data32 = bus_read_4(((qlnx_host_t *)cdev)->pci_reg, offset);
4753
4754	return (data32);
4755}
4756
4757void
4758qlnx_direct_reg_wr32(void *p_hwfn, void *reg_addr, uint32_t value)
4759{
4760	uint32_t		offset;
4761	struct ecore_dev	*cdev;
4762
4763	cdev = ((struct ecore_hwfn *)p_hwfn)->p_dev;
4764	offset = (uint32_t)((uint8_t *)reg_addr - (uint8_t *)(cdev->regview));
4765
4766	bus_write_4(((qlnx_host_t *)cdev)->pci_reg, offset, value);
4767
4768	return;
4769}
4770
4771void *
4772qlnx_zalloc(uint32_t size)
4773{
4774	caddr_t	va;
4775
4776	va = malloc((unsigned long)size, M_QLNXBUF, M_NOWAIT);
4777	bzero(va, size);
4778	return ((void *)va);
4779}
4780
4781void
4782qlnx_barrier(void *p_hwfn)
4783{
4784	qlnx_host_t	*ha;
4785
4786	ha = (qlnx_host_t *)((struct ecore_hwfn *)p_hwfn)->p_dev;
4787	bus_barrier(ha->pci_reg,  0, 0, BUS_SPACE_BARRIER_WRITE);
4788}
4789
4790void
4791qlnx_link_update(void *p_hwfn)
4792{
4793	qlnx_host_t	*ha;
4794	int		prev_link_state;
4795
4796	ha = (qlnx_host_t *)((struct ecore_hwfn *)p_hwfn)->p_dev;
4797
4798	qlnx_fill_link(p_hwfn, &ha->if_link);
4799
4800	prev_link_state = ha->link_up;
4801	ha->link_up = ha->if_link.link_up;
4802
4803        if (prev_link_state !=  ha->link_up) {
4804                if (ha->link_up) {
4805                        if_link_state_change(ha->ifp, LINK_STATE_UP);
4806                } else {
4807                        if_link_state_change(ha->ifp, LINK_STATE_DOWN);
4808                }
4809        }
4810        return;
4811}
4812
4813void
4814qlnx_fill_link(struct ecore_hwfn *hwfn, struct qlnx_link_output *if_link)
4815{
4816	struct ecore_mcp_link_params    link_params;
4817	struct ecore_mcp_link_state     link_state;
4818
4819	memset(if_link, 0, sizeof(*if_link));
4820	memset(&link_params, 0, sizeof(struct ecore_mcp_link_params));
4821	memset(&link_state, 0, sizeof(struct ecore_mcp_link_state));
4822
4823	/* Prepare source inputs */
4824	/* we only deal with physical functions */
4825	memcpy(&link_params, ecore_mcp_get_link_params(hwfn),
4826		sizeof(link_params));
4827	memcpy(&link_state, ecore_mcp_get_link_state(hwfn),
4828		sizeof(link_state));
4829
4830	ecore_mcp_get_media_type(hwfn->p_dev, &if_link->media_type);
4831
4832	/* Set the link parameters to pass to protocol driver */
4833	if (link_state.link_up) {
4834		if_link->link_up = true;
4835		if_link->speed = link_state.speed;
4836	}
4837
4838	if_link->supported_caps = QLNX_LINK_CAP_FIBRE;
4839
4840	if (link_params.speed.autoneg)
4841		if_link->supported_caps |= QLNX_LINK_CAP_Autoneg;
4842
4843	if (link_params.pause.autoneg ||
4844		(link_params.pause.forced_rx && link_params.pause.forced_tx))
4845		if_link->supported_caps |= QLNX_LINK_CAP_Asym_Pause;
4846
4847	if (link_params.pause.autoneg || link_params.pause.forced_rx ||
4848		link_params.pause.forced_tx)
4849		if_link->supported_caps |= QLNX_LINK_CAP_Pause;
4850
4851	if (link_params.speed.advertised_speeds &
4852		NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G)
4853		if_link->supported_caps |= QLNX_LINK_CAP_1000baseT_Half |
4854                                           QLNX_LINK_CAP_1000baseT_Full;
4855
4856	if (link_params.speed.advertised_speeds &
4857		NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G)
4858		if_link->supported_caps |= QLNX_LINK_CAP_10000baseKR_Full;
4859
4860	if (link_params.speed.advertised_speeds &
4861		NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_25G)
4862		if_link->supported_caps |= QLNX_LINK_CAP_25000baseKR_Full;
4863
4864	if (link_params.speed.advertised_speeds &
4865		NVM_CFG1_PORT_DRV_LINK_SPEED_40G)
4866		if_link->supported_caps |= QLNX_LINK_CAP_40000baseLR4_Full;
4867
4868	if (link_params.speed.advertised_speeds &
4869		NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G)
4870		if_link->supported_caps |= QLNX_LINK_CAP_50000baseKR2_Full;
4871
4872	if (link_params.speed.advertised_speeds &
4873		NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_BB_100G)
4874		if_link->supported_caps |= QLNX_LINK_CAP_100000baseKR4_Full;
4875
4876	if_link->advertised_caps = if_link->supported_caps;
4877
4878	if_link->autoneg = link_params.speed.autoneg;
4879	if_link->duplex = QLNX_LINK_DUPLEX;
4880
4881	/* Link partner capabilities */
4882
4883	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_1G_HD)
4884		if_link->link_partner_caps |= QLNX_LINK_CAP_1000baseT_Half;
4885
4886	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_1G_FD)
4887		if_link->link_partner_caps |= QLNX_LINK_CAP_1000baseT_Full;
4888
4889	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_10G)
4890		if_link->link_partner_caps |= QLNX_LINK_CAP_10000baseKR_Full;
4891
4892	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_25G)
4893		if_link->link_partner_caps |= QLNX_LINK_CAP_25000baseKR_Full;
4894
4895	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_40G)
4896		if_link->link_partner_caps |= QLNX_LINK_CAP_40000baseLR4_Full;
4897
4898	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_50G)
4899		if_link->link_partner_caps |= QLNX_LINK_CAP_50000baseKR2_Full;
4900
4901	if (link_state.partner_adv_speed & ECORE_LINK_PARTNER_SPEED_100G)
4902		if_link->link_partner_caps |= QLNX_LINK_CAP_100000baseKR4_Full;
4903
4904	if (link_state.an_complete)
4905		if_link->link_partner_caps |= QLNX_LINK_CAP_Autoneg;
4906
4907	if (link_state.partner_adv_pause)
4908		if_link->link_partner_caps |= QLNX_LINK_CAP_Pause;
4909
4910	if ((link_state.partner_adv_pause ==
4911		ECORE_LINK_PARTNER_ASYMMETRIC_PAUSE) ||
4912		(link_state.partner_adv_pause ==
4913			ECORE_LINK_PARTNER_BOTH_PAUSE))
4914		if_link->link_partner_caps |= QLNX_LINK_CAP_Asym_Pause;
4915
4916	return;
4917}
4918
4919static int
4920qlnx_nic_setup(struct ecore_dev *cdev, struct ecore_pf_params *func_params)
4921{
4922        int	rc, i;
4923
4924        for (i = 0; i < cdev->num_hwfns; i++) {
4925                struct ecore_hwfn *p_hwfn = &cdev->hwfns[i];
4926                p_hwfn->pf_params = *func_params;
4927        }
4928
4929        rc = ecore_resc_alloc(cdev);
4930        if (rc)
4931                goto qlnx_nic_setup_exit;
4932
4933        ecore_resc_setup(cdev);
4934
4935qlnx_nic_setup_exit:
4936
4937        return rc;
4938}
4939
4940static int
4941qlnx_nic_start(struct ecore_dev *cdev)
4942{
4943        int				rc;
4944	struct ecore_hw_init_params	params;
4945
4946	bzero(&params, sizeof (struct ecore_hw_init_params));
4947
4948	params.p_tunn = NULL;
4949	params.b_hw_start = true;
4950	params.int_mode = cdev->int_mode;
4951	params.allow_npar_tx_switch = true;
4952	params.bin_fw_data = NULL;
4953
4954        rc = ecore_hw_init(cdev, &params);
4955        if (rc) {
4956                ecore_resc_free(cdev);
4957                return rc;
4958        }
4959
4960        return 0;
4961}
4962
4963static int
4964qlnx_slowpath_start(qlnx_host_t *ha)
4965{
4966	struct ecore_dev	*cdev;
4967	struct ecore_pf_params	pf_params;
4968	int			rc;
4969
4970	memset(&pf_params, 0, sizeof(struct ecore_pf_params));
4971	pf_params.eth_pf_params.num_cons  =
4972		(ha->num_rss) * (ha->num_tc + 1);
4973
4974	cdev = &ha->cdev;
4975
4976	rc = qlnx_nic_setup(cdev, &pf_params);
4977        if (rc)
4978                goto qlnx_slowpath_start_exit;
4979
4980        cdev->int_mode = ECORE_INT_MODE_MSIX;
4981        cdev->int_coalescing_mode = ECORE_COAL_MODE_ENABLE;
4982
4983#ifdef QLNX_MAX_COALESCE
4984	cdev->rx_coalesce_usecs = 255;
4985	cdev->tx_coalesce_usecs = 255;
4986#endif
4987
4988	rc = qlnx_nic_start(cdev);
4989
4990	ha->rx_coalesce_usecs = cdev->rx_coalesce_usecs;
4991	ha->tx_coalesce_usecs = cdev->tx_coalesce_usecs;
4992
4993qlnx_slowpath_start_exit:
4994
4995	return (rc);
4996}
4997
4998static int
4999qlnx_slowpath_stop(qlnx_host_t *ha)
5000{
5001	struct ecore_dev	*cdev;
5002	device_t		dev = ha->pci_dev;
5003	int			i;
5004
5005	cdev = &ha->cdev;
5006
5007	ecore_hw_stop(cdev);
5008
5009 	for (i = 0; i < ha->cdev.num_hwfns; i++) {
5010
5011        	if (ha->sp_handle[i])
5012                	(void)bus_teardown_intr(dev, ha->sp_irq[i],
5013				ha->sp_handle[i]);
5014
5015		ha->sp_handle[i] = NULL;
5016
5017        	if (ha->sp_irq[i])
5018			(void) bus_release_resource(dev, SYS_RES_IRQ,
5019				ha->sp_irq_rid[i], ha->sp_irq[i]);
5020		ha->sp_irq[i] = NULL;
5021	}
5022
5023        ecore_resc_free(cdev);
5024
5025        return 0;
5026}
5027
5028static void
5029qlnx_set_id(struct ecore_dev *cdev, char name[NAME_SIZE],
5030	char ver_str[VER_SIZE])
5031{
5032        int	i;
5033
5034        memcpy(cdev->name, name, NAME_SIZE);
5035
5036        for_each_hwfn(cdev, i) {
5037                snprintf(cdev->hwfns[i].name, NAME_SIZE, "%s-%d", name, i);
5038        }
5039
5040        cdev->drv_type = DRV_ID_DRV_TYPE_FREEBSD;
5041
5042	return ;
5043}
5044
5045void
5046qlnx_get_protocol_stats(void *cdev, int proto_type, void *proto_stats)
5047{
5048	enum ecore_mcp_protocol_type	type;
5049	union ecore_mcp_protocol_stats	*stats;
5050	struct ecore_eth_stats		eth_stats;
5051	device_t			dev;
5052
5053	dev = ((qlnx_host_t *)cdev)->pci_dev;
5054	stats = proto_stats;
5055	type = proto_type;
5056
5057        switch (type) {
5058        case ECORE_MCP_LAN_STATS:
5059                ecore_get_vport_stats((struct ecore_dev *)cdev, &eth_stats);
5060                stats->lan_stats.ucast_rx_pkts = eth_stats.common.rx_ucast_pkts;
5061                stats->lan_stats.ucast_tx_pkts = eth_stats.common.tx_ucast_pkts;
5062                stats->lan_stats.fcs_err = -1;
5063                break;
5064
5065	default:
5066		((qlnx_host_t *)cdev)->err_get_proto_invalid_type++;
5067
5068		QL_DPRINT1(((qlnx_host_t *)cdev),
5069			(dev, "%s: invalid protocol type 0x%x\n", __func__,
5070			type));
5071		break;
5072	}
5073	return;
5074}
5075
5076static int
5077qlnx_get_mfw_version(qlnx_host_t *ha, uint32_t *mfw_ver)
5078{
5079	struct ecore_hwfn	*p_hwfn;
5080	struct ecore_ptt	*p_ptt;
5081
5082	p_hwfn = &ha->cdev.hwfns[0];
5083	p_ptt = ecore_ptt_acquire(p_hwfn);
5084
5085	if (p_ptt ==  NULL) {
5086                QL_DPRINT1(ha, (ha->pci_dev,
5087                        "%s : ecore_ptt_acquire failed\n", __func__));
5088                return (-1);
5089	}
5090	ecore_mcp_get_mfw_ver(p_hwfn, p_ptt, mfw_ver, NULL);
5091
5092	ecore_ptt_release(p_hwfn, p_ptt);
5093
5094	return (0);
5095}
5096
5097static int
5098qlnx_get_flash_size(qlnx_host_t *ha, uint32_t *flash_size)
5099{
5100	struct ecore_hwfn	*p_hwfn;
5101	struct ecore_ptt	*p_ptt;
5102
5103	p_hwfn = &ha->cdev.hwfns[0];
5104	p_ptt = ecore_ptt_acquire(p_hwfn);
5105
5106	if (p_ptt ==  NULL) {
5107                QL_DPRINT1(ha, (ha->pci_dev,
5108                        "%s : ecore_ptt_acquire failed\n", __func__));
5109                return (-1);
5110	}
5111	ecore_mcp_get_flash_size(p_hwfn, p_ptt, flash_size);
5112
5113	ecore_ptt_release(p_hwfn, p_ptt);
5114
5115	return (0);
5116}
5117
5118static int
5119qlnx_alloc_mem_arrays(qlnx_host_t *ha)
5120{
5121	struct ecore_dev	*cdev;
5122
5123	cdev = &ha->cdev;
5124
5125	bzero(&ha->txq_array[0], (sizeof(struct qlnx_tx_queue) * QLNX_MAX_RSS));
5126	bzero(&ha->rxq_array[0], (sizeof(struct qlnx_rx_queue) * QLNX_MAX_RSS));
5127	bzero(&ha->sb_array[0], (sizeof(struct ecore_sb_info) * QLNX_MAX_RSS));
5128
5129        return 0;
5130}
5131
5132static void
5133qlnx_init_fp(qlnx_host_t *ha)
5134{
5135	int rss_id, txq_array_index, tc;
5136
5137	for (rss_id = 0; rss_id < ha->num_rss; rss_id++) {
5138
5139		struct qlnx_fastpath *fp = &ha->fp_array[rss_id];
5140
5141		fp->rss_id = rss_id;
5142		fp->edev = ha;
5143		fp->sb_info = &ha->sb_array[rss_id];
5144		fp->rxq = &ha->rxq_array[rss_id];
5145		fp->rxq->rxq_id = rss_id;
5146
5147		for (tc = 0; tc < ha->num_tc; tc++) {
5148                        txq_array_index = tc * ha->num_rss + rss_id;
5149                        fp->txq[tc] = &ha->txq_array[txq_array_index];
5150                        fp->txq[tc]->index = txq_array_index;
5151		}
5152
5153		snprintf(fp->name, sizeof(fp->name), "%s-fp-%d", qlnx_name_str,
5154			rss_id);
5155
5156		/* reset all the statistics counters */
5157
5158		fp->tx_pkts_processed = 0;
5159		fp->tx_pkts_freed = 0;
5160		fp->tx_pkts_transmitted = 0;
5161		fp->tx_pkts_completed = 0;
5162		fp->tx_lso_wnd_min_len = 0;
5163		fp->tx_defrag = 0;
5164		fp->tx_nsegs_gt_elem_left = 0;
5165		fp->tx_tso_max_nsegs = 0;
5166		fp->tx_tso_min_nsegs = 0;
5167		fp->err_tx_nsegs_gt_elem_left = 0;
5168		fp->err_tx_dmamap_create = 0;
5169		fp->err_tx_defrag_dmamap_load = 0;
5170		fp->err_tx_non_tso_max_seg = 0;
5171		fp->err_tx_dmamap_load = 0;
5172		fp->err_tx_defrag = 0;
5173		fp->err_tx_free_pkt_null = 0;
5174		fp->err_tx_cons_idx_conflict = 0;
5175
5176		fp->rx_pkts = 0;
5177		fp->err_m_getcl = 0;
5178		fp->err_m_getjcl = 0;
5179        }
5180	return;
5181}
5182
5183static void
5184qlnx_free_mem_sb(qlnx_host_t *ha, struct ecore_sb_info *sb_info)
5185{
5186	struct ecore_dev	*cdev;
5187
5188	cdev = &ha->cdev;
5189
5190        if (sb_info->sb_virt) {
5191                OSAL_DMA_FREE_COHERENT(cdev, ((void *)sb_info->sb_virt),
5192			(sb_info->sb_phys), (sizeof(*sb_info->sb_virt)));
5193		sb_info->sb_virt = NULL;
5194	}
5195}
5196
5197static int
5198qlnx_sb_init(struct ecore_dev *cdev, struct ecore_sb_info *sb_info,
5199	void *sb_virt_addr, bus_addr_t sb_phy_addr, u16 sb_id)
5200{
5201        struct ecore_hwfn	*p_hwfn;
5202        int			hwfn_index, rc;
5203        u16			rel_sb_id;
5204
5205        hwfn_index = sb_id % cdev->num_hwfns;
5206        p_hwfn = &cdev->hwfns[hwfn_index];
5207        rel_sb_id = sb_id / cdev->num_hwfns;
5208
5209        QL_DPRINT2(((qlnx_host_t *)cdev), (((qlnx_host_t *)cdev)->pci_dev,
5210                "%s: hwfn_index = %d p_hwfn = %p sb_id = 0x%x rel_sb_id = 0x%x "
5211                "sb_info = %p sb_virt_addr = %p sb_phy_addr = %p\n",
5212                __func__, hwfn_index, p_hwfn, sb_id, rel_sb_id, sb_info,
5213                sb_virt_addr, (void *)sb_phy_addr));
5214
5215        rc = ecore_int_sb_init(p_hwfn, p_hwfn->p_main_ptt, sb_info,
5216                             sb_virt_addr, sb_phy_addr, rel_sb_id);
5217
5218        return rc;
5219}
5220
5221/* This function allocates fast-path status block memory */
5222static int
5223qlnx_alloc_mem_sb(qlnx_host_t *ha, struct ecore_sb_info *sb_info, u16 sb_id)
5224{
5225        struct status_block	*sb_virt;
5226        bus_addr_t		sb_phys;
5227        int			rc;
5228	uint32_t		size;
5229	struct ecore_dev	*cdev;
5230
5231	cdev = &ha->cdev;
5232
5233	size = sizeof(*sb_virt);
5234	sb_virt = OSAL_DMA_ALLOC_COHERENT(cdev, (&sb_phys), size);
5235
5236        if (!sb_virt) {
5237                QL_DPRINT1(ha, (ha->pci_dev,
5238			"%s: Status block allocation failed\n", __func__));
5239                return -ENOMEM;
5240        }
5241
5242        rc = qlnx_sb_init(cdev, sb_info, sb_virt, sb_phys, sb_id);
5243        if (rc) {
5244                QL_DPRINT1(ha, (ha->pci_dev, "%s: failed\n", __func__));
5245                OSAL_DMA_FREE_COHERENT(cdev, sb_virt, sb_phys, size);
5246        }
5247
5248	return rc;
5249}
5250
5251static void
5252qlnx_free_rx_buffers(qlnx_host_t *ha, struct qlnx_rx_queue *rxq)
5253{
5254        int			i;
5255	struct sw_rx_data	*rx_buf;
5256
5257        for (i = 0; i < rxq->num_rx_buffers; i++) {
5258
5259                rx_buf = &rxq->sw_rx_ring[i];
5260
5261		if (rx_buf->data != NULL) {
5262			if (rx_buf->map != NULL) {
5263				bus_dmamap_unload(ha->rx_tag, rx_buf->map);
5264				bus_dmamap_destroy(ha->rx_tag, rx_buf->map);
5265				rx_buf->map = NULL;
5266			}
5267			m_freem(rx_buf->data);
5268			rx_buf->data = NULL;
5269		}
5270        }
5271	return;
5272}
5273
5274static void
5275qlnx_free_mem_rxq(qlnx_host_t *ha, struct qlnx_rx_queue *rxq)
5276{
5277	struct ecore_dev	*cdev;
5278	int			i;
5279
5280	cdev = &ha->cdev;
5281
5282	qlnx_free_rx_buffers(ha, rxq);
5283
5284	for (i = 0; i < ETH_TPA_MAX_AGGS_NUM; i++) {
5285		qlnx_free_tpa_mbuf(ha, &rxq->tpa_info[i]);
5286		if (rxq->tpa_info[i].mpf != NULL)
5287			m_freem(rxq->tpa_info[i].mpf);
5288	}
5289
5290	bzero((void *)&rxq->sw_rx_ring[0],
5291		(sizeof (struct sw_rx_data) * RX_RING_SIZE));
5292
5293        /* Free the real RQ ring used by FW */
5294	if (rxq->rx_bd_ring.p_virt_addr) {
5295                ecore_chain_free(cdev, &rxq->rx_bd_ring);
5296                rxq->rx_bd_ring.p_virt_addr = NULL;
5297        }
5298
5299        /* Free the real completion ring used by FW */
5300        if (rxq->rx_comp_ring.p_virt_addr &&
5301                        rxq->rx_comp_ring.pbl_sp.p_virt_table) {
5302                ecore_chain_free(cdev, &rxq->rx_comp_ring);
5303                rxq->rx_comp_ring.p_virt_addr = NULL;
5304                rxq->rx_comp_ring.pbl_sp.p_virt_table = NULL;
5305        }
5306
5307#ifdef QLNX_SOFT_LRO
5308	{
5309		struct lro_ctrl *lro;
5310
5311		lro = &rxq->lro;
5312		tcp_lro_free(lro);
5313	}
5314#endif /* #ifdef QLNX_SOFT_LRO */
5315
5316	return;
5317}
5318
5319static int
5320qlnx_alloc_rx_buffer(qlnx_host_t *ha, struct qlnx_rx_queue *rxq)
5321{
5322        register struct mbuf	*mp;
5323        uint16_t		rx_buf_size;
5324        struct sw_rx_data	*sw_rx_data;
5325        struct eth_rx_bd	*rx_bd;
5326        dma_addr_t		dma_addr;
5327	bus_dmamap_t		map;
5328	bus_dma_segment_t       segs[1];
5329	int			nsegs;
5330	int			ret;
5331	struct ecore_dev	*cdev;
5332
5333	cdev = &ha->cdev;
5334
5335        rx_buf_size = rxq->rx_buf_size;
5336
5337	mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, rx_buf_size);
5338
5339        if (mp == NULL) {
5340                QL_DPRINT1(ha, (ha->pci_dev,
5341			"%s : Failed to allocate Rx data\n", __func__));
5342                return -ENOMEM;
5343        }
5344
5345	mp->m_len = mp->m_pkthdr.len = rx_buf_size;
5346
5347	map = (bus_dmamap_t)0;
5348
5349	ret = bus_dmamap_load_mbuf_sg(ha->rx_tag, map, mp, segs, &nsegs,
5350			BUS_DMA_NOWAIT);
5351	dma_addr = segs[0].ds_addr;
5352
5353	if (ret || !dma_addr || (nsegs != 1)) {
5354		m_freem(mp);
5355		QL_DPRINT1(ha, (ha->pci_dev,
5356			"%s: bus_dmamap_load failed[%d, 0x%016llx, %d]\n",
5357                        __func__, ret, (long long unsigned int)dma_addr,
5358                        nsegs));
5359		return -ENOMEM;
5360	}
5361
5362        sw_rx_data = &rxq->sw_rx_ring[rxq->sw_rx_prod];
5363        sw_rx_data->data = mp;
5364        sw_rx_data->dma_addr = dma_addr;
5365        sw_rx_data->map = map;
5366
5367        /* Advance PROD and get BD pointer */
5368        rx_bd = (struct eth_rx_bd *)ecore_chain_produce(&rxq->rx_bd_ring);
5369        rx_bd->addr.hi = htole32(U64_HI(dma_addr));
5370        rx_bd->addr.lo = htole32(U64_LO(dma_addr));
5371	bus_dmamap_sync(ha->rx_tag, map, BUS_DMASYNC_PREREAD);
5372
5373        rxq->sw_rx_prod = (rxq->sw_rx_prod + 1) & (RX_RING_SIZE - 1);
5374
5375        return 0;
5376}
5377
5378static int
5379qlnx_alloc_tpa_mbuf(qlnx_host_t *ha, uint16_t rx_buf_size,
5380	struct qlnx_agg_info *tpa)
5381{
5382	struct mbuf		*mp;
5383        dma_addr_t		dma_addr;
5384	bus_dmamap_t		map;
5385	bus_dma_segment_t       segs[1];
5386	int			nsegs;
5387	int			ret;
5388        struct sw_rx_data	*rx_buf;
5389
5390	mp = m_getjcl(M_NOWAIT, MT_DATA, M_PKTHDR, rx_buf_size);
5391
5392        if (mp == NULL) {
5393                QL_DPRINT1(ha, (ha->pci_dev,
5394			"%s : Failed to allocate Rx data\n", __func__));
5395                return -ENOMEM;
5396        }
5397
5398	mp->m_len = mp->m_pkthdr.len = rx_buf_size;
5399
5400	map = (bus_dmamap_t)0;
5401
5402	ret = bus_dmamap_load_mbuf_sg(ha->rx_tag, map, mp, segs, &nsegs,
5403			BUS_DMA_NOWAIT);
5404	dma_addr = segs[0].ds_addr;
5405
5406	if (ret || !dma_addr || (nsegs != 1)) {
5407		m_freem(mp);
5408		QL_DPRINT1(ha, (ha->pci_dev,
5409			"%s: bus_dmamap_load failed[%d, 0x%016llx, %d]\n",
5410                        __func__, ret, (long long unsigned int)dma_addr,
5411                        nsegs));
5412		return -ENOMEM;
5413	}
5414
5415        rx_buf = &tpa->rx_buf;
5416
5417	memset(rx_buf, 0, sizeof (struct sw_rx_data));
5418
5419        rx_buf->data = mp;
5420        rx_buf->dma_addr = dma_addr;
5421        rx_buf->map = map;
5422
5423	bus_dmamap_sync(ha->rx_tag, map, BUS_DMASYNC_PREREAD);
5424
5425	return (0);
5426}
5427
5428static void
5429qlnx_free_tpa_mbuf(qlnx_host_t *ha, struct qlnx_agg_info *tpa)
5430{
5431        struct sw_rx_data	*rx_buf;
5432
5433	rx_buf = &tpa->rx_buf;
5434
5435	if (rx_buf->data != NULL) {
5436		if (rx_buf->map != NULL) {
5437			bus_dmamap_unload(ha->rx_tag, rx_buf->map);
5438			bus_dmamap_destroy(ha->rx_tag, rx_buf->map);
5439			rx_buf->map = NULL;
5440		}
5441		m_freem(rx_buf->data);
5442		rx_buf->data = NULL;
5443	}
5444	return;
5445}
5446
5447/* This function allocates all memory needed per Rx queue */
5448static int
5449qlnx_alloc_mem_rxq(qlnx_host_t *ha, struct qlnx_rx_queue *rxq)
5450{
5451        int			i, rc, num_allocated;
5452	struct ifnet		*ifp;
5453	struct ecore_dev	 *cdev;
5454
5455	cdev = &ha->cdev;
5456	ifp = ha->ifp;
5457
5458        rxq->num_rx_buffers = RX_RING_SIZE;
5459
5460	rxq->rx_buf_size = ha->rx_buf_size;
5461
5462        /* Allocate the parallel driver ring for Rx buffers */
5463	bzero((void *)&rxq->sw_rx_ring[0],
5464		(sizeof (struct sw_rx_data) * RX_RING_SIZE));
5465
5466        /* Allocate FW Rx ring  */
5467
5468        rc = ecore_chain_alloc(cdev,
5469			ECORE_CHAIN_USE_TO_CONSUME_PRODUCE,
5470			ECORE_CHAIN_MODE_NEXT_PTR,
5471			ECORE_CHAIN_CNT_TYPE_U16,
5472			RX_RING_SIZE,
5473			sizeof(struct eth_rx_bd),
5474			&rxq->rx_bd_ring, NULL);
5475
5476        if (rc)
5477                goto err;
5478
5479        /* Allocate FW completion ring */
5480        rc = ecore_chain_alloc(cdev,
5481                        ECORE_CHAIN_USE_TO_CONSUME,
5482                        ECORE_CHAIN_MODE_PBL,
5483			ECORE_CHAIN_CNT_TYPE_U16,
5484                        RX_RING_SIZE,
5485                        sizeof(union eth_rx_cqe),
5486                        &rxq->rx_comp_ring, NULL);
5487
5488        if (rc)
5489                goto err;
5490
5491        /* Allocate buffers for the Rx ring */
5492
5493	for (i = 0; i < ETH_TPA_MAX_AGGS_NUM; i++) {
5494		rc = qlnx_alloc_tpa_mbuf(ha, rxq->rx_buf_size,
5495			&rxq->tpa_info[i]);
5496                if (rc)
5497                        break;
5498
5499	}
5500
5501        for (i = 0; i < rxq->num_rx_buffers; i++) {
5502                rc = qlnx_alloc_rx_buffer(ha, rxq);
5503                if (rc)
5504                        break;
5505        }
5506        num_allocated = i;
5507        if (!num_allocated) {
5508		QL_DPRINT1(ha, (ha->pci_dev,
5509			"%s: Rx buffers allocation failed\n", __func__));
5510                goto err;
5511        } else if (num_allocated < rxq->num_rx_buffers) {
5512		QL_DPRINT1(ha, (ha->pci_dev,
5513                	"%s: Allocated less buffers than"
5514			" desired (%d allocated)\n", __func__, num_allocated));
5515        }
5516
5517#ifdef QLNX_SOFT_LRO
5518
5519	{
5520		struct lro_ctrl *lro;
5521
5522		lro = &rxq->lro;
5523
5524#if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO)
5525		if (tcp_lro_init_args(lro, ifp, 0, rxq->num_rx_buffers)) {
5526			QL_DPRINT1(ha, (ha->pci_dev,
5527				"%s: tcp_lro_init[%d] failed\n",
5528				__func__, rxq->rxq_id));
5529			goto err;
5530		}
5531#else
5532		if (tcp_lro_init(lro)) {
5533			QL_DPRINT1(ha, (ha->pci_dev,
5534				"%s: tcp_lro_init[%d] failed\n",
5535				__func__, rxq->rxq_id));
5536			goto err;
5537		}
5538#endif /* #if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO) */
5539
5540		lro->ifp = ha->ifp;
5541	}
5542#endif /* #ifdef QLNX_SOFT_LRO */
5543        return 0;
5544
5545err:
5546        qlnx_free_mem_rxq(ha, rxq);
5547        return -ENOMEM;
5548}
5549
5550
5551static void
5552qlnx_free_mem_txq(qlnx_host_t *ha, struct qlnx_fastpath *fp,
5553	struct qlnx_tx_queue *txq)
5554{
5555	struct ecore_dev	*cdev;
5556
5557	cdev = &ha->cdev;
5558
5559	bzero((void *)&txq->sw_tx_ring[0],
5560		(sizeof (struct sw_tx_bd) * TX_RING_SIZE));
5561
5562        /* Free the real RQ ring used by FW */
5563        if (txq->tx_pbl.p_virt_addr) {
5564                ecore_chain_free(cdev, &txq->tx_pbl);
5565                txq->tx_pbl.p_virt_addr = NULL;
5566        }
5567	return;
5568}
5569
5570/* This function allocates all memory needed per Tx queue */
5571static int
5572qlnx_alloc_mem_txq(qlnx_host_t *ha, struct qlnx_fastpath *fp,
5573	struct qlnx_tx_queue *txq)
5574{
5575        int			ret = ECORE_SUCCESS;
5576        union eth_tx_bd_types	*p_virt;
5577	struct ecore_dev	*cdev;
5578
5579	cdev = &ha->cdev;
5580
5581	bzero((void *)&txq->sw_tx_ring[0],
5582		(sizeof (struct sw_tx_bd) * TX_RING_SIZE));
5583
5584        /* Allocate the real Tx ring to be used by FW */
5585        ret = ecore_chain_alloc(cdev,
5586                        ECORE_CHAIN_USE_TO_CONSUME_PRODUCE,
5587                        ECORE_CHAIN_MODE_PBL,
5588			ECORE_CHAIN_CNT_TYPE_U16,
5589                        TX_RING_SIZE,
5590                        sizeof(*p_virt),
5591                        &txq->tx_pbl, NULL);
5592
5593        if (ret != ECORE_SUCCESS) {
5594                goto err;
5595        }
5596
5597	txq->num_tx_buffers = TX_RING_SIZE;
5598
5599        return 0;
5600
5601err:
5602        qlnx_free_mem_txq(ha, fp, txq);
5603        return -ENOMEM;
5604}
5605
5606static void
5607qlnx_free_tx_br(qlnx_host_t *ha, struct qlnx_fastpath *fp)
5608{
5609	struct mbuf	*mp;
5610	struct ifnet	*ifp = ha->ifp;
5611
5612	if (mtx_initialized(&fp->tx_mtx)) {
5613
5614		if (fp->tx_br != NULL) {
5615
5616			mtx_lock(&fp->tx_mtx);
5617
5618			while ((mp = drbr_dequeue(ifp, fp->tx_br)) != NULL) {
5619				fp->tx_pkts_freed++;
5620				m_freem(mp);
5621			}
5622
5623			mtx_unlock(&fp->tx_mtx);
5624
5625			buf_ring_free(fp->tx_br, M_DEVBUF);
5626			fp->tx_br = NULL;
5627		}
5628		mtx_destroy(&fp->tx_mtx);
5629	}
5630	return;
5631}
5632
5633static void
5634qlnx_free_mem_fp(qlnx_host_t *ha, struct qlnx_fastpath *fp)
5635{
5636        int	tc;
5637
5638        qlnx_free_mem_sb(ha, fp->sb_info);
5639
5640        qlnx_free_mem_rxq(ha, fp->rxq);
5641
5642        for (tc = 0; tc < ha->num_tc; tc++)
5643                qlnx_free_mem_txq(ha, fp, fp->txq[tc]);
5644
5645	return;
5646}
5647
5648static int
5649qlnx_alloc_tx_br(qlnx_host_t *ha, struct qlnx_fastpath *fp)
5650{
5651	snprintf(fp->tx_mtx_name, sizeof(fp->tx_mtx_name),
5652		"qlnx%d_fp%d_tx_mq_lock", ha->dev_unit, fp->rss_id);
5653
5654	mtx_init(&fp->tx_mtx, fp->tx_mtx_name, NULL, MTX_DEF);
5655
5656        fp->tx_br = buf_ring_alloc(TX_RING_SIZE, M_DEVBUF,
5657                                   M_NOWAIT, &fp->tx_mtx);
5658        if (fp->tx_br == NULL) {
5659            QL_DPRINT1(ha, (ha->pci_dev, "buf_ring_alloc failed for "
5660		" fp[%d, %d]\n", ha->dev_unit, fp->rss_id));
5661            return -ENOMEM;
5662        }
5663	return 0;
5664}
5665
5666static int
5667qlnx_alloc_mem_fp(qlnx_host_t *ha, struct qlnx_fastpath *fp)
5668{
5669        int	rc, tc;
5670
5671        rc = qlnx_alloc_mem_sb(ha, fp->sb_info, fp->rss_id);
5672        if (rc)
5673                goto err;
5674
5675	if (ha->rx_jumbo_buf_eq_mtu) {
5676		if (ha->max_frame_size <= MCLBYTES)
5677			ha->rx_buf_size = MCLBYTES;
5678		else if (ha->max_frame_size <= MJUMPAGESIZE)
5679			ha->rx_buf_size = MJUMPAGESIZE;
5680		else if (ha->max_frame_size <= MJUM9BYTES)
5681			ha->rx_buf_size = MJUM9BYTES;
5682		else if (ha->max_frame_size <= MJUM16BYTES)
5683			ha->rx_buf_size = MJUM16BYTES;
5684	} else {
5685		if (ha->max_frame_size <= MCLBYTES)
5686			ha->rx_buf_size = MCLBYTES;
5687		else
5688			ha->rx_buf_size = MJUMPAGESIZE;
5689	}
5690
5691        rc = qlnx_alloc_mem_rxq(ha, fp->rxq);
5692        if (rc)
5693                goto err;
5694
5695        for (tc = 0; tc < ha->num_tc; tc++) {
5696                rc = qlnx_alloc_mem_txq(ha, fp, fp->txq[tc]);
5697                if (rc)
5698                        goto err;
5699        }
5700
5701        return 0;
5702
5703err:
5704        qlnx_free_mem_fp(ha, fp);
5705        return -ENOMEM;
5706}
5707
5708static void
5709qlnx_free_mem_load(qlnx_host_t *ha)
5710{
5711        int			i;
5712	struct ecore_dev	*cdev;
5713
5714	cdev = &ha->cdev;
5715
5716        for (i = 0; i < ha->num_rss; i++) {
5717                struct qlnx_fastpath *fp = &ha->fp_array[i];
5718
5719                qlnx_free_mem_fp(ha, fp);
5720        }
5721	return;
5722}
5723
5724static int
5725qlnx_alloc_mem_load(qlnx_host_t *ha)
5726{
5727        int	rc = 0, rss_id;
5728
5729        for (rss_id = 0; rss_id < ha->num_rss; rss_id++) {
5730                struct qlnx_fastpath *fp = &ha->fp_array[rss_id];
5731
5732                rc = qlnx_alloc_mem_fp(ha, fp);
5733                if (rc)
5734                        break;
5735        }
5736	return (rc);
5737}
5738
5739static int
5740qlnx_start_vport(struct ecore_dev *cdev,
5741                u8 vport_id,
5742                u16 mtu,
5743                u8 drop_ttl0_flg,
5744                u8 inner_vlan_removal_en_flg,
5745		u8 tx_switching,
5746		u8 hw_lro_enable)
5747{
5748        int					rc, i;
5749	struct ecore_sp_vport_start_params	vport_start_params = { 0 };
5750	qlnx_host_t				*ha;
5751
5752	ha = (qlnx_host_t *)cdev;
5753
5754	vport_start_params.remove_inner_vlan = inner_vlan_removal_en_flg;
5755	vport_start_params.tx_switching = 0;
5756	vport_start_params.handle_ptp_pkts = 0;
5757	vport_start_params.only_untagged = 0;
5758	vport_start_params.drop_ttl0 = drop_ttl0_flg;
5759
5760	vport_start_params.tpa_mode =
5761		(hw_lro_enable ? ECORE_TPA_MODE_RSC : ECORE_TPA_MODE_NONE);
5762	vport_start_params.max_buffers_per_cqe = QLNX_TPA_MAX_AGG_BUFFERS;
5763
5764	vport_start_params.vport_id = vport_id;
5765	vport_start_params.mtu = mtu;
5766
5767
5768	QL_DPRINT2(ha, (ha->pci_dev, "%s: setting mtu to %d\n", __func__, mtu));
5769
5770        for_each_hwfn(cdev, i) {
5771                struct ecore_hwfn *p_hwfn = &cdev->hwfns[i];
5772
5773		vport_start_params.concrete_fid = p_hwfn->hw_info.concrete_fid;
5774		vport_start_params.opaque_fid = p_hwfn->hw_info.opaque_fid;
5775
5776                rc = ecore_sp_vport_start(p_hwfn, &vport_start_params);
5777
5778                if (rc) {
5779			QL_DPRINT1(ha, (ha->pci_dev,
5780				"%s: Failed to start VPORT V-PORT %d "
5781				"with MTU %d\n", __func__, vport_id, mtu));
5782                        return -ENOMEM;
5783                }
5784
5785                ecore_hw_start_fastpath(p_hwfn);
5786
5787		QL_DPRINT2(ha, (ha->pci_dev,
5788			"%s: Started V-PORT %d with MTU %d\n",
5789			__func__, vport_id, mtu));
5790        }
5791        return 0;
5792}
5793
5794
5795static int
5796qlnx_update_vport(struct ecore_dev *cdev,
5797	struct qlnx_update_vport_params *params)
5798{
5799        struct ecore_sp_vport_update_params	sp_params;
5800        int					rc, i, j, fp_index;
5801	struct ecore_hwfn			*p_hwfn;
5802        struct ecore_rss_params			*rss;
5803	qlnx_host_t				*ha = (qlnx_host_t *)cdev;
5804        struct qlnx_fastpath			*fp;
5805
5806        memset(&sp_params, 0, sizeof(sp_params));
5807        /* Translate protocol params into sp params */
5808        sp_params.vport_id = params->vport_id;
5809
5810        sp_params.update_vport_active_rx_flg =
5811		params->update_vport_active_rx_flg;
5812        sp_params.vport_active_rx_flg = params->vport_active_rx_flg;
5813
5814        sp_params.update_vport_active_tx_flg =
5815		params->update_vport_active_tx_flg;
5816        sp_params.vport_active_tx_flg = params->vport_active_tx_flg;
5817
5818        sp_params.update_inner_vlan_removal_flg =
5819                params->update_inner_vlan_removal_flg;
5820        sp_params.inner_vlan_removal_flg = params->inner_vlan_removal_flg;
5821
5822	sp_params.sge_tpa_params = params->sge_tpa_params;
5823
5824        /* RSS - is a bit tricky, since upper-layer isn't familiar with hwfns.
5825         * We need to re-fix the rss values per engine for CMT.
5826         */
5827
5828        sp_params.rss_params = params->rss_params;
5829
5830        for_each_hwfn(cdev, i) {
5831
5832		p_hwfn = &cdev->hwfns[i];
5833
5834		if ((cdev->num_hwfns > 1) &&
5835			params->rss_params->update_rss_config &&
5836			params->rss_params->rss_enable) {
5837
5838			rss = params->rss_params;
5839
5840			for (j = 0; j < ECORE_RSS_IND_TABLE_SIZE; j++) {
5841
5842				fp_index = ((cdev->num_hwfns * j) + i) %
5843						ha->num_rss;
5844
5845                		fp = &ha->fp_array[fp_index];
5846                        	rss->rss_ind_table[i] = fp->rxq->handle;
5847			}
5848
5849			for (j = 0; j < ECORE_RSS_IND_TABLE_SIZE;) {
5850				QL_DPRINT3(ha, (ha->pci_dev,
5851					"%p %p %p %p %p %p %p %p \n",
5852					rss->rss_ind_table[j],
5853					rss->rss_ind_table[j+1],
5854					rss->rss_ind_table[j+2],
5855					rss->rss_ind_table[j+3],
5856					rss->rss_ind_table[j+4],
5857					rss->rss_ind_table[j+5],
5858					rss->rss_ind_table[j+6],
5859					rss->rss_ind_table[j+7]));
5860					j += 8;
5861			}
5862		}
5863
5864                sp_params.opaque_fid = p_hwfn->hw_info.opaque_fid;
5865                rc = ecore_sp_vport_update(p_hwfn, &sp_params,
5866                                           ECORE_SPQ_MODE_EBLOCK, NULL);
5867                if (rc) {
5868			QL_DPRINT1(ha, (ha->pci_dev,
5869				"%s:Failed to update VPORT\n", __func__));
5870                        return rc;
5871                }
5872
5873                QL_DPRINT2(ha, (ha->pci_dev,
5874			"%s: Updated V-PORT %d: tx_active_flag %d,"
5875			"rx_active_flag %d [tx_update %d], [rx_update %d]\n",
5876			__func__,
5877			params->vport_id, params->vport_active_tx_flg,
5878			params->vport_active_rx_flg,
5879			params->update_vport_active_tx_flg,
5880			params->update_vport_active_rx_flg));
5881        }
5882
5883        return 0;
5884}
5885
5886static void
5887qlnx_reuse_rx_data(struct qlnx_rx_queue *rxq)
5888{
5889        struct eth_rx_bd	*rx_bd_cons =
5890					ecore_chain_consume(&rxq->rx_bd_ring);
5891        struct eth_rx_bd	*rx_bd_prod =
5892					ecore_chain_produce(&rxq->rx_bd_ring);
5893        struct sw_rx_data	*sw_rx_data_cons =
5894					&rxq->sw_rx_ring[rxq->sw_rx_cons];
5895        struct sw_rx_data	*sw_rx_data_prod =
5896					&rxq->sw_rx_ring[rxq->sw_rx_prod];
5897
5898        sw_rx_data_prod->data = sw_rx_data_cons->data;
5899        memcpy(rx_bd_prod, rx_bd_cons, sizeof(struct eth_rx_bd));
5900
5901        rxq->sw_rx_cons  = (rxq->sw_rx_cons + 1) & (RX_RING_SIZE - 1);
5902        rxq->sw_rx_prod  = (rxq->sw_rx_prod + 1) & (RX_RING_SIZE - 1);
5903
5904	return;
5905}
5906
5907static void
5908qlnx_update_rx_prod(struct ecore_hwfn *p_hwfn, struct qlnx_rx_queue *rxq)
5909{
5910
5911        uint16_t	 	bd_prod;
5912        uint16_t		cqe_prod;
5913        struct eth_rx_prod_data	rx_prods = {0};
5914
5915        bd_prod = ecore_chain_get_prod_idx(&rxq->rx_bd_ring);
5916        cqe_prod = ecore_chain_get_prod_idx(&rxq->rx_comp_ring);
5917
5918        /* Update producers */
5919        rx_prods.bd_prod = htole16(bd_prod);
5920        rx_prods.cqe_prod = htole16(cqe_prod);
5921
5922        /* Make sure that the BD and SGE data is updated before updating the
5923         * producers since FW might read the BD/SGE right after the producer
5924         * is updated.
5925         */
5926	wmb();
5927	//bus_barrier(ha->pci_reg,  0, 0, BUS_SPACE_BARRIER_READ);
5928	//bus_barrier(ha->pci_dbells,  0, 0, BUS_SPACE_BARRIER_READ);
5929
5930        internal_ram_wr(p_hwfn, rxq->hw_rxq_prod_addr,
5931		sizeof(rx_prods), (u32 *)&rx_prods);
5932
5933        /* mmiowb is needed to synchronize doorbell writes from more than one
5934         * processor. It guarantees that the write arrives to the device before
5935         * the napi lock is released and another qlnx_poll is called (possibly
5936         * on another CPU). Without this barrier, the next doorbell can bypass
5937         * this doorbell. This is applicable to IA64/Altix systems.
5938         */
5939        wmb();
5940
5941	return;
5942}
5943
5944static uint32_t qlnx_hash_key[] = {
5945                ((0x6d << 24)|(0x5a << 16)|(0x56 << 8)|0xda),
5946                ((0x25 << 24)|(0x5b << 16)|(0x0e << 8)|0xc2),
5947                ((0x41 << 24)|(0x67 << 16)|(0x25 << 8)|0x3d),
5948                ((0x43 << 24)|(0xa3 << 16)|(0x8f << 8)|0xb0),
5949                ((0xd0 << 24)|(0xca << 16)|(0x2b << 8)|0xcb),
5950                ((0xae << 24)|(0x7b << 16)|(0x30 << 8)|0xb4),
5951                ((0x77 << 24)|(0xcb << 16)|(0x2d << 8)|0xa3),
5952                ((0x80 << 24)|(0x30 << 16)|(0xf2 << 8)|0x0c),
5953                ((0x6a << 24)|(0x42 << 16)|(0xb7 << 8)|0x3b),
5954                ((0xbe << 24)|(0xac << 16)|(0x01 << 8)|0xfa)};
5955
5956static int
5957qlnx_start_queues(qlnx_host_t *ha)
5958{
5959        int				rc, tc, i, vport_id = 0,
5960					drop_ttl0_flg = 1, vlan_removal_en = 1,
5961					tx_switching = 0, hw_lro_enable = 0;
5962        struct ecore_dev		*cdev = &ha->cdev;
5963        struct ecore_rss_params		*rss_params = &ha->rss_params;
5964        struct qlnx_update_vport_params	vport_update_params;
5965        struct ifnet			*ifp;
5966        struct ecore_hwfn		*p_hwfn;
5967	struct ecore_sge_tpa_params	tpa_params;
5968	struct ecore_queue_start_common_params qparams;
5969        struct qlnx_fastpath		*fp;
5970
5971	ifp = ha->ifp;
5972
5973        if (!ha->num_rss) {
5974		QL_DPRINT1(ha, (ha->pci_dev,
5975			"%s: Cannot update V-VPORT as active as there"
5976			" are no Rx queues\n", __func__));
5977                return -EINVAL;
5978        }
5979
5980#ifndef QLNX_SOFT_LRO
5981        hw_lro_enable = ifp->if_capenable & IFCAP_LRO;
5982#endif /* #ifndef QLNX_SOFT_LRO */
5983
5984        rc = qlnx_start_vport(cdev, vport_id, ifp->if_mtu, drop_ttl0_flg,
5985			vlan_removal_en, tx_switching, hw_lro_enable);
5986
5987        if (rc) {
5988                QL_DPRINT1(ha, (ha->pci_dev,
5989			"%s: Start V-PORT failed %d\n", __func__, rc));
5990                return rc;
5991        }
5992
5993	QL_DPRINT2(ha, (ha->pci_dev,
5994		"%s: Start vport ramrod passed,"
5995		" vport_id = %d, MTU = %d, vlan_removal_en = %d\n", __func__,
5996		vport_id, (int)(ifp->if_mtu + 0xe), vlan_removal_en));
5997
5998        for_each_rss(i) {
5999		struct ecore_rxq_start_ret_params rx_ret_params;
6000		struct ecore_txq_start_ret_params tx_ret_params;
6001
6002                fp = &ha->fp_array[i];
6003        	p_hwfn = &cdev->hwfns[(fp->rss_id % cdev->num_hwfns)];
6004
6005		bzero(&qparams, sizeof(struct ecore_queue_start_common_params));
6006		bzero(&rx_ret_params,
6007			sizeof (struct ecore_rxq_start_ret_params));
6008
6009		qparams.queue_id = i ;
6010		qparams.vport_id = vport_id;
6011		qparams.stats_id = vport_id;
6012		qparams.p_sb = fp->sb_info;
6013		qparams.sb_idx = RX_PI;
6014
6015
6016		rc = ecore_eth_rx_queue_start(p_hwfn,
6017			p_hwfn->hw_info.opaque_fid,
6018			&qparams,
6019			fp->rxq->rx_buf_size,	/* bd_max_bytes */
6020			/* bd_chain_phys_addr */
6021			fp->rxq->rx_bd_ring.p_phys_addr,
6022			/* cqe_pbl_addr */
6023			ecore_chain_get_pbl_phys(&fp->rxq->rx_comp_ring),
6024			/* cqe_pbl_size */
6025			ecore_chain_get_page_cnt(&fp->rxq->rx_comp_ring),
6026			&rx_ret_params);
6027
6028                if (rc) {
6029                	QL_DPRINT1(ha, (ha->pci_dev,
6030				"%s: Start RXQ #%d failed %d\n", __func__,
6031				i, rc));
6032                        return rc;
6033                }
6034
6035		fp->rxq->hw_rxq_prod_addr	= rx_ret_params.p_prod;
6036		fp->rxq->handle			= rx_ret_params.p_handle;
6037                fp->rxq->hw_cons_ptr		=
6038				&fp->sb_info->sb_virt->pi_array[RX_PI];
6039
6040                qlnx_update_rx_prod(p_hwfn, fp->rxq);
6041
6042                for (tc = 0; tc < ha->num_tc; tc++) {
6043                        struct qlnx_tx_queue *txq = fp->txq[tc];
6044
6045			bzero(&qparams,
6046				sizeof(struct ecore_queue_start_common_params));
6047			bzero(&tx_ret_params,
6048				sizeof (struct ecore_txq_start_ret_params));
6049
6050			qparams.queue_id = txq->index / cdev->num_hwfns ;
6051			qparams.vport_id = vport_id;
6052			qparams.stats_id = vport_id;
6053			qparams.p_sb = fp->sb_info;
6054			qparams.sb_idx = TX_PI(tc);
6055
6056			rc = ecore_eth_tx_queue_start(p_hwfn,
6057				p_hwfn->hw_info.opaque_fid,
6058				&qparams, tc,
6059				/* bd_chain_phys_addr */
6060				ecore_chain_get_pbl_phys(&txq->tx_pbl),
6061				ecore_chain_get_page_cnt(&txq->tx_pbl),
6062				&tx_ret_params);
6063
6064                        if (rc) {
6065                		QL_DPRINT1(ha, (ha->pci_dev,
6066					"%s: Start TXQ #%d failed %d\n",
6067					__func__, txq->index, rc));
6068                                return rc;
6069                        }
6070
6071			txq->doorbell_addr = tx_ret_params.p_doorbell;
6072			txq->handle = tx_ret_params.p_handle;
6073
6074                        txq->hw_cons_ptr =
6075                                &fp->sb_info->sb_virt->pi_array[TX_PI(tc)];
6076                        SET_FIELD(txq->tx_db.data.params,
6077                                  ETH_DB_DATA_DEST, DB_DEST_XCM);
6078                        SET_FIELD(txq->tx_db.data.params, ETH_DB_DATA_AGG_CMD,
6079                                  DB_AGG_CMD_SET);
6080                        SET_FIELD(txq->tx_db.data.params,
6081                                  ETH_DB_DATA_AGG_VAL_SEL,
6082                                  DQ_XCM_ETH_TX_BD_PROD_CMD);
6083
6084                        txq->tx_db.data.agg_flags = DQ_XCM_ETH_DQ_CF_CMD;
6085                }
6086        }
6087
6088        /* Fill struct with RSS params */
6089        if (ha->num_rss > 1) {
6090
6091                rss_params->update_rss_config = 1;
6092                rss_params->rss_enable = 1;
6093                rss_params->update_rss_capabilities = 1;
6094                rss_params->update_rss_ind_table = 1;
6095                rss_params->update_rss_key = 1;
6096                rss_params->rss_caps = ECORE_RSS_IPV4 | ECORE_RSS_IPV6 |
6097                                       ECORE_RSS_IPV4_TCP | ECORE_RSS_IPV6_TCP;
6098                rss_params->rss_table_size_log = 7; /* 2^7 = 128 */
6099
6100                for (i = 0; i < ECORE_RSS_IND_TABLE_SIZE; i++) {
6101                	fp = &ha->fp_array[(i % ha->num_rss)];
6102                        rss_params->rss_ind_table[i] = fp->rxq->handle;
6103		}
6104
6105                for (i = 0; i < ECORE_RSS_KEY_SIZE; i++)
6106			rss_params->rss_key[i] = (__le32)qlnx_hash_key[i];
6107
6108        } else {
6109                memset(rss_params, 0, sizeof(*rss_params));
6110        }
6111
6112
6113        /* Prepare and send the vport enable */
6114        memset(&vport_update_params, 0, sizeof(vport_update_params));
6115        vport_update_params.vport_id = vport_id;
6116        vport_update_params.update_vport_active_tx_flg = 1;
6117        vport_update_params.vport_active_tx_flg = 1;
6118        vport_update_params.update_vport_active_rx_flg = 1;
6119        vport_update_params.vport_active_rx_flg = 1;
6120        vport_update_params.rss_params = rss_params;
6121        vport_update_params.update_inner_vlan_removal_flg = 1;
6122        vport_update_params.inner_vlan_removal_flg = 1;
6123
6124	if (hw_lro_enable) {
6125		memset(&tpa_params, 0, sizeof (struct ecore_sge_tpa_params));
6126
6127		tpa_params.max_buffers_per_cqe = QLNX_TPA_MAX_AGG_BUFFERS;
6128
6129		tpa_params.update_tpa_en_flg = 1;
6130		tpa_params.tpa_ipv4_en_flg = 1;
6131		tpa_params.tpa_ipv6_en_flg = 1;
6132
6133		tpa_params.update_tpa_param_flg = 1;
6134		tpa_params.tpa_pkt_split_flg = 0;
6135		tpa_params.tpa_hdr_data_split_flg = 0;
6136		tpa_params.tpa_gro_consistent_flg = 0;
6137		tpa_params.tpa_max_aggs_num = ETH_TPA_MAX_AGGS_NUM;
6138		tpa_params.tpa_max_size = (uint16_t)(-1);
6139		tpa_params.tpa_min_size_to_start = ifp->if_mtu/2;
6140		tpa_params.tpa_min_size_to_cont = ifp->if_mtu/2;
6141
6142		vport_update_params.sge_tpa_params = &tpa_params;
6143	}
6144
6145        rc = qlnx_update_vport(cdev, &vport_update_params);
6146        if (rc) {
6147		QL_DPRINT1(ha, (ha->pci_dev,
6148			"%s: Update V-PORT failed %d\n", __func__, rc));
6149                return rc;
6150        }
6151
6152        return 0;
6153}
6154
6155static int
6156qlnx_drain_txq(qlnx_host_t *ha, struct qlnx_fastpath *fp,
6157	struct qlnx_tx_queue *txq)
6158{
6159	uint16_t	hw_bd_cons;
6160	uint16_t	ecore_cons_idx;
6161
6162	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
6163
6164	hw_bd_cons = le16toh(*txq->hw_cons_ptr);
6165
6166	while (hw_bd_cons !=
6167		(ecore_cons_idx = ecore_chain_get_cons_idx(&txq->tx_pbl))) {
6168
6169		mtx_lock(&fp->tx_mtx);
6170
6171		(void)qlnx_tx_int(ha, fp, txq);
6172
6173		mtx_unlock(&fp->tx_mtx);
6174
6175		qlnx_mdelay(__func__, 2);
6176
6177		hw_bd_cons = le16toh(*txq->hw_cons_ptr);
6178	}
6179
6180	QL_DPRINT2(ha, (ha->pci_dev, "%s[%d, %d]: done\n", __func__,
6181		fp->rss_id, txq->index));
6182
6183        return 0;
6184}
6185
6186static int
6187qlnx_stop_queues(qlnx_host_t *ha)
6188{
6189        struct qlnx_update_vport_params	vport_update_params;
6190        struct ecore_dev		*cdev;
6191        struct qlnx_fastpath		*fp;
6192        int				rc, tc, i;
6193
6194        cdev = &ha->cdev;
6195
6196        /* Disable the vport */
6197
6198        memset(&vport_update_params, 0, sizeof(vport_update_params));
6199
6200        vport_update_params.vport_id = 0;
6201        vport_update_params.update_vport_active_tx_flg = 1;
6202        vport_update_params.vport_active_tx_flg = 0;
6203        vport_update_params.update_vport_active_rx_flg = 1;
6204        vport_update_params.vport_active_rx_flg = 0;
6205        vport_update_params.rss_params = &ha->rss_params;
6206        vport_update_params.rss_params->update_rss_config = 0;
6207        vport_update_params.rss_params->rss_enable = 0;
6208        vport_update_params.update_inner_vlan_removal_flg = 0;
6209        vport_update_params.inner_vlan_removal_flg = 0;
6210
6211        rc = qlnx_update_vport(cdev, &vport_update_params);
6212        if (rc) {
6213		QL_DPRINT1(ha, (ha->pci_dev, "%s:Failed to update vport\n",
6214			__func__));
6215                return rc;
6216        }
6217
6218        /* Flush Tx queues. If needed, request drain from MCP */
6219        for_each_rss(i) {
6220                fp = &ha->fp_array[i];
6221
6222                for (tc = 0; tc < ha->num_tc; tc++) {
6223                        struct qlnx_tx_queue *txq = fp->txq[tc];
6224
6225                        rc = qlnx_drain_txq(ha, fp, txq);
6226                        if (rc)
6227                                return rc;
6228                }
6229        }
6230
6231        /* Stop all Queues in reverse order*/
6232        for (i = ha->num_rss - 1; i >= 0; i--) {
6233
6234		struct ecore_hwfn *p_hwfn = &cdev->hwfns[(i % cdev->num_hwfns)];
6235
6236                fp = &ha->fp_array[i];
6237
6238                /* Stop the Tx Queue(s)*/
6239                for (tc = 0; tc < ha->num_tc; tc++) {
6240			int tx_queue_id;
6241
6242			tx_queue_id = tc * ha->num_rss + i;
6243			rc = ecore_eth_tx_queue_stop(p_hwfn,
6244					fp->txq[tc]->handle);
6245
6246                        if (rc) {
6247				QL_DPRINT1(ha, (ha->pci_dev,
6248					"%s: Failed to stop TXQ #%d\n",
6249					__func__, tx_queue_id));
6250                                return rc;
6251                        }
6252                }
6253
6254                /* Stop the Rx Queue*/
6255		rc = ecore_eth_rx_queue_stop(p_hwfn, fp->rxq->handle, false,
6256				false);
6257                if (rc) {
6258                        QL_DPRINT1(ha, (ha->pci_dev,
6259				"%s: Failed to stop RXQ #%d\n", __func__, i));
6260                        return rc;
6261                }
6262        }
6263
6264        /* Stop the vport */
6265	for_each_hwfn(cdev, i) {
6266
6267		struct ecore_hwfn *p_hwfn = &cdev->hwfns[i];
6268
6269		rc = ecore_sp_vport_stop(p_hwfn, p_hwfn->hw_info.opaque_fid, 0);
6270
6271		if (rc) {
6272                        QL_DPRINT1(ha, (ha->pci_dev,
6273				"%s: Failed to stop VPORT\n", __func__));
6274			return rc;
6275		}
6276	}
6277
6278        return rc;
6279}
6280
6281static int
6282qlnx_set_ucast_rx_mac(qlnx_host_t *ha,
6283	enum ecore_filter_opcode opcode,
6284	unsigned char mac[ETH_ALEN])
6285{
6286	struct ecore_filter_ucast	ucast;
6287	struct ecore_dev		*cdev;
6288	int				rc;
6289
6290	cdev = &ha->cdev;
6291
6292	bzero(&ucast, sizeof(struct ecore_filter_ucast));
6293
6294        ucast.opcode = opcode;
6295        ucast.type = ECORE_FILTER_MAC;
6296        ucast.is_rx_filter = 1;
6297        ucast.vport_to_add_to = 0;
6298        memcpy(&ucast.mac[0], mac, ETH_ALEN);
6299
6300	rc = ecore_filter_ucast_cmd(cdev, &ucast, ECORE_SPQ_MODE_CB, NULL);
6301
6302        return (rc);
6303}
6304
6305static int
6306qlnx_remove_all_ucast_mac(qlnx_host_t *ha)
6307{
6308	struct ecore_filter_ucast	ucast;
6309	struct ecore_dev		*cdev;
6310	int				rc;
6311
6312	bzero(&ucast, sizeof(struct ecore_filter_ucast));
6313
6314	ucast.opcode = ECORE_FILTER_REPLACE;
6315	ucast.type = ECORE_FILTER_MAC;
6316	ucast.is_rx_filter = 1;
6317
6318	cdev = &ha->cdev;
6319
6320	rc = ecore_filter_ucast_cmd(cdev, &ucast, ECORE_SPQ_MODE_CB, NULL);
6321
6322	return (rc);
6323}
6324
6325static int
6326qlnx_remove_all_mcast_mac(qlnx_host_t *ha)
6327{
6328	struct ecore_filter_mcast	*mcast;
6329	struct ecore_dev		*cdev;
6330	int				rc, i;
6331
6332	cdev = &ha->cdev;
6333
6334	mcast = &ha->ecore_mcast;
6335	bzero(mcast, sizeof(struct ecore_filter_mcast));
6336
6337	mcast->opcode = ECORE_FILTER_REMOVE;
6338
6339	for (i = 0; i < QLNX_MAX_NUM_MULTICAST_ADDRS; i++) {
6340
6341		if (ha->mcast[i].addr[0] || ha->mcast[i].addr[1] ||
6342			ha->mcast[i].addr[2] || ha->mcast[i].addr[3] ||
6343			ha->mcast[i].addr[4] || ha->mcast[i].addr[5]) {
6344
6345			memcpy(&mcast->mac[0], &ha->mcast[i].addr[0], ETH_ALEN);
6346			mcast->num_mc_addrs++;
6347			mcast++;
6348		}
6349	}
6350	mcast = &ha->ecore_mcast;
6351
6352	rc = ecore_filter_mcast_cmd(cdev, mcast, ECORE_SPQ_MODE_CB, NULL);
6353
6354	bzero(ha->mcast, (sizeof(qlnx_mcast_t) * QLNX_MAX_NUM_MULTICAST_ADDRS));
6355	ha->nmcast = 0;
6356
6357	return (rc);
6358}
6359
6360static int
6361qlnx_clean_filters(qlnx_host_t *ha)
6362{
6363        int	rc = 0;
6364
6365	/* Remove all unicast macs */
6366	qlnx_remove_all_ucast_mac(ha);
6367	if (rc)
6368		return rc;
6369
6370	/* Remove all multicast macs */
6371	rc = qlnx_remove_all_mcast_mac(ha);
6372	if (rc)
6373		return rc;
6374
6375        rc = qlnx_set_ucast_rx_mac(ha, ECORE_FILTER_FLUSH, ha->primary_mac);
6376
6377        return (rc);
6378}
6379
6380static int
6381qlnx_set_rx_accept_filter(qlnx_host_t *ha, uint8_t filter)
6382{
6383	struct ecore_filter_accept_flags	accept;
6384	int					rc = 0;
6385	struct ecore_dev			*cdev;
6386
6387	cdev = &ha->cdev;
6388
6389	bzero(&accept, sizeof(struct ecore_filter_accept_flags));
6390
6391	accept.update_rx_mode_config = 1;
6392	accept.rx_accept_filter = filter;
6393
6394	accept.update_tx_mode_config = 1;
6395	accept.tx_accept_filter = ECORE_ACCEPT_UCAST_MATCHED |
6396		ECORE_ACCEPT_MCAST_MATCHED | ECORE_ACCEPT_BCAST;
6397
6398	rc = ecore_filter_accept_cmd(cdev, 0, accept, false, false,
6399			ECORE_SPQ_MODE_CB, NULL);
6400
6401	return (rc);
6402}
6403
6404static int
6405qlnx_set_rx_mode(qlnx_host_t *ha)
6406{
6407	int	rc = 0;
6408	uint8_t	filter;
6409
6410	rc = qlnx_set_ucast_rx_mac(ha, ECORE_FILTER_REPLACE, ha->primary_mac);
6411        if (rc)
6412                return rc;
6413
6414	rc = qlnx_remove_all_mcast_mac(ha);
6415        if (rc)
6416                return rc;
6417
6418	filter = ECORE_ACCEPT_UCAST_MATCHED |
6419			ECORE_ACCEPT_MCAST_MATCHED |
6420			ECORE_ACCEPT_BCAST;
6421	ha->filter = filter;
6422
6423	rc = qlnx_set_rx_accept_filter(ha, filter);
6424
6425	return (rc);
6426}
6427
6428static int
6429qlnx_set_link(qlnx_host_t *ha, bool link_up)
6430{
6431        int			i, rc = 0;
6432	struct ecore_dev	*cdev;
6433	struct ecore_hwfn	*hwfn;
6434	struct ecore_ptt	*ptt;
6435
6436	cdev = &ha->cdev;
6437
6438        for_each_hwfn(cdev, i) {
6439
6440                hwfn = &cdev->hwfns[i];
6441
6442                ptt = ecore_ptt_acquire(hwfn);
6443       	        if (!ptt)
6444                        return -EBUSY;
6445
6446                rc = ecore_mcp_set_link(hwfn, ptt, link_up);
6447
6448                ecore_ptt_release(hwfn, ptt);
6449
6450                if (rc)
6451                        return rc;
6452        }
6453        return (rc);
6454}
6455
6456#if __FreeBSD_version >= 1100000
6457static uint64_t
6458qlnx_get_counter(if_t ifp, ift_counter cnt)
6459{
6460	qlnx_host_t *ha;
6461	uint64_t count;
6462
6463        ha = (qlnx_host_t *)if_getsoftc(ifp);
6464
6465        switch (cnt) {
6466
6467        case IFCOUNTER_IPACKETS:
6468		count = ha->hw_stats.common.rx_ucast_pkts +
6469			ha->hw_stats.common.rx_mcast_pkts +
6470			ha->hw_stats.common.rx_bcast_pkts;
6471		break;
6472
6473        case IFCOUNTER_IERRORS:
6474		count = ha->hw_stats.common.rx_crc_errors +
6475			ha->hw_stats.common.rx_align_errors +
6476			ha->hw_stats.common.rx_oversize_packets +
6477			ha->hw_stats.common.rx_undersize_packets;
6478		break;
6479
6480        case IFCOUNTER_OPACKETS:
6481		count = ha->hw_stats.common.tx_ucast_pkts +
6482			ha->hw_stats.common.tx_mcast_pkts +
6483			ha->hw_stats.common.tx_bcast_pkts;
6484		break;
6485
6486        case IFCOUNTER_OERRORS:
6487                count = ha->hw_stats.common.tx_err_drop_pkts;
6488		break;
6489
6490        case IFCOUNTER_COLLISIONS:
6491                return (0);
6492
6493        case IFCOUNTER_IBYTES:
6494		count = ha->hw_stats.common.rx_ucast_bytes +
6495			ha->hw_stats.common.rx_mcast_bytes +
6496			ha->hw_stats.common.rx_bcast_bytes;
6497		break;
6498
6499        case IFCOUNTER_OBYTES:
6500		count = ha->hw_stats.common.tx_ucast_bytes +
6501			ha->hw_stats.common.tx_mcast_bytes +
6502			ha->hw_stats.common.tx_bcast_bytes;
6503		break;
6504
6505        case IFCOUNTER_IMCASTS:
6506		count = ha->hw_stats.common.rx_mcast_bytes;
6507		break;
6508
6509        case IFCOUNTER_OMCASTS:
6510		count = ha->hw_stats.common.tx_mcast_bytes;
6511		break;
6512
6513        case IFCOUNTER_IQDROPS:
6514        case IFCOUNTER_OQDROPS:
6515        case IFCOUNTER_NOPROTO:
6516
6517        default:
6518                return (if_get_counter_default(ifp, cnt));
6519        }
6520	return (count);
6521}
6522#endif
6523
6524
6525static void
6526qlnx_timer(void *arg)
6527{
6528	qlnx_host_t	*ha;
6529
6530	ha = (qlnx_host_t *)arg;
6531
6532       	ecore_get_vport_stats(&ha->cdev, &ha->hw_stats);
6533
6534	if (ha->storm_stats_enable)
6535		qlnx_sample_storm_stats(ha);
6536
6537	callout_reset(&ha->qlnx_callout, hz, qlnx_timer, ha);
6538
6539	return;
6540}
6541
6542static int
6543qlnx_load(qlnx_host_t *ha)
6544{
6545	int			i;
6546	int			rc = 0;
6547	struct ecore_dev	*cdev;
6548        device_t		dev;
6549
6550	cdev = &ha->cdev;
6551        dev = ha->pci_dev;
6552
6553	QL_DPRINT2(ha, (dev, "%s: enter\n", __func__));
6554
6555        rc = qlnx_alloc_mem_arrays(ha);
6556        if (rc)
6557                goto qlnx_load_exit0;
6558
6559        qlnx_init_fp(ha);
6560
6561        rc = qlnx_alloc_mem_load(ha);
6562        if (rc)
6563                goto qlnx_load_exit1;
6564
6565        QL_DPRINT2(ha, (dev, "%s: Allocated %d RSS queues on %d TC/s\n",
6566		__func__, ha->num_rss, ha->num_tc));
6567
6568	for (i = 0; i < ha->num_rss; i++) {
6569
6570		if ((rc = bus_setup_intr(dev, ha->irq_vec[i].irq,
6571                        (INTR_TYPE_NET | INTR_MPSAFE),
6572                        NULL, qlnx_fp_isr, &ha->irq_vec[i],
6573                        &ha->irq_vec[i].handle))) {
6574
6575                        QL_DPRINT1(ha, (dev, "could not setup interrupt\n"));
6576
6577                        goto qlnx_load_exit2;
6578		}
6579
6580		QL_DPRINT2(ha, (dev, "%s: rss_id = %d irq_rid %d"
6581			" irq %p handle %p\n", __func__, i,
6582			ha->irq_vec[i].irq_rid,
6583			ha->irq_vec[i].irq, ha->irq_vec[i].handle));
6584
6585		bus_bind_intr(dev, ha->irq_vec[i].irq, (i % mp_ncpus));
6586	}
6587
6588        rc = qlnx_start_queues(ha);
6589        if (rc)
6590                goto qlnx_load_exit2;
6591
6592        QL_DPRINT2(ha, (dev, "%s: Start VPORT, RXQ and TXQ succeeded\n",
6593		__func__));
6594
6595        /* Add primary mac and set Rx filters */
6596        rc = qlnx_set_rx_mode(ha);
6597        if (rc)
6598                goto qlnx_load_exit2;
6599
6600        /* Ask for link-up using current configuration */
6601	qlnx_set_link(ha, true);
6602
6603        ha->state = QLNX_STATE_OPEN;
6604
6605	bzero(&ha->hw_stats, sizeof(struct ecore_eth_stats));
6606
6607	if (ha->flags.callout_init)
6608        	callout_reset(&ha->qlnx_callout, hz, qlnx_timer, ha);
6609
6610        goto qlnx_load_exit0;
6611
6612qlnx_load_exit2:
6613        qlnx_free_mem_load(ha);
6614
6615qlnx_load_exit1:
6616        ha->num_rss = 0;
6617
6618qlnx_load_exit0:
6619	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit [%d]\n", __func__, rc));
6620        return rc;
6621}
6622
6623static void
6624qlnx_drain_soft_lro(qlnx_host_t *ha)
6625{
6626#ifdef QLNX_SOFT_LRO
6627
6628	struct ifnet	*ifp;
6629	int		i;
6630
6631	ifp = ha->ifp;
6632
6633
6634	if (ifp->if_capenable & IFCAP_LRO) {
6635
6636	        for (i = 0; i < ha->num_rss; i++) {
6637
6638			struct qlnx_fastpath *fp = &ha->fp_array[i];
6639			struct lro_ctrl *lro;
6640
6641			lro = &fp->rxq->lro;
6642
6643#if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO)
6644
6645			tcp_lro_flush_all(lro);
6646
6647#else
6648			struct lro_entry *queued;
6649
6650			while ((!SLIST_EMPTY(&lro->lro_active))){
6651				queued = SLIST_FIRST(&lro->lro_active);
6652				SLIST_REMOVE_HEAD(&lro->lro_active, next);
6653				tcp_lro_flush(lro, queued);
6654			}
6655
6656#endif /* #if (__FreeBSD_version >= 1100101) || (defined QLNX_QSORT_LRO) */
6657
6658                }
6659	}
6660
6661#endif /* #ifdef QLNX_SOFT_LRO */
6662
6663	return;
6664}
6665
6666static void
6667qlnx_unload(qlnx_host_t *ha)
6668{
6669	struct ecore_dev	*cdev;
6670        device_t		dev;
6671	int			i;
6672
6673	cdev = &ha->cdev;
6674        dev = ha->pci_dev;
6675
6676	QL_DPRINT2(ha, (ha->pci_dev, "%s: enter\n", __func__));
6677
6678	if (ha->state == QLNX_STATE_OPEN) {
6679
6680		qlnx_set_link(ha, false);
6681		qlnx_clean_filters(ha);
6682		qlnx_stop_queues(ha);
6683		ecore_hw_stop_fastpath(cdev);
6684
6685		for (i = 0; i < ha->num_rss; i++) {
6686			if (ha->irq_vec[i].handle) {
6687				(void)bus_teardown_intr(dev,
6688					ha->irq_vec[i].irq,
6689					ha->irq_vec[i].handle);
6690				ha->irq_vec[i].handle = NULL;
6691			}
6692		}
6693
6694		qlnx_drain_fp_taskqueues(ha);
6695		qlnx_drain_soft_lro(ha);
6696        	qlnx_free_mem_load(ha);
6697	}
6698
6699	if (ha->flags.callout_init)
6700		callout_drain(&ha->qlnx_callout);
6701
6702	qlnx_mdelay(__func__, 1000);
6703
6704        ha->state = QLNX_STATE_CLOSED;
6705
6706	QL_DPRINT2(ha, (ha->pci_dev, "%s: exit\n", __func__));
6707	return;
6708}
6709
6710static int
6711qlnx_grc_dumpsize(qlnx_host_t *ha, uint32_t *num_dwords, int hwfn_index)
6712{
6713	int			rval = -1;
6714	struct ecore_hwfn	*p_hwfn;
6715	struct ecore_ptt	*p_ptt;
6716
6717	ecore_dbg_set_app_ver(ecore_dbg_get_fw_func_ver());
6718
6719	p_hwfn = &ha->cdev.hwfns[hwfn_index];
6720	p_ptt = ecore_ptt_acquire(p_hwfn);
6721
6722        if (!p_ptt) {
6723		QL_DPRINT1(ha, (ha->pci_dev, "%s: ecore_ptt_acquire failed\n",
6724			__func__));
6725                return (rval);
6726        }
6727
6728        rval = ecore_dbg_grc_get_dump_buf_size(p_hwfn, p_ptt, num_dwords);
6729
6730	if (rval == DBG_STATUS_OK)
6731                rval = 0;
6732        else {
6733		QL_DPRINT1(ha, (ha->pci_dev,
6734                	"%s : ecore_dbg_grc_get_dump_buf_size failed [0x%x]\n",
6735			__func__, rval));
6736	}
6737
6738        ecore_ptt_release(p_hwfn, p_ptt);
6739
6740        return (rval);
6741}
6742
6743static int
6744qlnx_idle_chk_size(qlnx_host_t *ha, uint32_t *num_dwords, int hwfn_index)
6745{
6746	int			rval = -1;
6747	struct ecore_hwfn	*p_hwfn;
6748	struct ecore_ptt	*p_ptt;
6749
6750	ecore_dbg_set_app_ver(ecore_dbg_get_fw_func_ver());
6751
6752	p_hwfn = &ha->cdev.hwfns[hwfn_index];
6753	p_ptt = ecore_ptt_acquire(p_hwfn);
6754
6755        if (!p_ptt) {
6756		QL_DPRINT1(ha, (ha->pci_dev, "%s: ecore_ptt_acquire failed\n",
6757			__func__));
6758                return (rval);
6759        }
6760
6761        rval = ecore_dbg_idle_chk_get_dump_buf_size(p_hwfn, p_ptt, num_dwords);
6762
6763	if (rval == DBG_STATUS_OK)
6764                rval = 0;
6765        else {
6766		QL_DPRINT1(ha, (ha->pci_dev, "%s : "
6767			"ecore_dbg_idle_chk_get_dump_buf_size failed [0x%x]\n",
6768			__func__, rval));
6769	}
6770
6771        ecore_ptt_release(p_hwfn, p_ptt);
6772
6773        return (rval);
6774}
6775
6776
6777static void
6778qlnx_sample_storm_stats(qlnx_host_t *ha)
6779{
6780        int			i, index;
6781        struct ecore_dev	*cdev;
6782	qlnx_storm_stats_t	*s_stats;
6783	uint32_t		reg;
6784        struct ecore_ptt	*p_ptt;
6785        struct ecore_hwfn	*hwfn;
6786
6787	if (ha->storm_stats_index >= QLNX_STORM_STATS_SAMPLES_PER_HWFN) {
6788		ha->storm_stats_enable = 0;
6789		return;
6790	}
6791
6792        cdev = &ha->cdev;
6793
6794        for_each_hwfn(cdev, i) {
6795
6796                hwfn = &cdev->hwfns[i];
6797
6798                p_ptt = ecore_ptt_acquire(hwfn);
6799                if (!p_ptt)
6800                        return;
6801
6802		index = ha->storm_stats_index +
6803				(i * QLNX_STORM_STATS_SAMPLES_PER_HWFN);
6804
6805		s_stats = &ha->storm_stats[index];
6806
6807		/* XSTORM */
6808		reg = XSEM_REG_FAST_MEMORY +
6809				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6810		s_stats->xstorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6811
6812		reg = XSEM_REG_FAST_MEMORY +
6813				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6814		s_stats->xstorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6815
6816		reg = XSEM_REG_FAST_MEMORY +
6817				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6818		s_stats->xstorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6819
6820		reg = XSEM_REG_FAST_MEMORY +
6821				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6822		s_stats->xstorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6823
6824		/* YSTORM */
6825		reg = YSEM_REG_FAST_MEMORY +
6826				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6827		s_stats->ystorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6828
6829		reg = YSEM_REG_FAST_MEMORY +
6830				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6831		s_stats->ystorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6832
6833		reg = YSEM_REG_FAST_MEMORY +
6834				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6835		s_stats->ystorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6836
6837		reg = YSEM_REG_FAST_MEMORY +
6838				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6839		s_stats->ystorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6840
6841		/* PSTORM */
6842		reg = PSEM_REG_FAST_MEMORY +
6843				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6844		s_stats->pstorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6845
6846		reg = PSEM_REG_FAST_MEMORY +
6847				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6848		s_stats->pstorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6849
6850		reg = PSEM_REG_FAST_MEMORY +
6851				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6852		s_stats->pstorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6853
6854		reg = PSEM_REG_FAST_MEMORY +
6855				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6856		s_stats->pstorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6857
6858		/* TSTORM */
6859		reg = TSEM_REG_FAST_MEMORY +
6860				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6861		s_stats->tstorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6862
6863		reg = TSEM_REG_FAST_MEMORY +
6864				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6865		s_stats->tstorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6866
6867		reg = TSEM_REG_FAST_MEMORY +
6868				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6869		s_stats->tstorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6870
6871		reg = TSEM_REG_FAST_MEMORY +
6872				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6873		s_stats->tstorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6874
6875		/* MSTORM */
6876		reg = MSEM_REG_FAST_MEMORY +
6877				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6878		s_stats->mstorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6879
6880		reg = MSEM_REG_FAST_MEMORY +
6881				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6882		s_stats->mstorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6883
6884		reg = MSEM_REG_FAST_MEMORY +
6885				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6886		s_stats->mstorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6887
6888		reg = MSEM_REG_FAST_MEMORY +
6889				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6890		s_stats->mstorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6891
6892		/* USTORM */
6893		reg = USEM_REG_FAST_MEMORY +
6894				SEM_FAST_REG_STORM_ACTIVE_CYCLES_BB_K2;
6895		s_stats->ustorm_active_cycles = ecore_rd(hwfn, p_ptt, reg);
6896
6897		reg = USEM_REG_FAST_MEMORY +
6898				SEM_FAST_REG_STORM_STALL_CYCLES_BB_K2;
6899		s_stats->ustorm_stall_cycles = ecore_rd(hwfn, p_ptt, reg);
6900
6901		reg = USEM_REG_FAST_MEMORY +
6902				SEM_FAST_REG_IDLE_SLEEPING_CYCLES_BB_K2;
6903		s_stats->ustorm_sleeping_cycles = ecore_rd(hwfn, p_ptt, reg);
6904
6905		reg = USEM_REG_FAST_MEMORY +
6906				SEM_FAST_REG_IDLE_INACTIVE_CYCLES_BB_K2;
6907		s_stats->ustorm_inactive_cycles = ecore_rd(hwfn, p_ptt, reg);
6908
6909                ecore_ptt_release(hwfn, p_ptt);
6910        }
6911
6912	ha->storm_stats_index++;
6913
6914        return;
6915}
6916
6917/*
6918 * Name: qlnx_dump_buf8
6919 * Function: dumps a buffer as bytes
6920 */
6921static void
6922qlnx_dump_buf8(qlnx_host_t *ha, const char *msg, void *dbuf, uint32_t len)
6923{
6924        device_t	dev;
6925        uint32_t	i = 0;
6926        uint8_t		*buf;
6927
6928        dev = ha->pci_dev;
6929        buf = dbuf;
6930
6931        device_printf(dev, "%s: %s 0x%x dump start\n", __func__, msg, len);
6932
6933        while (len >= 16) {
6934                device_printf(dev,"0x%08x:"
6935                        " %02x %02x %02x %02x %02x %02x %02x %02x"
6936                        " %02x %02x %02x %02x %02x %02x %02x %02x\n", i,
6937                        buf[0], buf[1], buf[2], buf[3],
6938                        buf[4], buf[5], buf[6], buf[7],
6939                        buf[8], buf[9], buf[10], buf[11],
6940                        buf[12], buf[13], buf[14], buf[15]);
6941                i += 16;
6942                len -= 16;
6943                buf += 16;
6944        }
6945        switch (len) {
6946        case 1:
6947                device_printf(dev,"0x%08x: %02x\n", i, buf[0]);
6948                break;
6949        case 2:
6950                device_printf(dev,"0x%08x: %02x %02x\n", i, buf[0], buf[1]);
6951                break;
6952        case 3:
6953                device_printf(dev,"0x%08x: %02x %02x %02x\n",
6954                        i, buf[0], buf[1], buf[2]);
6955                break;
6956        case 4:
6957                device_printf(dev,"0x%08x: %02x %02x %02x %02x\n", i,
6958                        buf[0], buf[1], buf[2], buf[3]);
6959                break;
6960        case 5:
6961                device_printf(dev,"0x%08x:"
6962                        " %02x %02x %02x %02x %02x\n", i,
6963                        buf[0], buf[1], buf[2], buf[3], buf[4]);
6964                break;
6965        case 6:
6966                device_printf(dev,"0x%08x:"
6967                        " %02x %02x %02x %02x %02x %02x\n", i,
6968                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5]);
6969                break;
6970        case 7:
6971                device_printf(dev,"0x%08x:"
6972                        " %02x %02x %02x %02x %02x %02x %02x\n", i,
6973                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6]);
6974                break;
6975        case 8:
6976                device_printf(dev,"0x%08x:"
6977                        " %02x %02x %02x %02x %02x %02x %02x %02x\n", i,
6978                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
6979                        buf[7]);
6980                break;
6981        case 9:
6982                device_printf(dev,"0x%08x:"
6983                        " %02x %02x %02x %02x %02x %02x %02x %02x"
6984                        " %02x\n", i,
6985                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
6986                        buf[7], buf[8]);
6987                break;
6988        case 10:
6989                device_printf(dev,"0x%08x:"
6990                        " %02x %02x %02x %02x %02x %02x %02x %02x"
6991                        " %02x %02x\n", i,
6992                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
6993                        buf[7], buf[8], buf[9]);
6994                break;
6995        case 11:
6996                device_printf(dev,"0x%08x:"
6997                        " %02x %02x %02x %02x %02x %02x %02x %02x"
6998                        " %02x %02x %02x\n", i,
6999                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
7000                        buf[7], buf[8], buf[9], buf[10]);
7001                break;
7002        case 12:
7003                device_printf(dev,"0x%08x:"
7004                        " %02x %02x %02x %02x %02x %02x %02x %02x"
7005                        " %02x %02x %02x %02x\n", i,
7006                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
7007                        buf[7], buf[8], buf[9], buf[10], buf[11]);
7008                break;
7009        case 13:
7010                device_printf(dev,"0x%08x:"
7011                        " %02x %02x %02x %02x %02x %02x %02x %02x"
7012                        " %02x %02x %02x %02x %02x\n", i,
7013                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
7014                        buf[7], buf[8], buf[9], buf[10], buf[11], buf[12]);
7015                break;
7016        case 14:
7017                device_printf(dev,"0x%08x:"
7018                        " %02x %02x %02x %02x %02x %02x %02x %02x"
7019                        " %02x %02x %02x %02x %02x %02x\n", i,
7020                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
7021                        buf[7], buf[8], buf[9], buf[10], buf[11], buf[12],
7022                        buf[13]);
7023                break;
7024        case 15:
7025                device_printf(dev,"0x%08x:"
7026                        " %02x %02x %02x %02x %02x %02x %02x %02x"
7027                        " %02x %02x %02x %02x %02x %02x %02x\n", i,
7028                        buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6],
7029                        buf[7], buf[8], buf[9], buf[10], buf[11], buf[12],
7030                        buf[13], buf[14]);
7031                break;
7032        default:
7033                break;
7034        }
7035
7036        device_printf(dev, "%s: %s dump end\n", __func__, msg);
7037
7038        return;
7039}
7040
7041