/*
 *   BSD LICENSE
 *
 *   Copyright(c) 2017 Cavium, Inc.. All rights reserved.
 *   All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or without
 *   modification, are permitted provided that the following conditions
 *   are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in
 *       the documentation and/or other materials provided with the
 *       distribution.
 *     * Neither the name of Cavium, Inc. nor the names of its
 *       contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 *   OWNER(S) OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
/*$FreeBSD$*/

#include <sys/types.h>

#include "lio_bsd.h"
#include "lio_common.h"
#include "lio_droq.h"
#include "lio_iq.h"
#include "lio_response_manager.h"
#include "lio_device.h"
#include "lio_network.h"
#include "lio_ctrl.h"
#include "cn23xx_pf_device.h"
#include "lio_image.h"
#include "lio_main.h"
#include "lio_rxtx.h"
#include "lio_ioctl.h"

#define LIO_OFF_PAUSE	0
#define LIO_RX_PAUSE	1
#define LIO_TX_PAUSE	2

#define LIO_REGDUMP_LEN		4096
#define LIO_REGDUMP_LEN_23XX	49248

#define LIO_REGDUMP_LEN_XXXX	LIO_REGDUMP_LEN_23XX

#define LIO_USE_ADAPTIVE_RX_COALESCE		1
#define LIO_USE_ADAPTIVE_TX_COALESCE		2
#define LIO_RX_COALESCE_USECS			3
#define LIO_RX_MAX_COALESCED_FRAMES		4
#define LIO_TX_MAX_COALESCED_FRAMES		8
#define LIO_PKT_RATE_LOW			12
#define LIO_RX_COALESCE_USECS_LOW		13
#define LIO_RX_MAX_COALESCED_FRAMES_LOW		14
#define LIO_TX_MAX_COALESCED_FRAMES_LOW		16
#define LIO_PKT_RATE_HIGH			17
#define LIO_RX_COALESCE_USECS_HIGH		18
#define LIO_RX_MAX_COALESCED_FRAMES_HIGH	19
#define LIO_TX_MAX_COALESCED_FRAMES_HIGH	21
#define LIO_RATE_SAMPLE_INTERVAL		22

#define LIO_SET_RING_RX				1
#define LIO_SET_RING_TX				2

static int	lio_get_eeprom(SYSCTL_HANDLER_ARGS);
static int	lio_get_set_pauseparam(SYSCTL_HANDLER_ARGS);
static int	lio_get_regs(SYSCTL_HANDLER_ARGS);
static int	lio_cn23xx_pf_read_csr_reg(char *s, struct octeon_device *oct);
static int	lio_get_set_fwmsglevel(SYSCTL_HANDLER_ARGS);
static int	lio_set_stats_interval(SYSCTL_HANDLER_ARGS);
static void	lio_get_fw_stats(void *arg);
static int	lio_get_set_intr_coalesce(SYSCTL_HANDLER_ARGS);
static int	lio_get_intrmod_cfg(struct lio *lio,
				    struct octeon_intrmod_cfg *intr_cfg);
static int	lio_get_ringparam(SYSCTL_HANDLER_ARGS);
static int	lio_set_ringparam(SYSCTL_HANDLER_ARGS);
static int	lio_get_channels(SYSCTL_HANDLER_ARGS);
static int	lio_set_channels(SYSCTL_HANDLER_ARGS);
static int	lio_irq_reallocate_irqs(struct octeon_device *oct,
					uint32_t num_ioqs);

struct lio_intrmod_context {
	int	octeon_id;
	volatile int cond;
	int	status;
};

struct lio_intrmod_resp {
	uint64_t	rh;
	struct octeon_intrmod_cfg intrmod;
	uint64_t	status;
};

static int
lio_send_queue_count_update(if_t ifp, uint32_t num_queues)
{
	struct lio_ctrl_pkt	nctrl;
	struct lio		*lio = if_getsoftc(ifp);
	struct octeon_device	*oct = lio->oct_dev;
	int ret = 0;

	bzero(&nctrl, sizeof(struct lio_ctrl_pkt));

	nctrl.ncmd.cmd64 = 0;
	nctrl.ncmd.s.cmd = LIO_CMD_QUEUE_COUNT_CTL;
	nctrl.ncmd.s.param1 = num_queues;
	nctrl.ncmd.s.param2 = num_queues;
	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
	nctrl.wait_time = 100;
	nctrl.lio = lio;
	nctrl.cb_fn = lio_ctrl_cmd_completion;

	ret = lio_send_ctrl_pkt(lio->oct_dev, &nctrl);
	if (ret < 0) {
		lio_dev_err(oct, "Failed to send Queue reset command (ret: 0x%x)\n",
			    ret);
		return (-1);
	}

	return (0);
}

