2 * Keystone GBE and XGBE subsystem code
4 * Copyright (C) 2014 Texas Instruments Incorporated
5 * Authors: Sandeep Nair <sandeep_n@ti.com>
6 * Sandeep Paulraj <s-paulraj@ti.com>
7 * Cyril Chemparathy <cyril@ti.com>
8 * Santosh Shilimkar <santosh.shilimkar@ti.com>
9 * Wingman Kwok <w-kwok2@ti.com>
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License as
13 * published by the Free Software Foundation version 2.
15 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
16 * kind, whether express or implied; without even the implied warranty
17 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
22 #include <linux/module.h>
23 #include <linux/of_mdio.h>
24 #include <linux/of_address.h>
25 #include <linux/if_vlan.h>
26 #include <linux/ethtool.h>
31 #define NETCP_DRIVER_NAME "TI KeyStone Ethernet Driver"
32 #define NETCP_DRIVER_VERSION "v1.0"
34 #define GBE_IDENT(reg) ((reg >> 16) & 0xffff)
35 #define GBE_MAJOR_VERSION(reg) (reg >> 8 & 0x7)
36 #define GBE_MINOR_VERSION(reg) (reg & 0xff)
37 #define GBE_RTL_VERSION(reg) ((reg >> 11) & 0x1f)
39 /* 1G Ethernet SS defines */
40 #define GBE_MODULE_NAME "netcp-gbe"
41 #define GBE_SS_VERSION_14 0x4ed21104
43 #define GBE_SS_REG_INDEX 0
44 #define GBE_SGMII34_REG_INDEX 1
45 #define GBE_SM_REG_INDEX 2
46 /* offset relative to base of GBE_SS_REG_INDEX */
47 #define GBE13_SGMII_MODULE_OFFSET 0x100
48 /* offset relative to base of GBE_SM_REG_INDEX */
49 #define GBE13_HOST_PORT_OFFSET 0x34
50 #define GBE13_SLAVE_PORT_OFFSET 0x60
51 #define GBE13_EMAC_OFFSET 0x100
52 #define GBE13_SLAVE_PORT2_OFFSET 0x200
53 #define GBE13_HW_STATS_OFFSET 0x300
54 #define GBE13_ALE_OFFSET 0x600
55 #define GBE13_HOST_PORT_NUM 0
56 #define GBE13_NUM_ALE_ENTRIES 1024
58 /* 1G Ethernet NU SS defines */
59 #define GBENU_MODULE_NAME "netcp-gbenu"
60 #define GBE_SS_ID_NU 0x4ee6
61 #define GBE_SS_ID_2U 0x4ee8
63 #define IS_SS_ID_MU(d) \
64 ((GBE_IDENT((d)->ss_version) == GBE_SS_ID_NU) || \
65 (GBE_IDENT((d)->ss_version) == GBE_SS_ID_2U))
67 #define IS_SS_ID_NU(d) \
68 (GBE_IDENT((d)->ss_version) == GBE_SS_ID_NU)
70 #define GBENU_SS_REG_INDEX 0
71 #define GBENU_SM_REG_INDEX 1
72 #define GBENU_SGMII_MODULE_OFFSET 0x100
73 #define GBENU_HOST_PORT_OFFSET 0x1000
74 #define GBENU_SLAVE_PORT_OFFSET 0x2000
75 #define GBENU_EMAC_OFFSET 0x2330
76 #define GBENU_HW_STATS_OFFSET 0x1a000
77 #define GBENU_ALE_OFFSET 0x1e000
78 #define GBENU_HOST_PORT_NUM 0
79 #define GBENU_NUM_ALE_ENTRIES 1024
81 /* 10G Ethernet SS defines */
82 #define XGBE_MODULE_NAME "netcp-xgbe"
83 #define XGBE_SS_VERSION_10 0x4ee42100
85 #define XGBE_SS_REG_INDEX 0
86 #define XGBE_SM_REG_INDEX 1
87 #define XGBE_SERDES_REG_INDEX 2
89 /* offset relative to base of XGBE_SS_REG_INDEX */
90 #define XGBE10_SGMII_MODULE_OFFSET 0x100
91 /* offset relative to base of XGBE_SM_REG_INDEX */
92 #define XGBE10_HOST_PORT_OFFSET 0x34
93 #define XGBE10_SLAVE_PORT_OFFSET 0x64
94 #define XGBE10_EMAC_OFFSET 0x400
95 #define XGBE10_ALE_OFFSET 0x700
96 #define XGBE10_HW_STATS_OFFSET 0x800
97 #define XGBE10_HOST_PORT_NUM 0
98 #define XGBE10_NUM_ALE_ENTRIES 1024
100 #define GBE_TIMER_INTERVAL (HZ / 2)
102 /* Soft reset register values */
103 #define SOFT_RESET_MASK BIT(0)
104 #define SOFT_RESET BIT(0)
105 #define DEVICE_EMACSL_RESET_POLL_COUNT 100
106 #define GMACSL_RET_WARN_RESET_INCOMPLETE -2
108 #define MACSL_RX_ENABLE_CSF BIT(23)
109 #define MACSL_ENABLE_EXT_CTL BIT(18)
110 #define MACSL_XGMII_ENABLE BIT(13)
111 #define MACSL_XGIG_MODE BIT(8)
112 #define MACSL_GIG_MODE BIT(7)
113 #define MACSL_GMII_ENABLE BIT(5)
114 #define MACSL_FULLDUPLEX BIT(0)
116 #define GBE_CTL_P0_ENABLE BIT(2)
117 #define GBE13_REG_VAL_STAT_ENABLE_ALL 0xff
118 #define XGBE_REG_VAL_STAT_ENABLE_ALL 0xf
119 #define GBE_STATS_CD_SEL BIT(28)
121 #define GBE_PORT_MASK(x) (BIT(x) - 1)
122 #define GBE_MASK_NO_PORTS 0
124 #define GBE_DEF_1G_MAC_CONTROL \
125 (MACSL_GIG_MODE | MACSL_GMII_ENABLE | \
126 MACSL_ENABLE_EXT_CTL | MACSL_RX_ENABLE_CSF)
128 #define GBE_DEF_10G_MAC_CONTROL \
129 (MACSL_XGIG_MODE | MACSL_XGMII_ENABLE | \
130 MACSL_ENABLE_EXT_CTL | MACSL_RX_ENABLE_CSF)
132 #define GBE_STATSA_MODULE 0
133 #define GBE_STATSB_MODULE 1
134 #define GBE_STATSC_MODULE 2
135 #define GBE_STATSD_MODULE 3
137 #define GBENU_STATS0_MODULE 0
138 #define GBENU_STATS1_MODULE 1
139 #define GBENU_STATS2_MODULE 2
140 #define GBENU_STATS3_MODULE 3
141 #define GBENU_STATS4_MODULE 4
142 #define GBENU_STATS5_MODULE 5
143 #define GBENU_STATS6_MODULE 6
144 #define GBENU_STATS7_MODULE 7
145 #define GBENU_STATS8_MODULE 8
147 #define XGBE_STATS0_MODULE 0
148 #define XGBE_STATS1_MODULE 1
149 #define XGBE_STATS2_MODULE 2
151 /* s: 0-based slave_port */
152 #define SGMII_BASE(s) \
153 (((s) < 2) ? gbe_dev->sgmii_port_regs : gbe_dev->sgmii_port34_regs)
155 #define GBE_TX_QUEUE 648
156 #define GBE_TXHOOK_ORDER 0
157 #define GBE_DEFAULT_ALE_AGEOUT 30
158 #define SLAVE_LINK_IS_XGMII(s) ((s)->link_interface >= XGMII_LINK_MAC_PHY)
159 #define NETCP_LINK_STATE_INVALID -1
161 #define GBE_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
162 offsetof(struct gbe##_##rb, rn)
163 #define GBENU_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
164 offsetof(struct gbenu##_##rb, rn)
165 #define XGBE_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
166 offsetof(struct xgbe##_##rb, rn)
167 #define GBE_REG_ADDR(p, rb, rn) (p->rb + p->rb##_ofs.rn)
169 #define HOST_TX_PRI_MAP_DEFAULT 0x00000000
171 struct xgbe_ss_regs {
178 struct xgbe_switch_regs {
192 struct xgbe_port_regs {
206 struct xgbe_host_port_regs {
215 struct xgbe_emac_regs {
230 struct xgbe_host_hw_stats {
232 u32 rx_broadcast_frames;
233 u32 rx_multicast_frames;
235 u32 rx_oversized_frames;
237 u32 rx_undersized_frames;
243 u32 tx_broadcast_frames;
244 u32 tx_multicast_frames;
247 u32 tx_64byte_frames;
248 u32 tx_65_to_127byte_frames;
249 u32 tx_128_to_255byte_frames;
250 u32 tx_256_to_511byte_frames;
251 u32 tx_512_to_1023byte_frames;
252 u32 tx_1024byte_frames;
259 struct xgbe_hw_stats {
261 u32 rx_broadcast_frames;
262 u32 rx_multicast_frames;
265 u32 rx_align_code_errors;
266 u32 rx_oversized_frames;
267 u32 rx_jabber_frames;
268 u32 rx_undersized_frames;
274 u32 tx_broadcast_frames;
275 u32 tx_multicast_frames;
277 u32 tx_deferred_frames;
278 u32 tx_collision_frames;
279 u32 tx_single_coll_frames;
280 u32 tx_mult_coll_frames;
281 u32 tx_excessive_collisions;
282 u32 tx_late_collisions;
284 u32 tx_carrier_sense_errors;
286 u32 tx_64byte_frames;
287 u32 tx_65_to_127byte_frames;
288 u32 tx_128_to_255byte_frames;
289 u32 tx_256_to_511byte_frames;
290 u32 tx_512_to_1023byte_frames;
291 u32 tx_1024byte_frames;
298 #define XGBE10_NUM_STAT_ENTRIES (sizeof(struct xgbe_hw_stats)/sizeof(u32))
300 struct gbenu_ss_regs {
302 u32 synce_count; /* NU */
303 u32 synce_mux; /* NU */
304 u32 control; /* 2U */
305 u32 __rsvd_0[2]; /* 2U */
306 u32 rgmii_status; /* 2U */
307 u32 ss_status; /* 2U */
310 struct gbenu_switch_regs {
318 u32 thru_rate; /* NU */
319 u32 gap_thresh; /* NU */
320 u32 tx_start_wds; /* NU */
321 u32 eee_prescale; /* 2U */
322 u32 tx_g_oflow_thresh_set; /* NU */
323 u32 tx_g_oflow_thresh_clr; /* NU */
324 u32 tx_g_buf_thresh_set_l; /* NU */
325 u32 tx_g_buf_thresh_set_h; /* NU */
326 u32 tx_g_buf_thresh_clr_l; /* NU */
327 u32 tx_g_buf_thresh_clr_h; /* NU */
330 struct gbenu_port_regs {
333 u32 max_blks; /* 2U */
337 u32 tx_pri_map; /* NU */
338 u32 pri_ctl; /* 2U */
341 u32 tx_blks_pri; /* NU */
343 u32 idle2lpi; /* 2U */
344 u32 lpi2idle; /* 2U */
345 u32 eee_status; /* 2U */
347 u32 __rsvd_3[176]; /* NU: more to add */
358 struct gbenu_host_port_regs {
361 u32 flow_id_offset; /* 2U */
365 u32 tx_pri_map; /* NU */
369 u32 tx_blks_pri; /* NU */
371 u32 idle2lpi; /* 2U */
372 u32 lpi2wake; /* 2U */
373 u32 eee_status; /* 2U */
375 u32 __rsvd_4[184]; /* NU */
376 u32 host_blks_pri; /* NU */
379 struct gbenu_emac_regs {
385 u32 __rsvd_0[11]; /* NU */
387 u32 __rsvd_1[11]; /* NU */
392 /* Some hw stat regs are applicable to slave port only.
393 * This is handled by gbenu_et_stats struct. Also some
394 * are for SS version NU and some are for 2U.
396 struct gbenu_hw_stats {
398 u32 rx_broadcast_frames;
399 u32 rx_multicast_frames;
400 u32 rx_pause_frames; /* slave */
402 u32 rx_align_code_errors; /* slave */
403 u32 rx_oversized_frames;
404 u32 rx_jabber_frames; /* slave */
405 u32 rx_undersized_frames;
406 u32 rx_fragments; /* slave */
408 u32 ale_overrun_drop;
411 u32 tx_broadcast_frames;
412 u32 tx_multicast_frames;
413 u32 tx_pause_frames; /* slave */
414 u32 tx_deferred_frames; /* slave */
415 u32 tx_collision_frames; /* slave */
416 u32 tx_single_coll_frames; /* slave */
417 u32 tx_mult_coll_frames; /* slave */
418 u32 tx_excessive_collisions; /* slave */
419 u32 tx_late_collisions; /* slave */
420 u32 rx_ipg_error; /* slave 10G only */
421 u32 tx_carrier_sense_errors; /* slave */
424 u32 tx_65_to_127B_frames;
425 u32 tx_128_to_255B_frames;
426 u32 tx_256_to_511B_frames;
427 u32 tx_512_to_1023B_frames;
430 u32 rx_bottom_fifo_drop;
431 u32 rx_port_mask_drop;
432 u32 rx_top_fifo_drop;
433 u32 ale_rate_limit_drop;
434 u32 ale_vid_ingress_drop;
435 u32 ale_da_eq_sa_drop;
437 u32 ale_unknown_ucast;
438 u32 ale_unknown_ucast_bytes;
439 u32 ale_unknown_mcast;
440 u32 ale_unknown_mcast_bytes;
441 u32 ale_unknown_bcast;
442 u32 ale_unknown_bcast_bytes;
444 u32 ale_pol_match_red; /* NU */
445 u32 ale_pol_match_yellow; /* NU */
447 u32 tx_mem_protect_err;
448 /* following NU only */
473 u32 tx_pri0_drop_bcnt;
474 u32 tx_pri1_drop_bcnt;
475 u32 tx_pri2_drop_bcnt;
476 u32 tx_pri3_drop_bcnt;
477 u32 tx_pri4_drop_bcnt;
478 u32 tx_pri5_drop_bcnt;
479 u32 tx_pri6_drop_bcnt;
480 u32 tx_pri7_drop_bcnt;
483 #define GBENU_NUM_HW_STAT_ENTRIES (sizeof(struct gbenu_hw_stats) / sizeof(u32))
484 #define GBENU_HW_STATS_REG_MAP_SZ 0x200
492 struct gbe_ss_regs_ofs {
497 struct gbe_switch_regs {
510 struct gbe_switch_regs_ofs {
520 struct gbe_port_regs {
534 struct gbe_port_regs_ofs {
544 u16 rx_maxlen; /* 2U, NU */
547 struct gbe_host_port_regs {
554 struct gbe_host_port_regs_ofs {
560 struct gbe_emac_regs {
574 struct gbe_emac_regs_ofs {
580 struct gbe_hw_stats {
582 u32 rx_broadcast_frames;
583 u32 rx_multicast_frames;
586 u32 rx_align_code_errors;
587 u32 rx_oversized_frames;
588 u32 rx_jabber_frames;
589 u32 rx_undersized_frames;
594 u32 tx_broadcast_frames;
595 u32 tx_multicast_frames;
597 u32 tx_deferred_frames;
598 u32 tx_collision_frames;
599 u32 tx_single_coll_frames;
600 u32 tx_mult_coll_frames;
601 u32 tx_excessive_collisions;
602 u32 tx_late_collisions;
604 u32 tx_carrier_sense_errors;
606 u32 tx_64byte_frames;
607 u32 tx_65_to_127byte_frames;
608 u32 tx_128_to_255byte_frames;
609 u32 tx_256_to_511byte_frames;
610 u32 tx_512_to_1023byte_frames;
611 u32 tx_1024byte_frames;
618 #define GBE13_NUM_HW_STAT_ENTRIES (sizeof(struct gbe_hw_stats)/sizeof(u32))
619 #define GBE_MAX_HW_STAT_MODS 9
620 #define GBE_HW_STATS_REG_MAP_SZ 0x100
623 void __iomem *port_regs;
624 void __iomem *emac_regs;
625 struct gbe_port_regs_ofs port_regs_ofs;
626 struct gbe_emac_regs_ofs emac_regs_ofs;
627 int slave_num; /* 0 based logical number */
628 int port_num; /* actual port number */
631 struct phy_device *phy;
635 struct device_node *phy_node;
636 struct list_head slave_list;
641 struct netcp_device *netcp_device;
642 struct timer_list timer;
648 u8 max_num_ports; /* max_num_slaves + 1 */
649 struct netcp_tx_pipe tx_pipe;
656 void __iomem *ss_regs;
657 void __iomem *switch_regs;
658 void __iomem *host_port_regs;
659 void __iomem *ale_reg;
660 void __iomem *sgmii_port_regs;
661 void __iomem *sgmii_port34_regs;
662 void __iomem *xgbe_serdes_regs;
663 void __iomem *hw_stats_regs[GBE_MAX_HW_STAT_MODS];
665 struct gbe_ss_regs_ofs ss_regs_ofs;
666 struct gbe_switch_regs_ofs switch_regs_ofs;
667 struct gbe_host_port_regs_ofs host_port_regs_ofs;
669 struct cpsw_ale *ale;
670 unsigned int tx_queue_id;
671 const char *dma_chan_name;
673 struct list_head gbe_intf_head;
674 struct list_head secondary_slaves;
675 struct net_device *dummy_ndev;
678 const struct netcp_ethtool_stat *et_stats;
680 /* Lock for updating the hwstats */
681 spinlock_t hw_stats_lock;
685 struct net_device *ndev;
687 struct gbe_priv *gbe_dev;
688 struct netcp_tx_pipe tx_pipe;
689 struct gbe_slave *slave;
690 struct list_head gbe_intf_list;
691 unsigned long active_vlans[BITS_TO_LONGS(VLAN_N_VID)];
694 static struct netcp_module gbe_module;
695 static struct netcp_module xgbe_module;
697 /* Statistic management */
698 struct netcp_ethtool_stat {
699 char desc[ETH_GSTRING_LEN];
705 #define GBE_STATSA_INFO(field) \
707 "GBE_A:"#field, GBE_STATSA_MODULE, \
708 FIELD_SIZEOF(struct gbe_hw_stats, field), \
709 offsetof(struct gbe_hw_stats, field) \
712 #define GBE_STATSB_INFO(field) \
714 "GBE_B:"#field, GBE_STATSB_MODULE, \
715 FIELD_SIZEOF(struct gbe_hw_stats, field), \
716 offsetof(struct gbe_hw_stats, field) \
719 #define GBE_STATSC_INFO(field) \
721 "GBE_C:"#field, GBE_STATSC_MODULE, \
722 FIELD_SIZEOF(struct gbe_hw_stats, field), \
723 offsetof(struct gbe_hw_stats, field) \
726 #define GBE_STATSD_INFO(field) \
728 "GBE_D:"#field, GBE_STATSD_MODULE, \
729 FIELD_SIZEOF(struct gbe_hw_stats, field), \
730 offsetof(struct gbe_hw_stats, field) \
733 static const struct netcp_ethtool_stat gbe13_et_stats[] = {
735 GBE_STATSA_INFO(rx_good_frames),
736 GBE_STATSA_INFO(rx_broadcast_frames),
737 GBE_STATSA_INFO(rx_multicast_frames),
738 GBE_STATSA_INFO(rx_pause_frames),
739 GBE_STATSA_INFO(rx_crc_errors),
740 GBE_STATSA_INFO(rx_align_code_errors),
741 GBE_STATSA_INFO(rx_oversized_frames),
742 GBE_STATSA_INFO(rx_jabber_frames),
743 GBE_STATSA_INFO(rx_undersized_frames),
744 GBE_STATSA_INFO(rx_fragments),
745 GBE_STATSA_INFO(rx_bytes),
746 GBE_STATSA_INFO(tx_good_frames),
747 GBE_STATSA_INFO(tx_broadcast_frames),
748 GBE_STATSA_INFO(tx_multicast_frames),
749 GBE_STATSA_INFO(tx_pause_frames),
750 GBE_STATSA_INFO(tx_deferred_frames),
751 GBE_STATSA_INFO(tx_collision_frames),
752 GBE_STATSA_INFO(tx_single_coll_frames),
753 GBE_STATSA_INFO(tx_mult_coll_frames),
754 GBE_STATSA_INFO(tx_excessive_collisions),
755 GBE_STATSA_INFO(tx_late_collisions),
756 GBE_STATSA_INFO(tx_underrun),
757 GBE_STATSA_INFO(tx_carrier_sense_errors),
758 GBE_STATSA_INFO(tx_bytes),
759 GBE_STATSA_INFO(tx_64byte_frames),
760 GBE_STATSA_INFO(tx_65_to_127byte_frames),
761 GBE_STATSA_INFO(tx_128_to_255byte_frames),
762 GBE_STATSA_INFO(tx_256_to_511byte_frames),
763 GBE_STATSA_INFO(tx_512_to_1023byte_frames),
764 GBE_STATSA_INFO(tx_1024byte_frames),
765 GBE_STATSA_INFO(net_bytes),
766 GBE_STATSA_INFO(rx_sof_overruns),
767 GBE_STATSA_INFO(rx_mof_overruns),
768 GBE_STATSA_INFO(rx_dma_overruns),
770 GBE_STATSB_INFO(rx_good_frames),
771 GBE_STATSB_INFO(rx_broadcast_frames),
772 GBE_STATSB_INFO(rx_multicast_frames),
773 GBE_STATSB_INFO(rx_pause_frames),
774 GBE_STATSB_INFO(rx_crc_errors),
775 GBE_STATSB_INFO(rx_align_code_errors),
776 GBE_STATSB_INFO(rx_oversized_frames),
777 GBE_STATSB_INFO(rx_jabber_frames),
778 GBE_STATSB_INFO(rx_undersized_frames),
779 GBE_STATSB_INFO(rx_fragments),
780 GBE_STATSB_INFO(rx_bytes),
781 GBE_STATSB_INFO(tx_good_frames),
782 GBE_STATSB_INFO(tx_broadcast_frames),
783 GBE_STATSB_INFO(tx_multicast_frames),
784 GBE_STATSB_INFO(tx_pause_frames),
785 GBE_STATSB_INFO(tx_deferred_frames),
786 GBE_STATSB_INFO(tx_collision_frames),
787 GBE_STATSB_INFO(tx_single_coll_frames),
788 GBE_STATSB_INFO(tx_mult_coll_frames),
789 GBE_STATSB_INFO(tx_excessive_collisions),
790 GBE_STATSB_INFO(tx_late_collisions),
791 GBE_STATSB_INFO(tx_underrun),
792 GBE_STATSB_INFO(tx_carrier_sense_errors),
793 GBE_STATSB_INFO(tx_bytes),
794 GBE_STATSB_INFO(tx_64byte_frames),
795 GBE_STATSB_INFO(tx_65_to_127byte_frames),
796 GBE_STATSB_INFO(tx_128_to_255byte_frames),
797 GBE_STATSB_INFO(tx_256_to_511byte_frames),
798 GBE_STATSB_INFO(tx_512_to_1023byte_frames),
799 GBE_STATSB_INFO(tx_1024byte_frames),
800 GBE_STATSB_INFO(net_bytes),
801 GBE_STATSB_INFO(rx_sof_overruns),
802 GBE_STATSB_INFO(rx_mof_overruns),
803 GBE_STATSB_INFO(rx_dma_overruns),
805 GBE_STATSC_INFO(rx_good_frames),
806 GBE_STATSC_INFO(rx_broadcast_frames),
807 GBE_STATSC_INFO(rx_multicast_frames),
808 GBE_STATSC_INFO(rx_pause_frames),
809 GBE_STATSC_INFO(rx_crc_errors),
810 GBE_STATSC_INFO(rx_align_code_errors),
811 GBE_STATSC_INFO(rx_oversized_frames),
812 GBE_STATSC_INFO(rx_jabber_frames),
813 GBE_STATSC_INFO(rx_undersized_frames),
814 GBE_STATSC_INFO(rx_fragments),
815 GBE_STATSC_INFO(rx_bytes),
816 GBE_STATSC_INFO(tx_good_frames),
817 GBE_STATSC_INFO(tx_broadcast_frames),
818 GBE_STATSC_INFO(tx_multicast_frames),
819 GBE_STATSC_INFO(tx_pause_frames),
820 GBE_STATSC_INFO(tx_deferred_frames),
821 GBE_STATSC_INFO(tx_collision_frames),
822 GBE_STATSC_INFO(tx_single_coll_frames),
823 GBE_STATSC_INFO(tx_mult_coll_frames),
824 GBE_STATSC_INFO(tx_excessive_collisions),
825 GBE_STATSC_INFO(tx_late_collisions),
826 GBE_STATSC_INFO(tx_underrun),
827 GBE_STATSC_INFO(tx_carrier_sense_errors),
828 GBE_STATSC_INFO(tx_bytes),
829 GBE_STATSC_INFO(tx_64byte_frames),
830 GBE_STATSC_INFO(tx_65_to_127byte_frames),
831 GBE_STATSC_INFO(tx_128_to_255byte_frames),
832 GBE_STATSC_INFO(tx_256_to_511byte_frames),
833 GBE_STATSC_INFO(tx_512_to_1023byte_frames),
834 GBE_STATSC_INFO(tx_1024byte_frames),
835 GBE_STATSC_INFO(net_bytes),
836 GBE_STATSC_INFO(rx_sof_overruns),
837 GBE_STATSC_INFO(rx_mof_overruns),
838 GBE_STATSC_INFO(rx_dma_overruns),
840 GBE_STATSD_INFO(rx_good_frames),
841 GBE_STATSD_INFO(rx_broadcast_frames),
842 GBE_STATSD_INFO(rx_multicast_frames),
843 GBE_STATSD_INFO(rx_pause_frames),
844 GBE_STATSD_INFO(rx_crc_errors),
845 GBE_STATSD_INFO(rx_align_code_errors),
846 GBE_STATSD_INFO(rx_oversized_frames),
847 GBE_STATSD_INFO(rx_jabber_frames),
848 GBE_STATSD_INFO(rx_undersized_frames),
849 GBE_STATSD_INFO(rx_fragments),
850 GBE_STATSD_INFO(rx_bytes),
851 GBE_STATSD_INFO(tx_good_frames),
852 GBE_STATSD_INFO(tx_broadcast_frames),
853 GBE_STATSD_INFO(tx_multicast_frames),
854 GBE_STATSD_INFO(tx_pause_frames),
855 GBE_STATSD_INFO(tx_deferred_frames),
856 GBE_STATSD_INFO(tx_collision_frames),
857 GBE_STATSD_INFO(tx_single_coll_frames),
858 GBE_STATSD_INFO(tx_mult_coll_frames),
859 GBE_STATSD_INFO(tx_excessive_collisions),
860 GBE_STATSD_INFO(tx_late_collisions),
861 GBE_STATSD_INFO(tx_underrun),
862 GBE_STATSD_INFO(tx_carrier_sense_errors),
863 GBE_STATSD_INFO(tx_bytes),
864 GBE_STATSD_INFO(tx_64byte_frames),
865 GBE_STATSD_INFO(tx_65_to_127byte_frames),
866 GBE_STATSD_INFO(tx_128_to_255byte_frames),
867 GBE_STATSD_INFO(tx_256_to_511byte_frames),
868 GBE_STATSD_INFO(tx_512_to_1023byte_frames),
869 GBE_STATSD_INFO(tx_1024byte_frames),
870 GBE_STATSD_INFO(net_bytes),
871 GBE_STATSD_INFO(rx_sof_overruns),
872 GBE_STATSD_INFO(rx_mof_overruns),
873 GBE_STATSD_INFO(rx_dma_overruns),
876 /* This is the size of entries in GBENU_STATS_HOST */
877 #define GBENU_ET_STATS_HOST_SIZE 33
879 #define GBENU_STATS_HOST(field) \
881 "GBE_HOST:"#field, GBENU_STATS0_MODULE, \
882 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
883 offsetof(struct gbenu_hw_stats, field) \
886 /* This is the size of entries in GBENU_STATS_HOST */
887 #define GBENU_ET_STATS_PORT_SIZE 46
889 #define GBENU_STATS_P1(field) \
891 "GBE_P1:"#field, GBENU_STATS1_MODULE, \
892 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
893 offsetof(struct gbenu_hw_stats, field) \
896 #define GBENU_STATS_P2(field) \
898 "GBE_P2:"#field, GBENU_STATS2_MODULE, \
899 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
900 offsetof(struct gbenu_hw_stats, field) \
903 #define GBENU_STATS_P3(field) \
905 "GBE_P3:"#field, GBENU_STATS3_MODULE, \
906 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
907 offsetof(struct gbenu_hw_stats, field) \
910 #define GBENU_STATS_P4(field) \
912 "GBE_P4:"#field, GBENU_STATS4_MODULE, \
913 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
914 offsetof(struct gbenu_hw_stats, field) \
917 #define GBENU_STATS_P5(field) \
919 "GBE_P5:"#field, GBENU_STATS5_MODULE, \
920 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
921 offsetof(struct gbenu_hw_stats, field) \
924 #define GBENU_STATS_P6(field) \
926 "GBE_P6:"#field, GBENU_STATS6_MODULE, \
927 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
928 offsetof(struct gbenu_hw_stats, field) \
931 #define GBENU_STATS_P7(field) \
933 "GBE_P7:"#field, GBENU_STATS7_MODULE, \
934 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
935 offsetof(struct gbenu_hw_stats, field) \
938 #define GBENU_STATS_P8(field) \
940 "GBE_P8:"#field, GBENU_STATS8_MODULE, \
941 FIELD_SIZEOF(struct gbenu_hw_stats, field), \
942 offsetof(struct gbenu_hw_stats, field) \
945 static const struct netcp_ethtool_stat gbenu_et_stats[] = {
946 /* GBENU Host Module */
947 GBENU_STATS_HOST(rx_good_frames),
948 GBENU_STATS_HOST(rx_broadcast_frames),
949 GBENU_STATS_HOST(rx_multicast_frames),
950 GBENU_STATS_HOST(rx_crc_errors),
951 GBENU_STATS_HOST(rx_oversized_frames),
952 GBENU_STATS_HOST(rx_undersized_frames),
953 GBENU_STATS_HOST(ale_drop),
954 GBENU_STATS_HOST(ale_overrun_drop),
955 GBENU_STATS_HOST(rx_bytes),
956 GBENU_STATS_HOST(tx_good_frames),
957 GBENU_STATS_HOST(tx_broadcast_frames),
958 GBENU_STATS_HOST(tx_multicast_frames),
959 GBENU_STATS_HOST(tx_bytes),
960 GBENU_STATS_HOST(tx_64B_frames),
961 GBENU_STATS_HOST(tx_65_to_127B_frames),
962 GBENU_STATS_HOST(tx_128_to_255B_frames),
963 GBENU_STATS_HOST(tx_256_to_511B_frames),
964 GBENU_STATS_HOST(tx_512_to_1023B_frames),
965 GBENU_STATS_HOST(tx_1024B_frames),
966 GBENU_STATS_HOST(net_bytes),
967 GBENU_STATS_HOST(rx_bottom_fifo_drop),
968 GBENU_STATS_HOST(rx_port_mask_drop),
969 GBENU_STATS_HOST(rx_top_fifo_drop),
970 GBENU_STATS_HOST(ale_rate_limit_drop),
971 GBENU_STATS_HOST(ale_vid_ingress_drop),
972 GBENU_STATS_HOST(ale_da_eq_sa_drop),
973 GBENU_STATS_HOST(ale_unknown_ucast),
974 GBENU_STATS_HOST(ale_unknown_ucast_bytes),
975 GBENU_STATS_HOST(ale_unknown_mcast),
976 GBENU_STATS_HOST(ale_unknown_mcast_bytes),
977 GBENU_STATS_HOST(ale_unknown_bcast),
978 GBENU_STATS_HOST(ale_unknown_bcast_bytes),
979 GBENU_STATS_HOST(tx_mem_protect_err),
981 GBENU_STATS_P1(rx_good_frames),
982 GBENU_STATS_P1(rx_broadcast_frames),
983 GBENU_STATS_P1(rx_multicast_frames),
984 GBENU_STATS_P1(rx_pause_frames),
985 GBENU_STATS_P1(rx_crc_errors),
986 GBENU_STATS_P1(rx_align_code_errors),
987 GBENU_STATS_P1(rx_oversized_frames),
988 GBENU_STATS_P1(rx_jabber_frames),
989 GBENU_STATS_P1(rx_undersized_frames),
990 GBENU_STATS_P1(rx_fragments),
991 GBENU_STATS_P1(ale_drop),
992 GBENU_STATS_P1(ale_overrun_drop),
993 GBENU_STATS_P1(rx_bytes),
994 GBENU_STATS_P1(tx_good_frames),
995 GBENU_STATS_P1(tx_broadcast_frames),
996 GBENU_STATS_P1(tx_multicast_frames),
997 GBENU_STATS_P1(tx_pause_frames),
998 GBENU_STATS_P1(tx_deferred_frames),
999 GBENU_STATS_P1(tx_collision_frames),
1000 GBENU_STATS_P1(tx_single_coll_frames),
1001 GBENU_STATS_P1(tx_mult_coll_frames),
1002 GBENU_STATS_P1(tx_excessive_collisions),
1003 GBENU_STATS_P1(tx_late_collisions),
1004 GBENU_STATS_P1(rx_ipg_error),
1005 GBENU_STATS_P1(tx_carrier_sense_errors),
1006 GBENU_STATS_P1(tx_bytes),
1007 GBENU_STATS_P1(tx_64B_frames),
1008 GBENU_STATS_P1(tx_65_to_127B_frames),
1009 GBENU_STATS_P1(tx_128_to_255B_frames),
1010 GBENU_STATS_P1(tx_256_to_511B_frames),
1011 GBENU_STATS_P1(tx_512_to_1023B_frames),
1012 GBENU_STATS_P1(tx_1024B_frames),
1013 GBENU_STATS_P1(net_bytes),
1014 GBENU_STATS_P1(rx_bottom_fifo_drop),
1015 GBENU_STATS_P1(rx_port_mask_drop),
1016 GBENU_STATS_P1(rx_top_fifo_drop),
1017 GBENU_STATS_P1(ale_rate_limit_drop),
1018 GBENU_STATS_P1(ale_vid_ingress_drop),
1019 GBENU_STATS_P1(ale_da_eq_sa_drop),
1020 GBENU_STATS_P1(ale_unknown_ucast),
1021 GBENU_STATS_P1(ale_unknown_ucast_bytes),
1022 GBENU_STATS_P1(ale_unknown_mcast),
1023 GBENU_STATS_P1(ale_unknown_mcast_bytes),
1024 GBENU_STATS_P1(ale_unknown_bcast),
1025 GBENU_STATS_P1(ale_unknown_bcast_bytes),
1026 GBENU_STATS_P1(tx_mem_protect_err),
1027 /* GBENU Module 2 */
1028 GBENU_STATS_P2(rx_good_frames),
1029 GBENU_STATS_P2(rx_broadcast_frames),
1030 GBENU_STATS_P2(rx_multicast_frames),
1031 GBENU_STATS_P2(rx_pause_frames),
1032 GBENU_STATS_P2(rx_crc_errors),
1033 GBENU_STATS_P2(rx_align_code_errors),
1034 GBENU_STATS_P2(rx_oversized_frames),
1035 GBENU_STATS_P2(rx_jabber_frames),
1036 GBENU_STATS_P2(rx_undersized_frames),
1037 GBENU_STATS_P2(rx_fragments),
1038 GBENU_STATS_P2(ale_drop),
1039 GBENU_STATS_P2(ale_overrun_drop),
1040 GBENU_STATS_P2(rx_bytes),
1041 GBENU_STATS_P2(tx_good_frames),
1042 GBENU_STATS_P2(tx_broadcast_frames),
1043 GBENU_STATS_P2(tx_multicast_frames),
1044 GBENU_STATS_P2(tx_pause_frames),
1045 GBENU_STATS_P2(tx_deferred_frames),
1046 GBENU_STATS_P2(tx_collision_frames),
1047 GBENU_STATS_P2(tx_single_coll_frames),
1048 GBENU_STATS_P2(tx_mult_coll_frames),
1049 GBENU_STATS_P2(tx_excessive_collisions),
1050 GBENU_STATS_P2(tx_late_collisions),
1051 GBENU_STATS_P2(rx_ipg_error),
1052 GBENU_STATS_P2(tx_carrier_sense_errors),
1053 GBENU_STATS_P2(tx_bytes),
1054 GBENU_STATS_P2(tx_64B_frames),
1055 GBENU_STATS_P2(tx_65_to_127B_frames),
1056 GBENU_STATS_P2(tx_128_to_255B_frames),
1057 GBENU_STATS_P2(tx_256_to_511B_frames),
1058 GBENU_STATS_P2(tx_512_to_1023B_frames),
1059 GBENU_STATS_P2(tx_1024B_frames),
1060 GBENU_STATS_P2(net_bytes),
1061 GBENU_STATS_P2(rx_bottom_fifo_drop),
1062 GBENU_STATS_P2(rx_port_mask_drop),
1063 GBENU_STATS_P2(rx_top_fifo_drop),
1064 GBENU_STATS_P2(ale_rate_limit_drop),
1065 GBENU_STATS_P2(ale_vid_ingress_drop),
1066 GBENU_STATS_P2(ale_da_eq_sa_drop),
1067 GBENU_STATS_P2(ale_unknown_ucast),
1068 GBENU_STATS_P2(ale_unknown_ucast_bytes),
1069 GBENU_STATS_P2(ale_unknown_mcast),
1070 GBENU_STATS_P2(ale_unknown_mcast_bytes),
1071 GBENU_STATS_P2(ale_unknown_bcast),
1072 GBENU_STATS_P2(ale_unknown_bcast_bytes),
1073 GBENU_STATS_P2(tx_mem_protect_err),
1074 /* GBENU Module 3 */
1075 GBENU_STATS_P3(rx_good_frames),
1076 GBENU_STATS_P3(rx_broadcast_frames),
1077 GBENU_STATS_P3(rx_multicast_frames),
1078 GBENU_STATS_P3(rx_pause_frames),
1079 GBENU_STATS_P3(rx_crc_errors),
1080 GBENU_STATS_P3(rx_align_code_errors),
1081 GBENU_STATS_P3(rx_oversized_frames),
1082 GBENU_STATS_P3(rx_jabber_frames),
1083 GBENU_STATS_P3(rx_undersized_frames),
1084 GBENU_STATS_P3(rx_fragments),
1085 GBENU_STATS_P3(ale_drop),
1086 GBENU_STATS_P3(ale_overrun_drop),
1087 GBENU_STATS_P3(rx_bytes),
1088 GBENU_STATS_P3(tx_good_frames),
1089 GBENU_STATS_P3(tx_broadcast_frames),
1090 GBENU_STATS_P3(tx_multicast_frames),
1091 GBENU_STATS_P3(tx_pause_frames),
1092 GBENU_STATS_P3(tx_deferred_frames),
1093 GBENU_STATS_P3(tx_collision_frames),
1094 GBENU_STATS_P3(tx_single_coll_frames),
1095 GBENU_STATS_P3(tx_mult_coll_frames),
1096 GBENU_STATS_P3(tx_excessive_collisions),
1097 GBENU_STATS_P3(tx_late_collisions),
1098 GBENU_STATS_P3(rx_ipg_error),
1099 GBENU_STATS_P3(tx_carrier_sense_errors),
1100 GBENU_STATS_P3(tx_bytes),
1101 GBENU_STATS_P3(tx_64B_frames),
1102 GBENU_STATS_P3(tx_65_to_127B_frames),
1103 GBENU_STATS_P3(tx_128_to_255B_frames),
1104 GBENU_STATS_P3(tx_256_to_511B_frames),
1105 GBENU_STATS_P3(tx_512_to_1023B_frames),
1106 GBENU_STATS_P3(tx_1024B_frames),
1107 GBENU_STATS_P3(net_bytes),
1108 GBENU_STATS_P3(rx_bottom_fifo_drop),
1109 GBENU_STATS_P3(rx_port_mask_drop),
1110 GBENU_STATS_P3(rx_top_fifo_drop),
1111 GBENU_STATS_P3(ale_rate_limit_drop),
1112 GBENU_STATS_P3(ale_vid_ingress_drop),
1113 GBENU_STATS_P3(ale_da_eq_sa_drop),
1114 GBENU_STATS_P3(ale_unknown_ucast),
1115 GBENU_STATS_P3(ale_unknown_ucast_bytes),
1116 GBENU_STATS_P3(ale_unknown_mcast),
1117 GBENU_STATS_P3(ale_unknown_mcast_bytes),
1118 GBENU_STATS_P3(ale_unknown_bcast),
1119 GBENU_STATS_P3(ale_unknown_bcast_bytes),
1120 GBENU_STATS_P3(tx_mem_protect_err),
1121 /* GBENU Module 4 */
1122 GBENU_STATS_P4(rx_good_frames),
1123 GBENU_STATS_P4(rx_broadcast_frames),
1124 GBENU_STATS_P4(rx_multicast_frames),
1125 GBENU_STATS_P4(rx_pause_frames),
1126 GBENU_STATS_P4(rx_crc_errors),
1127 GBENU_STATS_P4(rx_align_code_errors),
1128 GBENU_STATS_P4(rx_oversized_frames),
1129 GBENU_STATS_P4(rx_jabber_frames),
1130 GBENU_STATS_P4(rx_undersized_frames),
1131 GBENU_STATS_P4(rx_fragments),
1132 GBENU_STATS_P4(ale_drop),
1133 GBENU_STATS_P4(ale_overrun_drop),
1134 GBENU_STATS_P4(rx_bytes),
1135 GBENU_STATS_P4(tx_good_frames),
1136 GBENU_STATS_P4(tx_broadcast_frames),
1137 GBENU_STATS_P4(tx_multicast_frames),
1138 GBENU_STATS_P4(tx_pause_frames),
1139 GBENU_STATS_P4(tx_deferred_frames),
1140 GBENU_STATS_P4(tx_collision_frames),
1141 GBENU_STATS_P4(tx_single_coll_frames),
1142 GBENU_STATS_P4(tx_mult_coll_frames),
1143 GBENU_STATS_P4(tx_excessive_collisions),
1144 GBENU_STATS_P4(tx_late_collisions),
1145 GBENU_STATS_P4(rx_ipg_error),
1146 GBENU_STATS_P4(tx_carrier_sense_errors),
1147 GBENU_STATS_P4(tx_bytes),
1148 GBENU_STATS_P4(tx_64B_frames),
1149 GBENU_STATS_P4(tx_65_to_127B_frames),
1150 GBENU_STATS_P4(tx_128_to_255B_frames),
1151 GBENU_STATS_P4(tx_256_to_511B_frames),
1152 GBENU_STATS_P4(tx_512_to_1023B_frames),
1153 GBENU_STATS_P4(tx_1024B_frames),
1154 GBENU_STATS_P4(net_bytes),
1155 GBENU_STATS_P4(rx_bottom_fifo_drop),
1156 GBENU_STATS_P4(rx_port_mask_drop),
1157 GBENU_STATS_P4(rx_top_fifo_drop),
1158 GBENU_STATS_P4(ale_rate_limit_drop),
1159 GBENU_STATS_P4(ale_vid_ingress_drop),
1160 GBENU_STATS_P4(ale_da_eq_sa_drop),
1161 GBENU_STATS_P4(ale_unknown_ucast),
1162 GBENU_STATS_P4(ale_unknown_ucast_bytes),
1163 GBENU_STATS_P4(ale_unknown_mcast),
1164 GBENU_STATS_P4(ale_unknown_mcast_bytes),
1165 GBENU_STATS_P4(ale_unknown_bcast),
1166 GBENU_STATS_P4(ale_unknown_bcast_bytes),
1167 GBENU_STATS_P4(tx_mem_protect_err),
1168 /* GBENU Module 5 */
1169 GBENU_STATS_P5(rx_good_frames),
1170 GBENU_STATS_P5(rx_broadcast_frames),
1171 GBENU_STATS_P5(rx_multicast_frames),
1172 GBENU_STATS_P5(rx_pause_frames),
1173 GBENU_STATS_P5(rx_crc_errors),
1174 GBENU_STATS_P5(rx_align_code_errors),
1175 GBENU_STATS_P5(rx_oversized_frames),
1176 GBENU_STATS_P5(rx_jabber_frames),
1177 GBENU_STATS_P5(rx_undersized_frames),
1178 GBENU_STATS_P5(rx_fragments),
1179 GBENU_STATS_P5(ale_drop),
1180 GBENU_STATS_P5(ale_overrun_drop),
1181 GBENU_STATS_P5(rx_bytes),
1182 GBENU_STATS_P5(tx_good_frames),
1183 GBENU_STATS_P5(tx_broadcast_frames),
1184 GBENU_STATS_P5(tx_multicast_frames),
1185 GBENU_STATS_P5(tx_pause_frames),
1186 GBENU_STATS_P5(tx_deferred_frames),
1187 GBENU_STATS_P5(tx_collision_frames),
1188 GBENU_STATS_P5(tx_single_coll_frames),
1189 GBENU_STATS_P5(tx_mult_coll_frames),
1190 GBENU_STATS_P5(tx_excessive_collisions),
1191 GBENU_STATS_P5(tx_late_collisions),
1192 GBENU_STATS_P5(rx_ipg_error),
1193 GBENU_STATS_P5(tx_carrier_sense_errors),
1194 GBENU_STATS_P5(tx_bytes),
1195 GBENU_STATS_P5(tx_64B_frames),
1196 GBENU_STATS_P5(tx_65_to_127B_frames),
1197 GBENU_STATS_P5(tx_128_to_255B_frames),
1198 GBENU_STATS_P5(tx_256_to_511B_frames),
1199 GBENU_STATS_P5(tx_512_to_1023B_frames),
1200 GBENU_STATS_P5(tx_1024B_frames),
1201 GBENU_STATS_P5(net_bytes),
1202 GBENU_STATS_P5(rx_bottom_fifo_drop),
1203 GBENU_STATS_P5(rx_port_mask_drop),
1204 GBENU_STATS_P5(rx_top_fifo_drop),
1205 GBENU_STATS_P5(ale_rate_limit_drop),
1206 GBENU_STATS_P5(ale_vid_ingress_drop),
1207 GBENU_STATS_P5(ale_da_eq_sa_drop),
1208 GBENU_STATS_P5(ale_unknown_ucast),
1209 GBENU_STATS_P5(ale_unknown_ucast_bytes),
1210 GBENU_STATS_P5(ale_unknown_mcast),
1211 GBENU_STATS_P5(ale_unknown_mcast_bytes),
1212 GBENU_STATS_P5(ale_unknown_bcast),
1213 GBENU_STATS_P5(ale_unknown_bcast_bytes),
1214 GBENU_STATS_P5(tx_mem_protect_err),
1215 /* GBENU Module 6 */
1216 GBENU_STATS_P6(rx_good_frames),
1217 GBENU_STATS_P6(rx_broadcast_frames),
1218 GBENU_STATS_P6(rx_multicast_frames),
1219 GBENU_STATS_P6(rx_pause_frames),
1220 GBENU_STATS_P6(rx_crc_errors),
1221 GBENU_STATS_P6(rx_align_code_errors),
1222 GBENU_STATS_P6(rx_oversized_frames),
1223 GBENU_STATS_P6(rx_jabber_frames),
1224 GBENU_STATS_P6(rx_undersized_frames),
1225 GBENU_STATS_P6(rx_fragments),
1226 GBENU_STATS_P6(ale_drop),
1227 GBENU_STATS_P6(ale_overrun_drop),
1228 GBENU_STATS_P6(rx_bytes),
1229 GBENU_STATS_P6(tx_good_frames),
1230 GBENU_STATS_P6(tx_broadcast_frames),
1231 GBENU_STATS_P6(tx_multicast_frames),
1232 GBENU_STATS_P6(tx_pause_frames),
1233 GBENU_STATS_P6(tx_deferred_frames),
1234 GBENU_STATS_P6(tx_collision_frames),
1235 GBENU_STATS_P6(tx_single_coll_frames),
1236 GBENU_STATS_P6(tx_mult_coll_frames),
1237 GBENU_STATS_P6(tx_excessive_collisions),
1238 GBENU_STATS_P6(tx_late_collisions),
1239 GBENU_STATS_P6(rx_ipg_error),
1240 GBENU_STATS_P6(tx_carrier_sense_errors),
1241 GBENU_STATS_P6(tx_bytes),
1242 GBENU_STATS_P6(tx_64B_frames),
1243 GBENU_STATS_P6(tx_65_to_127B_frames),
1244 GBENU_STATS_P6(tx_128_to_255B_frames),
1245 GBENU_STATS_P6(tx_256_to_511B_frames),
1246 GBENU_STATS_P6(tx_512_to_1023B_frames),
1247 GBENU_STATS_P6(tx_1024B_frames),
1248 GBENU_STATS_P6(net_bytes),
1249 GBENU_STATS_P6(rx_bottom_fifo_drop),
1250 GBENU_STATS_P6(rx_port_mask_drop),
1251 GBENU_STATS_P6(rx_top_fifo_drop),
1252 GBENU_STATS_P6(ale_rate_limit_drop),
1253 GBENU_STATS_P6(ale_vid_ingress_drop),
1254 GBENU_STATS_P6(ale_da_eq_sa_drop),
1255 GBENU_STATS_P6(ale_unknown_ucast),
1256 GBENU_STATS_P6(ale_unknown_ucast_bytes),
1257 GBENU_STATS_P6(ale_unknown_mcast),
1258 GBENU_STATS_P6(ale_unknown_mcast_bytes),
1259 GBENU_STATS_P6(ale_unknown_bcast),
1260 GBENU_STATS_P6(ale_unknown_bcast_bytes),
1261 GBENU_STATS_P6(tx_mem_protect_err),
1262 /* GBENU Module 7 */
1263 GBENU_STATS_P7(rx_good_frames),
1264 GBENU_STATS_P7(rx_broadcast_frames),
1265 GBENU_STATS_P7(rx_multicast_frames),
1266 GBENU_STATS_P7(rx_pause_frames),
1267 GBENU_STATS_P7(rx_crc_errors),
1268 GBENU_STATS_P7(rx_align_code_errors),
1269 GBENU_STATS_P7(rx_oversized_frames),
1270 GBENU_STATS_P7(rx_jabber_frames),
1271 GBENU_STATS_P7(rx_undersized_frames),
1272 GBENU_STATS_P7(rx_fragments),
1273 GBENU_STATS_P7(ale_drop),
1274 GBENU_STATS_P7(ale_overrun_drop),
1275 GBENU_STATS_P7(rx_bytes),
1276 GBENU_STATS_P7(tx_good_frames),
1277 GBENU_STATS_P7(tx_broadcast_frames),
1278 GBENU_STATS_P7(tx_multicast_frames),
1279 GBENU_STATS_P7(tx_pause_frames),
1280 GBENU_STATS_P7(tx_deferred_frames),
1281 GBENU_STATS_P7(tx_collision_frames),
1282 GBENU_STATS_P7(tx_single_coll_frames),
1283 GBENU_STATS_P7(tx_mult_coll_frames),
1284 GBENU_STATS_P7(tx_excessive_collisions),
1285 GBENU_STATS_P7(tx_late_collisions),
1286 GBENU_STATS_P7(rx_ipg_error),
1287 GBENU_STATS_P7(tx_carrier_sense_errors),
1288 GBENU_STATS_P7(tx_bytes),
1289 GBENU_STATS_P7(tx_64B_frames),
1290 GBENU_STATS_P7(tx_65_to_127B_frames),
1291 GBENU_STATS_P7(tx_128_to_255B_frames),
1292 GBENU_STATS_P7(tx_256_to_511B_frames),
1293 GBENU_STATS_P7(tx_512_to_1023B_frames),
1294 GBENU_STATS_P7(tx_1024B_frames),
1295 GBENU_STATS_P7(net_bytes),
1296 GBENU_STATS_P7(rx_bottom_fifo_drop),
1297 GBENU_STATS_P7(rx_port_mask_drop),
1298 GBENU_STATS_P7(rx_top_fifo_drop),
1299 GBENU_STATS_P7(ale_rate_limit_drop),
1300 GBENU_STATS_P7(ale_vid_ingress_drop),
1301 GBENU_STATS_P7(ale_da_eq_sa_drop),
1302 GBENU_STATS_P7(ale_unknown_ucast),
1303 GBENU_STATS_P7(ale_unknown_ucast_bytes),
1304 GBENU_STATS_P7(ale_unknown_mcast),
1305 GBENU_STATS_P7(ale_unknown_mcast_bytes),
1306 GBENU_STATS_P7(ale_unknown_bcast),
1307 GBENU_STATS_P7(ale_unknown_bcast_bytes),
1308 GBENU_STATS_P7(tx_mem_protect_err),
1309 /* GBENU Module 8 */
1310 GBENU_STATS_P8(rx_good_frames),
1311 GBENU_STATS_P8(rx_broadcast_frames),
1312 GBENU_STATS_P8(rx_multicast_frames),
1313 GBENU_STATS_P8(rx_pause_frames),
1314 GBENU_STATS_P8(rx_crc_errors),
1315 GBENU_STATS_P8(rx_align_code_errors),
1316 GBENU_STATS_P8(rx_oversized_frames),
1317 GBENU_STATS_P8(rx_jabber_frames),
1318 GBENU_STATS_P8(rx_undersized_frames),
1319 GBENU_STATS_P8(rx_fragments),
1320 GBENU_STATS_P8(ale_drop),
1321 GBENU_STATS_P8(ale_overrun_drop),
1322 GBENU_STATS_P8(rx_bytes),
1323 GBENU_STATS_P8(tx_good_frames),
1324 GBENU_STATS_P8(tx_broadcast_frames),
1325 GBENU_STATS_P8(tx_multicast_frames),
1326 GBENU_STATS_P8(tx_pause_frames),
1327 GBENU_STATS_P8(tx_deferred_frames),
1328 GBENU_STATS_P8(tx_collision_frames),
1329 GBENU_STATS_P8(tx_single_coll_frames),
1330 GBENU_STATS_P8(tx_mult_coll_frames),
1331 GBENU_STATS_P8(tx_excessive_collisions),
1332 GBENU_STATS_P8(tx_late_collisions),
1333 GBENU_STATS_P8(rx_ipg_error),
1334 GBENU_STATS_P8(tx_carrier_sense_errors),
1335 GBENU_STATS_P8(tx_bytes),
1336 GBENU_STATS_P8(tx_64B_frames),
1337 GBENU_STATS_P8(tx_65_to_127B_frames),
1338 GBENU_STATS_P8(tx_128_to_255B_frames),
1339 GBENU_STATS_P8(tx_256_to_511B_frames),
1340 GBENU_STATS_P8(tx_512_to_1023B_frames),
1341 GBENU_STATS_P8(tx_1024B_frames),
1342 GBENU_STATS_P8(net_bytes),
1343 GBENU_STATS_P8(rx_bottom_fifo_drop),
1344 GBENU_STATS_P8(rx_port_mask_drop),
1345 GBENU_STATS_P8(rx_top_fifo_drop),
1346 GBENU_STATS_P8(ale_rate_limit_drop),
1347 GBENU_STATS_P8(ale_vid_ingress_drop),
1348 GBENU_STATS_P8(ale_da_eq_sa_drop),
1349 GBENU_STATS_P8(ale_unknown_ucast),
1350 GBENU_STATS_P8(ale_unknown_ucast_bytes),
1351 GBENU_STATS_P8(ale_unknown_mcast),
1352 GBENU_STATS_P8(ale_unknown_mcast_bytes),
1353 GBENU_STATS_P8(ale_unknown_bcast),
1354 GBENU_STATS_P8(ale_unknown_bcast_bytes),
1355 GBENU_STATS_P8(tx_mem_protect_err),
1358 #define XGBE_STATS0_INFO(field) \
1360 "GBE_0:"#field, XGBE_STATS0_MODULE, \
1361 FIELD_SIZEOF(struct xgbe_hw_stats, field), \
1362 offsetof(struct xgbe_hw_stats, field) \
1365 #define XGBE_STATS1_INFO(field) \
1367 "GBE_1:"#field, XGBE_STATS1_MODULE, \
1368 FIELD_SIZEOF(struct xgbe_hw_stats, field), \
1369 offsetof(struct xgbe_hw_stats, field) \
1372 #define XGBE_STATS2_INFO(field) \
1374 "GBE_2:"#field, XGBE_STATS2_MODULE, \
1375 FIELD_SIZEOF(struct xgbe_hw_stats, field), \
1376 offsetof(struct xgbe_hw_stats, field) \
1379 static const struct netcp_ethtool_stat xgbe10_et_stats[] = {
1381 XGBE_STATS0_INFO(rx_good_frames),
1382 XGBE_STATS0_INFO(rx_broadcast_frames),
1383 XGBE_STATS0_INFO(rx_multicast_frames),
1384 XGBE_STATS0_INFO(rx_oversized_frames),
1385 XGBE_STATS0_INFO(rx_undersized_frames),
1386 XGBE_STATS0_INFO(overrun_type4),
1387 XGBE_STATS0_INFO(overrun_type5),
1388 XGBE_STATS0_INFO(rx_bytes),
1389 XGBE_STATS0_INFO(tx_good_frames),
1390 XGBE_STATS0_INFO(tx_broadcast_frames),
1391 XGBE_STATS0_INFO(tx_multicast_frames),
1392 XGBE_STATS0_INFO(tx_bytes),
1393 XGBE_STATS0_INFO(tx_64byte_frames),
1394 XGBE_STATS0_INFO(tx_65_to_127byte_frames),
1395 XGBE_STATS0_INFO(tx_128_to_255byte_frames),
1396 XGBE_STATS0_INFO(tx_256_to_511byte_frames),
1397 XGBE_STATS0_INFO(tx_512_to_1023byte_frames),
1398 XGBE_STATS0_INFO(tx_1024byte_frames),
1399 XGBE_STATS0_INFO(net_bytes),
1400 XGBE_STATS0_INFO(rx_sof_overruns),
1401 XGBE_STATS0_INFO(rx_mof_overruns),
1402 XGBE_STATS0_INFO(rx_dma_overruns),
1404 XGBE_STATS1_INFO(rx_good_frames),
1405 XGBE_STATS1_INFO(rx_broadcast_frames),
1406 XGBE_STATS1_INFO(rx_multicast_frames),
1407 XGBE_STATS1_INFO(rx_pause_frames),
1408 XGBE_STATS1_INFO(rx_crc_errors),
1409 XGBE_STATS1_INFO(rx_align_code_errors),
1410 XGBE_STATS1_INFO(rx_oversized_frames),
1411 XGBE_STATS1_INFO(rx_jabber_frames),
1412 XGBE_STATS1_INFO(rx_undersized_frames),
1413 XGBE_STATS1_INFO(rx_fragments),
1414 XGBE_STATS1_INFO(overrun_type4),
1415 XGBE_STATS1_INFO(overrun_type5),
1416 XGBE_STATS1_INFO(rx_bytes),
1417 XGBE_STATS1_INFO(tx_good_frames),
1418 XGBE_STATS1_INFO(tx_broadcast_frames),
1419 XGBE_STATS1_INFO(tx_multicast_frames),
1420 XGBE_STATS1_INFO(tx_pause_frames),
1421 XGBE_STATS1_INFO(tx_deferred_frames),
1422 XGBE_STATS1_INFO(tx_collision_frames),
1423 XGBE_STATS1_INFO(tx_single_coll_frames),
1424 XGBE_STATS1_INFO(tx_mult_coll_frames),
1425 XGBE_STATS1_INFO(tx_excessive_collisions),
1426 XGBE_STATS1_INFO(tx_late_collisions),
1427 XGBE_STATS1_INFO(tx_underrun),
1428 XGBE_STATS1_INFO(tx_carrier_sense_errors),
1429 XGBE_STATS1_INFO(tx_bytes),
1430 XGBE_STATS1_INFO(tx_64byte_frames),
1431 XGBE_STATS1_INFO(tx_65_to_127byte_frames),
1432 XGBE_STATS1_INFO(tx_128_to_255byte_frames),
1433 XGBE_STATS1_INFO(tx_256_to_511byte_frames),
1434 XGBE_STATS1_INFO(tx_512_to_1023byte_frames),
1435 XGBE_STATS1_INFO(tx_1024byte_frames),
1436 XGBE_STATS1_INFO(net_bytes),
1437 XGBE_STATS1_INFO(rx_sof_overruns),
1438 XGBE_STATS1_INFO(rx_mof_overruns),
1439 XGBE_STATS1_INFO(rx_dma_overruns),
1441 XGBE_STATS2_INFO(rx_good_frames),
1442 XGBE_STATS2_INFO(rx_broadcast_frames),
1443 XGBE_STATS2_INFO(rx_multicast_frames),
1444 XGBE_STATS2_INFO(rx_pause_frames),
1445 XGBE_STATS2_INFO(rx_crc_errors),
1446 XGBE_STATS2_INFO(rx_align_code_errors),
1447 XGBE_STATS2_INFO(rx_oversized_frames),
1448 XGBE_STATS2_INFO(rx_jabber_frames),
1449 XGBE_STATS2_INFO(rx_undersized_frames),
1450 XGBE_STATS2_INFO(rx_fragments),
1451 XGBE_STATS2_INFO(overrun_type4),
1452 XGBE_STATS2_INFO(overrun_type5),
1453 XGBE_STATS2_INFO(rx_bytes),
1454 XGBE_STATS2_INFO(tx_good_frames),
1455 XGBE_STATS2_INFO(tx_broadcast_frames),
1456 XGBE_STATS2_INFO(tx_multicast_frames),
1457 XGBE_STATS2_INFO(tx_pause_frames),
1458 XGBE_STATS2_INFO(tx_deferred_frames),
1459 XGBE_STATS2_INFO(tx_collision_frames),
1460 XGBE_STATS2_INFO(tx_single_coll_frames),
1461 XGBE_STATS2_INFO(tx_mult_coll_frames),
1462 XGBE_STATS2_INFO(tx_excessive_collisions),
1463 XGBE_STATS2_INFO(tx_late_collisions),
1464 XGBE_STATS2_INFO(tx_underrun),
1465 XGBE_STATS2_INFO(tx_carrier_sense_errors),
1466 XGBE_STATS2_INFO(tx_bytes),
1467 XGBE_STATS2_INFO(tx_64byte_frames),
1468 XGBE_STATS2_INFO(tx_65_to_127byte_frames),
1469 XGBE_STATS2_INFO(tx_128_to_255byte_frames),
1470 XGBE_STATS2_INFO(tx_256_to_511byte_frames),
1471 XGBE_STATS2_INFO(tx_512_to_1023byte_frames),
1472 XGBE_STATS2_INFO(tx_1024byte_frames),
1473 XGBE_STATS2_INFO(net_bytes),
1474 XGBE_STATS2_INFO(rx_sof_overruns),
1475 XGBE_STATS2_INFO(rx_mof_overruns),
1476 XGBE_STATS2_INFO(rx_dma_overruns),
1479 #define for_each_intf(i, priv) \
1480 list_for_each_entry((i), &(priv)->gbe_intf_head, gbe_intf_list)
1482 #define for_each_sec_slave(slave, priv) \
1483 list_for_each_entry((slave), &(priv)->secondary_slaves, slave_list)
1485 #define first_sec_slave(priv) \
1486 list_first_entry(&priv->secondary_slaves, \
1487 struct gbe_slave, slave_list)
1489 static void keystone_get_drvinfo(struct net_device *ndev,
1490 struct ethtool_drvinfo *info)
1492 strncpy(info->driver, NETCP_DRIVER_NAME, sizeof(info->driver));
1493 strncpy(info->version, NETCP_DRIVER_VERSION, sizeof(info->version));
1496 static u32 keystone_get_msglevel(struct net_device *ndev)
1498 struct netcp_intf *netcp = netdev_priv(ndev);
1500 return netcp->msg_enable;
1503 static void keystone_set_msglevel(struct net_device *ndev, u32 value)
1505 struct netcp_intf *netcp = netdev_priv(ndev);
1507 netcp->msg_enable = value;
1510 static void keystone_get_stat_strings(struct net_device *ndev,
1511 uint32_t stringset, uint8_t *data)
1513 struct netcp_intf *netcp = netdev_priv(ndev);
1514 struct gbe_intf *gbe_intf;
1515 struct gbe_priv *gbe_dev;
1518 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1521 gbe_dev = gbe_intf->gbe_dev;
1523 switch (stringset) {
1525 for (i = 0; i < gbe_dev->num_et_stats; i++) {
1526 memcpy(data, gbe_dev->et_stats[i].desc,
1528 data += ETH_GSTRING_LEN;
1536 static int keystone_get_sset_count(struct net_device *ndev, int stringset)
1538 struct netcp_intf *netcp = netdev_priv(ndev);
1539 struct gbe_intf *gbe_intf;
1540 struct gbe_priv *gbe_dev;
1542 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1545 gbe_dev = gbe_intf->gbe_dev;
1547 switch (stringset) {
1551 return gbe_dev->num_et_stats;
1557 static void gbe_update_stats(struct gbe_priv *gbe_dev, uint64_t *data)
1559 void __iomem *base = NULL;
1564 for (i = 0; i < gbe_dev->num_et_stats; i++) {
1565 base = gbe_dev->hw_stats_regs[gbe_dev->et_stats[i].type];
1566 p = base + gbe_dev->et_stats[i].offset;
1568 gbe_dev->hw_stats[i] = gbe_dev->hw_stats[i] + tmp;
1570 data[i] = gbe_dev->hw_stats[i];
1571 /* write-to-decrement:
1572 * new register value = old register value - write value
1578 static void gbe_update_stats_ver14(struct gbe_priv *gbe_dev, uint64_t *data)
1580 void __iomem *gbe_statsa = gbe_dev->hw_stats_regs[0];
1581 void __iomem *gbe_statsb = gbe_dev->hw_stats_regs[1];
1582 u64 *hw_stats = &gbe_dev->hw_stats[0];
1583 void __iomem *base = NULL;
1585 u32 tmp = 0, val, pair_size = (gbe_dev->num_et_stats / 2);
1588 for (pair = 0; pair < 2; pair++) {
1589 val = readl(GBE_REG_ADDR(gbe_dev, switch_regs, stat_port_en));
1592 val &= ~GBE_STATS_CD_SEL;
1594 val |= GBE_STATS_CD_SEL;
1596 /* make the stat modules visible */
1597 writel(val, GBE_REG_ADDR(gbe_dev, switch_regs, stat_port_en));
1599 for (i = 0; i < pair_size; i++) {
1600 j = pair * pair_size + i;
1601 switch (gbe_dev->et_stats[j].type) {
1602 case GBE_STATSA_MODULE:
1603 case GBE_STATSC_MODULE:
1606 case GBE_STATSB_MODULE:
1607 case GBE_STATSD_MODULE:
1612 p = base + gbe_dev->et_stats[j].offset;
1616 data[j] = hw_stats[j];
1617 /* write-to-decrement:
1618 * new register value = old register value - write value
1625 static void keystone_get_ethtool_stats(struct net_device *ndev,
1626 struct ethtool_stats *stats,
1629 struct netcp_intf *netcp = netdev_priv(ndev);
1630 struct gbe_intf *gbe_intf;
1631 struct gbe_priv *gbe_dev;
1633 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1637 gbe_dev = gbe_intf->gbe_dev;
1638 spin_lock_bh(&gbe_dev->hw_stats_lock);
1639 if (gbe_dev->ss_version == GBE_SS_VERSION_14)
1640 gbe_update_stats_ver14(gbe_dev, data);
1642 gbe_update_stats(gbe_dev, data);
1643 spin_unlock_bh(&gbe_dev->hw_stats_lock);
1646 static int keystone_get_settings(struct net_device *ndev,
1647 struct ethtool_cmd *cmd)
1649 struct netcp_intf *netcp = netdev_priv(ndev);
1650 struct phy_device *phy = ndev->phydev;
1651 struct gbe_intf *gbe_intf;
1657 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1661 if (!gbe_intf->slave)
1664 ret = phy_ethtool_gset(phy, cmd);
1666 cmd->port = gbe_intf->slave->phy_port_t;
1671 static int keystone_set_settings(struct net_device *ndev,
1672 struct ethtool_cmd *cmd)
1674 struct netcp_intf *netcp = netdev_priv(ndev);
1675 struct phy_device *phy = ndev->phydev;
1676 struct gbe_intf *gbe_intf;
1677 u32 features = cmd->advertising & cmd->supported;
1682 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1686 if (!gbe_intf->slave)
1689 if (cmd->port != gbe_intf->slave->phy_port_t) {
1690 if ((cmd->port == PORT_TP) && !(features & ADVERTISED_TP))
1693 if ((cmd->port == PORT_AUI) && !(features & ADVERTISED_AUI))
1696 if ((cmd->port == PORT_BNC) && !(features & ADVERTISED_BNC))
1699 if ((cmd->port == PORT_MII) && !(features & ADVERTISED_MII))
1702 if ((cmd->port == PORT_FIBRE) && !(features & ADVERTISED_FIBRE))
1706 gbe_intf->slave->phy_port_t = cmd->port;
1707 return phy_ethtool_sset(phy, cmd);
1710 static const struct ethtool_ops keystone_ethtool_ops = {
1711 .get_drvinfo = keystone_get_drvinfo,
1712 .get_link = ethtool_op_get_link,
1713 .get_msglevel = keystone_get_msglevel,
1714 .set_msglevel = keystone_set_msglevel,
1715 .get_strings = keystone_get_stat_strings,
1716 .get_sset_count = keystone_get_sset_count,
1717 .get_ethtool_stats = keystone_get_ethtool_stats,
1718 .get_settings = keystone_get_settings,
1719 .set_settings = keystone_set_settings,
1722 #define mac_hi(mac) (((mac)[0] << 0) | ((mac)[1] << 8) | \
1723 ((mac)[2] << 16) | ((mac)[3] << 24))
1724 #define mac_lo(mac) (((mac)[4] << 0) | ((mac)[5] << 8))
1726 static void gbe_set_slave_mac(struct gbe_slave *slave,
1727 struct gbe_intf *gbe_intf)
1729 struct net_device *ndev = gbe_intf->ndev;
1731 writel(mac_hi(ndev->dev_addr), GBE_REG_ADDR(slave, port_regs, sa_hi));
1732 writel(mac_lo(ndev->dev_addr), GBE_REG_ADDR(slave, port_regs, sa_lo));
1735 static int gbe_get_slave_port(struct gbe_priv *priv, u32 slave_num)
1737 if (priv->host_port == 0)
1738 return slave_num + 1;
1743 static void netcp_ethss_link_state_action(struct gbe_priv *gbe_dev,
1744 struct net_device *ndev,
1745 struct gbe_slave *slave,
1748 struct phy_device *phy = slave->phy;
1749 u32 mac_control = 0;
1752 mac_control = slave->mac_control;
1753 if (phy && (phy->speed == SPEED_1000)) {
1754 mac_control |= MACSL_GIG_MODE;
1755 mac_control &= ~MACSL_XGIG_MODE;
1756 } else if (phy && (phy->speed == SPEED_10000)) {
1757 mac_control |= MACSL_XGIG_MODE;
1758 mac_control &= ~MACSL_GIG_MODE;
1761 writel(mac_control, GBE_REG_ADDR(slave, emac_regs,
1764 cpsw_ale_control_set(gbe_dev->ale, slave->port_num,
1766 ALE_PORT_STATE_FORWARD);
1768 if (ndev && slave->open &&
1769 slave->link_interface != SGMII_LINK_MAC_PHY &&
1770 slave->link_interface != XGMII_LINK_MAC_PHY)
1771 netif_carrier_on(ndev);
1773 writel(mac_control, GBE_REG_ADDR(slave, emac_regs,
1775 cpsw_ale_control_set(gbe_dev->ale, slave->port_num,
1777 ALE_PORT_STATE_DISABLE);
1779 slave->link_interface != SGMII_LINK_MAC_PHY &&
1780 slave->link_interface != XGMII_LINK_MAC_PHY)
1781 netif_carrier_off(ndev);
1785 phy_print_status(phy);
1788 static bool gbe_phy_link_status(struct gbe_slave *slave)
1790 return !slave->phy || slave->phy->link;
1793 static void netcp_ethss_update_link_state(struct gbe_priv *gbe_dev,
1794 struct gbe_slave *slave,
1795 struct net_device *ndev)
1797 int sp = slave->slave_num;
1798 int phy_link_state, sgmii_link_state = 1, link_state;
1803 if (!SLAVE_LINK_IS_XGMII(slave)) {
1804 if (gbe_dev->ss_version == GBE_SS_VERSION_14)
1806 netcp_sgmii_get_port_link(SGMII_BASE(sp), sp);
1809 netcp_sgmii_get_port_link(
1810 gbe_dev->sgmii_port_regs, sp);
1813 phy_link_state = gbe_phy_link_status(slave);
1814 link_state = phy_link_state & sgmii_link_state;
1816 if (atomic_xchg(&slave->link_state, link_state) != link_state)
1817 netcp_ethss_link_state_action(gbe_dev, ndev, slave,
1821 static void xgbe_adjust_link(struct net_device *ndev)
1823 struct netcp_intf *netcp = netdev_priv(ndev);
1824 struct gbe_intf *gbe_intf;
1826 gbe_intf = netcp_module_get_intf_data(&xgbe_module, netcp);
1830 netcp_ethss_update_link_state(gbe_intf->gbe_dev, gbe_intf->slave,
1834 static void gbe_adjust_link(struct net_device *ndev)
1836 struct netcp_intf *netcp = netdev_priv(ndev);
1837 struct gbe_intf *gbe_intf;
1839 gbe_intf = netcp_module_get_intf_data(&gbe_module, netcp);
1843 netcp_ethss_update_link_state(gbe_intf->gbe_dev, gbe_intf->slave,
1847 static void gbe_adjust_link_sec_slaves(struct net_device *ndev)
1849 struct gbe_priv *gbe_dev = netdev_priv(ndev);
1850 struct gbe_slave *slave;
1852 for_each_sec_slave(slave, gbe_dev)
1853 netcp_ethss_update_link_state(gbe_dev, slave, NULL);
1857 * Soft reset is set and polled until clear, or until a timeout occurs
1859 static int gbe_port_reset(struct gbe_slave *slave)
1863 /* Set the soft reset bit */
1864 writel(SOFT_RESET, GBE_REG_ADDR(slave, emac_regs, soft_reset));
1866 /* Wait for the bit to clear */
1867 for (i = 0; i < DEVICE_EMACSL_RESET_POLL_COUNT; i++) {
1868 v = readl(GBE_REG_ADDR(slave, emac_regs, soft_reset));
1869 if ((v & SOFT_RESET_MASK) != SOFT_RESET)
1873 /* Timeout on the reset */
1874 return GMACSL_RET_WARN_RESET_INCOMPLETE;
1877 /* Configure EMAC */
1878 static void gbe_port_config(struct gbe_priv *gbe_dev, struct gbe_slave *slave,
1881 void __iomem *rx_maxlen_reg;
1884 if (max_rx_len > NETCP_MAX_FRAME_SIZE)
1885 max_rx_len = NETCP_MAX_FRAME_SIZE;
1887 /* Enable correct MII mode at SS level */
1888 if ((gbe_dev->ss_version == XGBE_SS_VERSION_10) &&
1889 (slave->link_interface >= XGMII_LINK_MAC_PHY)) {
1890 xgmii_mode = readl(GBE_REG_ADDR(gbe_dev, ss_regs, control));
1891 xgmii_mode |= (1 << slave->slave_num);
1892 writel(xgmii_mode, GBE_REG_ADDR(gbe_dev, ss_regs, control));
1895 if (IS_SS_ID_MU(gbe_dev))
1896 rx_maxlen_reg = GBE_REG_ADDR(slave, port_regs, rx_maxlen);
1898 rx_maxlen_reg = GBE_REG_ADDR(slave, emac_regs, rx_maxlen);
1900 writel(max_rx_len, rx_maxlen_reg);
1901 writel(slave->mac_control, GBE_REG_ADDR(slave, emac_regs, mac_control));
1904 static void gbe_sgmii_rtreset(struct gbe_priv *priv,
1905 struct gbe_slave *slave, bool set)
1907 void __iomem *sgmii_port_regs;
1909 if (SLAVE_LINK_IS_XGMII(slave))
1912 if ((priv->ss_version == GBE_SS_VERSION_14) && (slave->slave_num >= 2))
1913 sgmii_port_regs = priv->sgmii_port34_regs;
1915 sgmii_port_regs = priv->sgmii_port_regs;
1917 netcp_sgmii_rtreset(sgmii_port_regs, slave->slave_num, set);
1920 static void gbe_slave_stop(struct gbe_intf *intf)
1922 struct gbe_priv *gbe_dev = intf->gbe_dev;
1923 struct gbe_slave *slave = intf->slave;
1925 gbe_sgmii_rtreset(gbe_dev, slave, true);
1926 gbe_port_reset(slave);
1927 /* Disable forwarding */
1928 cpsw_ale_control_set(gbe_dev->ale, slave->port_num,
1929 ALE_PORT_STATE, ALE_PORT_STATE_DISABLE);
1930 cpsw_ale_del_mcast(gbe_dev->ale, intf->ndev->broadcast,
1931 1 << slave->port_num, 0, 0);
1936 phy_stop(slave->phy);
1937 phy_disconnect(slave->phy);
1941 static void gbe_sgmii_config(struct gbe_priv *priv, struct gbe_slave *slave)
1943 void __iomem *sgmii_port_regs;
1945 sgmii_port_regs = priv->sgmii_port_regs;
1946 if ((priv->ss_version == GBE_SS_VERSION_14) && (slave->slave_num >= 2))
1947 sgmii_port_regs = priv->sgmii_port34_regs;
1949 if (!SLAVE_LINK_IS_XGMII(slave)) {
1950 netcp_sgmii_reset(sgmii_port_regs, slave->slave_num);
1951 netcp_sgmii_config(sgmii_port_regs, slave->slave_num,
1952 slave->link_interface);
1956 static int gbe_slave_open(struct gbe_intf *gbe_intf)
1958 struct gbe_priv *priv = gbe_intf->gbe_dev;
1959 struct gbe_slave *slave = gbe_intf->slave;
1960 phy_interface_t phy_mode;
1961 bool has_phy = false;
1963 void (*hndlr)(struct net_device *) = gbe_adjust_link;
1965 gbe_sgmii_config(priv, slave);
1966 gbe_port_reset(slave);
1967 gbe_sgmii_rtreset(priv, slave, false);
1968 gbe_port_config(priv, slave, priv->rx_packet_max);
1969 gbe_set_slave_mac(slave, gbe_intf);
1970 /* enable forwarding */
1971 cpsw_ale_control_set(priv->ale, slave->port_num,
1972 ALE_PORT_STATE, ALE_PORT_STATE_FORWARD);
1973 cpsw_ale_add_mcast(priv->ale, gbe_intf->ndev->broadcast,
1974 1 << slave->port_num, 0, 0, ALE_MCAST_FWD_2);
1976 if (slave->link_interface == SGMII_LINK_MAC_PHY) {
1978 phy_mode = PHY_INTERFACE_MODE_SGMII;
1979 slave->phy_port_t = PORT_MII;
1980 } else if (slave->link_interface == XGMII_LINK_MAC_PHY) {
1982 phy_mode = PHY_INTERFACE_MODE_NA;
1983 slave->phy_port_t = PORT_FIBRE;
1987 if (priv->ss_version == XGBE_SS_VERSION_10)
1988 hndlr = xgbe_adjust_link;
1990 slave->phy = of_phy_connect(gbe_intf->ndev,
1995 dev_err(priv->dev, "phy not found on slave %d\n",
1999 dev_dbg(priv->dev, "phy found: id is: 0x%s\n",
2000 dev_name(&slave->phy->dev));
2001 phy_start(slave->phy);
2002 phy_read_status(slave->phy);
2007 static void gbe_init_host_port(struct gbe_priv *priv)
2012 if (IS_SS_ID_NU(priv))
2013 writel(HOST_TX_PRI_MAP_DEFAULT,
2014 GBE_REG_ADDR(priv, host_port_regs, tx_pri_map));
2016 /* Max length register */
2017 writel(NETCP_MAX_FRAME_SIZE, GBE_REG_ADDR(priv, host_port_regs,
2020 cpsw_ale_start(priv->ale);
2022 if (priv->enable_ale)
2025 cpsw_ale_control_set(priv->ale, 0, ALE_BYPASS, bypass_en);
2027 cpsw_ale_control_set(priv->ale, 0, ALE_NO_PORT_VLAN, 1);
2029 cpsw_ale_control_set(priv->ale, priv->host_port,
2030 ALE_PORT_STATE, ALE_PORT_STATE_FORWARD);
2032 cpsw_ale_control_set(priv->ale, 0,
2033 ALE_PORT_UNKNOWN_VLAN_MEMBER,
2034 GBE_PORT_MASK(priv->ale_ports));
2036 cpsw_ale_control_set(priv->ale, 0,
2037 ALE_PORT_UNKNOWN_MCAST_FLOOD,
2038 GBE_PORT_MASK(priv->ale_ports - 1));
2040 cpsw_ale_control_set(priv->ale, 0,
2041 ALE_PORT_UNKNOWN_REG_MCAST_FLOOD,
2042 GBE_PORT_MASK(priv->ale_ports));
2044 cpsw_ale_control_set(priv->ale, 0,
2045 ALE_PORT_UNTAGGED_EGRESS,
2046 GBE_PORT_MASK(priv->ale_ports));
2049 static void gbe_add_mcast_addr(struct gbe_intf *gbe_intf, u8 *addr)
2051 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2054 cpsw_ale_add_mcast(gbe_dev->ale, addr,
2055 GBE_PORT_MASK(gbe_dev->ale_ports), 0, 0,
2057 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) {
2058 cpsw_ale_add_mcast(gbe_dev->ale, addr,
2059 GBE_PORT_MASK(gbe_dev->ale_ports),
2060 ALE_VLAN, vlan_id, ALE_MCAST_FWD_2);
2064 static void gbe_add_ucast_addr(struct gbe_intf *gbe_intf, u8 *addr)
2066 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2069 cpsw_ale_add_ucast(gbe_dev->ale, addr, gbe_dev->host_port, 0, 0);
2071 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID)
2072 cpsw_ale_add_ucast(gbe_dev->ale, addr, gbe_dev->host_port,
2076 static void gbe_del_mcast_addr(struct gbe_intf *gbe_intf, u8 *addr)
2078 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2081 cpsw_ale_del_mcast(gbe_dev->ale, addr, 0, 0, 0);
2083 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) {
2084 cpsw_ale_del_mcast(gbe_dev->ale, addr, 0, ALE_VLAN, vlan_id);
2088 static void gbe_del_ucast_addr(struct gbe_intf *gbe_intf, u8 *addr)
2090 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2093 cpsw_ale_del_ucast(gbe_dev->ale, addr, gbe_dev->host_port, 0, 0);
2095 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) {
2096 cpsw_ale_del_ucast(gbe_dev->ale, addr, gbe_dev->host_port,
2101 static int gbe_add_addr(void *intf_priv, struct netcp_addr *naddr)
2103 struct gbe_intf *gbe_intf = intf_priv;
2104 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2106 dev_dbg(gbe_dev->dev, "ethss adding address %pM, type %d\n",
2107 naddr->addr, naddr->type);
2109 switch (naddr->type) {
2112 gbe_add_mcast_addr(gbe_intf, naddr->addr);
2116 gbe_add_ucast_addr(gbe_intf, naddr->addr);
2119 /* nothing to do for promiscuous */
2127 static int gbe_del_addr(void *intf_priv, struct netcp_addr *naddr)
2129 struct gbe_intf *gbe_intf = intf_priv;
2130 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2132 dev_dbg(gbe_dev->dev, "ethss deleting address %pM, type %d\n",
2133 naddr->addr, naddr->type);
2135 switch (naddr->type) {
2138 gbe_del_mcast_addr(gbe_intf, naddr->addr);
2142 gbe_del_ucast_addr(gbe_intf, naddr->addr);
2145 /* nothing to do for promiscuous */
2153 static int gbe_add_vid(void *intf_priv, int vid)
2155 struct gbe_intf *gbe_intf = intf_priv;
2156 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2158 set_bit(vid, gbe_intf->active_vlans);
2160 cpsw_ale_add_vlan(gbe_dev->ale, vid,
2161 GBE_PORT_MASK(gbe_dev->ale_ports),
2163 GBE_PORT_MASK(gbe_dev->ale_ports),
2164 GBE_PORT_MASK(gbe_dev->ale_ports - 1));
2169 static int gbe_del_vid(void *intf_priv, int vid)
2171 struct gbe_intf *gbe_intf = intf_priv;
2172 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2174 cpsw_ale_del_vlan(gbe_dev->ale, vid, 0);
2175 clear_bit(vid, gbe_intf->active_vlans);
2179 static int gbe_ioctl(void *intf_priv, struct ifreq *req, int cmd)
2181 struct gbe_intf *gbe_intf = intf_priv;
2182 struct phy_device *phy = gbe_intf->slave->phy;
2183 int ret = -EOPNOTSUPP;
2186 ret = phy_mii_ioctl(phy, req, cmd);
2191 static void netcp_ethss_timer(unsigned long arg)
2193 struct gbe_priv *gbe_dev = (struct gbe_priv *)arg;
2194 struct gbe_intf *gbe_intf;
2195 struct gbe_slave *slave;
2197 /* Check & update SGMII link state of interfaces */
2198 for_each_intf(gbe_intf, gbe_dev) {
2199 if (!gbe_intf->slave->open)
2201 netcp_ethss_update_link_state(gbe_dev, gbe_intf->slave,
2205 /* Check & update SGMII link state of secondary ports */
2206 for_each_sec_slave(slave, gbe_dev) {
2207 netcp_ethss_update_link_state(gbe_dev, slave, NULL);
2210 spin_lock_bh(&gbe_dev->hw_stats_lock);
2212 if (gbe_dev->ss_version == GBE_SS_VERSION_14)
2213 gbe_update_stats_ver14(gbe_dev, NULL);
2215 gbe_update_stats(gbe_dev, NULL);
2217 spin_unlock_bh(&gbe_dev->hw_stats_lock);
2219 gbe_dev->timer.expires = jiffies + GBE_TIMER_INTERVAL;
2220 add_timer(&gbe_dev->timer);
2223 static int gbe_tx_hook(int order, void *data, struct netcp_packet *p_info)
2225 struct gbe_intf *gbe_intf = data;
2227 p_info->tx_pipe = &gbe_intf->tx_pipe;
2231 static int gbe_open(void *intf_priv, struct net_device *ndev)
2233 struct gbe_intf *gbe_intf = intf_priv;
2234 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev;
2235 struct netcp_intf *netcp = netdev_priv(ndev);
2236 struct gbe_slave *slave = gbe_intf->slave;
2237 int port_num = slave->port_num;
2241 reg = readl(GBE_REG_ADDR(gbe_dev, switch_regs, id_ver));
2242 dev_dbg(gbe_dev->dev, "initializing gbe version %d.%d (%d) GBE identification value 0x%x\n",
2243 GBE_MAJOR_VERSION(reg), GBE_MINOR_VERSION(reg),
2244 GBE_RTL_VERSION(reg), GBE_IDENT(reg));
2246 /* For 10G and on NetCP 1.5, use directed to port */
2247 if ((gbe_dev->ss_version == XGBE_SS_VERSION_10) || IS_SS_ID_MU(gbe_dev))
2248 gbe_intf->tx_pipe.flags = SWITCH_TO_PORT_IN_TAGINFO;
2250 if (gbe_dev->enable_ale)
2251 gbe_intf->tx_pipe.switch_to_port = 0;
2253 gbe_intf->tx_pipe.switch_to_port = port_num;
2255 dev_dbg(gbe_dev->dev,
2256 "opened TX channel %s: %p with to port %d, flags %d\n",
2257 gbe_intf->tx_pipe.dma_chan_name,
2258 gbe_intf->tx_pipe.dma_channel,
2259 gbe_intf->tx_pipe.switch_to_port,
2260 gbe_intf->tx_pipe.flags);
2262 gbe_slave_stop(gbe_intf);
2264 /* disable priority elevation and enable statistics on all ports */
2265 writel(0, GBE_REG_ADDR(gbe_dev, switch_regs, ptype));
2267 /* Control register */
2268 writel(GBE_CTL_P0_ENABLE, GBE_REG_ADDR(gbe_dev, switch_regs, control));
2270 /* All statistics enabled and STAT AB visible by default */
2271 writel(gbe_dev->stats_en_mask, GBE_REG_ADDR(gbe_dev, switch_regs,
2274 ret = gbe_slave_open(gbe_intf);
2278 netcp_register_txhook(netcp, GBE_TXHOOK_ORDER, gbe_tx_hook,
2282 netcp_ethss_update_link_state(gbe_dev, slave, ndev);
2286 gbe_slave_stop(gbe_intf);
2290 static int gbe_close(void *intf_priv, struct net_device *ndev)
2292 struct gbe_intf *gbe_intf = intf_priv;
2293 struct netcp_intf *netcp = netdev_priv(ndev);
2295 gbe_slave_stop(gbe_intf);
2296 netcp_unregister_txhook(netcp, GBE_TXHOOK_ORDER, gbe_tx_hook,
2299 gbe_intf->slave->open = false;
2300 atomic_set(&gbe_intf->slave->link_state, NETCP_LINK_STATE_INVALID);
2304 static int init_slave(struct gbe_priv *gbe_dev, struct gbe_slave *slave,
2305 struct device_node *node)
2308 u32 port_reg_ofs, emac_reg_ofs;
2309 u32 port_reg_blk_sz, emac_reg_blk_sz;
2311 if (of_property_read_u32(node, "slave-port", &slave->slave_num)) {
2312 dev_err(gbe_dev->dev, "missing slave-port parameter\n");
2316 if (of_property_read_u32(node, "link-interface",
2317 &slave->link_interface)) {
2318 dev_warn(gbe_dev->dev,
2319 "missing link-interface value defaulting to 1G mac-phy link\n");
2320 slave->link_interface = SGMII_LINK_MAC_PHY;
2323 slave->open = false;
2324 slave->phy_node = of_parse_phandle(node, "phy-handle", 0);
2325 slave->port_num = gbe_get_slave_port(gbe_dev, slave->slave_num);
2327 if (slave->link_interface >= XGMII_LINK_MAC_PHY)
2328 slave->mac_control = GBE_DEF_10G_MAC_CONTROL;
2330 slave->mac_control = GBE_DEF_1G_MAC_CONTROL;
2332 /* Emac regs memmap are contiguous but port regs are not */
2333 port_reg_num = slave->slave_num;
2334 if (gbe_dev->ss_version == GBE_SS_VERSION_14) {
2335 if (slave->slave_num > 1) {
2336 port_reg_ofs = GBE13_SLAVE_PORT2_OFFSET;
2339 port_reg_ofs = GBE13_SLAVE_PORT_OFFSET;
2341 emac_reg_ofs = GBE13_EMAC_OFFSET;
2342 port_reg_blk_sz = 0x30;
2343 emac_reg_blk_sz = 0x40;
2344 } else if (IS_SS_ID_MU(gbe_dev)) {
2345 port_reg_ofs = GBENU_SLAVE_PORT_OFFSET;
2346 emac_reg_ofs = GBENU_EMAC_OFFSET;
2347 port_reg_blk_sz = 0x1000;
2348 emac_reg_blk_sz = 0x1000;
2349 } else if (gbe_dev->ss_version == XGBE_SS_VERSION_10) {
2350 port_reg_ofs = XGBE10_SLAVE_PORT_OFFSET;
2351 emac_reg_ofs = XGBE10_EMAC_OFFSET;
2352 port_reg_blk_sz = 0x30;
2353 emac_reg_blk_sz = 0x40;
2355 dev_err(gbe_dev->dev, "unknown ethss(0x%x)\n",
2356 gbe_dev->ss_version);
2360 slave->port_regs = gbe_dev->switch_regs + port_reg_ofs +
2361 (port_reg_blk_sz * port_reg_num);
2362 slave->emac_regs = gbe_dev->switch_regs + emac_reg_ofs +
2363 (emac_reg_blk_sz * slave->slave_num);
2365 if (gbe_dev->ss_version == GBE_SS_VERSION_14) {
2366 /* Initialize slave port register offsets */
2367 GBE_SET_REG_OFS(slave, port_regs, port_vlan);
2368 GBE_SET_REG_OFS(slave, port_regs, tx_pri_map);
2369 GBE_SET_REG_OFS(slave, port_regs, sa_lo);
2370 GBE_SET_REG_OFS(slave, port_regs, sa_hi);
2371 GBE_SET_REG_OFS(slave, port_regs, ts_ctl);
2372 GBE_SET_REG_OFS(slave, port_regs, ts_seq_ltype);
2373 GBE_SET_REG_OFS(slave, port_regs, ts_vlan);
2374 GBE_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2);
2375 GBE_SET_REG_OFS(slave, port_regs, ts_ctl2);
2377 /* Initialize EMAC register offsets */
2378 GBE_SET_REG_OFS(slave, emac_regs, mac_control);
2379 GBE_SET_REG_OFS(slave, emac_regs, soft_reset);
2380 GBE_SET_REG_OFS(slave, emac_regs, rx_maxlen);
2382 } else if (IS_SS_ID_MU(gbe_dev)) {
2383 /* Initialize slave port register offsets */
2384 GBENU_SET_REG_OFS(slave, port_regs, port_vlan);
2385 GBENU_SET_REG_OFS(slave, port_regs, tx_pri_map);
2386 GBENU_SET_REG_OFS(slave, port_regs, sa_lo);
2387 GBENU_SET_REG_OFS(slave, port_regs, sa_hi);
2388 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl);
2389 GBENU_SET_REG_OFS(slave, port_regs, ts_seq_ltype);
2390 GBENU_SET_REG_OFS(slave, port_regs, ts_vlan);
2391 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2);
2392 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl2);
2393 GBENU_SET_REG_OFS(slave, port_regs, rx_maxlen);
2395 /* Initialize EMAC register offsets */
2396 GBENU_SET_REG_OFS(slave, emac_regs, mac_control);
2397 GBENU_SET_REG_OFS(slave, emac_regs, soft_reset);
2399 } else if (gbe_dev->ss_version == XGBE_SS_VERSION_10) {
2400 /* Initialize slave port register offsets */
2401 XGBE_SET_REG_OFS(slave, port_regs, port_vlan);
2402 XGBE_SET_REG_OFS(slave, port_regs, tx_pri_map);
2403 XGBE_SET_REG_OFS(slave, port_regs, sa_lo);
2404 XGBE_SET_REG_OFS(slave, port_regs, sa_hi);
2405 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl);
2406 XGBE_SET_REG_OFS(slave, port_regs, ts_seq_ltype);
2407 XGBE_SET_REG_OFS(slave, port_regs, ts_vlan);
2408 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2);
2409 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl2);
2411 /* Initialize EMAC register offsets */
2412 XGBE_SET_REG_OFS(slave, emac_regs, mac_control);
2413 XGBE_SET_REG_OFS(slave, emac_regs, soft_reset);
2414 XGBE_SET_REG_OFS(slave, emac_regs, rx_maxlen);
2417 atomic_set(&slave->link_state, NETCP_LINK_STATE_INVALID);
2421 static void init_secondary_ports(struct gbe_priv *gbe_dev,
2422 struct device_node *node)
2424 struct device *dev = gbe_dev->dev;
2425 phy_interface_t phy_mode;
2426 struct gbe_priv **priv;
2427 struct device_node *port;
2428 struct gbe_slave *slave;
2429 bool mac_phy_link = false;
2431 for_each_child_of_node(node, port) {
2432 slave = devm_kzalloc(dev, sizeof(*slave), GFP_KERNEL);
2435 "memomry alloc failed for secondary port(%s), skipping...\n",
2440 if (init_slave(gbe_dev, slave, port)) {
2442 "Failed to initialize secondary port(%s), skipping...\n",
2444 devm_kfree(dev, slave);
2448 gbe_sgmii_config(gbe_dev, slave);
2449 gbe_port_reset(slave);
2450 gbe_port_config(gbe_dev, slave, gbe_dev->rx_packet_max);
2451 list_add_tail(&slave->slave_list, &gbe_dev->secondary_slaves);
2452 gbe_dev->num_slaves++;
2453 if ((slave->link_interface == SGMII_LINK_MAC_PHY) ||
2454 (slave->link_interface == XGMII_LINK_MAC_PHY))
2455 mac_phy_link = true;
2458 if (gbe_dev->num_slaves >= gbe_dev->max_num_slaves)
2462 /* of_phy_connect() is needed only for MAC-PHY interface */
2466 /* Allocate dummy netdev device for attaching to phy device */
2467 gbe_dev->dummy_ndev = alloc_netdev(sizeof(gbe_dev), "dummy",
2468 NET_NAME_UNKNOWN, ether_setup);
2469 if (!gbe_dev->dummy_ndev) {
2471 "Failed to allocate dummy netdev for secondary ports, skipping phy_connect()...\n");
2474 priv = netdev_priv(gbe_dev->dummy_ndev);
2477 if (slave->link_interface == SGMII_LINK_MAC_PHY) {
2478 phy_mode = PHY_INTERFACE_MODE_SGMII;
2479 slave->phy_port_t = PORT_MII;
2481 phy_mode = PHY_INTERFACE_MODE_NA;
2482 slave->phy_port_t = PORT_FIBRE;
2485 for_each_sec_slave(slave, gbe_dev) {
2486 if ((slave->link_interface != SGMII_LINK_MAC_PHY) &&
2487 (slave->link_interface != XGMII_LINK_MAC_PHY))
2490 of_phy_connect(gbe_dev->dummy_ndev,
2492 gbe_adjust_link_sec_slaves,
2495 dev_err(dev, "phy not found for slave %d\n",
2499 dev_dbg(dev, "phy found: id is: 0x%s\n",
2500 dev_name(&slave->phy->dev));
2501 phy_start(slave->phy);
2502 phy_read_status(slave->phy);
2507 static void free_secondary_ports(struct gbe_priv *gbe_dev)
2509 struct gbe_slave *slave;
2512 slave = first_sec_slave(gbe_dev);
2516 phy_disconnect(slave->phy);
2517 list_del(&slave->slave_list);
2519 if (gbe_dev->dummy_ndev)
2520 free_netdev(gbe_dev->dummy_ndev);
2523 static int set_xgbe_ethss10_priv(struct gbe_priv *gbe_dev,
2524 struct device_node *node)
2526 struct resource res;
2530 ret = of_address_to_resource(node, XGBE_SS_REG_INDEX, &res);
2532 dev_err(gbe_dev->dev,
2533 "Can't xlate xgbe of node(%s) ss address at %d\n",
2534 node->name, XGBE_SS_REG_INDEX);
2538 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2540 dev_err(gbe_dev->dev, "Failed to map xgbe ss register base\n");
2541 return PTR_ERR(regs);
2543 gbe_dev->ss_regs = regs;
2545 ret = of_address_to_resource(node, XGBE_SM_REG_INDEX, &res);
2547 dev_err(gbe_dev->dev,
2548 "Can't xlate xgbe of node(%s) sm address at %d\n",
2549 node->name, XGBE_SM_REG_INDEX);
2553 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2555 dev_err(gbe_dev->dev, "Failed to map xgbe sm register base\n");
2556 return PTR_ERR(regs);
2558 gbe_dev->switch_regs = regs;
2560 ret = of_address_to_resource(node, XGBE_SERDES_REG_INDEX, &res);
2562 dev_err(gbe_dev->dev,
2563 "Can't xlate xgbe serdes of node(%s) address at %d\n",
2564 node->name, XGBE_SERDES_REG_INDEX);
2568 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2570 dev_err(gbe_dev->dev, "Failed to map xgbe serdes register base\n");
2571 return PTR_ERR(regs);
2573 gbe_dev->xgbe_serdes_regs = regs;
2575 gbe_dev->hw_stats = devm_kzalloc(gbe_dev->dev,
2576 XGBE10_NUM_STAT_ENTRIES *
2577 (gbe_dev->max_num_ports) * sizeof(u64),
2579 if (!gbe_dev->hw_stats) {
2580 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n");
2584 gbe_dev->ss_version = XGBE_SS_VERSION_10;
2585 gbe_dev->sgmii_port_regs = gbe_dev->ss_regs +
2586 XGBE10_SGMII_MODULE_OFFSET;
2587 gbe_dev->host_port_regs = gbe_dev->ss_regs + XGBE10_HOST_PORT_OFFSET;
2589 for (i = 0; i < gbe_dev->max_num_ports; i++)
2590 gbe_dev->hw_stats_regs[i] = gbe_dev->switch_regs +
2591 XGBE10_HW_STATS_OFFSET + (GBE_HW_STATS_REG_MAP_SZ * i);
2593 gbe_dev->ale_reg = gbe_dev->switch_regs + XGBE10_ALE_OFFSET;
2594 gbe_dev->ale_ports = gbe_dev->max_num_ports;
2595 gbe_dev->host_port = XGBE10_HOST_PORT_NUM;
2596 gbe_dev->ale_entries = XGBE10_NUM_ALE_ENTRIES;
2597 gbe_dev->et_stats = xgbe10_et_stats;
2598 gbe_dev->num_et_stats = ARRAY_SIZE(xgbe10_et_stats);
2599 gbe_dev->stats_en_mask = (1 << (gbe_dev->max_num_ports)) - 1;
2601 /* Subsystem registers */
2602 XGBE_SET_REG_OFS(gbe_dev, ss_regs, id_ver);
2603 XGBE_SET_REG_OFS(gbe_dev, ss_regs, control);
2605 /* Switch module registers */
2606 XGBE_SET_REG_OFS(gbe_dev, switch_regs, id_ver);
2607 XGBE_SET_REG_OFS(gbe_dev, switch_regs, control);
2608 XGBE_SET_REG_OFS(gbe_dev, switch_regs, ptype);
2609 XGBE_SET_REG_OFS(gbe_dev, switch_regs, stat_port_en);
2610 XGBE_SET_REG_OFS(gbe_dev, switch_regs, flow_control);
2612 /* Host port registers */
2613 XGBE_SET_REG_OFS(gbe_dev, host_port_regs, port_vlan);
2614 XGBE_SET_REG_OFS(gbe_dev, host_port_regs, tx_pri_map);
2615 XGBE_SET_REG_OFS(gbe_dev, host_port_regs, rx_maxlen);
2619 static int get_gbe_resource_version(struct gbe_priv *gbe_dev,
2620 struct device_node *node)
2622 struct resource res;
2626 ret = of_address_to_resource(node, GBE_SS_REG_INDEX, &res);
2628 dev_err(gbe_dev->dev,
2629 "Can't translate of node(%s) of gbe ss address at %d\n",
2630 node->name, GBE_SS_REG_INDEX);
2634 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2636 dev_err(gbe_dev->dev, "Failed to map gbe register base\n");
2637 return PTR_ERR(regs);
2639 gbe_dev->ss_regs = regs;
2640 gbe_dev->ss_version = readl(gbe_dev->ss_regs);
2644 static int set_gbe_ethss14_priv(struct gbe_priv *gbe_dev,
2645 struct device_node *node)
2647 struct resource res;
2651 ret = of_address_to_resource(node, GBE_SGMII34_REG_INDEX, &res);
2653 dev_err(gbe_dev->dev,
2654 "Can't translate of gbe node(%s) address at index %d\n",
2655 node->name, GBE_SGMII34_REG_INDEX);
2659 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2661 dev_err(gbe_dev->dev,
2662 "Failed to map gbe sgmii port34 register base\n");
2663 return PTR_ERR(regs);
2665 gbe_dev->sgmii_port34_regs = regs;
2667 ret = of_address_to_resource(node, GBE_SM_REG_INDEX, &res);
2669 dev_err(gbe_dev->dev,
2670 "Can't translate of gbe node(%s) address at index %d\n",
2671 node->name, GBE_SM_REG_INDEX);
2675 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2677 dev_err(gbe_dev->dev,
2678 "Failed to map gbe switch module register base\n");
2679 return PTR_ERR(regs);
2681 gbe_dev->switch_regs = regs;
2683 gbe_dev->hw_stats = devm_kzalloc(gbe_dev->dev,
2684 GBE13_NUM_HW_STAT_ENTRIES *
2685 gbe_dev->max_num_slaves * sizeof(u64),
2687 if (!gbe_dev->hw_stats) {
2688 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n");
2692 gbe_dev->sgmii_port_regs = gbe_dev->ss_regs + GBE13_SGMII_MODULE_OFFSET;
2693 gbe_dev->host_port_regs = gbe_dev->switch_regs + GBE13_HOST_PORT_OFFSET;
2695 for (i = 0; i < gbe_dev->max_num_slaves; i++) {
2696 gbe_dev->hw_stats_regs[i] =
2697 gbe_dev->switch_regs + GBE13_HW_STATS_OFFSET +
2698 (GBE_HW_STATS_REG_MAP_SZ * i);
2701 gbe_dev->ale_reg = gbe_dev->switch_regs + GBE13_ALE_OFFSET;
2702 gbe_dev->ale_ports = gbe_dev->max_num_ports;
2703 gbe_dev->host_port = GBE13_HOST_PORT_NUM;
2704 gbe_dev->ale_entries = GBE13_NUM_ALE_ENTRIES;
2705 gbe_dev->et_stats = gbe13_et_stats;
2706 gbe_dev->num_et_stats = ARRAY_SIZE(gbe13_et_stats);
2707 gbe_dev->stats_en_mask = GBE13_REG_VAL_STAT_ENABLE_ALL;
2709 /* Subsystem registers */
2710 GBE_SET_REG_OFS(gbe_dev, ss_regs, id_ver);
2712 /* Switch module registers */
2713 GBE_SET_REG_OFS(gbe_dev, switch_regs, id_ver);
2714 GBE_SET_REG_OFS(gbe_dev, switch_regs, control);
2715 GBE_SET_REG_OFS(gbe_dev, switch_regs, soft_reset);
2716 GBE_SET_REG_OFS(gbe_dev, switch_regs, stat_port_en);
2717 GBE_SET_REG_OFS(gbe_dev, switch_regs, ptype);
2718 GBE_SET_REG_OFS(gbe_dev, switch_regs, flow_control);
2720 /* Host port registers */
2721 GBE_SET_REG_OFS(gbe_dev, host_port_regs, port_vlan);
2722 GBE_SET_REG_OFS(gbe_dev, host_port_regs, rx_maxlen);
2726 static int set_gbenu_ethss_priv(struct gbe_priv *gbe_dev,
2727 struct device_node *node)
2729 struct resource res;
2733 gbe_dev->hw_stats = devm_kzalloc(gbe_dev->dev,
2734 GBENU_NUM_HW_STAT_ENTRIES *
2735 (gbe_dev->max_num_ports) * sizeof(u64),
2737 if (!gbe_dev->hw_stats) {
2738 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n");
2742 ret = of_address_to_resource(node, GBENU_SM_REG_INDEX, &res);
2744 dev_err(gbe_dev->dev,
2745 "Can't translate of gbenu node(%s) addr at index %d\n",
2746 node->name, GBENU_SM_REG_INDEX);
2750 regs = devm_ioremap_resource(gbe_dev->dev, &res);
2752 dev_err(gbe_dev->dev,
2753 "Failed to map gbenu switch module register base\n");
2754 return PTR_ERR(regs);
2756 gbe_dev->switch_regs = regs;
2758 gbe_dev->sgmii_port_regs = gbe_dev->ss_regs + GBENU_SGMII_MODULE_OFFSET;
2759 gbe_dev->host_port_regs = gbe_dev->switch_regs + GBENU_HOST_PORT_OFFSET;
2761 for (i = 0; i < (gbe_dev->max_num_ports); i++)
2762 gbe_dev->hw_stats_regs[i] = gbe_dev->switch_regs +
2763 GBENU_HW_STATS_OFFSET + (GBENU_HW_STATS_REG_MAP_SZ * i);
2765 gbe_dev->ale_reg = gbe_dev->switch_regs + GBENU_ALE_OFFSET;
2766 gbe_dev->ale_ports = gbe_dev->max_num_ports;
2767 gbe_dev->host_port = GBENU_HOST_PORT_NUM;
2768 gbe_dev->ale_entries = GBE13_NUM_ALE_ENTRIES;
2769 gbe_dev->et_stats = gbenu_et_stats;
2770 gbe_dev->stats_en_mask = (1 << (gbe_dev->max_num_ports)) - 1;
2772 if (IS_SS_ID_NU(gbe_dev))
2773 gbe_dev->num_et_stats = GBENU_ET_STATS_HOST_SIZE +
2774 (gbe_dev->max_num_slaves * GBENU_ET_STATS_PORT_SIZE);
2776 gbe_dev->num_et_stats = GBENU_ET_STATS_HOST_SIZE +
2777 GBENU_ET_STATS_PORT_SIZE;
2779 /* Subsystem registers */
2780 GBENU_SET_REG_OFS(gbe_dev, ss_regs, id_ver);
2782 /* Switch module registers */
2783 GBENU_SET_REG_OFS(gbe_dev, switch_regs, id_ver);
2784 GBENU_SET_REG_OFS(gbe_dev, switch_regs, control);
2785 GBENU_SET_REG_OFS(gbe_dev, switch_regs, stat_port_en);
2786 GBENU_SET_REG_OFS(gbe_dev, switch_regs, ptype);
2788 /* Host port registers */
2789 GBENU_SET_REG_OFS(gbe_dev, host_port_regs, port_vlan);
2790 GBENU_SET_REG_OFS(gbe_dev, host_port_regs, rx_maxlen);
2792 /* For NU only. 2U does not need tx_pri_map.
2793 * NU cppi port 0 tx pkt streaming interface has (n-1)*8 egress threads
2794 * while 2U has only 1 such thread
2796 GBENU_SET_REG_OFS(gbe_dev, host_port_regs, tx_pri_map);
2800 static int gbe_probe(struct netcp_device *netcp_device, struct device *dev,
2801 struct device_node *node, void **inst_priv)
2803 struct device_node *interfaces, *interface;
2804 struct device_node *secondary_ports;
2805 struct cpsw_ale_params ale_params;
2806 struct gbe_priv *gbe_dev;
2811 dev_err(dev, "device tree info unavailable\n");
2815 gbe_dev = devm_kzalloc(dev, sizeof(struct gbe_priv), GFP_KERNEL);
2819 if (of_device_is_compatible(node, "ti,netcp-gbe-5") ||
2820 of_device_is_compatible(node, "ti,netcp-gbe")) {
2821 gbe_dev->max_num_slaves = 4;
2822 } else if (of_device_is_compatible(node, "ti,netcp-gbe-9")) {
2823 gbe_dev->max_num_slaves = 8;
2824 } else if (of_device_is_compatible(node, "ti,netcp-gbe-2")) {
2825 gbe_dev->max_num_slaves = 1;
2826 } else if (of_device_is_compatible(node, "ti,netcp-xgbe")) {
2827 gbe_dev->max_num_slaves = 2;
2829 dev_err(dev, "device tree node for unknown device\n");
2832 gbe_dev->max_num_ports = gbe_dev->max_num_slaves + 1;
2835 gbe_dev->netcp_device = netcp_device;
2836 gbe_dev->rx_packet_max = NETCP_MAX_FRAME_SIZE;
2838 /* init the hw stats lock */
2839 spin_lock_init(&gbe_dev->hw_stats_lock);
2841 if (of_find_property(node, "enable-ale", NULL)) {
2842 gbe_dev->enable_ale = true;
2843 dev_info(dev, "ALE enabled\n");
2845 gbe_dev->enable_ale = false;
2846 dev_dbg(dev, "ALE bypass enabled*\n");
2849 ret = of_property_read_u32(node, "tx-queue",
2850 &gbe_dev->tx_queue_id);
2852 dev_err(dev, "missing tx_queue parameter\n");
2853 gbe_dev->tx_queue_id = GBE_TX_QUEUE;
2856 ret = of_property_read_string(node, "tx-channel",
2857 &gbe_dev->dma_chan_name);
2859 dev_err(dev, "missing \"tx-channel\" parameter\n");
2864 if (!strcmp(node->name, "gbe")) {
2865 ret = get_gbe_resource_version(gbe_dev, node);
2869 dev_dbg(dev, "ss_version: 0x%08x\n", gbe_dev->ss_version);
2871 if (gbe_dev->ss_version == GBE_SS_VERSION_14)
2872 ret = set_gbe_ethss14_priv(gbe_dev, node);
2873 else if (IS_SS_ID_MU(gbe_dev))
2874 ret = set_gbenu_ethss_priv(gbe_dev, node);
2880 } else if (!strcmp(node->name, "xgbe")) {
2881 ret = set_xgbe_ethss10_priv(gbe_dev, node);
2884 ret = netcp_xgbe_serdes_init(gbe_dev->xgbe_serdes_regs,
2889 dev_err(dev, "unknown GBE node(%s)\n", node->name);
2894 interfaces = of_get_child_by_name(node, "interfaces");
2896 dev_err(dev, "could not find interfaces\n");
2898 ret = netcp_txpipe_init(&gbe_dev->tx_pipe, netcp_device,
2899 gbe_dev->dma_chan_name, gbe_dev->tx_queue_id);
2903 ret = netcp_txpipe_open(&gbe_dev->tx_pipe);
2907 /* Create network interfaces */
2908 INIT_LIST_HEAD(&gbe_dev->gbe_intf_head);
2909 for_each_child_of_node(interfaces, interface) {
2910 ret = of_property_read_u32(interface, "slave-port", &slave_num);
2912 dev_err(dev, "missing slave-port parameter, skipping interface configuration for %s\n",
2916 gbe_dev->num_slaves++;
2917 if (gbe_dev->num_slaves >= gbe_dev->max_num_slaves)
2921 if (!gbe_dev->num_slaves)
2922 dev_warn(dev, "No network interface configured\n");
2924 /* Initialize Secondary slave ports */
2925 secondary_ports = of_get_child_by_name(node, "secondary-slave-ports");
2926 INIT_LIST_HEAD(&gbe_dev->secondary_slaves);
2927 if (secondary_ports && (gbe_dev->num_slaves < gbe_dev->max_num_slaves))
2928 init_secondary_ports(gbe_dev, secondary_ports);
2929 of_node_put(secondary_ports);
2931 if (!gbe_dev->num_slaves) {
2932 dev_err(dev, "No network interface or secondary ports configured\n");
2937 memset(&ale_params, 0, sizeof(ale_params));
2938 ale_params.dev = gbe_dev->dev;
2939 ale_params.ale_regs = gbe_dev->ale_reg;
2940 ale_params.ale_ageout = GBE_DEFAULT_ALE_AGEOUT;
2941 ale_params.ale_entries = gbe_dev->ale_entries;
2942 ale_params.ale_ports = gbe_dev->ale_ports;
2944 gbe_dev->ale = cpsw_ale_create(&ale_params);
2945 if (!gbe_dev->ale) {
2946 dev_err(gbe_dev->dev, "error initializing ale engine\n");
2950 dev_dbg(gbe_dev->dev, "Created a gbe ale engine\n");
2953 /* initialize host port */
2954 gbe_init_host_port(gbe_dev);
2956 init_timer(&gbe_dev->timer);
2957 gbe_dev->timer.data = (unsigned long)gbe_dev;
2958 gbe_dev->timer.function = netcp_ethss_timer;
2959 gbe_dev->timer.expires = jiffies + GBE_TIMER_INTERVAL;
2960 add_timer(&gbe_dev->timer);
2961 *inst_priv = gbe_dev;
2965 if (gbe_dev->hw_stats)
2966 devm_kfree(dev, gbe_dev->hw_stats);
2967 cpsw_ale_destroy(gbe_dev->ale);
2968 if (gbe_dev->ss_regs)
2969 devm_iounmap(dev, gbe_dev->ss_regs);
2970 of_node_put(interfaces);
2971 devm_kfree(dev, gbe_dev);
2975 static int gbe_attach(void *inst_priv, struct net_device *ndev,
2976 struct device_node *node, void **intf_priv)
2978 struct gbe_priv *gbe_dev = inst_priv;
2979 struct gbe_intf *gbe_intf;
2983 dev_err(gbe_dev->dev, "interface node not available\n");
2987 gbe_intf = devm_kzalloc(gbe_dev->dev, sizeof(*gbe_intf), GFP_KERNEL);
2991 gbe_intf->ndev = ndev;
2992 gbe_intf->dev = gbe_dev->dev;
2993 gbe_intf->gbe_dev = gbe_dev;
2995 gbe_intf->slave = devm_kzalloc(gbe_dev->dev,
2996 sizeof(*gbe_intf->slave),
2998 if (!gbe_intf->slave) {
3003 if (init_slave(gbe_dev, gbe_intf->slave, node)) {
3008 gbe_intf->tx_pipe = gbe_dev->tx_pipe;
3009 ndev->ethtool_ops = &keystone_ethtool_ops;
3010 list_add_tail(&gbe_intf->gbe_intf_list, &gbe_dev->gbe_intf_head);
3011 *intf_priv = gbe_intf;
3015 if (gbe_intf->slave)
3016 devm_kfree(gbe_dev->dev, gbe_intf->slave);
3018 devm_kfree(gbe_dev->dev, gbe_intf);
3022 static int gbe_release(void *intf_priv)
3024 struct gbe_intf *gbe_intf = intf_priv;
3026 gbe_intf->ndev->ethtool_ops = NULL;
3027 list_del(&gbe_intf->gbe_intf_list);
3028 devm_kfree(gbe_intf->dev, gbe_intf->slave);
3029 devm_kfree(gbe_intf->dev, gbe_intf);
3033 static int gbe_remove(struct netcp_device *netcp_device, void *inst_priv)
3035 struct gbe_priv *gbe_dev = inst_priv;
3037 del_timer_sync(&gbe_dev->timer);
3038 cpsw_ale_stop(gbe_dev->ale);
3039 cpsw_ale_destroy(gbe_dev->ale);
3040 netcp_txpipe_close(&gbe_dev->tx_pipe);
3041 free_secondary_ports(gbe_dev);
3043 if (!list_empty(&gbe_dev->gbe_intf_head))
3044 dev_alert(gbe_dev->dev, "unreleased ethss interfaces present\n");
3046 devm_kfree(gbe_dev->dev, gbe_dev->hw_stats);
3047 devm_iounmap(gbe_dev->dev, gbe_dev->ss_regs);
3048 memset(gbe_dev, 0x00, sizeof(*gbe_dev));
3049 devm_kfree(gbe_dev->dev, gbe_dev);
3053 static struct netcp_module gbe_module = {
3054 .name = GBE_MODULE_NAME,
3055 .owner = THIS_MODULE,
3060 .remove = gbe_remove,
3061 .attach = gbe_attach,
3062 .release = gbe_release,
3063 .add_addr = gbe_add_addr,
3064 .del_addr = gbe_del_addr,
3065 .add_vid = gbe_add_vid,
3066 .del_vid = gbe_del_vid,
3070 static struct netcp_module xgbe_module = {
3071 .name = XGBE_MODULE_NAME,
3072 .owner = THIS_MODULE,
3077 .remove = gbe_remove,
3078 .attach = gbe_attach,
3079 .release = gbe_release,
3080 .add_addr = gbe_add_addr,
3081 .del_addr = gbe_del_addr,
3082 .add_vid = gbe_add_vid,
3083 .del_vid = gbe_del_vid,
3087 static int __init keystone_gbe_init(void)
3091 ret = netcp_register_module(&gbe_module);
3095 ret = netcp_register_module(&xgbe_module);
3101 module_init(keystone_gbe_init);
3103 static void __exit keystone_gbe_exit(void)
3105 netcp_unregister_module(&gbe_module);
3106 netcp_unregister_module(&xgbe_module);
3108 module_exit(keystone_gbe_exit);
3110 MODULE_LICENSE("GPL v2");
3111 MODULE_DESCRIPTION("TI NETCP ETHSS driver for Keystone SOCs");
3112 MODULE_AUTHOR("Sandeep Nair <sandeep_n@ti.com");