1/**********************************************************************
2 * Author: Cavium, Inc.
3 *
4 * Contact: support@cavium.com
5 *          Please include "LiquidIO" in the subject.
6 *
7 * Copyright (c) 2003-2016 Cavium, Inc.
8 *
9 * This file is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License, Version 2, as
11 * published by the Free Software Foundation.
12 *
13 * This file is distributed in the hope that it will be useful, but
14 * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
15 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
16 * NONINFRINGEMENT.  See the GNU General Public License for more details.
17 ***********************************************************************/
18#include <linux/ethtool.h>
19#include <linux/netdevice.h>
20#include <linux/net_tstamp.h>
21#include <linux/pci.h>
22#include "liquidio_common.h"
23#include "octeon_droq.h"
24#include "octeon_iq.h"
25#include "response_manager.h"
26#include "octeon_device.h"
27#include "octeon_nic.h"
28#include "octeon_main.h"
29#include "octeon_network.h"
30#include "cn66xx_regs.h"
31#include "cn66xx_device.h"
32#include "cn23xx_pf_device.h"
33#include "cn23xx_vf_device.h"
34
35static int lio_reset_queues(struct net_device *netdev, uint32_t num_qs);
36
37struct oct_intrmod_resp {
38	u64     rh;
39	struct oct_intrmod_cfg intrmod;
40	u64     status;
41};
42
43struct oct_mdio_cmd_resp {
44	u64 rh;
45	struct oct_mdio_cmd resp;
46	u64 status;
47};
48
49#define OCT_MDIO45_RESP_SIZE   (sizeof(struct oct_mdio_cmd_resp))
50
51/* Octeon's interface mode of operation */
52enum {
53	INTERFACE_MODE_DISABLED,
54	INTERFACE_MODE_RGMII,
55	INTERFACE_MODE_GMII,
56	INTERFACE_MODE_SPI,
57	INTERFACE_MODE_PCIE,
58	INTERFACE_MODE_XAUI,
59	INTERFACE_MODE_SGMII,
60	INTERFACE_MODE_PICMG,
61	INTERFACE_MODE_NPI,
62	INTERFACE_MODE_LOOP,
63	INTERFACE_MODE_SRIO,
64	INTERFACE_MODE_ILK,
65	INTERFACE_MODE_RXAUI,
66	INTERFACE_MODE_QSGMII,
67	INTERFACE_MODE_AGL,
68	INTERFACE_MODE_XLAUI,
69	INTERFACE_MODE_XFI,
70	INTERFACE_MODE_10G_KR,
71	INTERFACE_MODE_40G_KR4,
72	INTERFACE_MODE_MIXED,
73};
74
75#define OCT_ETHTOOL_REGDUMP_LEN  4096
76#define OCT_ETHTOOL_REGDUMP_LEN_23XX  (4096 * 11)
77#define OCT_ETHTOOL_REGDUMP_LEN_23XX_VF  (4096 * 2)
78#define OCT_ETHTOOL_REGSVER  1
79
80/* statistics of PF */
81static const char oct_stats_strings[][ETH_GSTRING_LEN] = {
82	"rx_packets",
83	"tx_packets",
84	"rx_bytes",
85	"tx_bytes",
86	"rx_errors",
87	"tx_errors",
88	"rx_dropped",
89	"tx_dropped",
90
91	"tx_total_sent",
92	"tx_total_fwd",
93	"tx_err_pko",
94	"tx_err_pki",
95	"tx_err_link",
96	"tx_err_drop",
97
98	"tx_tso",
99	"tx_tso_packets",
100	"tx_tso_err",
101	"tx_vxlan",
102
103	"tx_mcast",
104	"tx_bcast",
105
106	"mac_tx_total_pkts",
107	"mac_tx_total_bytes",
108	"mac_tx_mcast_pkts",
109	"mac_tx_bcast_pkts",
110	"mac_tx_ctl_packets",
111	"mac_tx_total_collisions",
112	"mac_tx_one_collision",
113	"mac_tx_multi_collision",
114	"mac_tx_max_collision_fail",
115	"mac_tx_max_deferral_fail",
116	"mac_tx_fifo_err",
117	"mac_tx_runts",
118
119	"rx_total_rcvd",
120	"rx_total_fwd",
121	"rx_mcast",
122	"rx_bcast",
123	"rx_jabber_err",
124	"rx_l2_err",
125	"rx_frame_err",
126	"rx_err_pko",
127	"rx_err_link",
128	"rx_err_drop",
129
130	"rx_vxlan",
131	"rx_vxlan_err",
132
133	"rx_lro_pkts",
134	"rx_lro_bytes",
135	"rx_total_lro",
136
137	"rx_lro_aborts",
138	"rx_lro_aborts_port",
139	"rx_lro_aborts_seq",
140	"rx_lro_aborts_tsval",
141	"rx_lro_aborts_timer",
142	"rx_fwd_rate",
143
144	"mac_rx_total_rcvd",
145	"mac_rx_bytes",
146	"mac_rx_total_bcst",
147	"mac_rx_total_mcst",
148	"mac_rx_runts",
149	"mac_rx_ctl_packets",
150	"mac_rx_fifo_err",
151	"mac_rx_dma_drop",
152	"mac_rx_fcs_err",
153
154	"link_state_changes",
155};
156
157/* statistics of VF */
158static const char oct_vf_stats_strings[][ETH_GSTRING_LEN] = {
159	"rx_packets",
160	"tx_packets",
161	"rx_bytes",
162	"tx_bytes",
163	"rx_errors",
164	"tx_errors",
165	"rx_dropped",
166	"tx_dropped",
167	"rx_mcast",
168	"tx_mcast",
169	"rx_bcast",
170	"tx_bcast",
171	"link_state_changes",
172};
173
174/* statistics of host tx queue */
175static const char oct_iq_stats_strings[][ETH_GSTRING_LEN] = {
176	"packets",
177	"bytes",
178	"dropped",
179	"iq_busy",
180	"sgentry_sent",
181
182	"fw_instr_posted",
183	"fw_instr_processed",
184	"fw_instr_dropped",
185	"fw_bytes_sent",
186
187	"tso",
188	"vxlan",
189	"txq_restart",
190};
191
192/* statistics of host rx queue */
193static const char oct_droq_stats_strings[][ETH_GSTRING_LEN] = {
194	"packets",
195	"bytes",
196	"dropped",
197	"dropped_nomem",
198	"dropped_toomany",
199	"fw_dropped",
200	"fw_pkts_received",
201	"fw_bytes_received",
202	"fw_dropped_nodispatch",
203
204	"vxlan",
205	"buffer_alloc_failure",
206};
207
208/* LiquidIO driver private flags */
209static const char oct_priv_flags_strings[][ETH_GSTRING_LEN] = {
210};
211
212#define OCTNIC_NCMD_AUTONEG_ON  0x1
213#define OCTNIC_NCMD_PHY_ON      0x2
214
215static int lio_get_link_ksettings(struct net_device *netdev,
216				  struct ethtool_link_ksettings *ecmd)
217{
218	struct lio *lio = GET_LIO(netdev);
219	struct octeon_device *oct = lio->oct_dev;
220	struct oct_link_info *linfo;
221
222	linfo = &lio->linfo;
223
224	ethtool_link_ksettings_zero_link_mode(ecmd, supported);
225	ethtool_link_ksettings_zero_link_mode(ecmd, advertising);
226
227	switch (linfo->link.s.phy_type) {
228	case LIO_PHY_PORT_TP:
229		ecmd->base.port = PORT_TP;
230		ecmd->base.autoneg = AUTONEG_DISABLE;
231		ethtool_link_ksettings_add_link_mode(ecmd, supported, TP);
232		ethtool_link_ksettings_add_link_mode(ecmd, supported, Pause);
233		ethtool_link_ksettings_add_link_mode(ecmd, supported,
234						     10000baseT_Full);
235
236		ethtool_link_ksettings_add_link_mode(ecmd, advertising, Pause);
237		ethtool_link_ksettings_add_link_mode(ecmd, advertising,
238						     10000baseT_Full);
239
240		break;
241
242	case LIO_PHY_PORT_FIBRE:
243		if (linfo->link.s.if_mode == INTERFACE_MODE_XAUI ||
244		    linfo->link.s.if_mode == INTERFACE_MODE_RXAUI ||
245		    linfo->link.s.if_mode == INTERFACE_MODE_XLAUI ||
246		    linfo->link.s.if_mode == INTERFACE_MODE_XFI) {
247			dev_dbg(&oct->pci_dev->dev, "ecmd->base.transceiver is XCVR_EXTERNAL\n");
248			ecmd->base.transceiver = XCVR_EXTERNAL;
249		} else {
250			dev_err(&oct->pci_dev->dev, "Unknown link interface mode: %d\n",
251				linfo->link.s.if_mode);
252		}
253
254		ecmd->base.port = PORT_FIBRE;
255		ecmd->base.autoneg = AUTONEG_DISABLE;
256		ethtool_link_ksettings_add_link_mode(ecmd, supported, FIBRE);
257
258		ethtool_link_ksettings_add_link_mode(ecmd, supported, Pause);
259		ethtool_link_ksettings_add_link_mode(ecmd, advertising, Pause);
260		if (oct->subsystem_id == OCTEON_CN2350_25GB_SUBSYS_ID ||
261		    oct->subsystem_id == OCTEON_CN2360_25GB_SUBSYS_ID) {
262			if (OCTEON_CN23XX_PF(oct)) {
263				ethtool_link_ksettings_add_link_mode
264					(ecmd, supported, 25000baseSR_Full);
265				ethtool_link_ksettings_add_link_mode
266					(ecmd, supported, 25000baseKR_Full);
267				ethtool_link_ksettings_add_link_mode
268					(ecmd, supported, 25000baseCR_Full);
269
270				if (oct->no_speed_setting == 0)  {
271					ethtool_link_ksettings_add_link_mode
272						(ecmd, supported,
273						 10000baseSR_Full);
274					ethtool_link_ksettings_add_link_mode
275						(ecmd, supported,
276						 10000baseKR_Full);
277					ethtool_link_ksettings_add_link_mode
278						(ecmd, supported,
279						 10000baseCR_Full);
280				}
281
282				if (oct->no_speed_setting == 0) {
283					liquidio_get_speed(lio);
284					liquidio_get_fec(lio);
285				} else {
286					oct->speed_setting = 25;
287				}
288
289				if (oct->speed_setting == 10) {
290					ethtool_link_ksettings_add_link_mode
291						(ecmd, advertising,
292						 10000baseSR_Full);
293					ethtool_link_ksettings_add_link_mode
294						(ecmd, advertising,
295						 10000baseKR_Full);
296					ethtool_link_ksettings_add_link_mode
297						(ecmd, advertising,
298						 10000baseCR_Full);
299				}
300				if (oct->speed_setting == 25) {
301					ethtool_link_ksettings_add_link_mode
302						(ecmd, advertising,
303						 25000baseSR_Full);
304					ethtool_link_ksettings_add_link_mode
305						(ecmd, advertising,
306						 25000baseKR_Full);
307					ethtool_link_ksettings_add_link_mode
308						(ecmd, advertising,
309						 25000baseCR_Full);
310				}
311
312				if (oct->no_speed_setting)
313					break;
314
315				ethtool_link_ksettings_add_link_mode
316					(ecmd, supported, FEC_RS);
317				ethtool_link_ksettings_add_link_mode
318					(ecmd, supported, FEC_NONE);
319					/*FEC_OFF*/
320				if (oct->props[lio->ifidx].fec == 1) {
321					/* ETHTOOL_FEC_RS */
322					ethtool_link_ksettings_add_link_mode
323						(ecmd, advertising, FEC_RS);
324				} else {
325					/* ETHTOOL_FEC_OFF */
326					ethtool_link_ksettings_add_link_mode
327						(ecmd, advertising, FEC_NONE);
328				}
329			} else { /* VF */
330				if (linfo->link.s.speed == 10000) {
331					ethtool_link_ksettings_add_link_mode
332						(ecmd, supported,
333						 10000baseSR_Full);
334					ethtool_link_ksettings_add_link_mode
335						(ecmd, supported,
336						 10000baseKR_Full);
337					ethtool_link_ksettings_add_link_mode
338						(ecmd, supported,
339						 10000baseCR_Full);
340
341					ethtool_link_ksettings_add_link_mode
342						(ecmd, advertising,
343						 10000baseSR_Full);
344					ethtool_link_ksettings_add_link_mode
345						(ecmd, advertising,
346						 10000baseKR_Full);
347					ethtool_link_ksettings_add_link_mode
348						(ecmd, advertising,
349						 10000baseCR_Full);
350				}
351
352				if (linfo->link.s.speed == 25000) {
353					ethtool_link_ksettings_add_link_mode
354						(ecmd, supported,
355						 25000baseSR_Full);
356					ethtool_link_ksettings_add_link_mode
357						(ecmd, supported,
358						 25000baseKR_Full);
359					ethtool_link_ksettings_add_link_mode
360						(ecmd, supported,
361						 25000baseCR_Full);
362
363					ethtool_link_ksettings_add_link_mode
364						(ecmd, advertising,
365						 25000baseSR_Full);
366					ethtool_link_ksettings_add_link_mode
367						(ecmd, advertising,
368						 25000baseKR_Full);
369					ethtool_link_ksettings_add_link_mode
370						(ecmd, advertising,
371						 25000baseCR_Full);
372				}
373			}
374		} else {
375			ethtool_link_ksettings_add_link_mode(ecmd, supported,
376							     10000baseT_Full);
377			ethtool_link_ksettings_add_link_mode(ecmd, advertising,
378							     10000baseT_Full);
379		}
380		break;
381	}
382
383	if (linfo->link.s.link_up) {
384		ecmd->base.speed = linfo->link.s.speed;
385		ecmd->base.duplex = linfo->link.s.duplex;
386	} else {
387		ecmd->base.speed = SPEED_UNKNOWN;
388		ecmd->base.duplex = DUPLEX_UNKNOWN;
389	}
390
391	return 0;
392}
393
394static int lio_set_link_ksettings(struct net_device *netdev,
395				  const struct ethtool_link_ksettings *ecmd)
396{
397	const int speed = ecmd->base.speed;
398	struct lio *lio = GET_LIO(netdev);
399	struct oct_link_info *linfo;
400	struct octeon_device *oct;
401
402	oct = lio->oct_dev;
403
404	linfo = &lio->linfo;
405
406	if (!(oct->subsystem_id == OCTEON_CN2350_25GB_SUBSYS_ID ||
407	      oct->subsystem_id == OCTEON_CN2360_25GB_SUBSYS_ID))
408		return -EOPNOTSUPP;
409
410	if (oct->no_speed_setting) {
411		dev_err(&oct->pci_dev->dev, "%s: Changing speed is not supported\n",
412			__func__);
413		return -EOPNOTSUPP;
414	}
415
416	if ((ecmd->base.duplex != DUPLEX_UNKNOWN &&
417	     ecmd->base.duplex != linfo->link.s.duplex) ||
418	     ecmd->base.autoneg != AUTONEG_DISABLE ||
419	    (ecmd->base.speed != 10000 && ecmd->base.speed != 25000 &&
420	     ecmd->base.speed != SPEED_UNKNOWN))
421		return -EOPNOTSUPP;
422
423	if ((oct->speed_boot == speed / 1000) &&
424	    oct->speed_boot == oct->speed_setting)
425		return 0;
426
427	liquidio_set_speed(lio, speed / 1000);
428
429	dev_dbg(&oct->pci_dev->dev, "Port speed is set to %dG\n",
430		oct->speed_setting);
431
432	return 0;
433}
434
435static void
436lio_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo)
437{
438	struct lio *lio;
439	struct octeon_device *oct;
440
441	lio = GET_LIO(netdev);
442	oct = lio->oct_dev;
443
444	memset(drvinfo, 0, sizeof(struct ethtool_drvinfo));
445	strscpy(drvinfo->driver, "liquidio", sizeof(drvinfo->driver));
446	strscpy(drvinfo->fw_version, oct->fw_info.liquidio_firmware_version,
447		sizeof(drvinfo->fw_version));
448	strscpy(drvinfo->bus_info, pci_name(oct->pci_dev),
449		sizeof(drvinfo->bus_info));
450}
451
452static void
453lio_get_vf_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo)
454{
455	struct octeon_device *oct;
456	struct lio *lio;
457
458	lio = GET_LIO(netdev);
459	oct = lio->oct_dev;
460
461	memset(drvinfo, 0, sizeof(struct ethtool_drvinfo));
462	strscpy(drvinfo->driver, "liquidio_vf", sizeof(drvinfo->driver));
463	strscpy(drvinfo->fw_version, oct->fw_info.liquidio_firmware_version,
464		sizeof(drvinfo->fw_version));
465	strscpy(drvinfo->bus_info, pci_name(oct->pci_dev),
466		sizeof(drvinfo->bus_info));
467}
468
469static int
470lio_send_queue_count_update(struct net_device *netdev, uint32_t num_queues)
471{
472	struct lio *lio = GET_LIO(netdev);
473	struct octeon_device *oct = lio->oct_dev;
474	struct octnic_ctrl_pkt nctrl;
475	int ret = 0;
476
477	memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
478
479	nctrl.ncmd.u64 = 0;
480	nctrl.ncmd.s.cmd = OCTNET_CMD_QUEUE_COUNT_CTL;
481	nctrl.ncmd.s.param1 = num_queues;
482	nctrl.ncmd.s.param2 = num_queues;
483	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
484	nctrl.netpndev = (u64)netdev;
485	nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
486
487	ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
488	if (ret) {
489		dev_err(&oct->pci_dev->dev, "Failed to send Queue reset command (ret: 0x%x)\n",
490			ret);
491		return -1;
492	}
493
494	return 0;
495}
496
497static void
498lio_ethtool_get_channels(struct net_device *dev,
499			 struct ethtool_channels *channel)
500{
501	struct lio *lio = GET_LIO(dev);
502	struct octeon_device *oct = lio->oct_dev;
503	u32 max_rx = 0, max_tx = 0, tx_count = 0, rx_count = 0;
504	u32 combined_count = 0, max_combined = 0;
505
506	if (OCTEON_CN6XXX(oct)) {
507		struct octeon_config *conf6x = CHIP_CONF(oct, cn6xxx);
508
509		max_rx = CFG_GET_OQ_MAX_Q(conf6x);
510		max_tx = CFG_GET_IQ_MAX_Q(conf6x);
511		rx_count = CFG_GET_NUM_RXQS_NIC_IF(conf6x, lio->ifidx);
512		tx_count = CFG_GET_NUM_TXQS_NIC_IF(conf6x, lio->ifidx);
513	} else if (OCTEON_CN23XX_PF(oct)) {
514		if (oct->sriov_info.sriov_enabled) {
515			max_combined = lio->linfo.num_txpciq;
516		} else {
517			struct octeon_config *conf23_pf =
518				CHIP_CONF(oct, cn23xx_pf);
519
520			max_combined = CFG_GET_IQ_MAX_Q(conf23_pf);
521		}
522		combined_count = oct->num_iqs;
523	} else if (OCTEON_CN23XX_VF(oct)) {
524		u64 reg_val = 0ULL;
525		u64 ctrl = CN23XX_VF_SLI_IQ_PKT_CONTROL64(0);
526
527		reg_val = octeon_read_csr64(oct, ctrl);
528		reg_val = reg_val >> CN23XX_PKT_INPUT_CTL_RPVF_POS;
529		max_combined = reg_val & CN23XX_PKT_INPUT_CTL_RPVF_MASK;
530		combined_count = oct->num_iqs;
531	}
532
533	channel->max_rx = max_rx;
534	channel->max_tx = max_tx;
535	channel->max_combined = max_combined;
536	channel->rx_count = rx_count;
537	channel->tx_count = tx_count;
538	channel->combined_count = combined_count;
539}
540
541static int
542lio_irq_reallocate_irqs(struct octeon_device *oct, uint32_t num_ioqs)
543{
544	struct msix_entry *msix_entries;
545	int num_msix_irqs = 0;
546	int i;
547
548	if (!oct->msix_on)
549		return 0;
550
551	/* Disable the input and output queues now. No more packets will
552	 * arrive from Octeon.
553	 */
554	oct->fn_list.disable_interrupt(oct, OCTEON_ALL_INTR);
555
556	if (oct->msix_on) {
557		if (OCTEON_CN23XX_PF(oct))
558			num_msix_irqs = oct->num_msix_irqs - 1;
559		else if (OCTEON_CN23XX_VF(oct))
560			num_msix_irqs = oct->num_msix_irqs;
561
562		msix_entries = (struct msix_entry *)oct->msix_entries;
563		for (i = 0; i < num_msix_irqs; i++) {
564			if (oct->ioq_vector[i].vector) {
565				/* clear the affinity_cpumask */
566				irq_set_affinity_hint(msix_entries[i].vector,
567						      NULL);
568				free_irq(msix_entries[i].vector,
569					 &oct->ioq_vector[i]);
570				oct->ioq_vector[i].vector = 0;
571			}
572		}
573
574		/* non-iov vector's argument is oct struct */
575		if (OCTEON_CN23XX_PF(oct))
576			free_irq(msix_entries[i].vector, oct);
577
578		pci_disable_msix(oct->pci_dev);
579		kfree(oct->msix_entries);
580		oct->msix_entries = NULL;
581	}
582
583	kfree(oct->irq_name_storage);
584	oct->irq_name_storage = NULL;
585
586	if (octeon_allocate_ioq_vector(oct, num_ioqs)) {
587		dev_err(&oct->pci_dev->dev, "OCTEON: ioq vector allocation failed\n");
588		return -1;
589	}
590
591	if (octeon_setup_interrupt(oct, num_ioqs)) {
592		dev_info(&oct->pci_dev->dev, "Setup interrupt failed\n");
593		return -1;
594	}
595
596	/* Enable Octeon device interrupts */
597	oct->fn_list.enable_interrupt(oct, OCTEON_ALL_INTR);
598
599	return 0;
600}
601
602static int
603lio_ethtool_set_channels(struct net_device *dev,
604			 struct ethtool_channels *channel)
605{
606	u32 combined_count, max_combined;
607	struct lio *lio = GET_LIO(dev);
608	struct octeon_device *oct = lio->oct_dev;
609	int stopped = 0;
610
611	if (strcmp(oct->fw_info.liquidio_firmware_version, "1.6.1") < 0) {
612		dev_err(&oct->pci_dev->dev, "Minimum firmware version required is 1.6.1\n");
613		return -EINVAL;
614	}
615
616	if (!channel->combined_count || channel->other_count ||
617	    channel->rx_count || channel->tx_count)
618		return -EINVAL;
619
620	combined_count = channel->combined_count;
621
622	if (OCTEON_CN23XX_PF(oct)) {
623		if (oct->sriov_info.sriov_enabled) {
624			max_combined = lio->linfo.num_txpciq;
625		} else {
626			struct octeon_config *conf23_pf =
627				CHIP_CONF(oct,
628					  cn23xx_pf);
629
630			max_combined =
631				CFG_GET_IQ_MAX_Q(conf23_pf);
632		}
633	} else if (OCTEON_CN23XX_VF(oct)) {
634		u64 reg_val = 0ULL;
635		u64 ctrl = CN23XX_VF_SLI_IQ_PKT_CONTROL64(0);
636
637		reg_val = octeon_read_csr64(oct, ctrl);
638		reg_val = reg_val >> CN23XX_PKT_INPUT_CTL_RPVF_POS;
639		max_combined = reg_val & CN23XX_PKT_INPUT_CTL_RPVF_MASK;
640	} else {
641		return -EINVAL;
642	}
643
644	if (combined_count > max_combined || combined_count < 1)
645		return -EINVAL;
646
647	if (combined_count == oct->num_iqs)
648		return 0;
649
650	ifstate_set(lio, LIO_IFSTATE_RESETTING);
651
652	if (netif_running(dev)) {
653		dev->netdev_ops->ndo_stop(dev);
654		stopped = 1;
655	}
656
657	if (lio_reset_queues(dev, combined_count))
658		return -EINVAL;
659
660	if (stopped)
661		dev->netdev_ops->ndo_open(dev);
662
663	ifstate_reset(lio, LIO_IFSTATE_RESETTING);
664
665	return 0;
666}
667
668static int lio_get_eeprom_len(struct net_device *netdev)
669{
670	u8 buf[192];
671	struct lio *lio = GET_LIO(netdev);
672	struct octeon_device *oct_dev = lio->oct_dev;
673	struct octeon_board_info *board_info;
674	int len;
675
676	board_info = (struct octeon_board_info *)(&oct_dev->boardinfo);
677	len = sprintf(buf, "boardname:%s serialnum:%s maj:%lld min:%lld\n",
678		      board_info->name, board_info->serial_number,
679		      board_info->major, board_info->minor);
680
681	return len;
682}
683
684static int
685lio_get_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom,
686	       u8 *bytes)
687{
688	struct lio *lio = GET_LIO(netdev);
689	struct octeon_device *oct_dev = lio->oct_dev;
690	struct octeon_board_info *board_info;
691
692	if (eeprom->offset)
693		return -EINVAL;
694
695	eeprom->magic = oct_dev->pci_dev->vendor;
696	board_info = (struct octeon_board_info *)(&oct_dev->boardinfo);
697	sprintf((char *)bytes,
698		"boardname:%s serialnum:%s maj:%lld min:%lld\n",
699		board_info->name, board_info->serial_number,
700		board_info->major, board_info->minor);
701
702	return 0;
703}
704
705static int octnet_gpio_access(struct net_device *netdev, int addr, int val)
706{
707	struct lio *lio = GET_LIO(netdev);
708	struct octeon_device *oct = lio->oct_dev;
709	struct octnic_ctrl_pkt nctrl;
710	int ret = 0;
711
712	memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
713
714	nctrl.ncmd.u64 = 0;
715	nctrl.ncmd.s.cmd = OCTNET_CMD_GPIO_ACCESS;
716	nctrl.ncmd.s.param1 = addr;
717	nctrl.ncmd.s.param2 = val;
718	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
719	nctrl.netpndev = (u64)netdev;
720	nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
721
722	ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
723	if (ret) {
724		dev_err(&oct->pci_dev->dev,
725			"Failed to configure gpio value, ret=%d\n", ret);
726		return -EINVAL;
727	}
728
729	return 0;
730}
731
732static int octnet_id_active(struct net_device *netdev, int val)
733{
734	struct lio *lio = GET_LIO(netdev);
735	struct octeon_device *oct = lio->oct_dev;
736	struct octnic_ctrl_pkt nctrl;
737	int ret = 0;
738
739	memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
740
741	nctrl.ncmd.u64 = 0;
742	nctrl.ncmd.s.cmd = OCTNET_CMD_ID_ACTIVE;
743	nctrl.ncmd.s.param1 = val;
744	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
745	nctrl.netpndev = (u64)netdev;
746	nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
747
748	ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
749	if (ret) {
750		dev_err(&oct->pci_dev->dev,
751			"Failed to configure gpio value, ret=%d\n", ret);
752		return -EINVAL;
753	}
754
755	return 0;
756}
757
758/* This routine provides PHY access routines for
759 * mdio  clause45 .
760 */
761static int
762octnet_mdio45_access(struct lio *lio, int op, int loc, int *value)
763{
764	struct octeon_device *oct_dev = lio->oct_dev;
765	struct octeon_soft_command *sc;
766	struct oct_mdio_cmd_resp *mdio_cmd_rsp;
767	struct oct_mdio_cmd *mdio_cmd;
768	int retval = 0;
769
770	sc = (struct octeon_soft_command *)
771		octeon_alloc_soft_command(oct_dev,
772					  sizeof(struct oct_mdio_cmd),
773					  sizeof(struct oct_mdio_cmd_resp), 0);
774
775	if (!sc)
776		return -ENOMEM;
777
778	mdio_cmd_rsp = (struct oct_mdio_cmd_resp *)sc->virtrptr;
779	mdio_cmd = (struct oct_mdio_cmd *)sc->virtdptr;
780
781	mdio_cmd->op = op;
782	mdio_cmd->mdio_addr = loc;
783	if (op)
784		mdio_cmd->value1 = *value;
785	octeon_swap_8B_data((u64 *)mdio_cmd, sizeof(struct oct_mdio_cmd) / 8);
786
787	sc->iq_no = lio->linfo.txpciq[0].s.q_no;
788
789	octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC, OPCODE_NIC_MDIO45,
790				    0, 0, 0);
791
792	init_completion(&sc->complete);
793	sc->sc_status = OCTEON_REQUEST_PENDING;
794
795	retval = octeon_send_soft_command(oct_dev, sc);
796	if (retval == IQ_SEND_FAILED) {
797		dev_err(&oct_dev->pci_dev->dev,
798			"octnet_mdio45_access instruction failed status: %x\n",
799			retval);
800		octeon_free_soft_command(oct_dev, sc);
801		return -EBUSY;
802	} else {
803		/* Sleep on a wait queue till the cond flag indicates that the
804		 * response arrived
805		 */
806		retval = wait_for_sc_completion_timeout(oct_dev, sc, 0);
807		if (retval)
808			return retval;
809
810		retval = mdio_cmd_rsp->status;
811		if (retval) {
812			dev_err(&oct_dev->pci_dev->dev,
813				"octnet mdio45 access failed: %x\n", retval);
814			WRITE_ONCE(sc->caller_is_done, true);
815			return -EBUSY;
816		}
817
818		octeon_swap_8B_data((u64 *)(&mdio_cmd_rsp->resp),
819				    sizeof(struct oct_mdio_cmd) / 8);
820
821		if (!op)
822			*value = mdio_cmd_rsp->resp.value1;
823
824		WRITE_ONCE(sc->caller_is_done, true);
825	}
826
827	return retval;
828}
829
830static int lio_set_phys_id(struct net_device *netdev,
831			   enum ethtool_phys_id_state state)
832{
833	struct lio *lio = GET_LIO(netdev);
834	struct octeon_device *oct = lio->oct_dev;
835	struct oct_link_info *linfo;
836	int value, ret;
837	u32 cur_ver;
838
839	linfo = &lio->linfo;
840	cur_ver = OCT_FW_VER(oct->fw_info.ver.maj,
841			     oct->fw_info.ver.min,
842			     oct->fw_info.ver.rev);
843
844	switch (state) {
845	case ETHTOOL_ID_ACTIVE:
846		if (oct->chip_id == OCTEON_CN66XX) {
847			octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
848					   VITESSE_PHY_GPIO_DRIVEON);
849			return 2;
850
851		} else if (oct->chip_id == OCTEON_CN68XX) {
852			/* Save the current LED settings */
853			ret = octnet_mdio45_access(lio, 0,
854						   LIO68XX_LED_BEACON_ADDR,
855						   &lio->phy_beacon_val);
856			if (ret)
857				return ret;
858
859			ret = octnet_mdio45_access(lio, 0,
860						   LIO68XX_LED_CTRL_ADDR,
861						   &lio->led_ctrl_val);
862			if (ret)
863				return ret;
864
865			/* Configure Beacon values */
866			value = LIO68XX_LED_BEACON_CFGON;
867			ret = octnet_mdio45_access(lio, 1,
868						   LIO68XX_LED_BEACON_ADDR,
869						   &value);
870			if (ret)
871				return ret;
872
873			value = LIO68XX_LED_CTRL_CFGON;
874			ret = octnet_mdio45_access(lio, 1,
875						   LIO68XX_LED_CTRL_ADDR,
876						   &value);
877			if (ret)
878				return ret;
879		} else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
880			octnet_id_active(netdev, LED_IDENTIFICATION_ON);
881			if (linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
882			    cur_ver > OCT_FW_VER(1, 7, 2))
883				return 2;
884			else
885				return 0;
886		} else {
887			return -EINVAL;
888		}
889		break;
890
891	case ETHTOOL_ID_ON:
892		if (oct->chip_id == OCTEON_CN23XX_PF_VID &&
893		    linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
894		    cur_ver > OCT_FW_VER(1, 7, 2))
895			octnet_id_active(netdev, LED_IDENTIFICATION_ON);
896		else if (oct->chip_id == OCTEON_CN66XX)
897			octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
898					   VITESSE_PHY_GPIO_HIGH);
899		else
900			return -EINVAL;
901
902		break;
903
904	case ETHTOOL_ID_OFF:
905		if (oct->chip_id == OCTEON_CN23XX_PF_VID &&
906		    linfo->link.s.phy_type == LIO_PHY_PORT_TP &&
907		    cur_ver > OCT_FW_VER(1, 7, 2))
908			octnet_id_active(netdev, LED_IDENTIFICATION_OFF);
909		else if (oct->chip_id == OCTEON_CN66XX)
910			octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
911					   VITESSE_PHY_GPIO_LOW);
912		else
913			return -EINVAL;
914
915		break;
916
917	case ETHTOOL_ID_INACTIVE:
918		if (oct->chip_id == OCTEON_CN66XX) {
919			octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
920					   VITESSE_PHY_GPIO_DRIVEOFF);
921		} else if (oct->chip_id == OCTEON_CN68XX) {
922			/* Restore LED settings */
923			ret = octnet_mdio45_access(lio, 1,
924						   LIO68XX_LED_CTRL_ADDR,
925						   &lio->led_ctrl_val);
926			if (ret)
927				return ret;
928
929			ret = octnet_mdio45_access(lio, 1,
930						   LIO68XX_LED_BEACON_ADDR,
931						   &lio->phy_beacon_val);
932			if (ret)
933				return ret;
934		} else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
935			octnet_id_active(netdev, LED_IDENTIFICATION_OFF);
936
937			return 0;
938		} else {
939			return -EINVAL;
940		}
941		break;
942
943	default:
944		return -EINVAL;
945	}
946
947	return 0;
948}
949
950static void
951lio_ethtool_get_ringparam(struct net_device *netdev,
952			  struct ethtool_ringparam *ering,
953			  struct kernel_ethtool_ringparam *kernel_ering,
954			  struct netlink_ext_ack *extack)
955{
956	struct lio *lio = GET_LIO(netdev);
957	struct octeon_device *oct = lio->oct_dev;
958	u32 tx_max_pending = 0, rx_max_pending = 0, tx_pending = 0,
959	    rx_pending = 0;
960
961	if (ifstate_check(lio, LIO_IFSTATE_RESETTING))
962		return;
963
964	if (OCTEON_CN6XXX(oct)) {
965		struct octeon_config *conf6x = CHIP_CONF(oct, cn6xxx);
966
967		tx_max_pending = CN6XXX_MAX_IQ_DESCRIPTORS;
968		rx_max_pending = CN6XXX_MAX_OQ_DESCRIPTORS;
969		rx_pending = CFG_GET_NUM_RX_DESCS_NIC_IF(conf6x, lio->ifidx);
970		tx_pending = CFG_GET_NUM_TX_DESCS_NIC_IF(conf6x, lio->ifidx);
971	} else if (OCTEON_CN23XX_PF(oct) || OCTEON_CN23XX_VF(oct)) {
972		tx_max_pending = CN23XX_MAX_IQ_DESCRIPTORS;
973		rx_max_pending = CN23XX_MAX_OQ_DESCRIPTORS;
974		rx_pending = oct->droq[0]->max_count;
975		tx_pending = oct->instr_queue[0]->max_count;
976	}
977
978	ering->tx_pending = tx_pending;
979	ering->tx_max_pending = tx_max_pending;
980	ering->rx_pending = rx_pending;
981	ering->rx_max_pending = rx_max_pending;
982	ering->rx_mini_pending = 0;
983	ering->rx_jumbo_pending = 0;
984	ering->rx_mini_max_pending = 0;
985	ering->rx_jumbo_max_pending = 0;
986}
987
988static int lio_23xx_reconfigure_queue_count(struct lio *lio)
989{
990	struct octeon_device *oct = lio->oct_dev;
991	u32 resp_size, data_size;
992	struct liquidio_if_cfg_resp *resp;
993	struct octeon_soft_command *sc;
994	union oct_nic_if_cfg if_cfg;
995	struct lio_version *vdata;
996	u32 ifidx_or_pfnum;
997	int retval;
998	int j;
999
1000	resp_size = sizeof(struct liquidio_if_cfg_resp);
1001	data_size = sizeof(struct lio_version);
1002	sc = (struct octeon_soft_command *)
1003		octeon_alloc_soft_command(oct, data_size,
1004					  resp_size, 0);
1005	if (!sc) {
1006		dev_err(&oct->pci_dev->dev, "%s: Failed to allocate soft command\n",
1007			__func__);
1008		return -1;
1009	}
1010
1011	resp = (struct liquidio_if_cfg_resp *)sc->virtrptr;
1012	vdata = (struct lio_version *)sc->virtdptr;
1013
1014	vdata->major = (__force u16)cpu_to_be16(LIQUIDIO_BASE_MAJOR_VERSION);
1015	vdata->minor = (__force u16)cpu_to_be16(LIQUIDIO_BASE_MINOR_VERSION);
1016	vdata->micro = (__force u16)cpu_to_be16(LIQUIDIO_BASE_MICRO_VERSION);
1017
1018	ifidx_or_pfnum = oct->pf_num;
1019
1020	if_cfg.u64 = 0;
1021	if_cfg.s.num_iqueues = oct->sriov_info.num_pf_rings;
1022	if_cfg.s.num_oqueues = oct->sriov_info.num_pf_rings;
1023	if_cfg.s.base_queue = oct->sriov_info.pf_srn;
1024	if_cfg.s.gmx_port_id = oct->pf_num;
1025
1026	sc->iq_no = 0;
1027	octeon_prepare_soft_command(oct, sc, OPCODE_NIC,
1028				    OPCODE_NIC_QCOUNT_UPDATE, 0,
1029				    if_cfg.u64, 0);
1030
1031	init_completion(&sc->complete);
1032	sc->sc_status = OCTEON_REQUEST_PENDING;
1033
1034	retval = octeon_send_soft_command(oct, sc);
1035	if (retval == IQ_SEND_FAILED) {
1036		dev_err(&oct->pci_dev->dev,
1037			"Sending iq/oq config failed status: %x\n",
1038			retval);
1039		octeon_free_soft_command(oct, sc);
1040		return -EIO;
1041	}
1042
1043	retval = wait_for_sc_completion_timeout(oct, sc, 0);
1044	if (retval)
1045		return retval;
1046
1047	retval = resp->status;
1048	if (retval) {
1049		dev_err(&oct->pci_dev->dev,
1050			"iq/oq config failed: %x\n", retval);
1051		WRITE_ONCE(sc->caller_is_done, true);
1052		return -1;
1053	}
1054
1055	octeon_swap_8B_data((u64 *)(&resp->cfg_info),
1056			    (sizeof(struct liquidio_if_cfg_info)) >> 3);
1057
1058	lio->ifidx = ifidx_or_pfnum;
1059	lio->linfo.num_rxpciq = hweight64(resp->cfg_info.iqmask);
1060	lio->linfo.num_txpciq = hweight64(resp->cfg_info.iqmask);
1061	for (j = 0; j < lio->linfo.num_rxpciq; j++) {
1062		lio->linfo.rxpciq[j].u64 =
1063			resp->cfg_info.linfo.rxpciq[j].u64;
1064	}
1065
1066	for (j = 0; j < lio->linfo.num_txpciq; j++) {
1067		lio->linfo.txpciq[j].u64 =
1068			resp->cfg_info.linfo.txpciq[j].u64;
1069	}
1070
1071	lio->linfo.hw_addr = resp->cfg_info.linfo.hw_addr;
1072	lio->linfo.gmxport = resp->cfg_info.linfo.gmxport;
1073	lio->linfo.link.u64 = resp->cfg_info.linfo.link.u64;
1074	lio->txq = lio->linfo.txpciq[0].s.q_no;
1075	lio->rxq = lio->linfo.rxpciq[0].s.q_no;
1076
1077	dev_info(&oct->pci_dev->dev, "Queue count updated to %d\n",
1078		 lio->linfo.num_rxpciq);
1079
1080	WRITE_ONCE(sc->caller_is_done, true);
1081
1082	return 0;
1083}
1084
1085static int lio_reset_queues(struct net_device *netdev, uint32_t num_qs)
1086{
1087	struct lio *lio = GET_LIO(netdev);
1088	struct octeon_device *oct = lio->oct_dev;
1089	int i, queue_count_update = 0;
1090	struct napi_struct *napi, *n;
1091	int ret;
1092
1093	schedule_timeout_uninterruptible(msecs_to_jiffies(100));
1094
1095	if (wait_for_pending_requests(oct))
1096		dev_err(&oct->pci_dev->dev, "There were pending requests\n");
1097
1098	if (lio_wait_for_instr_fetch(oct))
1099		dev_err(&oct->pci_dev->dev, "IQ had pending instructions\n");
1100
1101	if (octeon_set_io_queues_off(oct)) {
1102		dev_err(&oct->pci_dev->dev, "Setting io queues off failed\n");
1103		return -1;
1104	}
1105
1106	/* Disable the input and output queues now. No more packets will
1107	 * arrive from Octeon.
1108	 */
1109	oct->fn_list.disable_io_queues(oct);
1110	/* Delete NAPI */
1111	list_for_each_entry_safe(napi, n, &netdev->napi_list, dev_list)
1112		netif_napi_del(napi);
1113
1114	if (num_qs != oct->num_iqs) {
1115		ret = netif_set_real_num_rx_queues(netdev, num_qs);
1116		if (ret) {
1117			dev_err(&oct->pci_dev->dev,
1118				"Setting real number rx failed\n");
1119			return ret;
1120		}
1121
1122		ret = netif_set_real_num_tx_queues(netdev, num_qs);
1123		if (ret) {
1124			dev_err(&oct->pci_dev->dev,
1125				"Setting real number tx failed\n");
1126			return ret;
1127		}
1128
1129		/* The value of queue_count_update decides whether it is the
1130		 * queue count or the descriptor count that is being
1131		 * re-configured.
1132		 */
1133		queue_count_update = 1;
1134	}
1135
1136	/* Re-configuration of queues can happen in two scenarios, SRIOV enabled
1137	 * and SRIOV disabled. Few things like recreating queue zero, resetting
1138	 * glists and IRQs are required for both. For the latter, some more
1139	 * steps like updating sriov_info for the octeon device need to be done.
1140	 */
1141	if (queue_count_update) {
1142		cleanup_rx_oom_poll_fn(netdev);
1143
1144		lio_delete_glists(lio);
1145
1146		/* Delete mbox for PF which is SRIOV disabled because sriov_info
1147		 * will be now changed.
1148		 */
1149		if ((OCTEON_CN23XX_PF(oct)) && !oct->sriov_info.sriov_enabled)
1150			oct->fn_list.free_mbox(oct);
1151	}
1152
1153	for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct); i++) {
1154		if (!(oct->io_qmask.oq & BIT_ULL(i)))
1155			continue;
1156		octeon_delete_droq(oct, i);
1157	}
1158
1159	for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct); i++) {
1160		if (!(oct->io_qmask.iq & BIT_ULL(i)))
1161			continue;
1162		octeon_delete_instr_queue(oct, i);
1163	}
1164
1165	if (queue_count_update) {
1166		/* For PF re-configure sriov related information */
1167		if ((OCTEON_CN23XX_PF(oct)) &&
1168		    !oct->sriov_info.sriov_enabled) {
1169			oct->sriov_info.num_pf_rings = num_qs;
1170			if (cn23xx_sriov_config(oct)) {
1171				dev_err(&oct->pci_dev->dev,
1172					"Queue reset aborted: SRIOV config failed\n");
1173				return -1;
1174			}
1175
1176			num_qs = oct->sriov_info.num_pf_rings;
1177		}
1178	}
1179
1180	if (oct->fn_list.setup_device_regs(oct)) {
1181		dev_err(&oct->pci_dev->dev, "Failed to configure device registers\n");
1182		return -1;
1183	}
1184
1185	/* The following are needed in case of queue count re-configuration and
1186	 * not for descriptor count re-configuration.
1187	 */
1188	if (queue_count_update) {
1189		if (octeon_setup_instr_queues(oct))
1190			return -1;
1191
1192		if (octeon_setup_output_queues(oct))
1193			return -1;
1194
1195		/* Recreating mbox for PF that is SRIOV disabled */
1196		if (OCTEON_CN23XX_PF(oct) && !oct->sriov_info.sriov_enabled) {
1197			if (oct->fn_list.setup_mbox(oct)) {
1198				dev_err(&oct->pci_dev->dev, "Mailbox setup failed\n");
1199				return -1;
1200			}
1201		}
1202
1203		/* Deleting and recreating IRQs whether the interface is SRIOV
1204		 * enabled or disabled.
1205		 */
1206		if (lio_irq_reallocate_irqs(oct, num_qs)) {
1207			dev_err(&oct->pci_dev->dev, "IRQs could not be allocated\n");
1208			return -1;
1209		}
1210
1211		/* Enable the input and output queues for this Octeon device */
1212		if (oct->fn_list.enable_io_queues(oct)) {
1213			dev_err(&oct->pci_dev->dev, "Failed to enable input/output queues\n");
1214			return -1;
1215		}
1216
1217		for (i = 0; i < oct->num_oqs; i++)
1218			writel(oct->droq[i]->max_count,
1219			       oct->droq[i]->pkts_credit_reg);
1220
1221		/* Informing firmware about the new queue count. It is required
1222		 * for firmware to allocate more number of queues than those at
1223		 * load time.
1224		 */
1225		if (OCTEON_CN23XX_PF(oct) && !oct->sriov_info.sriov_enabled) {
1226			if (lio_23xx_reconfigure_queue_count(lio))
1227				return -1;
1228		}
1229	}
1230
1231	/* Once firmware is aware of the new value, queues can be recreated */
1232	if (liquidio_setup_io_queues(oct, 0, num_qs, num_qs)) {
1233		dev_err(&oct->pci_dev->dev, "I/O queues creation failed\n");
1234		return -1;
1235	}
1236
1237	if (queue_count_update) {
1238		if (lio_setup_glists(oct, lio, num_qs)) {
1239			dev_err(&oct->pci_dev->dev, "Gather list allocation failed\n");
1240			return -1;
1241		}
1242
1243		if (setup_rx_oom_poll_fn(netdev)) {
1244			dev_err(&oct->pci_dev->dev, "lio_setup_rx_oom_poll_fn failed\n");
1245			return 1;
1246		}
1247
1248		/* Send firmware the information about new number of queues
1249		 * if the interface is a VF or a PF that is SRIOV enabled.
1250		 */
1251		if (oct->sriov_info.sriov_enabled || OCTEON_CN23XX_VF(oct))
1252			if (lio_send_queue_count_update(netdev, num_qs))
1253				return -1;
1254	}
1255
1256	return 0;
1257}
1258
1259static int
1260lio_ethtool_set_ringparam(struct net_device *netdev,
1261			  struct ethtool_ringparam *ering,
1262			  struct kernel_ethtool_ringparam *kernel_ering,
1263			  struct netlink_ext_ack *extack)
1264{
1265	u32 rx_count, tx_count, rx_count_old, tx_count_old;
1266	struct lio *lio = GET_LIO(netdev);
1267	struct octeon_device *oct = lio->oct_dev;
1268	int stopped = 0;
1269
1270	if (!OCTEON_CN23XX_PF(oct) && !OCTEON_CN23XX_VF(oct))
1271		return -EINVAL;
1272
1273	if (ering->rx_mini_pending || ering->rx_jumbo_pending)
1274		return -EINVAL;
1275
1276	rx_count = clamp_t(u32, ering->rx_pending, CN23XX_MIN_OQ_DESCRIPTORS,
1277			   CN23XX_MAX_OQ_DESCRIPTORS);
1278	tx_count = clamp_t(u32, ering->tx_pending, CN23XX_MIN_IQ_DESCRIPTORS,
1279			   CN23XX_MAX_IQ_DESCRIPTORS);
1280
1281	rx_count_old = oct->droq[0]->max_count;
1282	tx_count_old = oct->instr_queue[0]->max_count;
1283
1284	if (rx_count == rx_count_old && tx_count == tx_count_old)
1285		return 0;
1286
1287	ifstate_set(lio, LIO_IFSTATE_RESETTING);
1288
1289	if (netif_running(netdev)) {
1290		netdev->netdev_ops->ndo_stop(netdev);
1291		stopped = 1;
1292	}
1293
1294	/* Change RX/TX DESCS  count */
1295	if (tx_count != tx_count_old)
1296		CFG_SET_NUM_TX_DESCS_NIC_IF(octeon_get_conf(oct), lio->ifidx,
1297					    tx_count);
1298	if (rx_count != rx_count_old)
1299		CFG_SET_NUM_RX_DESCS_NIC_IF(octeon_get_conf(oct), lio->ifidx,
1300					    rx_count);
1301
1302	if (lio_reset_queues(netdev, oct->num_iqs))
1303		goto err_lio_reset_queues;
1304
1305	if (stopped)
1306		netdev->netdev_ops->ndo_open(netdev);
1307
1308	ifstate_reset(lio, LIO_IFSTATE_RESETTING);
1309
1310	return 0;
1311
1312err_lio_reset_queues:
1313	if (tx_count != tx_count_old)
1314		CFG_SET_NUM_TX_DESCS_NIC_IF(octeon_get_conf(oct), lio->ifidx,
1315					    tx_count_old);
1316	if (rx_count != rx_count_old)
1317		CFG_SET_NUM_RX_DESCS_NIC_IF(octeon_get_conf(oct), lio->ifidx,
1318					    rx_count_old);
1319	return -EINVAL;
1320}
1321
1322static u32 lio_get_msglevel(struct net_device *netdev)
1323{
1324	struct lio *lio = GET_LIO(netdev);
1325
1326	return lio->msg_enable;
1327}
1328
1329static void lio_set_msglevel(struct net_device *netdev, u32 msglvl)
1330{
1331	struct lio *lio = GET_LIO(netdev);
1332
1333	if ((msglvl ^ lio->msg_enable) & NETIF_MSG_HW) {
1334		if (msglvl & NETIF_MSG_HW)
1335			liquidio_set_feature(netdev,
1336					     OCTNET_CMD_VERBOSE_ENABLE, 0);
1337		else
1338			liquidio_set_feature(netdev,
1339					     OCTNET_CMD_VERBOSE_DISABLE, 0);
1340	}
1341
1342	lio->msg_enable = msglvl;
1343}
1344
1345static void lio_vf_set_msglevel(struct net_device *netdev, u32 msglvl)
1346{
1347	struct lio *lio = GET_LIO(netdev);
1348
1349	lio->msg_enable = msglvl;
1350}
1351
1352static void
1353lio_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
1354{
1355	/* Notes: Not supporting any auto negotiation in these
1356	 * drivers. Just report pause frame support.
1357	 */
1358	struct lio *lio = GET_LIO(netdev);
1359	struct octeon_device *oct = lio->oct_dev;
1360
1361	pause->autoneg = 0;
1362
1363	pause->tx_pause = oct->tx_pause;
1364	pause->rx_pause = oct->rx_pause;
1365}
1366
1367static int
1368lio_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
1369{
1370	/* Notes: Not supporting any auto negotiation in these
1371	 * drivers.
1372	 */
1373	struct lio *lio = GET_LIO(netdev);
1374	struct octeon_device *oct = lio->oct_dev;
1375	struct octnic_ctrl_pkt nctrl;
1376	struct oct_link_info *linfo = &lio->linfo;
1377
1378	int ret = 0;
1379
1380	if (oct->chip_id != OCTEON_CN23XX_PF_VID)
1381		return -EINVAL;
1382
1383	if (linfo->link.s.duplex == 0) {
1384		/*no flow control for half duplex*/
1385		if (pause->rx_pause || pause->tx_pause)
1386			return -EINVAL;
1387	}
1388
1389	/*do not support autoneg of link flow control*/
1390	if (pause->autoneg == AUTONEG_ENABLE)
1391		return -EINVAL;
1392
1393	memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
1394
1395	nctrl.ncmd.u64 = 0;
1396	nctrl.ncmd.s.cmd = OCTNET_CMD_SET_FLOW_CTL;
1397	nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
1398	nctrl.netpndev = (u64)netdev;
1399	nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
1400
1401	if (pause->rx_pause) {
1402		/*enable rx pause*/
1403		nctrl.ncmd.s.param1 = 1;
1404	} else {
1405		/*disable rx pause*/
1406		nctrl.ncmd.s.param1 = 0;
1407	}
1408
1409	if (pause->tx_pause) {
1410		/*enable tx pause*/
1411		nctrl.ncmd.s.param2 = 1;
1412	} else {
1413		/*disable tx pause*/
1414		nctrl.ncmd.s.param2 = 0;
1415	}
1416
1417	ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
1418	if (ret) {
1419		dev_err(&oct->pci_dev->dev,
1420			"Failed to set pause parameter, ret=%d\n", ret);
1421		return -EINVAL;
1422	}
1423
1424	oct->rx_pause = pause->rx_pause;
1425	oct->tx_pause = pause->tx_pause;
1426
1427	return 0;
1428}
1429
1430static void
1431lio_get_ethtool_stats(struct net_device *netdev,
1432		      struct ethtool_stats *stats  __attribute__((unused)),
1433		      u64 *data)
1434{
1435	struct lio *lio = GET_LIO(netdev);
1436	struct octeon_device *oct_dev = lio->oct_dev;
1437	struct rtnl_link_stats64 lstats;
1438	int i = 0, j;
1439
1440	if (ifstate_check(lio, LIO_IFSTATE_RESETTING))
1441		return;
1442
1443	netdev->netdev_ops->ndo_get_stats64(netdev, &lstats);
1444	/*sum of oct->droq[oq_no]->stats->rx_pkts_received */
1445	data[i++] = lstats.rx_packets;
1446	/*sum of oct->instr_queue[iq_no]->stats.tx_done */
1447	data[i++] = lstats.tx_packets;
1448	/*sum of oct->droq[oq_no]->stats->rx_bytes_received */
1449	data[i++] = lstats.rx_bytes;
1450	/*sum of oct->instr_queue[iq_no]->stats.tx_tot_bytes */
1451	data[i++] = lstats.tx_bytes;
1452	data[i++] = lstats.rx_errors +
1453			oct_dev->link_stats.fromwire.fcs_err +
1454			oct_dev->link_stats.fromwire.jabber_err +
1455			oct_dev->link_stats.fromwire.l2_err +
1456			oct_dev->link_stats.fromwire.frame_err;
1457	data[i++] = lstats.tx_errors;
1458	/*sum of oct->droq[oq_no]->stats->rx_dropped +
1459	 *oct->droq[oq_no]->stats->dropped_nodispatch +
1460	 *oct->droq[oq_no]->stats->dropped_toomany +
1461	 *oct->droq[oq_no]->stats->dropped_nomem
1462	 */
1463	data[i++] = lstats.rx_dropped +
1464			oct_dev->link_stats.fromwire.fifo_err +
1465			oct_dev->link_stats.fromwire.dmac_drop +
1466			oct_dev->link_stats.fromwire.red_drops +
1467			oct_dev->link_stats.fromwire.fw_err_pko +
1468			oct_dev->link_stats.fromwire.fw_err_link +
1469			oct_dev->link_stats.fromwire.fw_err_drop;
1470	/*sum of oct->instr_queue[iq_no]->stats.tx_dropped */
1471	data[i++] = lstats.tx_dropped +
1472			oct_dev->link_stats.fromhost.max_collision_fail +
1473			oct_dev->link_stats.fromhost.max_deferral_fail +
1474			oct_dev->link_stats.fromhost.total_collisions +
1475			oct_dev->link_stats.fromhost.fw_err_pko +
1476			oct_dev->link_stats.fromhost.fw_err_link +
1477			oct_dev->link_stats.fromhost.fw_err_drop +
1478			oct_dev->link_stats.fromhost.fw_err_pki;
1479
1480	/* firmware tx stats */
1481	/*per_core_stats[cvmx_get_core_num()].link_stats[mdata->from_ifidx].
1482	 *fromhost.fw_total_sent
1483	 */
1484	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_total_sent);
1485	/*per_core_stats[i].link_stats[port].fromwire.fw_total_fwd */
1486	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_total_fwd);
1487	/*per_core_stats[j].link_stats[i].fromhost.fw_err_pko */
1488	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_pko);
1489	/*per_core_stats[j].link_stats[i].fromhost.fw_err_pki */
1490	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_pki);
1491	/*per_core_stats[j].link_stats[i].fromhost.fw_err_link */
1492	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_link);
1493	/*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
1494	 *fw_err_drop
1495	 */
1496	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_drop);
1497
1498	/*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.fw_tso */
1499	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tso);
1500	/*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
1501	 *fw_tso_fwd
1502	 */
1503	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tso_fwd);
1504	/*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
1505	 *fw_err_tso
1506	 */
1507	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_tso);
1508	/*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
1509	 *fw_tx_vxlan
1510	 */
1511	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tx_vxlan);
1512
1513	/* Multicast packets sent by this port */
1514	data[i++] = oct_dev->link_stats.fromhost.fw_total_mcast_sent;
1515	data[i++] = oct_dev->link_stats.fromhost.fw_total_bcast_sent;
1516
1517	/* mac tx statistics */
1518	/*CVMX_BGXX_CMRX_TX_STAT5 */
1519	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_pkts_sent);
1520	/*CVMX_BGXX_CMRX_TX_STAT4 */
1521	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_bytes_sent);
1522	/*CVMX_BGXX_CMRX_TX_STAT15 */
1523	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.mcast_pkts_sent);
1524	/*CVMX_BGXX_CMRX_TX_STAT14 */
1525	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.bcast_pkts_sent);
1526	/*CVMX_BGXX_CMRX_TX_STAT17 */
1527	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.ctl_sent);
1528	/*CVMX_BGXX_CMRX_TX_STAT0 */
1529	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_collisions);
1530	/*CVMX_BGXX_CMRX_TX_STAT3 */
1531	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.one_collision_sent);
1532	/*CVMX_BGXX_CMRX_TX_STAT2 */
1533	data[i++] =
1534		CVM_CAST64(oct_dev->link_stats.fromhost.multi_collision_sent);
1535	/*CVMX_BGXX_CMRX_TX_STAT0 */
1536	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.max_collision_fail);
1537	/*CVMX_BGXX_CMRX_TX_STAT1 */
1538	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.max_deferral_fail);
1539	/*CVMX_BGXX_CMRX_TX_STAT16 */
1540	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fifo_err);
1541	/*CVMX_BGXX_CMRX_TX_STAT6 */
1542	data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.runts);
1543
1544	/* RX firmware stats */
1545	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1546	 *fw_total_rcvd
1547	 */
1548	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_rcvd);
1549	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1550	 *fw_total_fwd
1551	 */
1552	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_fwd);
1553	/* Multicast packets received on this port */
1554	data[i++] = oct_dev->link_stats.fromwire.fw_total_mcast;
1555	data[i++] = oct_dev->link_stats.fromwire.fw_total_bcast;
1556	/*per_core_stats[core_id].link_stats[ifidx].fromwire.jabber_err */
1557	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.jabber_err);
1558	/*per_core_stats[core_id].link_stats[ifidx].fromwire.l2_err */
1559	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.l2_err);
1560	/*per_core_stats[core_id].link_stats[ifidx].fromwire.frame_err */
1561	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.frame_err);
1562	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1563	 *fw_err_pko
1564	 */
1565	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_pko);
1566	/*per_core_stats[j].link_stats[i].fromwire.fw_err_link */
1567	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_link);
1568	/*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
1569	 *fromwire.fw_err_drop
1570	 */
1571	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_drop);
1572
1573	/*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
1574	 *fromwire.fw_rx_vxlan
1575	 */
1576	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_rx_vxlan);
1577	/*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
1578	 *fromwire.fw_rx_vxlan_err
1579	 */
1580	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_rx_vxlan_err);
1581
1582	/* LRO */
1583	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1584	 *fw_lro_pkts
1585	 */
1586	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_pkts);
1587	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1588	 *fw_lro_octs
1589	 */
1590	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_octs);
1591	/*per_core_stats[j].link_stats[i].fromwire.fw_total_lro */
1592	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_lro);
1593	/*per_core_stats[j].link_stats[i].fromwire.fw_lro_aborts */
1594	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts);
1595	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1596	 *fw_lro_aborts_port
1597	 */
1598	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_port);
1599	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1600	 *fw_lro_aborts_seq
1601	 */
1602	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_seq);
1603	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1604	 *fw_lro_aborts_tsval
1605	 */
1606	data[i++] =
1607		CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_tsval);
1608	/*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
1609	 *fw_lro_aborts_timer
1610	 */
1611	/* intrmod: packet forward rate */
1612	data[i++] =
1613		CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_timer);
1614	/*per_core_stats[j].link_stats[i].fromwire.fw_lro_aborts */
1615	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fwd_rate);
1616
1617	/* mac: link-level stats */
1618	/*CVMX_BGXX_CMRX_RX_STAT0 */
1619	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_rcvd);
1620	/*CVMX_BGXX_CMRX_RX_STAT1 */
1621	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.bytes_rcvd);
1622	/*CVMX_PKI_STATX_STAT5 */
1623	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_bcst);
1624	/*CVMX_PKI_STATX_STAT5 */
1625	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_mcst);
1626	/*wqe->word2.err_code or wqe->word2.err_level */
1627	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.runts);
1628	/*CVMX_BGXX_CMRX_RX_STAT2 */
1629	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.ctl_rcvd);
1630	/*CVMX_BGXX_CMRX_RX_STAT6 */
1631	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fifo_err);
1632	/*CVMX_BGXX_CMRX_RX_STAT4 */
1633	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.dmac_drop);
1634	/*wqe->word2.err_code or wqe->word2.err_level */
1635	data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fcs_err);
1636	/*lio->link_changes*/
1637	data[i++] = CVM_CAST64(lio->link_changes);
1638
1639	for (j = 0; j < MAX_OCTEON_INSTR_QUEUES(oct_dev); j++) {
1640		if (!(oct_dev->io_qmask.iq & BIT_ULL(j)))
1641			continue;
1642		/*packets to network port*/
1643		/*# of packets tx to network */
1644		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_done);
1645		/*# of bytes tx to network */
1646		data[i++] =
1647			CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_tot_bytes);
1648		/*# of packets dropped */
1649		data[i++] =
1650			CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_dropped);
1651		/*# of tx fails due to queue full */
1652		data[i++] =
1653			CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_iq_busy);
1654		/*XXX gather entries sent */
1655		data[i++] =
1656			CVM_CAST64(oct_dev->instr_queue[j]->stats.sgentry_sent);
1657
1658		/*instruction to firmware: data and control */
1659		/*# of instructions to the queue */
1660		data[i++] =
1661			CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_posted);
1662		/*# of instructions processed */
1663		data[i++] = CVM_CAST64(
1664				oct_dev->instr_queue[j]->stats.instr_processed);
1665		/*# of instructions could not be processed */
1666		data[i++] = CVM_CAST64(
1667				oct_dev->instr_queue[j]->stats.instr_dropped);
1668		/*bytes sent through the queue */
1669		data[i++] =
1670			CVM_CAST64(oct_dev->instr_queue[j]->stats.bytes_sent);
1671
1672		/*tso request*/
1673		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_gso);
1674		/*vxlan request*/
1675		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_vxlan);
1676		/*txq restart*/
1677		data[i++] =
1678			CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_restart);
1679	}
1680
1681	/* RX */
1682	for (j = 0; j < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); j++) {
1683		if (!(oct_dev->io_qmask.oq & BIT_ULL(j)))
1684			continue;
1685
1686		/*packets send to TCP/IP network stack */
1687		/*# of packets to network stack */
1688		data[i++] =
1689			CVM_CAST64(oct_dev->droq[j]->stats.rx_pkts_received);
1690		/*# of bytes to network stack */
1691		data[i++] =
1692			CVM_CAST64(oct_dev->droq[j]->stats.rx_bytes_received);
1693		/*# of packets dropped */
1694		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem +
1695				       oct_dev->droq[j]->stats.dropped_toomany +
1696				       oct_dev->droq[j]->stats.rx_dropped);
1697		data[i++] =
1698			CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem);
1699		data[i++] =
1700			CVM_CAST64(oct_dev->droq[j]->stats.dropped_toomany);
1701		data[i++] =
1702			CVM_CAST64(oct_dev->droq[j]->stats.rx_dropped);
1703
1704		/*control and data path*/
1705		data[i++] =
1706			CVM_CAST64(oct_dev->droq[j]->stats.pkts_received);
1707		data[i++] =
1708			CVM_CAST64(oct_dev->droq[j]->stats.bytes_received);
1709		data[i++] =
1710			CVM_CAST64(oct_dev->droq[j]->stats.dropped_nodispatch);
1711
1712		data[i++] =
1713			CVM_CAST64(oct_dev->droq[j]->stats.rx_vxlan);
1714		data[i++] =
1715			CVM_CAST64(oct_dev->droq[j]->stats.rx_alloc_failure);
1716	}
1717}
1718
1719static void lio_vf_get_ethtool_stats(struct net_device *netdev,
1720				     struct ethtool_stats *stats
1721				     __attribute__((unused)),
1722				     u64 *data)
1723{
1724	struct rtnl_link_stats64 lstats;
1725	struct lio *lio = GET_LIO(netdev);
1726	struct octeon_device *oct_dev = lio->oct_dev;
1727	int i = 0, j, vj;
1728
1729	if (ifstate_check(lio, LIO_IFSTATE_RESETTING))
1730		return;
1731
1732	netdev->netdev_ops->ndo_get_stats64(netdev, &lstats);
1733	/* sum of oct->droq[oq_no]->stats->rx_pkts_received */
1734	data[i++] = lstats.rx_packets;
1735	/* sum of oct->instr_queue[iq_no]->stats.tx_done */
1736	data[i++] = lstats.tx_packets;
1737	/* sum of oct->droq[oq_no]->stats->rx_bytes_received */
1738	data[i++] = lstats.rx_bytes;
1739	/* sum of oct->instr_queue[iq_no]->stats.tx_tot_bytes */
1740	data[i++] = lstats.tx_bytes;
1741	data[i++] = lstats.rx_errors;
1742	data[i++] = lstats.tx_errors;
1743	 /* sum of oct->droq[oq_no]->stats->rx_dropped +
1744	  * oct->droq[oq_no]->stats->dropped_nodispatch +
1745	  * oct->droq[oq_no]->stats->dropped_toomany +
1746	  * oct->droq[oq_no]->stats->dropped_nomem
1747	  */
1748	data[i++] = lstats.rx_dropped;
1749	/* sum of oct->instr_queue[iq_no]->stats.tx_dropped */
1750	data[i++] = lstats.tx_dropped +
1751		oct_dev->link_stats.fromhost.fw_err_drop;
1752
1753	data[i++] = oct_dev->link_stats.fromwire.fw_total_mcast;
1754	data[i++] = oct_dev->link_stats.fromhost.fw_total_mcast_sent;
1755	data[i++] = oct_dev->link_stats.fromwire.fw_total_bcast;
1756	data[i++] = oct_dev->link_stats.fromhost.fw_total_bcast_sent;
1757
1758	/* lio->link_changes */
1759	data[i++] = CVM_CAST64(lio->link_changes);
1760
1761	for (vj = 0; vj < oct_dev->num_iqs; vj++) {
1762		j = lio->linfo.txpciq[vj].s.q_no;
1763
1764		/* packets to network port */
1765		/* # of packets tx to network */
1766		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_done);
1767		 /* # of bytes tx to network */
1768		data[i++] = CVM_CAST64(
1769				oct_dev->instr_queue[j]->stats.tx_tot_bytes);
1770		/* # of packets dropped */
1771		data[i++] = CVM_CAST64(
1772				oct_dev->instr_queue[j]->stats.tx_dropped);
1773		/* # of tx fails due to queue full */
1774		data[i++] = CVM_CAST64(
1775				oct_dev->instr_queue[j]->stats.tx_iq_busy);
1776		/* XXX gather entries sent */
1777		data[i++] = CVM_CAST64(
1778				oct_dev->instr_queue[j]->stats.sgentry_sent);
1779
1780		/* instruction to firmware: data and control */
1781		/* # of instructions to the queue */
1782		data[i++] = CVM_CAST64(
1783				oct_dev->instr_queue[j]->stats.instr_posted);
1784		/* # of instructions processed */
1785		data[i++] =
1786		    CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_processed);
1787		/* # of instructions could not be processed */
1788		data[i++] =
1789		    CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_dropped);
1790		/* bytes sent through the queue */
1791		data[i++] = CVM_CAST64(
1792				oct_dev->instr_queue[j]->stats.bytes_sent);
1793		/* tso request */
1794		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_gso);
1795		/* vxlan request */
1796		data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_vxlan);
1797		/* txq restart */
1798		data[i++] = CVM_CAST64(
1799				oct_dev->instr_queue[j]->stats.tx_restart);
1800	}
1801
1802	/* RX */
1803	for (vj = 0; vj < oct_dev->num_oqs; vj++) {
1804		j = lio->linfo.rxpciq[vj].s.q_no;
1805
1806		/* packets send to TCP/IP network stack */
1807		/* # of packets to network stack */
1808		data[i++] = CVM_CAST64(
1809				oct_dev->droq[j]->stats.rx_pkts_received);
1810		/* # of bytes to network stack */
1811		data[i++] = CVM_CAST64(
1812				oct_dev->droq[j]->stats.rx_bytes_received);
1813		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem +
1814				       oct_dev->droq[j]->stats.dropped_toomany +
1815				       oct_dev->droq[j]->stats.rx_dropped);
1816		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem);
1817		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_toomany);
1818		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.rx_dropped);
1819
1820		/* control and data path */
1821		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.pkts_received);
1822		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.bytes_received);
1823		data[i++] =
1824			CVM_CAST64(oct_dev->droq[j]->stats.dropped_nodispatch);
1825
1826		data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.rx_vxlan);
1827		data[i++] =
1828		    CVM_CAST64(oct_dev->droq[j]->stats.rx_alloc_failure);
1829	}
1830}
1831
1832static void lio_get_priv_flags_strings(struct lio *lio, u8 *data)
1833{
1834	struct octeon_device *oct_dev = lio->oct_dev;
1835	int i;
1836
1837	switch (oct_dev->chip_id) {
1838	case OCTEON_CN23XX_PF_VID:
1839	case OCTEON_CN23XX_VF_VID:
1840		for (i = 0; i < ARRAY_SIZE(oct_priv_flags_strings); i++) {
1841			sprintf(data, "%s", oct_priv_flags_strings[i]);
1842			data += ETH_GSTRING_LEN;
1843		}
1844		break;
1845	case OCTEON_CN68XX:
1846	case OCTEON_CN66XX:
1847		break;
1848	default:
1849		netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
1850		break;
1851	}
1852}
1853
1854static void lio_get_strings(struct net_device *netdev, u32 stringset, u8 *data)
1855{
1856	struct lio *lio = GET_LIO(netdev);
1857	struct octeon_device *oct_dev = lio->oct_dev;
1858	int num_iq_stats, num_oq_stats, i, j;
1859	int num_stats;
1860
1861	switch (stringset) {
1862	case ETH_SS_STATS:
1863		num_stats = ARRAY_SIZE(oct_stats_strings);
1864		for (j = 0; j < num_stats; j++) {
1865			sprintf(data, "%s", oct_stats_strings[j]);
1866			data += ETH_GSTRING_LEN;
1867		}
1868
1869		num_iq_stats = ARRAY_SIZE(oct_iq_stats_strings);
1870		for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct_dev); i++) {
1871			if (!(oct_dev->io_qmask.iq & BIT_ULL(i)))
1872				continue;
1873			for (j = 0; j < num_iq_stats; j++) {
1874				sprintf(data, "tx-%d-%s", i,
1875					oct_iq_stats_strings[j]);
1876				data += ETH_GSTRING_LEN;
1877			}
1878		}
1879
1880		num_oq_stats = ARRAY_SIZE(oct_droq_stats_strings);
1881		for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); i++) {
1882			if (!(oct_dev->io_qmask.oq & BIT_ULL(i)))
1883				continue;
1884			for (j = 0; j < num_oq_stats; j++) {
1885				sprintf(data, "rx-%d-%s", i,
1886					oct_droq_stats_strings[j]);
1887				data += ETH_GSTRING_LEN;
1888			}
1889		}
1890		break;
1891
1892	case ETH_SS_PRIV_FLAGS:
1893		lio_get_priv_flags_strings(lio, data);
1894		break;
1895	default:
1896		netif_info(lio, drv, lio->netdev, "Unknown Stringset !!\n");
1897		break;
1898	}
1899}
1900
1901static void lio_vf_get_strings(struct net_device *netdev, u32 stringset,
1902			       u8 *data)
1903{
1904	int num_iq_stats, num_oq_stats, i, j;
1905	struct lio *lio = GET_LIO(netdev);
1906	struct octeon_device *oct_dev = lio->oct_dev;
1907	int num_stats;
1908
1909	switch (stringset) {
1910	case ETH_SS_STATS:
1911		num_stats = ARRAY_SIZE(oct_vf_stats_strings);
1912		for (j = 0; j < num_stats; j++) {
1913			sprintf(data, "%s", oct_vf_stats_strings[j]);
1914			data += ETH_GSTRING_LEN;
1915		}
1916
1917		num_iq_stats = ARRAY_SIZE(oct_iq_stats_strings);
1918		for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct_dev); i++) {
1919			if (!(oct_dev->io_qmask.iq & BIT_ULL(i)))
1920				continue;
1921			for (j = 0; j < num_iq_stats; j++) {
1922				sprintf(data, "tx-%d-%s", i,
1923					oct_iq_stats_strings[j]);
1924				data += ETH_GSTRING_LEN;
1925			}
1926		}
1927
1928		num_oq_stats = ARRAY_SIZE(oct_droq_stats_strings);
1929		for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); i++) {
1930			if (!(oct_dev->io_qmask.oq & BIT_ULL(i)))
1931				continue;
1932			for (j = 0; j < num_oq_stats; j++) {
1933				sprintf(data, "rx-%d-%s", i,
1934					oct_droq_stats_strings[j]);
1935				data += ETH_GSTRING_LEN;
1936			}
1937		}
1938		break;
1939
1940	case ETH_SS_PRIV_FLAGS:
1941		lio_get_priv_flags_strings(lio, data);
1942		break;
1943	default:
1944		netif_info(lio, drv, lio->netdev, "Unknown Stringset !!\n");
1945		break;
1946	}
1947}
1948
1949static int lio_get_priv_flags_ss_count(struct lio *lio)
1950{
1951	struct octeon_device *oct_dev = lio->oct_dev;
1952
1953	switch (oct_dev->chip_id) {
1954	case OCTEON_CN23XX_PF_VID:
1955	case OCTEON_CN23XX_VF_VID:
1956		return ARRAY_SIZE(oct_priv_flags_strings);
1957	case OCTEON_CN68XX:
1958	case OCTEON_CN66XX:
1959		return -EOPNOTSUPP;
1960	default:
1961		netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
1962		return -EOPNOTSUPP;
1963	}
1964}
1965
1966static int lio_get_sset_count(struct net_device *netdev, int sset)
1967{
1968	struct lio *lio = GET_LIO(netdev);
1969	struct octeon_device *oct_dev = lio->oct_dev;
1970
1971	switch (sset) {
1972	case ETH_SS_STATS:
1973		return (ARRAY_SIZE(oct_stats_strings) +
1974			ARRAY_SIZE(oct_iq_stats_strings) * oct_dev->num_iqs +
1975			ARRAY_SIZE(oct_droq_stats_strings) * oct_dev->num_oqs);
1976	case ETH_SS_PRIV_FLAGS:
1977		return lio_get_priv_flags_ss_count(lio);
1978	default:
1979		return -EOPNOTSUPP;
1980	}
1981}
1982
1983static int lio_vf_get_sset_count(struct net_device *netdev, int sset)
1984{
1985	struct lio *lio = GET_LIO(netdev);
1986	struct octeon_device *oct_dev = lio->oct_dev;
1987
1988	switch (sset) {
1989	case ETH_SS_STATS:
1990		return (ARRAY_SIZE(oct_vf_stats_strings) +
1991			ARRAY_SIZE(oct_iq_stats_strings) * oct_dev->num_iqs +
1992			ARRAY_SIZE(oct_droq_stats_strings) * oct_dev->num_oqs);
1993	case ETH_SS_PRIV_FLAGS:
1994		return lio_get_priv_flags_ss_count(lio);
1995	default:
1996		return -EOPNOTSUPP;
1997	}
1998}
1999
2000/*  get interrupt moderation parameters */
2001static int octnet_get_intrmod_cfg(struct lio *lio,
2002				  struct oct_intrmod_cfg *intr_cfg)
2003{
2004	struct octeon_soft_command *sc;
2005	struct oct_intrmod_resp *resp;
2006	int retval;
2007	struct octeon_device *oct_dev = lio->oct_dev;
2008
2009	/* Alloc soft command */
2010	sc = (struct octeon_soft_command *)
2011		octeon_alloc_soft_command(oct_dev,
2012					  0,
2013					  sizeof(struct oct_intrmod_resp), 0);
2014
2015	if (!sc)
2016		return -ENOMEM;
2017
2018	resp = (struct oct_intrmod_resp *)sc->virtrptr;
2019	memset(resp, 0, sizeof(struct oct_intrmod_resp));
2020
2021	sc->iq_no = lio->linfo.txpciq[0].s.q_no;
2022
2023	octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC,
2024				    OPCODE_NIC_INTRMOD_PARAMS, 0, 0, 0);
2025
2026	init_completion(&sc->complete);
2027	sc->sc_status = OCTEON_REQUEST_PENDING;
2028
2029	retval = octeon_send_soft_command(oct_dev, sc);
2030	if (retval == IQ_SEND_FAILED) {
2031		octeon_free_soft_command(oct_dev, sc);
2032		return -EINVAL;
2033	}
2034
2035	/* Sleep on a wait queue till the cond flag indicates that the
2036	 * response arrived or timed-out.
2037	 */
2038	retval = wait_for_sc_completion_timeout(oct_dev, sc, 0);
2039	if (retval)
2040		return -ENODEV;
2041
2042	if (resp->status) {
2043		dev_err(&oct_dev->pci_dev->dev,
2044			"Get interrupt moderation parameters failed\n");
2045		WRITE_ONCE(sc->caller_is_done, true);
2046		return -ENODEV;
2047	}
2048
2049	octeon_swap_8B_data((u64 *)&resp->intrmod,
2050			    (sizeof(struct oct_intrmod_cfg)) / 8);
2051	memcpy(intr_cfg, &resp->intrmod, sizeof(struct oct_intrmod_cfg));
2052	WRITE_ONCE(sc->caller_is_done, true);
2053
2054	return 0;
2055}
2056
2057/*  Configure interrupt moderation parameters */
2058static int octnet_set_intrmod_cfg(struct lio *lio,
2059				  struct oct_intrmod_cfg *intr_cfg)
2060{
2061	struct octeon_soft_command *sc;
2062	struct oct_intrmod_cfg *cfg;
2063	int retval;
2064	struct octeon_device *oct_dev = lio->oct_dev;
2065
2066	/* Alloc soft command */
2067	sc = (struct octeon_soft_command *)
2068		octeon_alloc_soft_command(oct_dev,
2069					  sizeof(struct oct_intrmod_cfg),
2070					  16, 0);
2071
2072	if (!sc)
2073		return -ENOMEM;
2074
2075	cfg = (struct oct_intrmod_cfg *)sc->virtdptr;
2076
2077	memcpy(cfg, intr_cfg, sizeof(struct oct_intrmod_cfg));
2078	octeon_swap_8B_data((u64 *)cfg, (sizeof(struct oct_intrmod_cfg)) / 8);
2079
2080	sc->iq_no = lio->linfo.txpciq[0].s.q_no;
2081
2082	octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC,
2083				    OPCODE_NIC_INTRMOD_CFG, 0, 0, 0);
2084
2085	init_completion(&sc->complete);
2086	sc->sc_status = OCTEON_REQUEST_PENDING;
2087
2088	retval = octeon_send_soft_command(oct_dev, sc);
2089	if (retval == IQ_SEND_FAILED) {
2090		octeon_free_soft_command(oct_dev, sc);
2091		return -EINVAL;
2092	}
2093
2094	/* Sleep on a wait queue till the cond flag indicates that the
2095	 * response arrived or timed-out.
2096	 */
2097	retval = wait_for_sc_completion_timeout(oct_dev, sc, 0);
2098	if (retval)
2099		return retval;
2100
2101	retval = sc->sc_status;
2102	if (retval == 0) {
2103		dev_info(&oct_dev->pci_dev->dev,
2104			 "Rx-Adaptive Interrupt moderation %s\n",
2105			 (intr_cfg->rx_enable) ?
2106			 "enabled" : "disabled");
2107		WRITE_ONCE(sc->caller_is_done, true);
2108		return 0;
2109	}
2110
2111	dev_err(&oct_dev->pci_dev->dev,
2112		"intrmod config failed. Status: %x\n", retval);
2113	WRITE_ONCE(sc->caller_is_done, true);
2114	return -ENODEV;
2115}
2116
2117static int lio_get_intr_coalesce(struct net_device *netdev,
2118				 struct ethtool_coalesce *intr_coal,
2119				 struct kernel_ethtool_coalesce *kernel_coal,
2120				 struct netlink_ext_ack *extack)
2121{
2122	struct lio *lio = GET_LIO(netdev);
2123	struct octeon_device *oct = lio->oct_dev;
2124	struct octeon_instr_queue *iq;
2125	struct oct_intrmod_cfg intrmod_cfg;
2126
2127	if (octnet_get_intrmod_cfg(lio, &intrmod_cfg))
2128		return -ENODEV;
2129
2130	switch (oct->chip_id) {
2131	case OCTEON_CN23XX_PF_VID:
2132	case OCTEON_CN23XX_VF_VID: {
2133		if (!intrmod_cfg.rx_enable) {
2134			intr_coal->rx_coalesce_usecs = oct->rx_coalesce_usecs;
2135			intr_coal->rx_max_coalesced_frames =
2136				oct->rx_max_coalesced_frames;
2137		}
2138		if (!intrmod_cfg.tx_enable)
2139			intr_coal->tx_max_coalesced_frames =
2140				oct->tx_max_coalesced_frames;
2141		break;
2142	}
2143	case OCTEON_CN68XX:
2144	case OCTEON_CN66XX: {
2145		struct octeon_cn6xxx *cn6xxx =
2146			(struct octeon_cn6xxx *)oct->chip;
2147
2148		if (!intrmod_cfg.rx_enable) {
2149			intr_coal->rx_coalesce_usecs =
2150				CFG_GET_OQ_INTR_TIME(cn6xxx->conf);
2151			intr_coal->rx_max_coalesced_frames =
2152				CFG_GET_OQ_INTR_PKT(cn6xxx->conf);
2153		}
2154		iq = oct->instr_queue[lio->linfo.txpciq[0].s.q_no];
2155		intr_coal->tx_max_coalesced_frames = iq->fill_threshold;
2156		break;
2157	}
2158	default:
2159		netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
2160		return -EINVAL;
2161	}
2162	if (intrmod_cfg.rx_enable) {
2163		intr_coal->use_adaptive_rx_coalesce =
2164			intrmod_cfg.rx_enable;
2165		intr_coal->rate_sample_interval =
2166			intrmod_cfg.check_intrvl;
2167		intr_coal->pkt_rate_high =
2168			intrmod_cfg.maxpkt_ratethr;
2169		intr_coal->pkt_rate_low =
2170			intrmod_cfg.minpkt_ratethr;
2171		intr_coal->rx_max_coalesced_frames_high =
2172			intrmod_cfg.rx_maxcnt_trigger;
2173		intr_coal->rx_coalesce_usecs_high =
2174			intrmod_cfg.rx_maxtmr_trigger;
2175		intr_coal->rx_coalesce_usecs_low =
2176			intrmod_cfg.rx_mintmr_trigger;
2177		intr_coal->rx_max_coalesced_frames_low =
2178			intrmod_cfg.rx_mincnt_trigger;
2179	}
2180	if ((OCTEON_CN23XX_PF(oct) || OCTEON_CN23XX_VF(oct)) &&
2181	    (intrmod_cfg.tx_enable)) {
2182		intr_coal->use_adaptive_tx_coalesce =
2183			intrmod_cfg.tx_enable;
2184		intr_coal->tx_max_coalesced_frames_high =
2185			intrmod_cfg.tx_maxcnt_trigger;
2186		intr_coal->tx_max_coalesced_frames_low =
2187			intrmod_cfg.tx_mincnt_trigger;
2188	}
2189	return 0;
2190}
2191
2192/* Enable/Disable auto interrupt Moderation */
2193static int oct_cfg_adaptive_intr(struct lio *lio,
2194				 struct oct_intrmod_cfg *intrmod_cfg,
2195				 struct ethtool_coalesce *intr_coal)
2196{
2197	int ret = 0;
2198
2199	if (intrmod_cfg->rx_enable || intrmod_cfg->tx_enable) {
2200		intrmod_cfg->check_intrvl = intr_coal->rate_sample_interval;
2201		intrmod_cfg->maxpkt_ratethr = intr_coal->pkt_rate_high;
2202		intrmod_cfg->minpkt_ratethr = intr_coal->pkt_rate_low;
2203	}
2204	if (intrmod_cfg->rx_enable) {
2205		intrmod_cfg->rx_maxcnt_trigger =
2206			intr_coal->rx_max_coalesced_frames_high;
2207		intrmod_cfg->rx_maxtmr_trigger =
2208			intr_coal->rx_coalesce_usecs_high;
2209		intrmod_cfg->rx_mintmr_trigger =
2210			intr_coal->rx_coalesce_usecs_low;
2211		intrmod_cfg->rx_mincnt_trigger =
2212			intr_coal->rx_max_coalesced_frames_low;
2213	}
2214	if (intrmod_cfg->tx_enable) {
2215		intrmod_cfg->tx_maxcnt_trigger =
2216			intr_coal->tx_max_coalesced_frames_high;
2217		intrmod_cfg->tx_mincnt_trigger =
2218			intr_coal->tx_max_coalesced_frames_low;
2219	}
2220
2221	ret = octnet_set_intrmod_cfg(lio, intrmod_cfg);
2222
2223	return ret;
2224}
2225
2226static int
2227oct_cfg_rx_intrcnt(struct lio *lio,
2228		   struct oct_intrmod_cfg *intrmod,
2229		   struct ethtool_coalesce *intr_coal)
2230{
2231	struct octeon_device *oct = lio->oct_dev;
2232	u32 rx_max_coalesced_frames;
2233
2234	/* Config Cnt based interrupt values */
2235	switch (oct->chip_id) {
2236	case OCTEON_CN68XX:
2237	case OCTEON_CN66XX: {
2238		struct octeon_cn6xxx *cn6xxx =
2239			(struct octeon_cn6xxx *)oct->chip;
2240
2241		if (!intr_coal->rx_max_coalesced_frames)
2242			rx_max_coalesced_frames = CN6XXX_OQ_INTR_PKT;
2243		else
2244			rx_max_coalesced_frames =
2245				intr_coal->rx_max_coalesced_frames;
2246		octeon_write_csr(oct, CN6XXX_SLI_OQ_INT_LEVEL_PKTS,
2247				 rx_max_coalesced_frames);
2248		CFG_SET_OQ_INTR_PKT(cn6xxx->conf, rx_max_coalesced_frames);
2249		break;
2250	}
2251	case OCTEON_CN23XX_PF_VID: {
2252		int q_no;
2253
2254		if (!intr_coal->rx_max_coalesced_frames)
2255			rx_max_coalesced_frames = intrmod->rx_frames;
2256		else
2257			rx_max_coalesced_frames =
2258			    intr_coal->rx_max_coalesced_frames;
2259		for (q_no = 0; q_no < oct->num_oqs; q_no++) {
2260			q_no += oct->sriov_info.pf_srn;
2261			octeon_write_csr64(
2262			    oct, CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
2263			    (octeon_read_csr64(
2264				 oct, CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no)) &
2265			     (0x3fffff00000000UL)) |
2266				(rx_max_coalesced_frames - 1));
2267			/*consider setting resend bit*/
2268		}
2269		intrmod->rx_frames = rx_max_coalesced_frames;
2270		oct->rx_max_coalesced_frames = rx_max_coalesced_frames;
2271		break;
2272	}
2273	case OCTEON_CN23XX_VF_VID: {
2274		int q_no;
2275
2276		if (!intr_coal->rx_max_coalesced_frames)
2277			rx_max_coalesced_frames = intrmod->rx_frames;
2278		else
2279			rx_max_coalesced_frames =
2280			    intr_coal->rx_max_coalesced_frames;
2281		for (q_no = 0; q_no < oct->num_oqs; q_no++) {
2282			octeon_write_csr64(
2283			    oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no),
2284			    (octeon_read_csr64(
2285				 oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no)) &
2286			     (0x3fffff00000000UL)) |
2287				(rx_max_coalesced_frames - 1));
2288			/*consider writing to resend bit here*/
2289		}
2290		intrmod->rx_frames = rx_max_coalesced_frames;
2291		oct->rx_max_coalesced_frames = rx_max_coalesced_frames;
2292		break;
2293	}
2294	default:
2295		return -EINVAL;
2296	}
2297	return 0;
2298}
2299
2300static int oct_cfg_rx_intrtime(struct lio *lio,
2301			       struct oct_intrmod_cfg *intrmod,
2302			       struct ethtool_coalesce *intr_coal)
2303{
2304	struct octeon_device *oct = lio->oct_dev;
2305	u32 time_threshold, rx_coalesce_usecs;
2306
2307	/* Config Time based interrupt values */
2308	switch (oct->chip_id) {
2309	case OCTEON_CN68XX:
2310	case OCTEON_CN66XX: {
2311		struct octeon_cn6xxx *cn6xxx =
2312			(struct octeon_cn6xxx *)oct->chip;
2313		if (!intr_coal->rx_coalesce_usecs)
2314			rx_coalesce_usecs = CN6XXX_OQ_INTR_TIME;
2315		else
2316			rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
2317
2318		time_threshold = lio_cn6xxx_get_oq_ticks(oct,
2319							 rx_coalesce_usecs);
2320		octeon_write_csr(oct,
2321				 CN6XXX_SLI_OQ_INT_LEVEL_TIME,
2322				 time_threshold);
2323
2324		CFG_SET_OQ_INTR_TIME(cn6xxx->conf, rx_coalesce_usecs);
2325		break;
2326	}
2327	case OCTEON_CN23XX_PF_VID: {
2328		u64 time_threshold;
2329		int q_no;
2330
2331		if (!intr_coal->rx_coalesce_usecs)
2332			rx_coalesce_usecs = intrmod->rx_usecs;
2333		else
2334			rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
2335		time_threshold =
2336		    cn23xx_pf_get_oq_ticks(oct, (u32)rx_coalesce_usecs);
2337		for (q_no = 0; q_no < oct->num_oqs; q_no++) {
2338			q_no += oct->sriov_info.pf_srn;
2339			octeon_write_csr64(oct,
2340					   CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
2341					   (intrmod->rx_frames |
2342					    ((u64)time_threshold << 32)));
2343			/*consider writing to resend bit here*/
2344		}
2345		intrmod->rx_usecs = rx_coalesce_usecs;
2346		oct->rx_coalesce_usecs = rx_coalesce_usecs;
2347		break;
2348	}
2349	case OCTEON_CN23XX_VF_VID: {
2350		u64 time_threshold;
2351		int q_no;
2352
2353		if (!intr_coal->rx_coalesce_usecs)
2354			rx_coalesce_usecs = intrmod->rx_usecs;
2355		else
2356			rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
2357
2358		time_threshold =
2359		    cn23xx_vf_get_oq_ticks(oct, (u32)rx_coalesce_usecs);
2360		for (q_no = 0; q_no < oct->num_oqs; q_no++) {
2361			octeon_write_csr64(
2362				oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no),
2363				(intrmod->rx_frames |
2364				 ((u64)time_threshold << 32)));
2365			/*consider setting resend bit*/
2366		}
2367		intrmod->rx_usecs = rx_coalesce_usecs;
2368		oct->rx_coalesce_usecs = rx_coalesce_usecs;
2369		break;
2370	}
2371	default:
2372		return -EINVAL;
2373	}
2374
2375	return 0;
2376}
2377
2378static int
2379oct_cfg_tx_intrcnt(struct lio *lio,
2380		   struct oct_intrmod_cfg *intrmod,
2381		   struct ethtool_coalesce *intr_coal)
2382{
2383	struct octeon_device *oct = lio->oct_dev;
2384	u32 iq_intr_pkt;
2385	void __iomem *inst_cnt_reg;
2386	u64 val;
2387
2388	/* Config Cnt based interrupt values */
2389	switch (oct->chip_id) {
2390	case OCTEON_CN68XX:
2391	case OCTEON_CN66XX:
2392		break;
2393	case OCTEON_CN23XX_VF_VID:
2394	case OCTEON_CN23XX_PF_VID: {
2395		int q_no;
2396
2397		if (!intr_coal->tx_max_coalesced_frames)
2398			iq_intr_pkt = CN23XX_DEF_IQ_INTR_THRESHOLD &
2399				      CN23XX_PKT_IN_DONE_WMARK_MASK;
2400		else
2401			iq_intr_pkt = intr_coal->tx_max_coalesced_frames &
2402				      CN23XX_PKT_IN_DONE_WMARK_MASK;
2403		for (q_no = 0; q_no < oct->num_iqs; q_no++) {
2404			inst_cnt_reg = (oct->instr_queue[q_no])->inst_cnt_reg;
2405			val = readq(inst_cnt_reg);
2406			/*clear wmark and count.dont want to write count back*/
2407			val = (val & 0xFFFF000000000000ULL) |
2408			      ((u64)(iq_intr_pkt - 1)
2409			       << CN23XX_PKT_IN_DONE_WMARK_BIT_POS);
2410			writeq(val, inst_cnt_reg);
2411			/*consider setting resend bit*/
2412		}
2413		intrmod->tx_frames = iq_intr_pkt;
2414		oct->tx_max_coalesced_frames = iq_intr_pkt;
2415		break;
2416	}
2417	default:
2418		return -EINVAL;
2419	}
2420	return 0;
2421}
2422
2423static int lio_set_intr_coalesce(struct net_device *netdev,
2424				 struct ethtool_coalesce *intr_coal,
2425				 struct kernel_ethtool_coalesce *kernel_coal,
2426				 struct netlink_ext_ack *extack)
2427{
2428	struct lio *lio = GET_LIO(netdev);
2429	int ret;
2430	struct octeon_device *oct = lio->oct_dev;
2431	struct oct_intrmod_cfg intrmod = {0};
2432	u32 j, q_no;
2433	int db_max, db_min;
2434
2435	switch (oct->chip_id) {
2436	case OCTEON_CN68XX:
2437	case OCTEON_CN66XX:
2438		db_min = CN6XXX_DB_MIN;
2439		db_max = CN6XXX_DB_MAX;
2440		if ((intr_coal->tx_max_coalesced_frames >= db_min) &&
2441		    (intr_coal->tx_max_coalesced_frames <= db_max)) {
2442			for (j = 0; j < lio->linfo.num_txpciq; j++) {
2443				q_no = lio->linfo.txpciq[j].s.q_no;
2444				oct->instr_queue[q_no]->fill_threshold =
2445					intr_coal->tx_max_coalesced_frames;
2446			}
2447		} else {
2448			dev_err(&oct->pci_dev->dev,
2449				"LIQUIDIO: Invalid tx-frames:%d. Range is min:%d max:%d\n",
2450				intr_coal->tx_max_coalesced_frames,
2451				db_min, db_max);
2452			return -EINVAL;
2453		}
2454		break;
2455	case OCTEON_CN23XX_PF_VID:
2456	case OCTEON_CN23XX_VF_VID:
2457		break;
2458	default:
2459		return -EINVAL;
2460	}
2461
2462	intrmod.rx_enable = intr_coal->use_adaptive_rx_coalesce ? 1 : 0;
2463	intrmod.tx_enable = intr_coal->use_adaptive_tx_coalesce ? 1 : 0;
2464	intrmod.rx_frames = CFG_GET_OQ_INTR_PKT(octeon_get_conf(oct));
2465	intrmod.rx_usecs = CFG_GET_OQ_INTR_TIME(octeon_get_conf(oct));
2466	intrmod.tx_frames = CFG_GET_IQ_INTR_PKT(octeon_get_conf(oct));
2467
2468	ret = oct_cfg_adaptive_intr(lio, &intrmod, intr_coal);
2469
2470	if (!intr_coal->use_adaptive_rx_coalesce) {
2471		ret = oct_cfg_rx_intrtime(lio, &intrmod, intr_coal);
2472		if (ret)
2473			goto ret_intrmod;
2474
2475		ret = oct_cfg_rx_intrcnt(lio, &intrmod, intr_coal);
2476		if (ret)
2477			goto ret_intrmod;
2478	} else {
2479		oct->rx_coalesce_usecs =
2480			CFG_GET_OQ_INTR_TIME(octeon_get_conf(oct));
2481		oct->rx_max_coalesced_frames =
2482			CFG_GET_OQ_INTR_PKT(octeon_get_conf(oct));
2483	}
2484
2485	if (!intr_coal->use_adaptive_tx_coalesce) {
2486		ret = oct_cfg_tx_intrcnt(lio, &intrmod, intr_coal);
2487		if (ret)
2488			goto ret_intrmod;
2489	} else {
2490		oct->tx_max_coalesced_frames =
2491			CFG_GET_IQ_INTR_PKT(octeon_get_conf(oct));
2492	}
2493
2494	return 0;
2495ret_intrmod:
2496	return ret;
2497}
2498
2499static int lio_get_ts_info(struct net_device *netdev,
2500			   struct ethtool_ts_info *info)
2501{
2502	struct lio *lio = GET_LIO(netdev);
2503
2504	info->so_timestamping =
2505#ifdef PTP_HARDWARE_TIMESTAMPING
2506		SOF_TIMESTAMPING_TX_HARDWARE |
2507		SOF_TIMESTAMPING_RX_HARDWARE |
2508		SOF_TIMESTAMPING_RAW_HARDWARE |
2509		SOF_TIMESTAMPING_TX_SOFTWARE |
2510#endif
2511		SOF_TIMESTAMPING_RX_SOFTWARE |
2512		SOF_TIMESTAMPING_SOFTWARE;
2513
2514	if (lio->ptp_clock)
2515		info->phc_index = ptp_clock_index(lio->ptp_clock);
2516	else
2517		info->phc_index = -1;
2518
2519#ifdef PTP_HARDWARE_TIMESTAMPING
2520	info->tx_types = (1 << HWTSTAMP_TX_OFF) | (1 << HWTSTAMP_TX_ON);
2521
2522	info->rx_filters = (1 << HWTSTAMP_FILTER_NONE) |
2523			   (1 << HWTSTAMP_FILTER_PTP_V1_L4_EVENT) |
2524			   (1 << HWTSTAMP_FILTER_PTP_V2_L2_EVENT) |
2525			   (1 << HWTSTAMP_FILTER_PTP_V2_L4_EVENT);
2526#endif
2527
2528	return 0;
2529}
2530
2531/* Return register dump len. */
2532static int lio_get_regs_len(struct net_device *dev)
2533{
2534	struct lio *lio = GET_LIO(dev);
2535	struct octeon_device *oct = lio->oct_dev;
2536
2537	switch (oct->chip_id) {
2538	case OCTEON_CN23XX_PF_VID:
2539		return OCT_ETHTOOL_REGDUMP_LEN_23XX;
2540	case OCTEON_CN23XX_VF_VID:
2541		return OCT_ETHTOOL_REGDUMP_LEN_23XX_VF;
2542	default:
2543		return OCT_ETHTOOL_REGDUMP_LEN;
2544	}
2545}
2546
2547static int cn23xx_read_csr_reg(char *s, struct octeon_device *oct)
2548{
2549	u32 reg;
2550	u8 pf_num = oct->pf_num;
2551	int len = 0;
2552	int i;
2553
2554	/* PCI  Window Registers */
2555
2556	len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
2557
2558	/*0x29030 or 0x29040*/
2559	reg = CN23XX_SLI_PKT_MAC_RINFO64(oct->pcie_port, oct->pf_num);
2560	len += sprintf(s + len,
2561		       "\n[%08x] (SLI_PKT_MAC%d_PF%d_RINFO): %016llx\n",
2562		       reg, oct->pcie_port, oct->pf_num,
2563		       (u64)octeon_read_csr64(oct, reg));
2564
2565	/*0x27080 or 0x27090*/
2566	reg = CN23XX_SLI_MAC_PF_INT_ENB64(oct->pcie_port, oct->pf_num);
2567	len +=
2568	    sprintf(s + len, "\n[%08x] (SLI_MAC%d_PF%d_INT_ENB): %016llx\n",
2569		    reg, oct->pcie_port, oct->pf_num,
2570		    (u64)octeon_read_csr64(oct, reg));
2571
2572	/*0x27000 or 0x27010*/
2573	reg = CN23XX_SLI_MAC_PF_INT_SUM64(oct->pcie_port, oct->pf_num);
2574	len +=
2575	    sprintf(s + len, "\n[%08x] (SLI_MAC%d_PF%d_INT_SUM): %016llx\n",
2576		    reg, oct->pcie_port, oct->pf_num,
2577		    (u64)octeon_read_csr64(oct, reg));
2578
2579	/*0x29120*/
2580	reg = 0x29120;
2581	len += sprintf(s + len, "\n[%08x] (SLI_PKT_MEM_CTL): %016llx\n", reg,
2582		       (u64)octeon_read_csr64(oct, reg));
2583
2584	/*0x27300*/
2585	reg = 0x27300 + oct->pcie_port * CN23XX_MAC_INT_OFFSET +
2586	      (oct->pf_num) * CN23XX_PF_INT_OFFSET;
2587	len += sprintf(
2588	    s + len, "\n[%08x] (SLI_MAC%d_PF%d_PKT_VF_INT): %016llx\n", reg,
2589	    oct->pcie_port, oct->pf_num, (u64)octeon_read_csr64(oct, reg));
2590
2591	/*0x27200*/
2592	reg = 0x27200 + oct->pcie_port * CN23XX_MAC_INT_OFFSET +
2593	      (oct->pf_num) * CN23XX_PF_INT_OFFSET;
2594	len += sprintf(s + len,
2595		       "\n[%08x] (SLI_MAC%d_PF%d_PP_VF_INT): %016llx\n",
2596		       reg, oct->pcie_port, oct->pf_num,
2597		       (u64)octeon_read_csr64(oct, reg));
2598
2599	/*29130*/
2600	reg = CN23XX_SLI_PKT_CNT_INT;
2601	len += sprintf(s + len, "\n[%08x] (SLI_PKT_CNT_INT): %016llx\n", reg,
2602		       (u64)octeon_read_csr64(oct, reg));
2603
2604	/*0x29140*/
2605	reg = CN23XX_SLI_PKT_TIME_INT;
2606	len += sprintf(s + len, "\n[%08x] (SLI_PKT_TIME_INT): %016llx\n", reg,
2607		       (u64)octeon_read_csr64(oct, reg));
2608
2609	/*0x29160*/
2610	reg = 0x29160;
2611	len += sprintf(s + len, "\n[%08x] (SLI_PKT_INT): %016llx\n", reg,
2612		       (u64)octeon_read_csr64(oct, reg));
2613
2614	/*0x29180*/
2615	reg = CN23XX_SLI_OQ_WMARK;
2616	len += sprintf(s + len, "\n[%08x] (SLI_PKT_OUTPUT_WMARK): %016llx\n",
2617		       reg, (u64)octeon_read_csr64(oct, reg));
2618
2619	/*0x291E0*/
2620	reg = CN23XX_SLI_PKT_IOQ_RING_RST;
2621	len += sprintf(s + len, "\n[%08x] (SLI_PKT_RING_RST): %016llx\n", reg,
2622		       (u64)octeon_read_csr64(oct, reg));
2623
2624	/*0x29210*/
2625	reg = CN23XX_SLI_GBL_CONTROL;
2626	len += sprintf(s + len,
2627		       "\n[%08x] (SLI_PKT_GBL_CONTROL): %016llx\n", reg,
2628		       (u64)octeon_read_csr64(oct, reg));
2629
2630	/*0x29220*/
2631	reg = 0x29220;
2632	len += sprintf(s + len, "\n[%08x] (SLI_PKT_BIST_STATUS): %016llx\n",
2633		       reg, (u64)octeon_read_csr64(oct, reg));
2634
2635	/*PF only*/
2636	if (pf_num == 0) {
2637		/*0x29260*/
2638		reg = CN23XX_SLI_OUT_BP_EN_W1S;
2639		len += sprintf(s + len,
2640			       "\n[%08x] (SLI_PKT_OUT_BP_EN_W1S):  %016llx\n",
2641			       reg, (u64)octeon_read_csr64(oct, reg));
2642	} else if (pf_num == 1) {
2643		/*0x29270*/
2644		reg = CN23XX_SLI_OUT_BP_EN2_W1S;
2645		len += sprintf(s + len,
2646			       "\n[%08x] (SLI_PKT_OUT_BP_EN2_W1S): %016llx\n",
2647			       reg, (u64)octeon_read_csr64(oct, reg));
2648	}
2649
2650	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2651		reg = CN23XX_SLI_OQ_BUFF_INFO_SIZE(i);
2652		len +=
2653		    sprintf(s + len, "\n[%08x] (SLI_PKT%d_OUT_SIZE): %016llx\n",
2654			    reg, i, (u64)octeon_read_csr64(oct, reg));
2655	}
2656
2657	/*0x10040*/
2658	for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
2659		reg = CN23XX_SLI_IQ_INSTR_COUNT64(i);
2660		len += sprintf(s + len,
2661			       "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
2662			       reg, i, (u64)octeon_read_csr64(oct, reg));
2663	}
2664
2665	/*0x10080*/
2666	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2667		reg = CN23XX_SLI_OQ_PKTS_CREDIT(i);
2668		len += sprintf(s + len,
2669			       "\n[%08x] (SLI_PKT%d_SLIST_BAOFF_DBELL): %016llx\n",
2670			       reg, i, (u64)octeon_read_csr64(oct, reg));
2671	}
2672
2673	/*0x10090*/
2674	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2675		reg = CN23XX_SLI_OQ_SIZE(i);
2676		len += sprintf(
2677		    s + len, "\n[%08x] (SLI_PKT%d_SLIST_FIFO_RSIZE): %016llx\n",
2678		    reg, i, (u64)octeon_read_csr64(oct, reg));
2679	}
2680
2681	/*0x10050*/
2682	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2683		reg = CN23XX_SLI_OQ_PKT_CONTROL(i);
2684		len += sprintf(
2685			s + len,
2686			"\n[%08x] (SLI_PKT%d__OUTPUT_CONTROL): %016llx\n",
2687			reg, i, (u64)octeon_read_csr64(oct, reg));
2688	}
2689
2690	/*0x10070*/
2691	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2692		reg = CN23XX_SLI_OQ_BASE_ADDR64(i);
2693		len += sprintf(s + len,
2694			       "\n[%08x] (SLI_PKT%d_SLIST_BADDR): %016llx\n",
2695			       reg, i, (u64)octeon_read_csr64(oct, reg));
2696	}
2697
2698	/*0x100a0*/
2699	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2700		reg = CN23XX_SLI_OQ_PKT_INT_LEVELS(i);
2701		len += sprintf(s + len,
2702			       "\n[%08x] (SLI_PKT%d_INT_LEVELS): %016llx\n",
2703			       reg, i, (u64)octeon_read_csr64(oct, reg));
2704	}
2705
2706	/*0x100b0*/
2707	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2708		reg = CN23XX_SLI_OQ_PKTS_SENT(i);
2709		len += sprintf(s + len, "\n[%08x] (SLI_PKT%d_CNTS): %016llx\n",
2710			       reg, i, (u64)octeon_read_csr64(oct, reg));
2711	}
2712
2713	/*0x100c0*/
2714	for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
2715		reg = 0x100c0 + i * CN23XX_OQ_OFFSET;
2716		len += sprintf(s + len,
2717			       "\n[%08x] (SLI_PKT%d_ERROR_INFO): %016llx\n",
2718			       reg, i, (u64)octeon_read_csr64(oct, reg));
2719
2720		/*0x10000*/
2721		for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
2722			reg = CN23XX_SLI_IQ_PKT_CONTROL64(i);
2723			len += sprintf(
2724				s + len,
2725				"\n[%08x] (SLI_PKT%d_INPUT_CONTROL): %016llx\n",
2726				reg, i, (u64)octeon_read_csr64(oct, reg));
2727		}
2728
2729		/*0x10010*/
2730		for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
2731			reg = CN23XX_SLI_IQ_BASE_ADDR64(i);
2732			len += sprintf(
2733			    s + len,
2734			    "\n[%08x] (SLI_PKT%d_INSTR_BADDR): %016llx\n", reg,
2735			    i, (u64)octeon_read_csr64(oct, reg));
2736		}
2737
2738		/*0x10020*/
2739		for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
2740			reg = CN23XX_SLI_IQ_DOORBELL(i);
2741			len += sprintf(
2742			    s + len,
2743			    "\n[%08x] (SLI_PKT%d_INSTR_BAOFF_DBELL): %016llx\n",
2744			    reg, i, (u64)octeon_read_csr64(oct, reg));
2745		}
2746
2747		/*0x10030*/
2748		for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
2749			reg = CN23XX_SLI_IQ_SIZE(i);
2750			len += sprintf(
2751			    s + len,
2752			    "\n[%08x] (SLI_PKT%d_INSTR_FIFO_RSIZE): %016llx\n",
2753			    reg, i, (u64)octeon_read_csr64(oct, reg));
2754		}
2755
2756		/*0x10040*/
2757		for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++)
2758			reg = CN23XX_SLI_IQ_INSTR_COUNT64(i);
2759		len += sprintf(s + len,
2760			       "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
2761			       reg, i, (u64)octeon_read_csr64(oct, reg));
2762	}
2763
2764	return len;
2765}
2766
2767static int cn23xx_vf_read_csr_reg(char *s, struct octeon_device *oct)
2768{
2769	int len = 0;
2770	u32 reg;
2771	int i;
2772
2773	/* PCI  Window Registers */
2774
2775	len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
2776
2777	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2778		reg = CN23XX_VF_SLI_OQ_BUFF_INFO_SIZE(i);
2779		len += sprintf(s + len,
2780			       "\n[%08x] (SLI_PKT%d_OUT_SIZE): %016llx\n",
2781			       reg, i, (u64)octeon_read_csr64(oct, reg));
2782	}
2783
2784	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2785		reg = CN23XX_VF_SLI_IQ_INSTR_COUNT64(i);
2786		len += sprintf(s + len,
2787			       "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
2788			       reg, i, (u64)octeon_read_csr64(oct, reg));
2789	}
2790
2791	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2792		reg = CN23XX_VF_SLI_OQ_PKTS_CREDIT(i);
2793		len += sprintf(s + len,
2794			       "\n[%08x] (SLI_PKT%d_SLIST_BAOFF_DBELL): %016llx\n",
2795			       reg, i, (u64)octeon_read_csr64(oct, reg));
2796	}
2797
2798	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2799		reg = CN23XX_VF_SLI_OQ_SIZE(i);
2800		len += sprintf(s + len,
2801			       "\n[%08x] (SLI_PKT%d_SLIST_FIFO_RSIZE): %016llx\n",
2802			       reg, i, (u64)octeon_read_csr64(oct, reg));
2803	}
2804
2805	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2806		reg = CN23XX_VF_SLI_OQ_PKT_CONTROL(i);
2807		len += sprintf(s + len,
2808			       "\n[%08x] (SLI_PKT%d__OUTPUT_CONTROL): %016llx\n",
2809			       reg, i, (u64)octeon_read_csr64(oct, reg));
2810	}
2811
2812	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2813		reg = CN23XX_VF_SLI_OQ_BASE_ADDR64(i);
2814		len += sprintf(s + len,
2815			       "\n[%08x] (SLI_PKT%d_SLIST_BADDR): %016llx\n",
2816			       reg, i, (u64)octeon_read_csr64(oct, reg));
2817	}
2818
2819	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2820		reg = CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(i);
2821		len += sprintf(s + len,
2822			       "\n[%08x] (SLI_PKT%d_INT_LEVELS): %016llx\n",
2823			       reg, i, (u64)octeon_read_csr64(oct, reg));
2824	}
2825
2826	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2827		reg = CN23XX_VF_SLI_OQ_PKTS_SENT(i);
2828		len += sprintf(s + len, "\n[%08x] (SLI_PKT%d_CNTS): %016llx\n",
2829			       reg, i, (u64)octeon_read_csr64(oct, reg));
2830	}
2831
2832	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2833		reg = 0x100c0 + i * CN23XX_VF_OQ_OFFSET;
2834		len += sprintf(s + len,
2835			       "\n[%08x] (SLI_PKT%d_ERROR_INFO): %016llx\n",
2836			       reg, i, (u64)octeon_read_csr64(oct, reg));
2837	}
2838
2839	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2840		reg = 0x100d0 + i * CN23XX_VF_IQ_OFFSET;
2841		len += sprintf(s + len,
2842			       "\n[%08x] (SLI_PKT%d_VF_INT_SUM): %016llx\n",
2843			       reg, i, (u64)octeon_read_csr64(oct, reg));
2844	}
2845
2846	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2847		reg = CN23XX_VF_SLI_IQ_PKT_CONTROL64(i);
2848		len += sprintf(s + len,
2849			       "\n[%08x] (SLI_PKT%d_INPUT_CONTROL): %016llx\n",
2850			       reg, i, (u64)octeon_read_csr64(oct, reg));
2851	}
2852
2853	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2854		reg = CN23XX_VF_SLI_IQ_BASE_ADDR64(i);
2855		len += sprintf(s + len,
2856			       "\n[%08x] (SLI_PKT%d_INSTR_BADDR): %016llx\n",
2857			       reg, i, (u64)octeon_read_csr64(oct, reg));
2858	}
2859
2860	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2861		reg = CN23XX_VF_SLI_IQ_DOORBELL(i);
2862		len += sprintf(s + len,
2863			       "\n[%08x] (SLI_PKT%d_INSTR_BAOFF_DBELL): %016llx\n",
2864			       reg, i, (u64)octeon_read_csr64(oct, reg));
2865	}
2866
2867	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2868		reg = CN23XX_VF_SLI_IQ_SIZE(i);
2869		len += sprintf(s + len,
2870			       "\n[%08x] (SLI_PKT%d_INSTR_FIFO_RSIZE): %016llx\n",
2871			       reg, i, (u64)octeon_read_csr64(oct, reg));
2872	}
2873
2874	for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
2875		reg = CN23XX_VF_SLI_IQ_INSTR_COUNT64(i);
2876		len += sprintf(s + len,
2877			       "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
2878			       reg, i, (u64)octeon_read_csr64(oct, reg));
2879	}
2880
2881	return len;
2882}
2883
2884static int cn6xxx_read_csr_reg(char *s, struct octeon_device *oct)
2885{
2886	u32 reg;
2887	int i, len = 0;
2888
2889	/* PCI  Window Registers */
2890
2891	len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
2892	reg = CN6XXX_WIN_WR_ADDR_LO;
2893	len += sprintf(s + len, "\n[%02x] (WIN_WR_ADDR_LO): %08x\n",
2894		       CN6XXX_WIN_WR_ADDR_LO, octeon_read_csr(oct, reg));
2895	reg = CN6XXX_WIN_WR_ADDR_HI;
2896	len += sprintf(s + len, "[%02x] (WIN_WR_ADDR_HI): %08x\n",
2897		       CN6XXX_WIN_WR_ADDR_HI, octeon_read_csr(oct, reg));
2898	reg = CN6XXX_WIN_RD_ADDR_LO;
2899	len += sprintf(s + len, "[%02x] (WIN_RD_ADDR_LO): %08x\n",
2900		       CN6XXX_WIN_RD_ADDR_LO, octeon_read_csr(oct, reg));
2901	reg = CN6XXX_WIN_RD_ADDR_HI;
2902	len += sprintf(s + len, "[%02x] (WIN_RD_ADDR_HI): %08x\n",
2903		       CN6XXX_WIN_RD_ADDR_HI, octeon_read_csr(oct, reg));
2904	reg = CN6XXX_WIN_WR_DATA_LO;
2905	len += sprintf(s + len, "[%02x] (WIN_WR_DATA_LO): %08x\n",
2906		       CN6XXX_WIN_WR_DATA_LO, octeon_read_csr(oct, reg));
2907	reg = CN6XXX_WIN_WR_DATA_HI;
2908	len += sprintf(s + len, "[%02x] (WIN_WR_DATA_HI): %08x\n",
2909		       CN6XXX_WIN_WR_DATA_HI, octeon_read_csr(oct, reg));
2910	len += sprintf(s + len, "[%02x] (WIN_WR_MASK_REG): %08x\n",
2911		       CN6XXX_WIN_WR_MASK_REG,
2912		       octeon_read_csr(oct, CN6XXX_WIN_WR_MASK_REG));
2913
2914	/* PCI  Interrupt Register */
2915	len += sprintf(s + len, "\n[%x] (INT_ENABLE PORT 0): %08x\n",
2916		       CN6XXX_SLI_INT_ENB64_PORT0, octeon_read_csr(oct,
2917						CN6XXX_SLI_INT_ENB64_PORT0));
2918	len += sprintf(s + len, "\n[%x] (INT_ENABLE PORT 1): %08x\n",
2919		       CN6XXX_SLI_INT_ENB64_PORT1,
2920		       octeon_read_csr(oct, CN6XXX_SLI_INT_ENB64_PORT1));
2921	len += sprintf(s + len, "[%x] (INT_SUM): %08x\n", CN6XXX_SLI_INT_SUM64,
2922		       octeon_read_csr(oct, CN6XXX_SLI_INT_SUM64));
2923
2924	/* PCI  Output queue registers */
2925	for (i = 0; i < oct->num_oqs; i++) {
2926		reg = CN6XXX_SLI_OQ_PKTS_SENT(i);
2927		len += sprintf(s + len, "\n[%x] (PKTS_SENT_%d): %08x\n",
2928			       reg, i, octeon_read_csr(oct, reg));
2929		reg = CN6XXX_SLI_OQ_PKTS_CREDIT(i);
2930		len += sprintf(s + len, "[%x] (PKT_CREDITS_%d): %08x\n",
2931			       reg, i, octeon_read_csr(oct, reg));
2932	}
2933	reg = CN6XXX_SLI_OQ_INT_LEVEL_PKTS;
2934	len += sprintf(s + len, "\n[%x] (PKTS_SENT_INT_LEVEL): %08x\n",
2935		       reg, octeon_read_csr(oct, reg));
2936	reg = CN6XXX_SLI_OQ_INT_LEVEL_TIME;
2937	len += sprintf(s + len, "[%x] (PKTS_SENT_TIME): %08x\n",
2938		       reg, octeon_read_csr(oct, reg));
2939
2940	/* PCI  Input queue registers */
2941	for (i = 0; i <= 3; i++) {
2942		u32 reg;
2943
2944		reg = CN6XXX_SLI_IQ_DOORBELL(i);
2945		len += sprintf(s + len, "\n[%x] (INSTR_DOORBELL_%d): %08x\n",
2946			       reg, i, octeon_read_csr(oct, reg));
2947		reg = CN6XXX_SLI_IQ_INSTR_COUNT(i);
2948		len += sprintf(s + len, "[%x] (INSTR_COUNT_%d): %08x\n",
2949			       reg, i, octeon_read_csr(oct, reg));
2950	}
2951
2952	/* PCI  DMA registers */
2953
2954	len += sprintf(s + len, "\n[%x] (DMA_CNT_0): %08x\n",
2955		       CN6XXX_DMA_CNT(0),
2956		       octeon_read_csr(oct, CN6XXX_DMA_CNT(0)));
2957	reg = CN6XXX_DMA_PKT_INT_LEVEL(0);
2958	len += sprintf(s + len, "[%x] (DMA_INT_LEV_0): %08x\n",
2959		       CN6XXX_DMA_PKT_INT_LEVEL(0), octeon_read_csr(oct, reg));
2960	reg = CN6XXX_DMA_TIME_INT_LEVEL(0);
2961	len += sprintf(s + len, "[%x] (DMA_TIME_0): %08x\n",
2962		       CN6XXX_DMA_TIME_INT_LEVEL(0),
2963		       octeon_read_csr(oct, reg));
2964
2965	len += sprintf(s + len, "\n[%x] (DMA_CNT_1): %08x\n",
2966		       CN6XXX_DMA_CNT(1),
2967		       octeon_read_csr(oct, CN6XXX_DMA_CNT(1)));
2968	reg = CN6XXX_DMA_PKT_INT_LEVEL(1);
2969	len += sprintf(s + len, "[%x] (DMA_INT_LEV_1): %08x\n",
2970		       CN6XXX_DMA_PKT_INT_LEVEL(1),
2971		       octeon_read_csr(oct, reg));
2972	reg = CN6XXX_DMA_PKT_INT_LEVEL(1);
2973	len += sprintf(s + len, "[%x] (DMA_TIME_1): %08x\n",
2974		       CN6XXX_DMA_TIME_INT_LEVEL(1),
2975		       octeon_read_csr(oct, reg));
2976
2977	/* PCI  Index registers */
2978
2979	len += sprintf(s + len, "\n");
2980
2981	for (i = 0; i < 16; i++) {
2982		reg = lio_pci_readq(oct, CN6XXX_BAR1_REG(i, oct->pcie_port));
2983		len += sprintf(s + len, "[%llx] (BAR1_INDEX_%02d): %08x\n",
2984			       CN6XXX_BAR1_REG(i, oct->pcie_port), i, reg);
2985	}
2986
2987	return len;
2988}
2989
2990static int cn6xxx_read_config_reg(char *s, struct octeon_device *oct)
2991{
2992	u32 val;
2993	int i, len = 0;
2994
2995	/* PCI CONFIG Registers */
2996
2997	len += sprintf(s + len,
2998		       "\n\t Octeon Config space Registers\n\n");
2999
3000	for (i = 0; i <= 13; i++) {
3001		pci_read_config_dword(oct->pci_dev, (i * 4), &val);
3002		len += sprintf(s + len, "[0x%x] (Config[%d]): 0x%08x\n",
3003			       (i * 4), i, val);
3004	}
3005
3006	for (i = 30; i <= 34; i++) {
3007		pci_read_config_dword(oct->pci_dev, (i * 4), &val);
3008		len += sprintf(s + len, "[0x%x] (Config[%d]): 0x%08x\n",
3009			       (i * 4), i, val);
3010	}
3011
3012	return len;
3013}
3014
3015/*  Return register dump user app.  */
3016static void lio_get_regs(struct net_device *dev,
3017			 struct ethtool_regs *regs, void *regbuf)
3018{
3019	struct lio *lio = GET_LIO(dev);
3020	int len = 0;
3021	struct octeon_device *oct = lio->oct_dev;
3022
3023	regs->version = OCT_ETHTOOL_REGSVER;
3024
3025	switch (oct->chip_id) {
3026	case OCTEON_CN23XX_PF_VID:
3027		memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN_23XX);
3028		len += cn23xx_read_csr_reg(regbuf + len, oct);
3029		break;
3030	case OCTEON_CN23XX_VF_VID:
3031		memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN_23XX_VF);
3032		len += cn23xx_vf_read_csr_reg(regbuf + len, oct);
3033		break;
3034	case OCTEON_CN68XX:
3035	case OCTEON_CN66XX:
3036		memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN);
3037		len += cn6xxx_read_csr_reg(regbuf + len, oct);
3038		len += cn6xxx_read_config_reg(regbuf + len, oct);
3039		break;
3040	default:
3041		dev_err(&oct->pci_dev->dev, "%s Unknown chipid: %d\n",
3042			__func__, oct->chip_id);
3043	}
3044}
3045
3046static u32 lio_get_priv_flags(struct net_device *netdev)
3047{
3048	struct lio *lio = GET_LIO(netdev);
3049
3050	return lio->oct_dev->priv_flags;
3051}
3052
3053static int lio_set_priv_flags(struct net_device *netdev, u32 flags)
3054{
3055	struct lio *lio = GET_LIO(netdev);
3056	bool intr_by_tx_bytes = !!(flags & (0x1 << OCT_PRIV_FLAG_TX_BYTES));
3057
3058	lio_set_priv_flag(lio->oct_dev, OCT_PRIV_FLAG_TX_BYTES,
3059			  intr_by_tx_bytes);
3060	return 0;
3061}
3062
3063static int lio_get_fecparam(struct net_device *netdev,
3064			    struct ethtool_fecparam *fec)
3065{
3066	struct lio *lio = GET_LIO(netdev);
3067	struct octeon_device *oct = lio->oct_dev;
3068
3069	fec->active_fec = ETHTOOL_FEC_NONE;
3070	fec->fec = ETHTOOL_FEC_NONE;
3071
3072	if (oct->subsystem_id == OCTEON_CN2350_25GB_SUBSYS_ID ||
3073	    oct->subsystem_id == OCTEON_CN2360_25GB_SUBSYS_ID) {
3074		if (oct->no_speed_setting == 1)
3075			return 0;
3076
3077		liquidio_get_fec(lio);
3078		fec->fec = (ETHTOOL_FEC_RS | ETHTOOL_FEC_OFF);
3079		if (oct->props[lio->ifidx].fec == 1)
3080			fec->active_fec = ETHTOOL_FEC_RS;
3081		else
3082			fec->active_fec = ETHTOOL_FEC_OFF;
3083	}
3084
3085	return 0;
3086}
3087
3088static int lio_set_fecparam(struct net_device *netdev,
3089			    struct ethtool_fecparam *fec)
3090{
3091	struct lio *lio = GET_LIO(netdev);
3092	struct octeon_device *oct = lio->oct_dev;
3093
3094	if (oct->subsystem_id == OCTEON_CN2350_25GB_SUBSYS_ID ||
3095	    oct->subsystem_id == OCTEON_CN2360_25GB_SUBSYS_ID) {
3096		if (oct->no_speed_setting == 1)
3097			return -EOPNOTSUPP;
3098
3099		if (fec->fec & ETHTOOL_FEC_OFF)
3100			liquidio_set_fec(lio, 0);
3101		else if (fec->fec & ETHTOOL_FEC_RS)
3102			liquidio_set_fec(lio, 1);
3103		else
3104			return -EOPNOTSUPP;
3105	} else {
3106		return -EOPNOTSUPP;
3107	}
3108
3109	return 0;
3110}
3111
3112#define LIO_ETHTOOL_COALESCE	(ETHTOOL_COALESCE_RX_USECS |		\
3113				 ETHTOOL_COALESCE_MAX_FRAMES |		\
3114				 ETHTOOL_COALESCE_USE_ADAPTIVE |	\
3115				 ETHTOOL_COALESCE_RX_MAX_FRAMES_LOW |	\
3116				 ETHTOOL_COALESCE_TX_MAX_FRAMES_LOW |	\
3117				 ETHTOOL_COALESCE_RX_MAX_FRAMES_HIGH |	\
3118				 ETHTOOL_COALESCE_TX_MAX_FRAMES_HIGH |	\
3119				 ETHTOOL_COALESCE_PKT_RATE_RX_USECS)
3120
3121static const struct ethtool_ops lio_ethtool_ops = {
3122	.supported_coalesce_params = LIO_ETHTOOL_COALESCE,
3123	.get_link_ksettings	= lio_get_link_ksettings,
3124	.set_link_ksettings	= lio_set_link_ksettings,
3125	.get_fecparam		= lio_get_fecparam,
3126	.set_fecparam		= lio_set_fecparam,
3127	.get_link		= ethtool_op_get_link,
3128	.get_drvinfo		= lio_get_drvinfo,
3129	.get_ringparam		= lio_ethtool_get_ringparam,
3130	.set_ringparam		= lio_ethtool_set_ringparam,
3131	.get_channels		= lio_ethtool_get_channels,
3132	.set_channels		= lio_ethtool_set_channels,
3133	.set_phys_id		= lio_set_phys_id,
3134	.get_eeprom_len		= lio_get_eeprom_len,
3135	.get_eeprom		= lio_get_eeprom,
3136	.get_strings		= lio_get_strings,
3137	.get_ethtool_stats	= lio_get_ethtool_stats,
3138	.get_pauseparam		= lio_get_pauseparam,
3139	.set_pauseparam		= lio_set_pauseparam,
3140	.get_regs_len		= lio_get_regs_len,
3141	.get_regs		= lio_get_regs,
3142	.get_msglevel		= lio_get_msglevel,
3143	.set_msglevel		= lio_set_msglevel,
3144	.get_sset_count		= lio_get_sset_count,
3145	.get_coalesce		= lio_get_intr_coalesce,
3146	.set_coalesce		= lio_set_intr_coalesce,
3147	.get_priv_flags		= lio_get_priv_flags,
3148	.set_priv_flags		= lio_set_priv_flags,
3149	.get_ts_info		= lio_get_ts_info,
3150};
3151
3152static const struct ethtool_ops lio_vf_ethtool_ops = {
3153	.supported_coalesce_params = LIO_ETHTOOL_COALESCE,
3154	.get_link_ksettings	= lio_get_link_ksettings,
3155	.get_link		= ethtool_op_get_link,
3156	.get_drvinfo		= lio_get_vf_drvinfo,
3157	.get_ringparam		= lio_ethtool_get_ringparam,
3158	.set_ringparam          = lio_ethtool_set_ringparam,
3159	.get_channels		= lio_ethtool_get_channels,
3160	.set_channels		= lio_ethtool_set_channels,
3161	.get_strings		= lio_vf_get_strings,
3162	.get_ethtool_stats	= lio_vf_get_ethtool_stats,
3163	.get_regs_len		= lio_get_regs_len,
3164	.get_regs		= lio_get_regs,
3165	.get_msglevel		= lio_get_msglevel,
3166	.set_msglevel		= lio_vf_set_msglevel,
3167	.get_sset_count		= lio_vf_get_sset_count,
3168	.get_coalesce		= lio_get_intr_coalesce,
3169	.set_coalesce		= lio_set_intr_coalesce,
3170	.get_priv_flags		= lio_get_priv_flags,
3171	.set_priv_flags		= lio_set_priv_flags,
3172	.get_ts_info		= lio_get_ts_info,
3173};
3174
3175void liquidio_set_ethtool_ops(struct net_device *netdev)
3176{
3177	struct lio *lio = GET_LIO(netdev);
3178	struct octeon_device *oct = lio->oct_dev;
3179
3180	if (OCTEON_CN23XX_VF(oct))
3181		netdev->ethtool_ops = &lio_vf_ethtool_ops;
3182	else
3183		netdev->ethtool_ops = &lio_ethtool_ops;
3184}
3185EXPORT_SYMBOL_GPL(liquidio_set_ethtool_ops);
3186