/* Add sysctl variables to the system, one per statistic. */
void
lio_add_hw_stats(struct lio *lio)
{
	struct octeon_device	*oct_dev = lio->oct_dev;
	device_t dev = oct_dev->device;

	struct sysctl_ctx_list	*ctx = device_get_sysctl_ctx(dev);
	struct sysctl_oid	*tree = device_get_sysctl_tree(dev);
	struct sysctl_oid_list	*child = SYSCTL_CHILDREN(tree);
	struct sysctl_oid	*stat_node, *queue_node, *root_node;
	struct sysctl_oid_list	*stat_list, *queue_list, *root_list;
#define QUEUE_NAME_LEN 32
	char namebuf[QUEUE_NAME_LEN];

	callout_reset(&lio->stats_timer, lio_ms_to_ticks(lio->stats_interval),
		      lio_get_fw_stats, lio);

	SYSCTL_ADD_STRING(ctx, child, OID_AUTO, "fwversion", CTLFLAG_RD,
			  oct_dev->fw_info.lio_firmware_version, 0,
			  "Firmware version");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "stats_interval",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_set_stats_interval, "I",
	    "Set Stats Updation Timer in milli seconds");
	SYSCTL_ADD_UQUAD(ctx, child, OID_AUTO, "link_state_changes",
			 CTLFLAG_RD, &lio->link_changes, "Link Change Counter");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "eeprom-dump",
			CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_MPSAFE, lio, 0,
			lio_get_eeprom, "A", "EEPROM information");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "fc",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_get_set_pauseparam, "I",
	    "Get and set pause parameters.\n" \
	    "0 - off\n" \
	    "1 - rx pause\n" \
	    "2 - tx pause \n" \
	    "3 - rx and tx pause");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "register-dump",
	    CTLTYPE_STRING | CTLFLAG_RD | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_get_regs, "A", "Dump registers in raw format");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "fwmsglevel",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_get_set_fwmsglevel, "I", "Get or set firmware message level");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "rxq_descriptors",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, LIO_SET_RING_RX,
	    lio_set_ringparam, "I", "Set RX ring parameter");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "txq_descriptors",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, LIO_SET_RING_TX,
	    lio_set_ringparam, "I", "Set TX ring parameter");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "max_rxq_descriptors",
	    CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT, lio, LIO_SET_RING_RX,
	    lio_get_ringparam, "I", "Max RX descriptors");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "max_txq_descriptors",
	    CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT, lio, LIO_SET_RING_TX,
	    lio_get_ringparam, "I", "Max TX descriptors");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "active_queues",
	    CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_set_channels, "I", "Set channels information");
	SYSCTL_ADD_PROC(ctx, child, OID_AUTO, "max_queues",
	    CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_NEEDGIANT, lio, 0,
	    lio_get_channels, "I", "Get channels information");
	SYSCTL_ADD_UINT(ctx, child, OID_AUTO, "tx_budget",
			CTLFLAG_RW, &oct_dev->tx_budget,
			0, "TX process pkt budget");
	SYSCTL_ADD_UINT(ctx, child, OID_AUTO, "rx_budget",
			CTLFLAG_RW, &oct_dev->rx_budget,
			0, "RX process pkt budget");

	/* IRQ Coalescing Parameters */
	root_node = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "coalesce",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Get and Set Coalesce");

	root_list = SYSCTL_CHILDREN(root_node);

	if (lio_get_intrmod_cfg(lio, &lio->intrmod_cfg))
		lio_dev_info(oct_dev, "Coalescing driver update failed!\n");

	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "sample-interval",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RATE_SAMPLE_INTERVAL, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "tx-frame-high",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_TX_MAX_COALESCED_FRAMES_HIGH,
			lio_get_set_intr_coalesce, "QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-frame-high",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_MAX_COALESCED_FRAMES_HIGH,
			lio_get_set_intr_coalesce, "QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-usecs-high",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_COALESCE_USECS_HIGH, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "pkt-rate-high",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_PKT_RATE_HIGH, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "tx-frame-low",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_TX_MAX_COALESCED_FRAMES_LOW,
			lio_get_set_intr_coalesce, "QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-frame-low",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_MAX_COALESCED_FRAMES_LOW,
			lio_get_set_intr_coalesce, "QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-usecs-low",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_COALESCE_USECS_LOW, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "pkt-rate-low",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_PKT_RATE_LOW, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "tx-frames",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_TX_MAX_COALESCED_FRAMES, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-frames",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_MAX_COALESCED_FRAMES, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "rx-usecs",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_RX_COALESCE_USECS, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "adaptive-tx",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_USE_ADAPTIVE_TX_COALESCE, lio_get_set_intr_coalesce,
			"QU", NULL);
	SYSCTL_ADD_PROC(ctx, root_list, OID_AUTO, "adaptive-rx",
			CTLTYPE_U64 | CTLFLAG_RW | CTLFLAG_MPSAFE, lio,
			LIO_USE_ADAPTIVE_RX_COALESCE, lio_get_set_intr_coalesce,
			"QU", NULL);

	/* Root Node of all the Stats */
	root_node = SYSCTL_ADD_NODE(ctx, child, OID_AUTO, "stats",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Root Node of all the Stats");
	root_list = SYSCTL_CHILDREN(root_node);

	/* Firmware Tx Stats */
	stat_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, "fwtx",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Firmware Tx Statistics");
	stat_list = SYSCTL_CHILDREN(stat_node);

	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_total_sent", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_total_sent,
			 "Firmware Total Packets Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_total_fwd", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_total_fwd,
			 "Firmware Total Packets Forwarded");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_total_fwd_bytes",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_total_fwd_bytes,
			 "Firmware Total Bytes Forwarded");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_err_pko", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_err_pko,
			 "Firmware Tx PKO Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_err_pki", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_err_pki,
			 "Firmware Tx PKI Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_err_link", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_err_link,
			 "Firmware Tx Link Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_err_drop", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_err_drop,
			 "Firmware Tx Packets Dropped");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "fw_tso", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_tso,
			 "Firmware Tx TSO");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_tso_packets", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_tso_fwd,
			 "Firmware Tx TSO Packets");
	//SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_tso_err", CTLFLAG_RD,
			   //&oct_dev->link_stats.fromhost.fw_tso_err,
			   //"Firmware Tx TSO Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "tx_vxlan", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fw_tx_vxlan,
			 "Firmware Tx VXLAN");

	/* MAC Tx Stats */
	stat_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, "mactx",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "MAC Tx Statistics");
	stat_list = SYSCTL_CHILDREN(stat_node);

	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_total_pkts",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.total_pkts_sent,
			 "Link-Level Total Packets Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_total_bytes",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.total_bytes_sent,
			 "Link-Level Total Bytes Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_mcast_pkts",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.mcast_pkts_sent,
			 "Link-Level Multicast Packets Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_bcast_pkts",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.bcast_pkts_sent,
			 "Link-Level Broadcast Packets Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_ctl_packets",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.ctl_sent,
			 "Link-Level Control Packets Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_total_collisions",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.total_collisions,
			 "Link-Level Tx Total Collisions");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_one_collision",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.one_collision_sent,
			 "Link-Level Tx One Collision Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_multi_collison",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.multi_collision_sent,
			 "Link-Level Tx Multi-Collision Sent");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_max_collision_fail",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.max_collision_fail,
			 "Link-Level Tx Max Collision Failed");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_max_deferal_fail",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.max_deferral_fail,
			 "Link-Level Tx Max Deferral Failed");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_fifo_err",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.fifo_err,
			 "Link-Level Tx FIFO Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_tx_runts", CTLFLAG_RD,
			 &oct_dev->link_stats.fromhost.runts,
			 "Link-Level Tx Runts");

	/* Firmware Rx Stats */
	stat_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, "fwrx",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Firmware Rx Statistics");
	stat_list = SYSCTL_CHILDREN(stat_node);

	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_total_rcvd", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_total_rcvd,
			 "Firmware Total Packets Received");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_total_fwd", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_total_fwd,
			 "Firmware Total Packets Forwarded");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_jabber_err", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.jabber_err,
			 "Firmware Rx Jabber Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_l2_err", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.l2_err,
			 "Firmware Rx L2 Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_frame_err", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.frame_err,
			 "Firmware Rx Frame Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_err_pko", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_err_pko,
			 "Firmware Rx PKO Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_err_link", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_err_link,
			 "Firmware Rx Link Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_err_drop", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_err_drop,
			 "Firmware Rx Dropped");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_vxlan", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_rx_vxlan,
			 "Firmware Rx VXLAN");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_vxlan_err", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_rx_vxlan_err,
			 "Firmware Rx VXLAN Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_pkts", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_pkts,
			 "Firmware Rx LRO Packets");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_bytes", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_octs,
			 "Firmware Rx LRO Bytes");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_total_lro", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_total_lro,
			 "Firmware Rx Total LRO");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_aborts", CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_aborts,
			 "Firmware Rx LRO Aborts");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_aborts_port",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_aborts_port,
			 "Firmware Rx LRO Aborts Port");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_aborts_seq",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_aborts_seq,
			 "Firmware Rx LRO Aborts Sequence");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_aborts_tsval",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_aborts_tsval,
			 "Firmware Rx LRO Aborts tsval");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_lro_aborts_timer",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fw_lro_aborts_timer,
			 "Firmware Rx LRO Aborts Timer");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "rx_fwd_rate",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fwd_rate,
			 "Firmware Rx Packets Forward Rate");
	/* MAC Rx Stats */
	stat_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, "macrx",
	    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "MAC Rx Statistics");
	stat_list = SYSCTL_CHILDREN(stat_node);

	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_total_rcvd",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.total_rcvd,
			 "Link-Level Total Packets Received");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_bytes",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.bytes_rcvd,
			 "Link-Level Total Bytes Received");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_total_bcst",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.total_bcst,
			 "Link-Level Total Broadcast");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_total_mcst",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.total_mcst,
			 "Link-Level Total Multicast");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_runts",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.runts,
			 "Link-Level Rx Runts");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_ctl_packets",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.ctl_rcvd,
			 "Link-Level Rx Control Packets");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_fifo_err",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fifo_err,
			 "Link-Level Rx FIFO Errors");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_dma_drop",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.dmac_drop,
			 "Link-Level Rx DMA Dropped");
	SYSCTL_ADD_UQUAD(ctx, stat_list, OID_AUTO, "mac_rx_fcs_err",
			 CTLFLAG_RD,
			 &oct_dev->link_stats.fromwire.fcs_err,
			 "Link-Level Rx FCS Errors");

	/* TX */
	for (int i = 0; i < oct_dev->num_iqs; i++) {
		if (!(oct_dev->io_qmask.iq & BIT_ULL(i)))
			continue;

		snprintf(namebuf, QUEUE_NAME_LEN, "tx-%d", i);
		queue_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, namebuf,
		    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Input Queue Name");
		queue_list = SYSCTL_CHILDREN(queue_node);

		/* packets to network port */
		/* # of packets tx to network */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "packets",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_done,
				 "Number of Packets Tx to Network");
		/* # of bytes tx to network */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "bytes",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_tot_bytes,
				 "Number of Bytes Tx to Network");
		/* # of packets dropped */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "dropped",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_dropped,
				 "Number of Tx Packets Dropped");
		/* # of tx fails due to queue full */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "iq_busy",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_iq_busy,
				 "Number of Tx Fails Due to Queue Full");
		/* scatter gather entries sent */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "sgentry_sent",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.sgentry_sent,
				 "Scatter Gather Entries Sent");

		/* instruction to firmware: data and control */
		/* # of instructions to the queue */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_instr_posted",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.instr_posted,
				 "Number of Instructions to The Queue");
		/* # of instructions processed */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO,
				 "fw_instr_processed", CTLFLAG_RD,
			      &oct_dev->instr_queue[i]->stats.instr_processed,
				 "Number of Instructions Processed");
		/* # of instructions could not be processed */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_instr_dropped",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.instr_dropped,
				 "Number of Instructions Dropped");
		/* bytes sent through the queue */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_bytes_sent",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.bytes_sent,
				 "Bytes Sent Through The Queue");
		/* tso request */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "tso",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_gso,
				 "TSO Request");
		/* vxlan request */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "vxlan",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_vxlan,
				 "VXLAN Request");
		/* txq restart */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "txq_restart",
				 CTLFLAG_RD,
				 &oct_dev->instr_queue[i]->stats.tx_restart,
				 "TxQ Restart");
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "tx_dmamap_fail",
				 CTLFLAG_RD,
			       &oct_dev->instr_queue[i]->stats.tx_dmamap_fail,
				 "TxQ DMA Map Failed");
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO,
				 "mbuf_defrag_failed", CTLFLAG_RD,
			   &oct_dev->instr_queue[i]->stats.mbuf_defrag_failed,
				 "TxQ defrag Failed");
	}

	/* RX */
	for (int i = 0; i < oct_dev->num_oqs; i++) {
		if (!(oct_dev->io_qmask.oq & BIT_ULL(i)))
			continue;

		snprintf(namebuf, QUEUE_NAME_LEN, "rx-%d", i);
		queue_node = SYSCTL_ADD_NODE(ctx, root_list, OID_AUTO, namebuf,
		    CTLFLAG_RD | CTLFLAG_MPSAFE, NULL, "Output Queue Name");
		queue_list = SYSCTL_CHILDREN(queue_node);

		/* packets send to TCP/IP network stack */
		/* # of packets to network stack */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "packets",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.rx_pkts_received,
				 "Number of Packets to Network Stack");
		/* # of bytes to network stack */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "bytes",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.rx_bytes_received,
				 "Number of Bytes to Network Stack");
		/* # of packets dropped */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "dropped_nomem",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.dropped_nomem,
				 "Packets Dropped Due to No Memory");
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "dropped_toomany",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.dropped_toomany,
				 "Packets dropped, Too Many Pkts to Process");
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_dropped",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.rx_dropped,
				"Packets Dropped due to Receive path failures");
		/* control and data path */
		/* # packets  sent to stack from this queue. */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_pkts_received",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.pkts_received,
				 "Number of Packets Received");
		/* # Bytes sent to stack from this queue. */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "fw_bytes_received",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.bytes_received,
				 "Number of Bytes Received");
		/* Packets dropped due to no dispatch function. */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO,
				 "fw_dropped_nodispatch", CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.dropped_nodispatch,
				 "Packets Dropped, No Dispatch Function");
		/* Rx VXLAN */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO, "vxlan",
				 CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.rx_vxlan,
				 "Rx VXLAN");
		/* # failures of lio_recv_buffer_alloc */
		SYSCTL_ADD_UQUAD(ctx, queue_list, OID_AUTO,
				 "buffer_alloc_failure", CTLFLAG_RD,
				 &oct_dev->droq[i]->stats.rx_alloc_failure,
			       "Number of Failures of lio_recv_buffer_alloc");
	}
}

static int
lio_get_eeprom(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct_dev = lio->oct_dev;
	struct lio_board_info	*board_info;
	char	buf[512];

	board_info = (struct lio_board_info *)(&oct_dev->boardinfo);
	if (oct_dev->uboot_len == 0)
		sprintf(buf, "boardname:%s serialnum:%s maj:%lld min:%lld",
			board_info->name, board_info->serial_number,
			LIO_CAST64(board_info->major),
		       	LIO_CAST64(board_info->minor));
	else {
		sprintf(buf, "boardname:%s serialnum:%s maj:%lld min:%lld\n%s",
			board_info->name, board_info->serial_number,
			LIO_CAST64(board_info->major),
		        LIO_CAST64(board_info->minor),
			&oct_dev->uboot_version[oct_dev->uboot_sidx]);
	}

	return (sysctl_handle_string(oidp, buf, strlen(buf), req));
}

/*
 * Get and set pause parameters or flow control using sysctl:
 * 0 - off
 * 1 - rx pause
 * 2 - tx pause
 * 3 - full
 */
static int
lio_get_set_pauseparam(SYSCTL_HANDLER_ARGS)
{
	/* Notes: Not supporting any auto negotiation in these drivers. */
	struct lio_ctrl_pkt	nctrl;
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	struct octeon_link_info	*linfo = &lio->linfo;

	int	err, new_pause = LIO_OFF_PAUSE, old_pause = LIO_OFF_PAUSE;
	int	ret = 0;

	if (oct->chip_id != LIO_CN23XX_PF_VID)
		return (EINVAL);

	if (oct->rx_pause)
		old_pause |= LIO_RX_PAUSE;

	if (oct->tx_pause)
		old_pause |= LIO_TX_PAUSE;

	new_pause = old_pause;
	err = sysctl_handle_int(oidp, &new_pause, 0, req);

	if ((err) || (req->newptr == NULL))
		return (err);

	if (old_pause == new_pause)
		return (0);

	if (linfo->link.s.duplex == 0) {
		/* no flow control for half duplex */
		if (new_pause)
			return (EINVAL);
	}

	bzero(&nctrl, sizeof(struct lio_ctrl_pkt));

	nctrl.ncmd.cmd64 = 0;
	nctrl.ncmd.s.cmd = LIO_CMD_SET_FLOW_CTL;
	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
	nctrl.wait_time = 100;
	nctrl.lio = lio;
	nctrl.cb_fn = lio_ctrl_cmd_completion;

	if (new_pause & LIO_RX_PAUSE) {
		/* enable rx pause */
		nctrl.ncmd.s.param1 = 1;
	} else {
		/* disable rx pause */
		nctrl.ncmd.s.param1 = 0;
	}

	if (new_pause & LIO_TX_PAUSE) {
		/* enable tx pause */
		nctrl.ncmd.s.param2 = 1;
	} else {
		/* disable tx pause */
		nctrl.ncmd.s.param2 = 0;
	}

	ret = lio_send_ctrl_pkt(lio->oct_dev, &nctrl);
	if (ret < 0) {
		lio_dev_err(oct, "Failed to set pause parameter\n");
		return (EINVAL);
	}

	oct->rx_pause = new_pause & LIO_RX_PAUSE;
	oct->tx_pause = new_pause & LIO_TX_PAUSE;

	return (0);
}

/*  Return register dump user app.  */
static int
lio_get_regs(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	if_t			ifp = lio->ifp;
	char	*regbuf;
	int	error = EINVAL, len = 0;

	if (!(if_getflags(ifp) & IFF_DEBUG)) {
		char debug_info[30] = "Debugging is disabled";

		return (sysctl_handle_string(oidp, debug_info,
					     strlen(debug_info), req));
	}
	regbuf = malloc(sizeof(char) * LIO_REGDUMP_LEN_XXXX, M_DEVBUF,
			M_WAITOK | M_ZERO);

	if (regbuf == NULL)
		return (error);

	switch (oct->chip_id) {
	case LIO_CN23XX_PF_VID:
		len += lio_cn23xx_pf_read_csr_reg(regbuf, oct);
		break;
	default:
		len += sprintf(regbuf, "%s Unknown chipid: %d\n",
			       __func__, oct->chip_id);
	}

	error = sysctl_handle_string(oidp, regbuf, len, req);
	free(regbuf, M_DEVBUF);

	return (error);
}

static int
lio_cn23xx_pf_read_csr_reg(char *s, struct octeon_device *oct)
{
	uint32_t	reg;
	int	i, len = 0;
	uint8_t	pf_num = oct->pf_num;

	/* PCI  Window Registers */

	len += sprintf(s + len, "\t Octeon CSR Registers\n\n");

	/* 0x29030 or 0x29040 */
	reg = LIO_CN23XX_SLI_PKT_MAC_RINFO64(oct->pcie_port, oct->pf_num);
	len += sprintf(s + len, "[%08x] (SLI_PKT_MAC%d_PF%d_RINFO): %016llx\n",
		       reg, oct->pcie_port, oct->pf_num,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x27080 or 0x27090 */
	reg = LIO_CN23XX_SLI_MAC_PF_INT_ENB64(oct->pcie_port, oct->pf_num);
	len += sprintf(s + len, "[%08x] (SLI_MAC%d_PF%d_INT_ENB): %016llx\n",
		       reg, oct->pcie_port, oct->pf_num,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x27000 or 0x27010 */
	reg = LIO_CN23XX_SLI_MAC_PF_INT_SUM64(oct->pcie_port, oct->pf_num);
	len += sprintf(s + len, "[%08x] (SLI_MAC%d_PF%d_INT_SUM): %016llx\n",
		       reg, oct->pcie_port, oct->pf_num,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29120 */
	reg = 0x29120;
	len += sprintf(s + len, "[%08x] (SLI_PKT_MEM_CTL): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x27300 */
	reg = 0x27300 + oct->pcie_port * LIO_CN23XX_MAC_INT_OFFSET +
	    (oct->pf_num) * LIO_CN23XX_PF_INT_OFFSET;
	len += sprintf(s + len, "[%08x] (SLI_MAC%d_PF%d_PKT_VF_INT): %016llx\n",
		       reg, oct->pcie_port, oct->pf_num,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x27200 */
	reg = 0x27200 + oct->pcie_port * LIO_CN23XX_MAC_INT_OFFSET +
	    (oct->pf_num) * LIO_CN23XX_PF_INT_OFFSET;
	len += sprintf(s + len, "[%08x] (SLI_MAC%d_PF%d_PP_VF_INT): %016llx\n",
		       reg, oct->pcie_port, oct->pf_num,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 29130 */
	reg = LIO_CN23XX_SLI_PKT_CNT_INT;
	len += sprintf(s + len, "[%08x] (SLI_PKT_CNT_INT): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29140 */
	reg = LIO_CN23XX_SLI_PKT_TIME_INT;
	len += sprintf(s + len, "[%08x] (SLI_PKT_TIME_INT): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29160 */
	reg = 0x29160;
	len += sprintf(s + len, "[%08x] (SLI_PKT_INT): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29180 */
	reg = LIO_CN23XX_SLI_OQ_WMARK;
	len += sprintf(s + len, "[%08x] (SLI_PKT_OUTPUT_WMARK): %016llx\n",
		       reg, LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x291E0 */
	reg = LIO_CN23XX_SLI_PKT_IOQ_RING_RST;
	len += sprintf(s + len, "[%08x] (SLI_PKT_RING_RST): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29210 */
	reg = LIO_CN23XX_SLI_GBL_CONTROL;
	len += sprintf(s + len, "[%08x] (SLI_PKT_GBL_CONTROL): %016llx\n", reg,
		       LIO_CAST64(lio_read_csr64(oct, reg)));

	/* 0x29220 */
	reg = 0x29220;
	len += sprintf(s + len, "[%08x] (SLI_PKT_BIST_STATUS): %016llx\n",
		       reg, LIO_CAST64(lio_read_csr64(oct, reg)));

	/* PF only */
	if (pf_num == 0) {
		/* 0x29260 */
		reg = LIO_CN23XX_SLI_OUT_BP_EN_W1S;
		len += sprintf(s + len, "[%08x] (SLI_PKT_OUT_BP_EN_W1S):  %016llx\n",
			       reg, LIO_CAST64(lio_read_csr64(oct, reg)));
	} else if (pf_num == 1) {
		/* 0x29270 */
		reg = LIO_CN23XX_SLI_OUT_BP_EN2_W1S;
		len += sprintf(s + len, "[%08x] (SLI_PKT_OUT_BP_EN2_W1S): %016llx\n",
			       reg, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_BUFF_INFO_SIZE(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_OUT_SIZE): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10040 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_IQ_INSTR_COUNT64(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10080 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_PKTS_CREDIT(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_SLIST_BAOFF_DBELL): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10090 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_SIZE(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_SLIST_FIFO_RSIZE): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10050 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_PKT_CONTROL(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d__OUTPUT_CONTROL): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10070 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_BASE_ADDR64(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_SLIST_BADDR): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x100a0 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_INT_LEVELS): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x100b0 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_OQ_PKTS_SENT(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_CNTS): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x100c0 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_OUTPUT_QUEUES; i++) {
		reg = 0x100c0 + i * LIO_CN23XX_OQ_OFFSET;
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_ERROR_INFO): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10000 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_IQ_PKT_CONTROL64(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_INPUT_CONTROL): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10010 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_IQ_BASE_ADDR64(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_INSTR_BADDR): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10020 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_IQ_DOORBELL(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_INSTR_BAOFF_DBELL): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10030 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++) {
		reg = LIO_CN23XX_SLI_IQ_SIZE(i);
		len += sprintf(s + len, "[%08x] (SLI_PKT%d_INSTR_FIFO_RSIZE): %016llx\n",
			       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));
	}

	/* 0x10040 */
	for (i = 0; i < LIO_CN23XX_PF_MAX_INPUT_QUEUES; i++)
		reg = LIO_CN23XX_SLI_IQ_INSTR_COUNT64(i);
	len += sprintf(s + len, "[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
		       reg, i, LIO_CAST64(lio_read_csr64(oct, reg)));

	return (len);
}

static int
lio_get_ringparam(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t		rx_max_pending = 0, tx_max_pending = 0;
	int	err;

	if (LIO_CN23XX_PF(oct)) {
		tx_max_pending = LIO_CN23XX_MAX_IQ_DESCRIPTORS;
		rx_max_pending = LIO_CN23XX_MAX_OQ_DESCRIPTORS;
	}

	switch (arg2) {
	case LIO_SET_RING_RX:
		err = sysctl_handle_int(oidp, &rx_max_pending, 0, req);
		break;
	case LIO_SET_RING_TX:
		err = sysctl_handle_int(oidp, &tx_max_pending, 0, req);
		break;
	}

	return (err);
}

static int
lio_reset_queues(if_t ifp, uint32_t num_qs)
{
	struct lio		*lio = if_getsoftc(ifp);
	struct octeon_device	*oct = lio->oct_dev;
	int	i, update = 0;

	if (lio_wait_for_pending_requests(oct))
		lio_dev_err(oct, "There were pending requests\n");

	if (lio_wait_for_instr_fetch(oct))
		lio_dev_err(oct, "IQ had pending instructions\n");


	/*
	 * Disable the input and output queues now. No more packets will
	 * arrive from Octeon.
	 */
	oct->fn_list.disable_io_queues(oct);

	if (num_qs != oct->num_iqs)
		update = 1;

	for (i = 0; i < LIO_MAX_OUTPUT_QUEUES(oct); i++) {
		if (!(oct->io_qmask.oq & BIT_ULL(i)))
			continue;

		lio_delete_droq(oct, i);
	}

	for (i = 0; i < LIO_MAX_INSTR_QUEUES(oct); i++) {
		if (!(oct->io_qmask.iq & BIT_ULL(i)))
			continue;

		lio_delete_instr_queue(oct, i);
	}

	if (oct->fn_list.setup_device_regs(oct)) {
		lio_dev_err(oct, "Failed to configure device registers\n");
		return (-1);
	}

	if (lio_setup_io_queues(oct, 0, num_qs, num_qs)) {
		lio_dev_err(oct, "IO queues initialization failed\n");
		return (-1);
	}

	if (update && lio_send_queue_count_update(ifp, num_qs))
		return (-1);

	return (0);
}

static int
lio_set_ringparam(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t		rx_count, rx_count_old, tx_count, tx_count_old;
	int	err, stopped = 0;

	if (!LIO_CN23XX_PF(oct))
		return (EINVAL);

	switch (arg2) {
	case LIO_SET_RING_RX:
		rx_count = rx_count_old = oct->droq[0]->max_count;
		err = sysctl_handle_int(oidp, &rx_count, 0, req);

		if ((err) || (req->newptr == NULL))
			return (err);

		rx_count = min(max(rx_count, LIO_CN23XX_MIN_OQ_DESCRIPTORS),
			       LIO_CN23XX_MAX_OQ_DESCRIPTORS);

		if (rx_count == rx_count_old)
			return (0);

		lio_ifstate_set(lio, LIO_IFSTATE_RESETTING);

		if (if_getdrvflags(lio->ifp) & IFF_DRV_RUNNING) {
			lio_stop(lio->ifp);
			stopped = 1;
		}

		/* Change RX DESCS  count */
		LIO_SET_NUM_RX_DESCS_NIC_IF(lio_get_conf(oct),
					    lio->ifidx, rx_count);
		break;
	case LIO_SET_RING_TX:
		tx_count = tx_count_old = oct->instr_queue[0]->max_count;
		err = sysctl_handle_int(oidp, &tx_count, 0, req);

		if ((err) || (req->newptr == NULL))
			return (err);

		tx_count = min(max(tx_count, LIO_CN23XX_MIN_IQ_DESCRIPTORS),
			       LIO_CN23XX_MAX_IQ_DESCRIPTORS);

		if (tx_count == tx_count_old)
			return (0);

		lio_ifstate_set(lio, LIO_IFSTATE_RESETTING);

		if (if_getdrvflags(lio->ifp) & IFF_DRV_RUNNING) {
			lio_stop(lio->ifp);
			stopped = 1;
		}

		/* Change TX DESCS  count */
		LIO_SET_NUM_TX_DESCS_NIC_IF(lio_get_conf(oct),
					    lio->ifidx, tx_count);
		break;
	}

	if (lio_reset_queues(lio->ifp, lio->linfo.num_txpciq))
		goto err_lio_reset_queues;

	lio_irq_reallocate_irqs(oct, lio->linfo.num_txpciq);
	if (stopped)
		lio_open(lio);

	lio_ifstate_reset(lio, LIO_IFSTATE_RESETTING);

	return (0);

err_lio_reset_queues:
	if (arg2 == LIO_SET_RING_RX && rx_count != rx_count_old)
		LIO_SET_NUM_RX_DESCS_NIC_IF(lio_get_conf(oct), lio->ifidx,
					    rx_count_old);

	if (arg2 == LIO_SET_RING_TX && tx_count != tx_count_old)
		LIO_SET_NUM_TX_DESCS_NIC_IF(lio_get_conf(oct), lio->ifidx,
					    tx_count_old);

	return (EINVAL);
}

static int
lio_get_channels(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t	max_combined = 0;

		if (LIO_CN23XX_PF(oct))
			max_combined = lio->linfo.num_txpciq;
	return (sysctl_handle_int(oidp, &max_combined, 0, req));
}

static int
lio_irq_reallocate_irqs(struct octeon_device *oct, uint32_t num_ioqs)
{
	int	i, num_msix_irqs = 0;

	if (!oct->msix_on)
		return (0);

	/*
	 * Disable the input and output queues now. No more packets will
	 * arrive from Octeon.
	 */
	oct->fn_list.disable_interrupt(oct, OCTEON_ALL_INTR);

	if (oct->msix_on) {
		if (LIO_CN23XX_PF(oct))
			num_msix_irqs = oct->num_msix_irqs - 1;

		for (i = 0; i < num_msix_irqs; i++) {
			if (oct->ioq_vector[i].tag != NULL) {
				bus_teardown_intr(oct->device,
						  oct->ioq_vector[i].msix_res,
						  oct->ioq_vector[i].tag);
				oct->ioq_vector[i].tag = NULL;
			}

			if (oct->ioq_vector[i].msix_res != NULL) {
				bus_release_resource(oct->device, SYS_RES_IRQ,
						     oct->ioq_vector[i].vector,
						 oct->ioq_vector[i].msix_res);
				oct->ioq_vector[i].msix_res = NULL;
			}
		}


		if (oct->tag != NULL) {
			bus_teardown_intr(oct->device, oct->msix_res, oct->tag);
			oct->tag = NULL;
		}

		if (oct->msix_res != NULL) {
			bus_release_resource(oct->device, SYS_RES_IRQ,
					     oct->aux_vector,
					     oct->msix_res);
			oct->msix_res = NULL;
		}

		pci_release_msi(oct->device);

	}

	if (lio_setup_interrupt(oct, num_ioqs)) {
		lio_dev_info(oct, "Setup interuupt failed\n");
		return (1);
	}

	/* Enable Octeon device interrupts */
	oct->fn_list.enable_interrupt(oct, OCTEON_ALL_INTR);

	return (0);
}

static int
lio_set_channels(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t		combined_count, max_combined;
	int	err, stopped = 0;

	if (strcmp(oct->fw_info.lio_firmware_version, "1.6.1") < 0) {
		lio_dev_err(oct,
			    "Minimum firmware version required is 1.6.1\n");
		return (EINVAL);
	}

	combined_count = oct->num_iqs;
	err = sysctl_handle_int(oidp, &combined_count, 0, req);

	if ((err) || (req->newptr == NULL))
		return (err);

	if (!combined_count)
		return (EINVAL);

	if (LIO_CN23XX_PF(oct)) {
		max_combined = lio->linfo.num_txpciq;
	} else {
		return (EINVAL);
	}

	if ((combined_count > max_combined) || (combined_count < 1))
		return (EINVAL);

	if (combined_count == oct->num_iqs)
		return (0);

	lio_ifstate_set(lio, LIO_IFSTATE_RESETTING);

	if (if_getdrvflags(lio->ifp) & IFF_DRV_RUNNING) {
		lio_stop(lio->ifp);
		stopped = 1;
	}

	if (lio_reset_queues(lio->ifp, combined_count))
		return (EINVAL);

	lio_irq_reallocate_irqs(oct, combined_count);
	if (stopped)
		lio_open(lio);

	lio_ifstate_reset(lio, LIO_IFSTATE_RESETTING);

	return (0);
}


static int
lio_get_set_fwmsglevel(SYSCTL_HANDLER_ARGS)
{
	struct lio	*lio = (struct lio *)arg1;
	if_t		ifp = lio->ifp;
	int	err, new_msglvl = 0, old_msglvl = 0;

	if (lio_ifstate_check(lio, LIO_IFSTATE_RESETTING))
		return (ENXIO);

	old_msglvl = new_msglvl = lio->msg_enable;
	err = sysctl_handle_int(oidp, &new_msglvl, 0, req);

	if ((err) || (req->newptr == NULL))
		return (err);

	if (old_msglvl == new_msglvl)
		return (0);

	if (new_msglvl ^ lio->msg_enable) {
		if (new_msglvl)
			err = lio_set_feature(ifp, LIO_CMD_VERBOSE_ENABLE, 0);
		else
			err = lio_set_feature(ifp, LIO_CMD_VERBOSE_DISABLE, 0);
	}

	lio->msg_enable = new_msglvl;

	return ((err) ? EINVAL : 0);
}

static int
lio_set_stats_interval(SYSCTL_HANDLER_ARGS)
{
	struct lio	*lio = (struct lio *)arg1;
	int	err, new_time = 0, old_time = 0;

	old_time = new_time = lio->stats_interval;
	err = sysctl_handle_int(oidp, &new_time, 0, req);

	if ((err) || (req->newptr == NULL))
		return (err);

	if (old_time == new_time)
		return (0);

	lio->stats_interval = new_time;

	return (0);
}

static void
lio_fw_stats_callback(struct octeon_device *oct_dev, uint32_t status, void *ptr)
{
	struct lio_soft_command	*sc = (struct lio_soft_command *)ptr;
	struct lio_fw_stats_resp *resp =
		(struct lio_fw_stats_resp *)sc->virtrptr;
	struct octeon_rx_stats	*rsp_rstats = &resp->stats.fromwire;
	struct octeon_tx_stats	*rsp_tstats = &resp->stats.fromhost;
	struct octeon_rx_stats	*rstats = &oct_dev->link_stats.fromwire;
	struct octeon_tx_stats	*tstats = &oct_dev->link_stats.fromhost;
	if_t			ifp = oct_dev->props.ifp;
	struct lio		*lio = if_getsoftc(ifp);

	if ((status != LIO_REQUEST_TIMEOUT) && !resp->status) {
		lio_swap_8B_data((uint64_t *)&resp->stats,
				 (sizeof(struct octeon_link_stats)) >> 3);

		/* RX link-level stats */
		rstats->total_rcvd = rsp_rstats->total_rcvd;
		rstats->bytes_rcvd = rsp_rstats->bytes_rcvd;
		rstats->total_bcst = rsp_rstats->total_bcst;
		rstats->total_mcst = rsp_rstats->total_mcst;
		rstats->runts = rsp_rstats->runts;
		rstats->ctl_rcvd = rsp_rstats->ctl_rcvd;
		/* Accounts for over/under-run of buffers */
		rstats->fifo_err = rsp_rstats->fifo_err;
		rstats->dmac_drop = rsp_rstats->dmac_drop;
		rstats->fcs_err = rsp_rstats->fcs_err;
		rstats->jabber_err = rsp_rstats->jabber_err;
		rstats->l2_err = rsp_rstats->l2_err;
		rstats->frame_err = rsp_rstats->frame_err;

		/* RX firmware stats */
		rstats->fw_total_rcvd = rsp_rstats->fw_total_rcvd;
		rstats->fw_total_fwd = rsp_rstats->fw_total_fwd;
		rstats->fw_err_pko = rsp_rstats->fw_err_pko;
		rstats->fw_err_link = rsp_rstats->fw_err_link;
		rstats->fw_err_drop = rsp_rstats->fw_err_drop;
		rstats->fw_rx_vxlan = rsp_rstats->fw_rx_vxlan;
		rstats->fw_rx_vxlan_err = rsp_rstats->fw_rx_vxlan_err;

		/* Number of packets that are LROed      */
		rstats->fw_lro_pkts = rsp_rstats->fw_lro_pkts;
		/* Number of octets that are LROed       */
		rstats->fw_lro_octs = rsp_rstats->fw_lro_octs;
		/* Number of LRO packets formed          */
		rstats->fw_total_lro = rsp_rstats->fw_total_lro;
		/* Number of times lRO of packet aborted */
		rstats->fw_lro_aborts = rsp_rstats->fw_lro_aborts;
		rstats->fw_lro_aborts_port = rsp_rstats->fw_lro_aborts_port;
		rstats->fw_lro_aborts_seq = rsp_rstats->fw_lro_aborts_seq;
		rstats->fw_lro_aborts_tsval = rsp_rstats->fw_lro_aborts_tsval;
		rstats->fw_lro_aborts_timer = rsp_rstats->fw_lro_aborts_timer;
		/* intrmod: packet forward rate */
		rstats->fwd_rate = rsp_rstats->fwd_rate;

		/* TX link-level stats */
		tstats->total_pkts_sent = rsp_tstats->total_pkts_sent;
		tstats->total_bytes_sent = rsp_tstats->total_bytes_sent;
		tstats->mcast_pkts_sent = rsp_tstats->mcast_pkts_sent;
		tstats->bcast_pkts_sent = rsp_tstats->bcast_pkts_sent;
		tstats->ctl_sent = rsp_tstats->ctl_sent;
		/* Packets sent after one collision */
		tstats->one_collision_sent = rsp_tstats->one_collision_sent;
		/* Packets sent after multiple collision */
		tstats->multi_collision_sent = rsp_tstats->multi_collision_sent;
		/* Packets not sent due to max collisions */
		tstats->max_collision_fail = rsp_tstats->max_collision_fail;
		/* Packets not sent due to max deferrals */
		tstats->max_deferral_fail = rsp_tstats->max_deferral_fail;
		/* Accounts for over/under-run of buffers */
		tstats->fifo_err = rsp_tstats->fifo_err;
		tstats->runts = rsp_tstats->runts;
		/* Total number of collisions detected */
		tstats->total_collisions = rsp_tstats->total_collisions;

		/* firmware stats */
		tstats->fw_total_sent = rsp_tstats->fw_total_sent;
		tstats->fw_total_fwd = rsp_tstats->fw_total_fwd;
		tstats->fw_err_pko = rsp_tstats->fw_err_pko;
		tstats->fw_err_pki = rsp_tstats->fw_err_pki;
		tstats->fw_err_link = rsp_tstats->fw_err_link;
		tstats->fw_err_drop = rsp_tstats->fw_err_drop;
		tstats->fw_tso = rsp_tstats->fw_tso;
		tstats->fw_tso_fwd = rsp_tstats->fw_tso_fwd;
		tstats->fw_err_tso = rsp_tstats->fw_err_tso;
		tstats->fw_tx_vxlan = rsp_tstats->fw_tx_vxlan;
	}
	lio_free_soft_command(oct_dev, sc);
	callout_schedule(&lio->stats_timer,
			 lio_ms_to_ticks(lio->stats_interval));
}

/*  Configure interrupt moderation parameters */
static void
lio_get_fw_stats(void *arg)
{
	struct lio		*lio = arg;
	struct octeon_device	*oct_dev = lio->oct_dev;
	struct lio_soft_command	*sc;
	struct lio_fw_stats_resp *resp;
	int	retval;

	if (callout_pending(&lio->stats_timer) ||
	    callout_active(&lio->stats_timer) == 0)
		return;

	/* Alloc soft command */
	sc = lio_alloc_soft_command(oct_dev, 0,
				    sizeof(struct lio_fw_stats_resp), 0);

	if (sc == NULL)
		goto alloc_sc_failed;

	resp = (struct lio_fw_stats_resp *)sc->virtrptr;
	bzero(resp, sizeof(struct lio_fw_stats_resp));

	sc->iq_no = lio->linfo.txpciq[0].s.q_no;

	lio_prepare_soft_command(oct_dev, sc, LIO_OPCODE_NIC,
				 LIO_OPCODE_NIC_PORT_STATS, 0, 0, 0);

	sc->callback = lio_fw_stats_callback;
	sc->callback_arg = sc;
	sc->wait_time = 500;		/* in milli seconds */

	retval = lio_send_soft_command(oct_dev, sc);
	if (retval == LIO_IQ_SEND_FAILED)
		goto send_sc_failed;

	return;

send_sc_failed:
	lio_free_soft_command(oct_dev, sc);
alloc_sc_failed:
	callout_schedule(&lio->stats_timer,
			 lio_ms_to_ticks(lio->stats_interval));
}

/* Callback function for intrmod */
static void
lio_get_intrmod_callback(struct octeon_device *oct_dev, uint32_t status,
			 void *ptr)
{
	struct lio_soft_command	*sc = (struct lio_soft_command *)ptr;
	if_t			ifp = oct_dev->props.ifp;
	struct lio		*lio = if_getsoftc(ifp);
	struct lio_intrmod_resp	*resp;

	if (status) {
		lio_dev_err(oct_dev, "Failed to get intrmod\n");
	} else {
		resp = (struct lio_intrmod_resp *)sc->virtrptr;
		lio_swap_8B_data((uint64_t *)&resp->intrmod,
				 (sizeof(struct octeon_intrmod_cfg)) / 8);
		memcpy(&lio->intrmod_cfg, &resp->intrmod,
		       sizeof(struct octeon_intrmod_cfg));
	}

	lio_free_soft_command(oct_dev, sc);
}

/*  get interrupt moderation parameters */
static int
lio_get_intrmod_cfg(struct lio *lio, struct octeon_intrmod_cfg *intr_cfg)
{
	struct lio_soft_command	*sc;
	struct lio_intrmod_resp	*resp;
	struct octeon_device	*oct_dev = lio->oct_dev;
	int	retval;

	/* Alloc soft command */
	sc = lio_alloc_soft_command(oct_dev, 0, sizeof(struct lio_intrmod_resp),
				    0);

	if (sc == NULL)
		return (ENOMEM);

	resp = (struct lio_intrmod_resp *)sc->virtrptr;
	bzero(resp, sizeof(struct lio_intrmod_resp));
	sc->iq_no = lio->linfo.txpciq[0].s.q_no;

	lio_prepare_soft_command(oct_dev, sc, LIO_OPCODE_NIC,
				 LIO_OPCODE_NIC_INTRMOD_PARAMS, 0, 0, 0);

	sc->callback = lio_get_intrmod_callback;
	sc->callback_arg = sc;
	sc->wait_time = 1000;

	retval = lio_send_soft_command(oct_dev, sc);
	if (retval == LIO_IQ_SEND_FAILED) {
		lio_free_soft_command(oct_dev, sc);
		return (EINVAL);
	}

	return (0);
}

static void
lio_set_intrmod_callback(struct octeon_device *oct_dev, uint32_t status,
			 void *ptr)
{
	struct lio_soft_command		*sc = (struct lio_soft_command *)ptr;
	struct lio_intrmod_context	*ctx;

	ctx = (struct lio_intrmod_context *)sc->ctxptr;

	ctx->status = status;

	ctx->cond = 1;

	/*
	 * This barrier is required to be sure that the response has been
	 * written fully before waking up the handler
	 */
	wmb();
}

/*  Configure interrupt moderation parameters */
static int
lio_set_intrmod_cfg(struct lio *lio, struct octeon_intrmod_cfg *intr_cfg)
{
	struct lio_soft_command		*sc;
	struct lio_intrmod_context	*ctx;
	struct octeon_intrmod_cfg	*cfg;
	struct octeon_device		*oct_dev = lio->oct_dev;
	int	retval;

	/* Alloc soft command */
	sc = lio_alloc_soft_command(oct_dev, sizeof(struct octeon_intrmod_cfg),
				    0, sizeof(struct lio_intrmod_context));

	if (sc == NULL)
		return (ENOMEM);

	ctx = (struct lio_intrmod_context *)sc->ctxptr;

	ctx->cond = 0;
	ctx->octeon_id = lio_get_device_id(oct_dev);

	cfg = (struct octeon_intrmod_cfg *)sc->virtdptr;

	memcpy(cfg, intr_cfg, sizeof(struct octeon_intrmod_cfg));
	lio_swap_8B_data((uint64_t *)cfg,
			 (sizeof(struct octeon_intrmod_cfg)) / 8);

	sc->iq_no = lio->linfo.txpciq[0].s.q_no;

	lio_prepare_soft_command(oct_dev, sc, LIO_OPCODE_NIC,
				 LIO_OPCODE_NIC_INTRMOD_CFG, 0, 0, 0);

	sc->callback = lio_set_intrmod_callback;
	sc->callback_arg = sc;
	sc->wait_time = 1000;

	retval = lio_send_soft_command(oct_dev, sc);
	if (retval == LIO_IQ_SEND_FAILED) {
		lio_free_soft_command(oct_dev, sc);
		return (EINVAL);
	}

	/*
	 * Sleep on a wait queue till the cond flag indicates that the
	 * response arrived or timed-out.
	 */
	lio_sleep_cond(oct_dev, &ctx->cond);

	retval = ctx->status;
	if (retval)
		lio_dev_err(oct_dev, "intrmod config failed. Status: %llx\n",
			    LIO_CAST64(retval));
	else
		lio_dev_info(oct_dev, "Rx-Adaptive Interrupt moderation enabled:%llx\n",
			     LIO_CAST64(intr_cfg->rx_enable));

	lio_free_soft_command(oct_dev, sc);

	return ((retval) ? ETIMEDOUT : 0);
}

static int
lio_intrmod_cfg_rx_intrcnt(struct lio *lio, struct octeon_intrmod_cfg *intrmod,
			   uint32_t rx_max_frames)
{
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t		rx_max_coalesced_frames;

	/* Config Cnt based interrupt values */
	switch (oct->chip_id) {
	case LIO_CN23XX_PF_VID:{
			int	q_no;

			if (!rx_max_frames)
				rx_max_coalesced_frames = intrmod->rx_frames;
			else
				rx_max_coalesced_frames = rx_max_frames;

			for (q_no = 0; q_no < oct->num_oqs; q_no++) {
				q_no += oct->sriov_info.pf_srn;
				lio_write_csr64(oct,
					LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
						(lio_read_csr64(oct,
				     LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no)) &
						 (0x3fffff00000000UL)) |
						(rx_max_coalesced_frames - 1));
				/* consider setting resend bit */
			}

			intrmod->rx_frames = rx_max_coalesced_frames;
			oct->rx_max_coalesced_frames = rx_max_coalesced_frames;
			break;
		}
	default:
		return (EINVAL);
	}
	return (0);
}

static int
lio_intrmod_cfg_rx_intrtime(struct lio *lio, struct octeon_intrmod_cfg *intrmod,
			    uint32_t rx_usecs)
{
	struct octeon_device	*oct = lio->oct_dev;
	uint32_t		rx_coalesce_usecs;

	/* Config Time based interrupt values */
	switch (oct->chip_id) {
	case LIO_CN23XX_PF_VID:{
			uint64_t	time_threshold;
			int	q_no;

			if (!rx_usecs)
				rx_coalesce_usecs = intrmod->rx_usecs;
			else
				rx_coalesce_usecs = rx_usecs;

			time_threshold =
			    lio_cn23xx_pf_get_oq_ticks(oct, rx_coalesce_usecs);
			for (q_no = 0; q_no < oct->num_oqs; q_no++) {
				q_no += oct->sriov_info.pf_srn;
				lio_write_csr64(oct,
				       LIO_CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
						(intrmod->rx_frames |
					   ((uint64_t)time_threshold << 32)));
				/* consider writing to resend bit here */
			}

			intrmod->rx_usecs = rx_coalesce_usecs;
			oct->rx_coalesce_usecs = rx_coalesce_usecs;
			break;
		}
	default:
		return (EINVAL);
	}

	return (0);
}

static int
lio_intrmod_cfg_tx_intrcnt(struct lio *lio, struct octeon_intrmod_cfg *intrmod,
			   uint32_t tx_max_frames)
{
	struct octeon_device	*oct = lio->oct_dev;
	uint64_t	val;
	uint32_t	iq_intr_pkt;
	uint32_t	inst_cnt_reg;

	/* Config Cnt based interrupt values */
	switch (oct->chip_id) {
	case LIO_CN23XX_PF_VID:{
			int	q_no;

			if (!tx_max_frames)
				iq_intr_pkt = LIO_CN23XX_DEF_IQ_INTR_THRESHOLD &
				    LIO_CN23XX_PKT_IN_DONE_WMARK_MASK;
			else
				iq_intr_pkt = tx_max_frames &
				    LIO_CN23XX_PKT_IN_DONE_WMARK_MASK;
			for (q_no = 0; q_no < oct->num_iqs; q_no++) {
				inst_cnt_reg =
					(oct->instr_queue[q_no])->inst_cnt_reg;
				val = lio_read_csr64(oct, inst_cnt_reg);
				/*
				 * clear wmark and count.dont want to write
				 * count back
				 */
				val = (val & 0xFFFF000000000000ULL) |
				    ((uint64_t)(iq_intr_pkt - 1)
				     << LIO_CN23XX_PKT_IN_DONE_WMARK_BIT_POS);
				lio_write_csr64(oct, inst_cnt_reg, val);
				/* consider setting resend bit */
			}

			intrmod->tx_frames = iq_intr_pkt;
			oct->tx_max_coalesced_frames = iq_intr_pkt;
			break;
		}
	default:
		return (-EINVAL);
	}
	return (0);
}

static int
lio_get_set_intr_coalesce(SYSCTL_HANDLER_ARGS)
{
	struct lio		*lio = (struct lio *)arg1;
	struct octeon_device	*oct = lio->oct_dev;
	uint64_t	new_val = 0, old_val = 0;
	uint32_t	rx_coalesce_usecs = 0;
	uint32_t	rx_max_coalesced_frames = 0;
	uint32_t	tx_coalesce_usecs = 0;
	int		err, ret;

	switch (arg2) {
	case LIO_USE_ADAPTIVE_RX_COALESCE:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.rx_enable;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		lio->intrmod_cfg.rx_enable = new_val ? 1 : 0;
		break;

	case LIO_USE_ADAPTIVE_TX_COALESCE:
		if (lio->intrmod_cfg.tx_enable)
			new_val = old_val = lio->intrmod_cfg.tx_enable;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		lio->intrmod_cfg.tx_enable = new_val ? 1 : 0;
		break;

	case LIO_RX_COALESCE_USECS:
		if (!lio->intrmod_cfg.rx_enable)
			new_val = old_val = oct->rx_coalesce_usecs;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		rx_coalesce_usecs = new_val;
		break;

	case LIO_RX_MAX_COALESCED_FRAMES:
		if (!lio->intrmod_cfg.rx_enable)
			new_val = old_val = oct->rx_max_coalesced_frames;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		rx_max_coalesced_frames = new_val;
		break;

	case LIO_TX_MAX_COALESCED_FRAMES:
		if (!lio->intrmod_cfg.tx_enable)
			new_val = old_val = oct->tx_max_coalesced_frames;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		tx_coalesce_usecs = new_val;
		break;

	case LIO_PKT_RATE_LOW:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.minpkt_ratethr;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable || lio->intrmod_cfg.tx_enable)
			lio->intrmod_cfg.minpkt_ratethr = new_val;
		break;

	case LIO_RX_COALESCE_USECS_LOW:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.rx_mintmr_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable)
			lio->intrmod_cfg.rx_mintmr_trigger = new_val;
		break;

	case LIO_RX_MAX_COALESCED_FRAMES_LOW:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.rx_mincnt_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable)
			lio->intrmod_cfg.rx_mincnt_trigger = new_val;
		break;

	case LIO_TX_MAX_COALESCED_FRAMES_LOW:
		if (lio->intrmod_cfg.tx_enable)
			new_val = old_val = lio->intrmod_cfg.tx_mincnt_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.tx_enable)
			lio->intrmod_cfg.tx_mincnt_trigger = new_val;
		break;

	case LIO_PKT_RATE_HIGH:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.maxpkt_ratethr;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable || lio->intrmod_cfg.tx_enable)
			lio->intrmod_cfg.maxpkt_ratethr = new_val;
		break;

	case LIO_RX_COALESCE_USECS_HIGH:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.rx_maxtmr_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable)
			lio->intrmod_cfg.rx_maxtmr_trigger = new_val;
		break;

	case LIO_RX_MAX_COALESCED_FRAMES_HIGH:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.rx_maxcnt_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable)
			lio->intrmod_cfg.rx_maxcnt_trigger = new_val;
		break;

	case LIO_TX_MAX_COALESCED_FRAMES_HIGH:
		if (lio->intrmod_cfg.tx_enable)
			new_val = old_val = lio->intrmod_cfg.tx_maxcnt_trigger;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.tx_enable)
			lio->intrmod_cfg.tx_maxcnt_trigger = new_val;
		break;

	case LIO_RATE_SAMPLE_INTERVAL:
		if (lio->intrmod_cfg.rx_enable)
			new_val = old_val = lio->intrmod_cfg.check_intrvl;

		err = sysctl_handle_64(oidp, &new_val, 0, req);
		if ((err) || (req->newptr == NULL))
			return (err);

		if (old_val == new_val)
			return (0);

		if (lio->intrmod_cfg.rx_enable || lio->intrmod_cfg.tx_enable)
			lio->intrmod_cfg.check_intrvl = new_val;
		break;

	default:
		return (EINVAL);
	}

	lio->intrmod_cfg.rx_usecs = LIO_GET_OQ_INTR_TIME_CFG(lio_get_conf(oct));
	lio->intrmod_cfg.rx_frames = LIO_GET_OQ_INTR_PKT_CFG(lio_get_conf(oct));
	lio->intrmod_cfg.tx_frames = LIO_GET_IQ_INTR_PKT_CFG(lio_get_conf(oct));

	ret = lio_set_intrmod_cfg(lio, &lio->intrmod_cfg);
	if (ret)
		lio_dev_err(oct, "Interrupt coalescing updation to Firmware failed!\n");

	if (!lio->intrmod_cfg.rx_enable) {
		if (!rx_coalesce_usecs)
			rx_coalesce_usecs = oct->rx_coalesce_usecs;

		if (!rx_max_coalesced_frames)
			rx_max_coalesced_frames = oct->rx_max_coalesced_frames;

		ret = lio_intrmod_cfg_rx_intrtime(lio, &lio->intrmod_cfg,
						  rx_coalesce_usecs);
		if (ret)
			return (ret);

		ret = lio_intrmod_cfg_rx_intrcnt(lio, &lio->intrmod_cfg,
						 rx_max_coalesced_frames);
		if (ret)
			return (ret);
	} else {
		oct->rx_coalesce_usecs =
		    LIO_GET_OQ_INTR_TIME_CFG(lio_get_conf(oct));
		oct->rx_max_coalesced_frames =
		    LIO_GET_OQ_INTR_PKT_CFG(lio_get_conf(oct));
	}

	if (!lio->intrmod_cfg.tx_enable) {
		if (!tx_coalesce_usecs)
			tx_coalesce_usecs = oct->tx_max_coalesced_frames;

		ret = lio_intrmod_cfg_tx_intrcnt(lio, &lio->intrmod_cfg,
						 tx_coalesce_usecs);
		if (ret)
			return (ret);
	} else {
		oct->tx_max_coalesced_frames =
			LIO_GET_IQ_INTR_PKT_CFG(lio_get_conf(oct));
	}

	return (0);
}