Lines Matching +full:slave +full:- +full:dev
1 // SPDX-License-Identifier: GPL-2.0
7 * Sandeep Paulraj <s-paulraj@ti.com>
10 * Wingman Kwok <w-kwok2@ti.com>
37 #define GBE_MODULE_NAME "netcp-gbe"
56 #define GBENU_MODULE_NAME "netcp-gbenu"
61 ((GBE_IDENT((d)->ss_version) == GBE_SS_ID_NU) || \
62 (GBE_IDENT((d)->ss_version) == GBE_SS_ID_2U))
65 (GBE_IDENT((d)->ss_version) == GBE_SS_ID_NU)
68 (GBE_IDENT((d)->ss_version) == GBE_SS_VERSION_14)
70 (GBE_IDENT((d)->ss_version) == GBE_SS_ID_2U)
85 #define XGBE_MODULE_NAME "netcp-xgbe"
94 #define IS_SS_ID_XGBE(d) ((d)->ss_version == XGBE_SS_VERSION_10)
110 #define GMACSL_RET_WARN_RESET_INCOMPLETE -2
126 #define GBE_PORT_MASK(x) (BIT(x) - 1)
156 /* s: 0-based slave_port */
158 (((s) < 2) ? (d)->sgmii_port_regs : (d)->sgmii_port34_regs)
164 #define SLAVE_LINK_IS_XGMII(s) ((s)->link_interface >= XGMII_LINK_MAC_PHY)
166 (((s)->link_interface >= RGMII_LINK_MAC_PHY) && \
167 ((s)->link_interface <= RGMII_LINK_MAC_PHY_NO_MDIO))
169 ((s)->link_interface <= SGMII_LINK_MAC_PHY_NO_MDIO)
170 #define NETCP_LINK_STATE_INVALID -1
172 #define GBE_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
174 #define GBENU_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
176 #define XGBE_SET_REG_OFS(p, rb, rn) p->rb##_ofs.rn = \
178 #define GBE_REG_ADDR(p, rb, rn) (p->rb + p->rb##_ofs.rn)
228 /* The PTP event messages - Sync, Delay_Req, Pdelay_Req, and Pdelay_Resp. */
451 /* Some hw stat regs are applicable to slave port only.
459 u32 rx_pause_frames; /* slave */
461 u32 rx_align_code_errors; /* slave */
463 u32 rx_jabber_frames; /* slave */
465 u32 rx_fragments; /* slave */
472 u32 tx_pause_frames; /* slave */
473 u32 tx_deferred_frames; /* slave */
474 u32 tx_collision_frames; /* slave */
475 u32 tx_single_coll_frames; /* slave */
476 u32 tx_mult_coll_frames; /* slave */
477 u32 tx_excessive_collisions; /* slave */
478 u32 tx_late_collisions; /* slave */
479 u32 rx_ipg_error; /* slave 10G only */
480 u32 tx_carrier_sense_errors; /* slave */
708 struct device *dev; member
761 struct device *dev; member
764 struct gbe_slave *slave; member
1726 list_for_each_entry((i), &(priv)->gbe_intf_head, gbe_intf_list)
1728 #define for_each_sec_slave(slave, priv) \ argument
1729 list_for_each_entry((slave), &(priv)->secondary_slaves, slave_list)
1732 list_first_entry(&priv->secondary_slaves, \
1738 strncpy(info->driver, NETCP_DRIVER_NAME, sizeof(info->driver)); in keystone_get_drvinfo()
1739 strncpy(info->version, NETCP_DRIVER_VERSION, sizeof(info->version)); in keystone_get_drvinfo()
1746 return netcp->msg_enable; in keystone_get_msglevel()
1753 netcp->msg_enable = value; in keystone_set_msglevel()
1778 gbe_dev = gbe_intf->gbe_dev; in keystone_get_stat_strings()
1782 for (i = 0; i < gbe_dev->num_et_stats; i++) { in keystone_get_stat_strings()
1783 memcpy(data, gbe_dev->et_stats[i].desc, in keystone_get_stat_strings()
1801 return -EINVAL; in keystone_get_sset_count()
1802 gbe_dev = gbe_intf->gbe_dev; in keystone_get_sset_count()
1808 return gbe_dev->num_et_stats; in keystone_get_sset_count()
1810 return -EINVAL; in keystone_get_sset_count()
1816 void __iomem *base = gbe_dev->hw_stats_regs[stats_mod]; in gbe_reset_mod_stats()
1820 for (i = 0; i < gbe_dev->num_et_stats; i++) { in gbe_reset_mod_stats()
1821 if (gbe_dev->et_stats[i].type == stats_mod) { in gbe_reset_mod_stats()
1822 p_stats_entry = base + gbe_dev->et_stats[i].offset; in gbe_reset_mod_stats()
1823 gbe_dev->hw_stats[i] = 0; in gbe_reset_mod_stats()
1824 gbe_dev->hw_stats_prev[i] = readl(p_stats_entry); in gbe_reset_mod_stats()
1839 base = gbe_dev->hw_stats_regs[gbe_dev->et_stats[et_stats_entry].type]; in gbe_update_hw_stats_entry()
1840 p_stats_entry = base + gbe_dev->et_stats[et_stats_entry].offset; in gbe_update_hw_stats_entry()
1842 delta = curr - gbe_dev->hw_stats_prev[et_stats_entry]; in gbe_update_hw_stats_entry()
1843 gbe_dev->hw_stats_prev[et_stats_entry] = curr; in gbe_update_hw_stats_entry()
1844 gbe_dev->hw_stats[et_stats_entry] += delta; in gbe_update_hw_stats_entry()
1851 for (i = 0; i < gbe_dev->num_et_stats; i++) { in gbe_update_stats()
1855 data[i] = gbe_dev->hw_stats[i]; in gbe_update_stats()
1891 u32 half_num_et_stats = (gbe_dev->num_et_stats / 2); in gbe_update_stats_ver14()
1904 data[et_entry] = gbe_dev->hw_stats[et_entry]; in gbe_update_stats_ver14()
1921 gbe_dev = gbe_intf->gbe_dev; in keystone_get_ethtool_stats()
1922 spin_lock_bh(&gbe_dev->hw_stats_lock); in keystone_get_ethtool_stats()
1927 spin_unlock_bh(&gbe_dev->hw_stats_lock); in keystone_get_ethtool_stats()
1934 struct phy_device *phy = ndev->phydev; in keystone_get_link_ksettings()
1938 return -EINVAL; in keystone_get_link_ksettings()
1942 return -EINVAL; in keystone_get_link_ksettings()
1944 if (!gbe_intf->slave) in keystone_get_link_ksettings()
1945 return -EINVAL; in keystone_get_link_ksettings()
1948 cmd->base.port = gbe_intf->slave->phy_port_t; in keystone_get_link_ksettings()
1957 struct phy_device *phy = ndev->phydev; in keystone_set_link_ksettings()
1959 u8 port = cmd->base.port; in keystone_set_link_ksettings()
1964 cmd->link_modes.advertising); in keystone_set_link_ksettings()
1966 cmd->link_modes.supported); in keystone_set_link_ksettings()
1970 return -EINVAL; in keystone_set_link_ksettings()
1974 return -EINVAL; in keystone_set_link_ksettings()
1976 if (!gbe_intf->slave) in keystone_set_link_ksettings()
1977 return -EINVAL; in keystone_set_link_ksettings()
1979 if (port != gbe_intf->slave->phy_port_t) { in keystone_set_link_ksettings()
1981 return -EINVAL; in keystone_set_link_ksettings()
1984 return -EINVAL; in keystone_set_link_ksettings()
1987 return -EINVAL; in keystone_set_link_ksettings()
1990 return -EINVAL; in keystone_set_link_ksettings()
1993 return -EINVAL; in keystone_set_link_ksettings()
1996 gbe_intf->slave->phy_port_t = port; in keystone_set_link_ksettings()
2008 if (!gbe_intf || !gbe_intf->gbe_dev->cpts) in keystone_get_ts_info()
2009 return -EINVAL; in keystone_get_ts_info()
2011 info->so_timestamping = in keystone_get_ts_info()
2018 info->phc_index = gbe_intf->gbe_dev->cpts->phc_index; in keystone_get_ts_info()
2019 info->tx_types = in keystone_get_ts_info()
2022 info->rx_filters = in keystone_get_ts_info()
2032 info->so_timestamping = in keystone_get_ts_info()
2036 info->phc_index = -1; in keystone_get_ts_info()
2037 info->tx_types = 0; in keystone_get_ts_info()
2038 info->rx_filters = 0; in keystone_get_ts_info()
2056 static void gbe_set_slave_mac(struct gbe_slave *slave, in gbe_set_slave_mac() argument
2059 struct net_device *ndev = gbe_intf->ndev; in gbe_set_slave_mac()
2061 writel(mac_hi(ndev->dev_addr), GBE_REG_ADDR(slave, port_regs, sa_hi)); in gbe_set_slave_mac()
2062 writel(mac_lo(ndev->dev_addr), GBE_REG_ADDR(slave, port_regs, sa_lo)); in gbe_set_slave_mac()
2067 if (priv->host_port == 0) in gbe_get_slave_port()
2075 struct gbe_slave *slave, in netcp_ethss_link_state_action() argument
2078 struct phy_device *phy = slave->phy; in netcp_ethss_link_state_action()
2082 mac_control = slave->mac_control; in netcp_ethss_link_state_action()
2083 if (phy && (phy->speed == SPEED_1000)) { in netcp_ethss_link_state_action()
2086 } else if (phy && (phy->speed == SPEED_10000)) { in netcp_ethss_link_state_action()
2091 writel(mac_control, GBE_REG_ADDR(slave, emac_regs, in netcp_ethss_link_state_action()
2094 cpsw_ale_control_set(gbe_dev->ale, slave->port_num, in netcp_ethss_link_state_action()
2098 if (ndev && slave->open && in netcp_ethss_link_state_action()
2099 ((slave->link_interface != SGMII_LINK_MAC_PHY) && in netcp_ethss_link_state_action()
2100 (slave->link_interface != RGMII_LINK_MAC_PHY) && in netcp_ethss_link_state_action()
2101 (slave->link_interface != XGMII_LINK_MAC_PHY))) in netcp_ethss_link_state_action()
2104 writel(mac_control, GBE_REG_ADDR(slave, emac_regs, in netcp_ethss_link_state_action()
2106 cpsw_ale_control_set(gbe_dev->ale, slave->port_num, in netcp_ethss_link_state_action()
2110 ((slave->link_interface != SGMII_LINK_MAC_PHY) && in netcp_ethss_link_state_action()
2111 (slave->link_interface != RGMII_LINK_MAC_PHY) && in netcp_ethss_link_state_action()
2112 (slave->link_interface != XGMII_LINK_MAC_PHY))) in netcp_ethss_link_state_action()
2120 static bool gbe_phy_link_status(struct gbe_slave *slave) in gbe_phy_link_status() argument
2122 return !slave->phy || slave->phy->link; in gbe_phy_link_status()
2136 struct gbe_slave *slave, in netcp_ethss_update_link_state() argument
2140 int sp = slave->slave_num, link_state; in netcp_ethss_update_link_state()
2142 if (!slave->open) in netcp_ethss_update_link_state()
2145 if (SLAVE_LINK_IS_RGMII(slave)) in netcp_ethss_update_link_state()
2148 if (SLAVE_LINK_IS_SGMII(slave)) in netcp_ethss_update_link_state()
2152 phy_link_state = gbe_phy_link_status(slave); in netcp_ethss_update_link_state()
2155 if (atomic_xchg(&slave->link_state, link_state) != link_state) in netcp_ethss_update_link_state()
2156 netcp_ethss_link_state_action(gbe_dev, ndev, slave, in netcp_ethss_update_link_state()
2169 netcp_ethss_update_link_state(gbe_intf->gbe_dev, gbe_intf->slave, in xgbe_adjust_link()
2182 netcp_ethss_update_link_state(gbe_intf->gbe_dev, gbe_intf->slave, in gbe_adjust_link()
2189 struct gbe_slave *slave; in gbe_adjust_link_sec_slaves() local
2191 for_each_sec_slave(slave, gbe_dev) in gbe_adjust_link_sec_slaves()
2192 netcp_ethss_update_link_state(gbe_dev, slave, NULL); in gbe_adjust_link_sec_slaves()
2198 static int gbe_port_reset(struct gbe_slave *slave) in gbe_port_reset() argument
2203 writel(SOFT_RESET, GBE_REG_ADDR(slave, emac_regs, soft_reset)); in gbe_port_reset()
2207 v = readl(GBE_REG_ADDR(slave, emac_regs, soft_reset)); in gbe_port_reset()
2217 static void gbe_port_config(struct gbe_priv *gbe_dev, struct gbe_slave *slave, in gbe_port_config() argument
2228 (slave->link_interface >= XGMII_LINK_MAC_PHY)) { in gbe_port_config()
2230 xgmii_mode |= (1 << slave->slave_num); in gbe_port_config()
2235 rx_maxlen_reg = GBE_REG_ADDR(slave, port_regs, rx_maxlen); in gbe_port_config()
2237 rx_maxlen_reg = GBE_REG_ADDR(slave, emac_regs, rx_maxlen); in gbe_port_config()
2240 writel(slave->mac_control, GBE_REG_ADDR(slave, emac_regs, mac_control)); in gbe_port_config()
2244 struct gbe_slave *slave, bool set) in gbe_sgmii_rtreset() argument
2246 if (SLAVE_LINK_IS_XGMII(slave)) in gbe_sgmii_rtreset()
2249 netcp_sgmii_rtreset(SGMII_BASE(priv, slave->slave_num), in gbe_sgmii_rtreset()
2250 slave->slave_num, set); in gbe_sgmii_rtreset()
2255 struct gbe_priv *gbe_dev = intf->gbe_dev; in gbe_slave_stop()
2256 struct gbe_slave *slave = intf->slave; in gbe_slave_stop() local
2259 gbe_sgmii_rtreset(gbe_dev, slave, true); in gbe_slave_stop()
2260 gbe_port_reset(slave); in gbe_slave_stop()
2262 cpsw_ale_control_set(gbe_dev->ale, slave->port_num, in gbe_slave_stop()
2264 cpsw_ale_del_mcast(gbe_dev->ale, intf->ndev->broadcast, in gbe_slave_stop()
2265 1 << slave->port_num, 0, 0); in gbe_slave_stop()
2267 if (!slave->phy) in gbe_slave_stop()
2270 phy_stop(slave->phy); in gbe_slave_stop()
2271 phy_disconnect(slave->phy); in gbe_slave_stop()
2272 slave->phy = NULL; in gbe_slave_stop()
2275 static void gbe_sgmii_config(struct gbe_priv *priv, struct gbe_slave *slave) in gbe_sgmii_config() argument
2277 if (SLAVE_LINK_IS_XGMII(slave)) in gbe_sgmii_config()
2280 netcp_sgmii_reset(SGMII_BASE(priv, slave->slave_num), slave->slave_num); in gbe_sgmii_config()
2281 netcp_sgmii_config(SGMII_BASE(priv, slave->slave_num), slave->slave_num, in gbe_sgmii_config()
2282 slave->link_interface); in gbe_sgmii_config()
2287 struct gbe_priv *priv = gbe_intf->gbe_dev; in gbe_slave_open()
2288 struct gbe_slave *slave = gbe_intf->slave; in gbe_slave_open() local
2296 gbe_sgmii_config(priv, slave); in gbe_slave_open()
2297 gbe_port_reset(slave); in gbe_slave_open()
2299 gbe_sgmii_rtreset(priv, slave, false); in gbe_slave_open()
2300 gbe_port_config(priv, slave, priv->rx_packet_max); in gbe_slave_open()
2301 gbe_set_slave_mac(slave, gbe_intf); in gbe_slave_open()
2307 GBE_REG_ADDR(slave, port_regs, rx_pri_map)); in gbe_slave_open()
2310 cpsw_ale_control_set(priv->ale, slave->port_num, in gbe_slave_open()
2312 cpsw_ale_add_mcast(priv->ale, gbe_intf->ndev->broadcast, in gbe_slave_open()
2313 1 << slave->port_num, 0, 0, ALE_MCAST_FWD_2); in gbe_slave_open()
2315 if (slave->link_interface == SGMII_LINK_MAC_PHY) { in gbe_slave_open()
2318 slave->phy_port_t = PORT_MII; in gbe_slave_open()
2319 } else if (slave->link_interface == RGMII_LINK_MAC_PHY) { in gbe_slave_open()
2321 err = of_get_phy_mode(slave->node, &phy_mode); in gbe_slave_open()
2322 /* if phy-mode is not present, default to in gbe_slave_open()
2329 dev_err(priv->dev, in gbe_slave_open()
2331 return -EINVAL; in gbe_slave_open()
2333 slave->phy_port_t = PORT_MII; in gbe_slave_open()
2334 } else if (slave->link_interface == XGMII_LINK_MAC_PHY) { in gbe_slave_open()
2337 slave->phy_port_t = PORT_FIBRE; in gbe_slave_open()
2344 slave->phy = of_phy_connect(gbe_intf->ndev, in gbe_slave_open()
2345 slave->phy_node, in gbe_slave_open()
2348 if (!slave->phy) { in gbe_slave_open()
2349 dev_err(priv->dev, "phy not found on slave %d\n", in gbe_slave_open()
2350 slave->slave_num); in gbe_slave_open()
2351 return -ENODEV; in gbe_slave_open()
2353 dev_dbg(priv->dev, "phy found: id is: 0x%s\n", in gbe_slave_open()
2354 phydev_name(slave->phy)); in gbe_slave_open()
2355 phy_start(slave->phy); in gbe_slave_open()
2373 cpsw_ale_start(priv->ale); in gbe_init_host_port()
2375 if (priv->enable_ale) in gbe_init_host_port()
2378 cpsw_ale_control_set(priv->ale, 0, ALE_BYPASS, bypass_en); in gbe_init_host_port()
2380 cpsw_ale_control_set(priv->ale, 0, ALE_NO_PORT_VLAN, 1); in gbe_init_host_port()
2382 cpsw_ale_control_set(priv->ale, priv->host_port, in gbe_init_host_port()
2385 cpsw_ale_control_set(priv->ale, 0, in gbe_init_host_port()
2387 GBE_PORT_MASK(priv->ale_ports)); in gbe_init_host_port()
2389 cpsw_ale_control_set(priv->ale, 0, in gbe_init_host_port()
2391 GBE_PORT_MASK(priv->ale_ports - 1)); in gbe_init_host_port()
2393 cpsw_ale_control_set(priv->ale, 0, in gbe_init_host_port()
2395 GBE_PORT_MASK(priv->ale_ports)); in gbe_init_host_port()
2397 cpsw_ale_control_set(priv->ale, 0, in gbe_init_host_port()
2399 GBE_PORT_MASK(priv->ale_ports)); in gbe_init_host_port()
2404 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_add_mcast_addr()
2407 cpsw_ale_add_mcast(gbe_dev->ale, addr, in gbe_add_mcast_addr()
2408 GBE_PORT_MASK(gbe_dev->ale_ports), 0, 0, in gbe_add_mcast_addr()
2410 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) { in gbe_add_mcast_addr()
2411 cpsw_ale_add_mcast(gbe_dev->ale, addr, in gbe_add_mcast_addr()
2412 GBE_PORT_MASK(gbe_dev->ale_ports), in gbe_add_mcast_addr()
2419 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_add_ucast_addr()
2422 cpsw_ale_add_ucast(gbe_dev->ale, addr, gbe_dev->host_port, 0, 0); in gbe_add_ucast_addr()
2424 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) in gbe_add_ucast_addr()
2425 cpsw_ale_add_ucast(gbe_dev->ale, addr, gbe_dev->host_port, in gbe_add_ucast_addr()
2431 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_del_mcast_addr()
2434 cpsw_ale_del_mcast(gbe_dev->ale, addr, 0, 0, 0); in gbe_del_mcast_addr()
2436 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) { in gbe_del_mcast_addr()
2437 cpsw_ale_del_mcast(gbe_dev->ale, addr, 0, ALE_VLAN, vlan_id); in gbe_del_mcast_addr()
2443 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_del_ucast_addr()
2446 cpsw_ale_del_ucast(gbe_dev->ale, addr, gbe_dev->host_port, 0, 0); in gbe_del_ucast_addr()
2448 for_each_set_bit(vlan_id, gbe_intf->active_vlans, VLAN_N_VID) { in gbe_del_ucast_addr()
2449 cpsw_ale_del_ucast(gbe_dev->ale, addr, gbe_dev->host_port, in gbe_del_ucast_addr()
2457 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_add_addr()
2459 dev_dbg(gbe_dev->dev, "ethss adding address %pM, type %d\n", in gbe_add_addr()
2460 naddr->addr, naddr->type); in gbe_add_addr()
2462 switch (naddr->type) { in gbe_add_addr()
2465 gbe_add_mcast_addr(gbe_intf, naddr->addr); in gbe_add_addr()
2469 gbe_add_ucast_addr(gbe_intf, naddr->addr); in gbe_add_addr()
2483 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_del_addr()
2485 dev_dbg(gbe_dev->dev, "ethss deleting address %pM, type %d\n", in gbe_del_addr()
2486 naddr->addr, naddr->type); in gbe_del_addr()
2488 switch (naddr->type) { in gbe_del_addr()
2491 gbe_del_mcast_addr(gbe_intf, naddr->addr); in gbe_del_addr()
2495 gbe_del_ucast_addr(gbe_intf, naddr->addr); in gbe_del_addr()
2509 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_add_vid()
2511 set_bit(vid, gbe_intf->active_vlans); in gbe_add_vid()
2513 cpsw_ale_add_vlan(gbe_dev->ale, vid, in gbe_add_vid()
2514 GBE_PORT_MASK(gbe_dev->ale_ports), in gbe_add_vid()
2516 GBE_PORT_MASK(gbe_dev->ale_ports), in gbe_add_vid()
2517 GBE_PORT_MASK(gbe_dev->ale_ports - 1)); in gbe_add_vid()
2525 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_del_vid()
2527 cpsw_ale_del_vlan(gbe_dev->ale, vid, 0); in gbe_del_vid()
2528 clear_bit(vid, gbe_intf->active_vlans); in gbe_del_vid()
2537 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_txtstamp()
2539 cpts_tx_timestamp(gbe_dev->cpts, skb); in gbe_txtstamp()
2545 struct sk_buff *skb = p_info->skb; in gbe_need_txtstamp()
2547 return cpts_can_timestamp(gbe_intf->gbe_dev->cpts, skb); in gbe_need_txtstamp()
2553 struct phy_device *phydev = p_info->skb->dev->phydev; in gbe_txtstamp_mark_pkt()
2554 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_txtstamp_mark_pkt()
2556 if (!(skb_shinfo(p_info->skb)->tx_flags & SKBTX_HW_TSTAMP) || in gbe_txtstamp_mark_pkt()
2557 !gbe_dev->tx_ts_enabled) in gbe_txtstamp_mark_pkt()
2565 skb_shinfo(p_info->skb)->tx_flags |= SKBTX_IN_PROGRESS; in gbe_txtstamp_mark_pkt()
2570 p_info->txtstamp = gbe_txtstamp; in gbe_txtstamp_mark_pkt()
2571 p_info->ts_context = (void *)gbe_intf; in gbe_txtstamp_mark_pkt()
2572 skb_shinfo(p_info->skb)->tx_flags |= SKBTX_IN_PROGRESS; in gbe_txtstamp_mark_pkt()
2580 struct phy_device *phydev = p_info->skb->dev->phydev; in gbe_rxtstamp()
2581 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_rxtstamp()
2583 if (p_info->rxtstamp_complete) in gbe_rxtstamp()
2587 p_info->rxtstamp_complete = true; in gbe_rxtstamp()
2591 if (gbe_dev->rx_ts_enabled) in gbe_rxtstamp()
2592 cpts_rx_timestamp(gbe_dev->cpts, p_info->skb); in gbe_rxtstamp()
2594 p_info->rxtstamp_complete = true; in gbe_rxtstamp()
2601 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_hwtstamp_get()
2602 struct cpts *cpts = gbe_dev->cpts; in gbe_hwtstamp_get()
2606 return -EOPNOTSUPP; in gbe_hwtstamp_get()
2609 cfg.tx_type = gbe_dev->tx_ts_enabled ? HWTSTAMP_TX_ON : HWTSTAMP_TX_OFF; in gbe_hwtstamp_get()
2610 cfg.rx_filter = gbe_dev->rx_ts_enabled; in gbe_hwtstamp_get()
2612 return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0; in gbe_hwtstamp_get()
2617 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_hwtstamp()
2618 struct gbe_slave *slave = gbe_intf->slave; in gbe_hwtstamp() local
2621 if (!gbe_dev->rx_ts_enabled && in gbe_hwtstamp()
2622 !gbe_dev->tx_ts_enabled) { in gbe_hwtstamp()
2623 writel(0, GBE_REG_ADDR(slave, port_regs, ts_ctl)); in gbe_hwtstamp()
2630 (slave->ts_ctl.dst_port_map << TS_CTL_DST_PORT_SHIFT) | in gbe_hwtstamp()
2631 (slave->ts_ctl.uni ? TS_UNI_EN : in gbe_hwtstamp()
2632 slave->ts_ctl.maddr_map << TS_CTL_MADDR_SHIFT); in gbe_hwtstamp()
2634 if (gbe_dev->tx_ts_enabled) in gbe_hwtstamp()
2637 if (gbe_dev->rx_ts_enabled) in gbe_hwtstamp()
2640 writel(ts_en, GBE_REG_ADDR(slave, port_regs, ts_ctl)); in gbe_hwtstamp()
2641 writel(seq_id, GBE_REG_ADDR(slave, port_regs, ts_seq_ltype)); in gbe_hwtstamp()
2642 writel(ctl, GBE_REG_ADDR(slave, port_regs, ts_ctl_ltype2)); in gbe_hwtstamp()
2647 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_hwtstamp_set()
2648 struct cpts *cpts = gbe_dev->cpts; in gbe_hwtstamp_set()
2652 return -EOPNOTSUPP; in gbe_hwtstamp_set()
2654 if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg))) in gbe_hwtstamp_set()
2655 return -EFAULT; in gbe_hwtstamp_set()
2659 gbe_dev->tx_ts_enabled = 0; in gbe_hwtstamp_set()
2662 gbe_dev->tx_ts_enabled = 1; in gbe_hwtstamp_set()
2665 return -ERANGE; in gbe_hwtstamp_set()
2670 gbe_dev->rx_ts_enabled = HWTSTAMP_FILTER_NONE; in gbe_hwtstamp_set()
2675 gbe_dev->rx_ts_enabled = HWTSTAMP_FILTER_PTP_V1_L4_EVENT; in gbe_hwtstamp_set()
2687 gbe_dev->rx_ts_enabled = HWTSTAMP_FILTER_PTP_V2_EVENT; in gbe_hwtstamp_set()
2691 return -ERANGE; in gbe_hwtstamp_set()
2696 return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0; in gbe_hwtstamp_set()
2701 if (!gbe_dev->cpts) in gbe_register_cpts()
2704 if (gbe_dev->cpts_registered > 0) in gbe_register_cpts()
2707 if (cpts_register(gbe_dev->cpts)) { in gbe_register_cpts()
2708 dev_err(gbe_dev->dev, "error registering cpts device\n"); in gbe_register_cpts()
2713 ++gbe_dev->cpts_registered; in gbe_register_cpts()
2718 if (!gbe_dev->cpts || (gbe_dev->cpts_registered <= 0)) in gbe_unregister_cpts()
2721 if (--gbe_dev->cpts_registered) in gbe_unregister_cpts()
2724 cpts_unregister(gbe_dev->cpts); in gbe_unregister_cpts()
2742 return -EOPNOTSUPP; in gbe_hwtstamp()
2755 return -EOPNOTSUPP; in gbe_hwtstamp_get()
2760 return -EOPNOTSUPP; in gbe_hwtstamp_set()
2767 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_set_rx_mode()
2768 struct cpsw_ale *ale = gbe_dev->ale; in gbe_set_rx_mode()
2770 int i, ret = -ETIMEDOUT; in gbe_set_rx_mode()
2775 for (i = 0; i <= gbe_dev->num_slaves; i++) { in gbe_set_rx_mode()
2785 dev_vdbg(gbe_dev->dev, "promiscuous mode disabled\n"); in gbe_set_rx_mode()
2810 GBE_PORT_MASK(gbe_dev->ale_ports), in gbe_set_rx_mode()
2811 -1); in gbe_set_rx_mode()
2815 dev_vdbg(gbe_dev->dev, "promiscuous mode enabled\n"); in gbe_set_rx_mode()
2822 struct phy_device *phy = gbe_intf->slave->phy; in gbe_ioctl()
2836 return -EOPNOTSUPP; in gbe_ioctl()
2843 struct gbe_slave *slave; in netcp_ethss_timer() local
2847 if (!gbe_intf->slave->open) in netcp_ethss_timer()
2849 netcp_ethss_update_link_state(gbe_dev, gbe_intf->slave, in netcp_ethss_timer()
2850 gbe_intf->ndev); in netcp_ethss_timer()
2854 for_each_sec_slave(slave, gbe_dev) { in netcp_ethss_timer()
2855 netcp_ethss_update_link_state(gbe_dev, slave, NULL); in netcp_ethss_timer()
2859 spin_lock(&gbe_dev->hw_stats_lock); in netcp_ethss_timer()
2866 spin_unlock(&gbe_dev->hw_stats_lock); in netcp_ethss_timer()
2868 gbe_dev->timer.expires = jiffies + GBE_TIMER_INTERVAL; in netcp_ethss_timer()
2869 add_timer(&gbe_dev->timer); in netcp_ethss_timer()
2876 p_info->tx_pipe = &gbe_intf->tx_pipe; in gbe_txhook()
2891 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_open()
2893 struct gbe_slave *slave = gbe_intf->slave; in gbe_open() local
2894 int port_num = slave->port_num; in gbe_open()
2899 dev_dbg(gbe_dev->dev, "initializing gbe version %d.%d (%d) GBE identification value 0x%x\n", in gbe_open()
2905 gbe_intf->tx_pipe.flags = SWITCH_TO_PORT_IN_TAGINFO; in gbe_open()
2907 if (gbe_dev->enable_ale) in gbe_open()
2908 gbe_intf->tx_pipe.switch_to_port = 0; in gbe_open()
2910 gbe_intf->tx_pipe.switch_to_port = port_num; in gbe_open()
2912 dev_dbg(gbe_dev->dev, in gbe_open()
2914 gbe_intf->tx_pipe.dma_chan_name, in gbe_open()
2915 gbe_intf->tx_pipe.dma_channel, in gbe_open()
2916 gbe_intf->tx_pipe.switch_to_port, in gbe_open()
2917 gbe_intf->tx_pipe.flags); in gbe_open()
2928 netcp->hw_cap = ETH_SW_CAN_REMOVE_ETH_FCS; in gbe_open()
2933 writel(gbe_dev->stats_en_mask, GBE_REG_ADDR(gbe_dev, switch_regs, in gbe_open()
2943 slave->open = true; in gbe_open()
2944 netcp_ethss_update_link_state(gbe_dev, slave, ndev); in gbe_open()
2959 struct gbe_priv *gbe_dev = gbe_intf->gbe_dev; in gbe_close()
2968 gbe_intf->slave->open = false; in gbe_close()
2969 atomic_set(&gbe_intf->slave->link_state, NETCP_LINK_STATE_INVALID); in gbe_close()
2974 static void init_slave_ts_ctl(struct gbe_slave *slave) in init_slave_ts_ctl() argument
2976 slave->ts_ctl.uni = 1; in init_slave_ts_ctl()
2977 slave->ts_ctl.dst_port_map = in init_slave_ts_ctl()
2979 slave->ts_ctl.maddr_map = in init_slave_ts_ctl()
2984 static void init_slave_ts_ctl(struct gbe_slave *slave) in init_slave_ts_ctl() argument
2989 static int init_slave(struct gbe_priv *gbe_dev, struct gbe_slave *slave, in init_slave() argument
2996 if (of_property_read_u32(node, "slave-port", &slave->slave_num)) { in init_slave()
2997 dev_err(gbe_dev->dev, "missing slave-port parameter\n"); in init_slave()
2998 return -EINVAL; in init_slave()
3001 if (of_property_read_u32(node, "link-interface", in init_slave()
3002 &slave->link_interface)) { in init_slave()
3003 dev_warn(gbe_dev->dev, in init_slave()
3004 "missing link-interface value defaulting to 1G mac-phy link\n"); in init_slave()
3005 slave->link_interface = SGMII_LINK_MAC_PHY; in init_slave()
3008 slave->node = node; in init_slave()
3009 slave->open = false; in init_slave()
3010 if ((slave->link_interface == SGMII_LINK_MAC_PHY) || in init_slave()
3011 (slave->link_interface == RGMII_LINK_MAC_PHY) || in init_slave()
3012 (slave->link_interface == XGMII_LINK_MAC_PHY)) in init_slave()
3013 slave->phy_node = of_parse_phandle(node, "phy-handle", 0); in init_slave()
3014 slave->port_num = gbe_get_slave_port(gbe_dev, slave->slave_num); in init_slave()
3016 if (slave->link_interface >= XGMII_LINK_MAC_PHY) in init_slave()
3017 slave->mac_control = GBE_DEF_10G_MAC_CONTROL; in init_slave()
3019 slave->mac_control = GBE_DEF_1G_MAC_CONTROL; in init_slave()
3022 port_reg_num = slave->slave_num; in init_slave()
3024 if (slave->slave_num > 1) { in init_slave()
3026 port_reg_num -= 2; in init_slave()
3044 dev_err(gbe_dev->dev, "unknown ethss(0x%x)\n", in init_slave()
3045 gbe_dev->ss_version); in init_slave()
3046 return -EINVAL; in init_slave()
3049 slave->port_regs = gbe_dev->switch_regs + port_reg_ofs + in init_slave()
3051 slave->emac_regs = gbe_dev->switch_regs + emac_reg_ofs + in init_slave()
3052 (emac_reg_blk_sz * slave->slave_num); in init_slave()
3055 /* Initialize slave port register offsets */ in init_slave()
3056 GBE_SET_REG_OFS(slave, port_regs, port_vlan); in init_slave()
3057 GBE_SET_REG_OFS(slave, port_regs, tx_pri_map); in init_slave()
3058 GBE_SET_REG_OFS(slave, port_regs, sa_lo); in init_slave()
3059 GBE_SET_REG_OFS(slave, port_regs, sa_hi); in init_slave()
3060 GBE_SET_REG_OFS(slave, port_regs, ts_ctl); in init_slave()
3061 GBE_SET_REG_OFS(slave, port_regs, ts_seq_ltype); in init_slave()
3062 GBE_SET_REG_OFS(slave, port_regs, ts_vlan); in init_slave()
3063 GBE_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2); in init_slave()
3064 GBE_SET_REG_OFS(slave, port_regs, ts_ctl2); in init_slave()
3067 GBE_SET_REG_OFS(slave, emac_regs, mac_control); in init_slave()
3068 GBE_SET_REG_OFS(slave, emac_regs, soft_reset); in init_slave()
3069 GBE_SET_REG_OFS(slave, emac_regs, rx_maxlen); in init_slave()
3072 /* Initialize slave port register offsets */ in init_slave()
3073 GBENU_SET_REG_OFS(slave, port_regs, port_vlan); in init_slave()
3074 GBENU_SET_REG_OFS(slave, port_regs, tx_pri_map); in init_slave()
3075 GBENU_SET_REG_OFS(slave, port_regs, rx_pri_map); in init_slave()
3076 GBENU_SET_REG_OFS(slave, port_regs, sa_lo); in init_slave()
3077 GBENU_SET_REG_OFS(slave, port_regs, sa_hi); in init_slave()
3078 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl); in init_slave()
3079 GBENU_SET_REG_OFS(slave, port_regs, ts_seq_ltype); in init_slave()
3080 GBENU_SET_REG_OFS(slave, port_regs, ts_vlan); in init_slave()
3081 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2); in init_slave()
3082 GBENU_SET_REG_OFS(slave, port_regs, ts_ctl2); in init_slave()
3083 GBENU_SET_REG_OFS(slave, port_regs, rx_maxlen); in init_slave()
3086 GBENU_SET_REG_OFS(slave, emac_regs, mac_control); in init_slave()
3087 GBENU_SET_REG_OFS(slave, emac_regs, soft_reset); in init_slave()
3090 /* Initialize slave port register offsets */ in init_slave()
3091 XGBE_SET_REG_OFS(slave, port_regs, port_vlan); in init_slave()
3092 XGBE_SET_REG_OFS(slave, port_regs, tx_pri_map); in init_slave()
3093 XGBE_SET_REG_OFS(slave, port_regs, sa_lo); in init_slave()
3094 XGBE_SET_REG_OFS(slave, port_regs, sa_hi); in init_slave()
3095 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl); in init_slave()
3096 XGBE_SET_REG_OFS(slave, port_regs, ts_seq_ltype); in init_slave()
3097 XGBE_SET_REG_OFS(slave, port_regs, ts_vlan); in init_slave()
3098 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl_ltype2); in init_slave()
3099 XGBE_SET_REG_OFS(slave, port_regs, ts_ctl2); in init_slave()
3102 XGBE_SET_REG_OFS(slave, emac_regs, mac_control); in init_slave()
3103 XGBE_SET_REG_OFS(slave, emac_regs, soft_reset); in init_slave()
3104 XGBE_SET_REG_OFS(slave, emac_regs, rx_maxlen); in init_slave()
3107 atomic_set(&slave->link_state, NETCP_LINK_STATE_INVALID); in init_slave()
3109 init_slave_ts_ctl(slave); in init_slave()
3116 struct device *dev = gbe_dev->dev; in init_secondary_ports() local
3120 struct gbe_slave *slave; in init_secondary_ports() local
3124 slave = devm_kzalloc(dev, sizeof(*slave), GFP_KERNEL); in init_secondary_ports()
3125 if (!slave) { in init_secondary_ports()
3126 dev_err(dev, "memory alloc failed for secondary port(%pOFn), skipping...\n", in init_secondary_ports()
3131 if (init_slave(gbe_dev, slave, port)) { in init_secondary_ports()
3132 dev_err(dev, in init_secondary_ports()
3135 devm_kfree(dev, slave); in init_secondary_ports()
3140 gbe_sgmii_config(gbe_dev, slave); in init_secondary_ports()
3141 gbe_port_reset(slave); in init_secondary_ports()
3142 gbe_port_config(gbe_dev, slave, gbe_dev->rx_packet_max); in init_secondary_ports()
3143 list_add_tail(&slave->slave_list, &gbe_dev->secondary_slaves); in init_secondary_ports()
3144 gbe_dev->num_slaves++; in init_secondary_ports()
3145 if ((slave->link_interface == SGMII_LINK_MAC_PHY) || in init_secondary_ports()
3146 (slave->link_interface == XGMII_LINK_MAC_PHY)) in init_secondary_ports()
3149 slave->open = true; in init_secondary_ports()
3150 if (gbe_dev->num_slaves >= gbe_dev->max_num_slaves) { in init_secondary_ports()
3156 /* of_phy_connect() is needed only for MAC-PHY interface */ in init_secondary_ports()
3161 gbe_dev->dummy_ndev = alloc_netdev(sizeof(gbe_dev), "dummy", in init_secondary_ports()
3163 if (!gbe_dev->dummy_ndev) { in init_secondary_ports()
3164 dev_err(dev, in init_secondary_ports()
3168 priv = netdev_priv(gbe_dev->dummy_ndev); in init_secondary_ports()
3171 if (slave->link_interface == SGMII_LINK_MAC_PHY) { in init_secondary_ports()
3173 slave->phy_port_t = PORT_MII; in init_secondary_ports()
3174 } else if (slave->link_interface == RGMII_LINK_MAC_PHY) { in init_secondary_ports()
3176 slave->phy_port_t = PORT_MII; in init_secondary_ports()
3179 slave->phy_port_t = PORT_FIBRE; in init_secondary_ports()
3182 for_each_sec_slave(slave, gbe_dev) { in init_secondary_ports()
3183 if ((slave->link_interface != SGMII_LINK_MAC_PHY) && in init_secondary_ports()
3184 (slave->link_interface != RGMII_LINK_MAC_PHY) && in init_secondary_ports()
3185 (slave->link_interface != XGMII_LINK_MAC_PHY)) in init_secondary_ports()
3187 slave->phy = in init_secondary_ports()
3188 of_phy_connect(gbe_dev->dummy_ndev, in init_secondary_ports()
3189 slave->phy_node, in init_secondary_ports()
3192 if (!slave->phy) { in init_secondary_ports()
3193 dev_err(dev, "phy not found for slave %d\n", in init_secondary_ports()
3194 slave->slave_num); in init_secondary_ports()
3196 dev_dbg(dev, "phy found: id is: 0x%s\n", in init_secondary_ports()
3197 phydev_name(slave->phy)); in init_secondary_ports()
3198 phy_start(slave->phy); in init_secondary_ports()
3205 struct gbe_slave *slave; in free_secondary_ports() local
3207 while (!list_empty(&gbe_dev->secondary_slaves)) { in free_secondary_ports()
3208 slave = first_sec_slave(gbe_dev); in free_secondary_ports()
3210 if (slave->phy) in free_secondary_ports()
3211 phy_disconnect(slave->phy); in free_secondary_ports()
3212 list_del(&slave->slave_list); in free_secondary_ports()
3214 if (gbe_dev->dummy_ndev) in free_secondary_ports()
3215 free_netdev(gbe_dev->dummy_ndev); in free_secondary_ports()
3227 dev_err(gbe_dev->dev, in set_xgbe_ethss10_priv()
3233 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_xgbe_ethss10_priv()
3235 dev_err(gbe_dev->dev, "Failed to map xgbe ss register base\n"); in set_xgbe_ethss10_priv()
3238 gbe_dev->ss_regs = regs; in set_xgbe_ethss10_priv()
3242 dev_err(gbe_dev->dev, in set_xgbe_ethss10_priv()
3248 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_xgbe_ethss10_priv()
3250 dev_err(gbe_dev->dev, "Failed to map xgbe sm register base\n"); in set_xgbe_ethss10_priv()
3253 gbe_dev->switch_regs = regs; in set_xgbe_ethss10_priv()
3257 dev_err(gbe_dev->dev, in set_xgbe_ethss10_priv()
3263 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_xgbe_ethss10_priv()
3265 dev_err(gbe_dev->dev, "Failed to map xgbe serdes register base\n"); in set_xgbe_ethss10_priv()
3268 gbe_dev->xgbe_serdes_regs = regs; in set_xgbe_ethss10_priv()
3270 gbe_dev->num_stats_mods = gbe_dev->max_num_ports; in set_xgbe_ethss10_priv()
3271 gbe_dev->et_stats = xgbe10_et_stats; in set_xgbe_ethss10_priv()
3272 gbe_dev->num_et_stats = ARRAY_SIZE(xgbe10_et_stats); in set_xgbe_ethss10_priv()
3274 gbe_dev->hw_stats = devm_kcalloc(gbe_dev->dev, in set_xgbe_ethss10_priv()
3275 gbe_dev->num_et_stats, sizeof(u64), in set_xgbe_ethss10_priv()
3277 if (!gbe_dev->hw_stats) { in set_xgbe_ethss10_priv()
3278 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n"); in set_xgbe_ethss10_priv()
3279 return -ENOMEM; in set_xgbe_ethss10_priv()
3282 gbe_dev->hw_stats_prev = in set_xgbe_ethss10_priv()
3283 devm_kcalloc(gbe_dev->dev, in set_xgbe_ethss10_priv()
3284 gbe_dev->num_et_stats, sizeof(u32), in set_xgbe_ethss10_priv()
3286 if (!gbe_dev->hw_stats_prev) { in set_xgbe_ethss10_priv()
3287 dev_err(gbe_dev->dev, in set_xgbe_ethss10_priv()
3289 return -ENOMEM; in set_xgbe_ethss10_priv()
3292 gbe_dev->ss_version = XGBE_SS_VERSION_10; in set_xgbe_ethss10_priv()
3293 gbe_dev->sgmii_port_regs = gbe_dev->ss_regs + in set_xgbe_ethss10_priv()
3295 gbe_dev->host_port_regs = gbe_dev->ss_regs + XGBE10_HOST_PORT_OFFSET; in set_xgbe_ethss10_priv()
3297 for (i = 0; i < gbe_dev->max_num_ports; i++) in set_xgbe_ethss10_priv()
3298 gbe_dev->hw_stats_regs[i] = gbe_dev->switch_regs + in set_xgbe_ethss10_priv()
3301 gbe_dev->ale_reg = gbe_dev->switch_regs + XGBE10_ALE_OFFSET; in set_xgbe_ethss10_priv()
3302 gbe_dev->cpts_reg = gbe_dev->switch_regs + XGBE10_CPTS_OFFSET; in set_xgbe_ethss10_priv()
3303 gbe_dev->ale_ports = gbe_dev->max_num_ports; in set_xgbe_ethss10_priv()
3304 gbe_dev->host_port = XGBE10_HOST_PORT_NUM; in set_xgbe_ethss10_priv()
3305 gbe_dev->stats_en_mask = (1 << (gbe_dev->max_num_ports)) - 1; in set_xgbe_ethss10_priv()
3334 dev_err(gbe_dev->dev, in get_gbe_resource_version()
3340 regs = devm_ioremap_resource(gbe_dev->dev, &res); in get_gbe_resource_version()
3342 dev_err(gbe_dev->dev, "Failed to map gbe register base\n"); in get_gbe_resource_version()
3345 gbe_dev->ss_regs = regs; in get_gbe_resource_version()
3346 gbe_dev->ss_version = readl(gbe_dev->ss_regs); in get_gbe_resource_version()
3359 dev_err(gbe_dev->dev, in set_gbe_ethss14_priv()
3365 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_gbe_ethss14_priv()
3367 dev_err(gbe_dev->dev, in set_gbe_ethss14_priv()
3371 gbe_dev->sgmii_port34_regs = regs; in set_gbe_ethss14_priv()
3375 dev_err(gbe_dev->dev, in set_gbe_ethss14_priv()
3381 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_gbe_ethss14_priv()
3383 dev_err(gbe_dev->dev, in set_gbe_ethss14_priv()
3387 gbe_dev->switch_regs = regs; in set_gbe_ethss14_priv()
3389 gbe_dev->num_stats_mods = gbe_dev->max_num_slaves; in set_gbe_ethss14_priv()
3390 gbe_dev->et_stats = gbe13_et_stats; in set_gbe_ethss14_priv()
3391 gbe_dev->num_et_stats = ARRAY_SIZE(gbe13_et_stats); in set_gbe_ethss14_priv()
3393 gbe_dev->hw_stats = devm_kcalloc(gbe_dev->dev, in set_gbe_ethss14_priv()
3394 gbe_dev->num_et_stats, sizeof(u64), in set_gbe_ethss14_priv()
3396 if (!gbe_dev->hw_stats) { in set_gbe_ethss14_priv()
3397 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n"); in set_gbe_ethss14_priv()
3398 return -ENOMEM; in set_gbe_ethss14_priv()
3401 gbe_dev->hw_stats_prev = in set_gbe_ethss14_priv()
3402 devm_kcalloc(gbe_dev->dev, in set_gbe_ethss14_priv()
3403 gbe_dev->num_et_stats, sizeof(u32), in set_gbe_ethss14_priv()
3405 if (!gbe_dev->hw_stats_prev) { in set_gbe_ethss14_priv()
3406 dev_err(gbe_dev->dev, in set_gbe_ethss14_priv()
3408 return -ENOMEM; in set_gbe_ethss14_priv()
3411 gbe_dev->sgmii_port_regs = gbe_dev->ss_regs + GBE13_SGMII_MODULE_OFFSET; in set_gbe_ethss14_priv()
3412 gbe_dev->host_port_regs = gbe_dev->switch_regs + GBE13_HOST_PORT_OFFSET; in set_gbe_ethss14_priv()
3418 for (i = 0; i < gbe_dev->max_num_slaves; i++) { in set_gbe_ethss14_priv()
3419 gbe_dev->hw_stats_regs[i] = in set_gbe_ethss14_priv()
3420 gbe_dev->switch_regs + GBE13_HW_STATS_OFFSET + in set_gbe_ethss14_priv()
3424 gbe_dev->cpts_reg = gbe_dev->switch_regs + GBE13_CPTS_OFFSET; in set_gbe_ethss14_priv()
3425 gbe_dev->ale_reg = gbe_dev->switch_regs + GBE13_ALE_OFFSET; in set_gbe_ethss14_priv()
3426 gbe_dev->ale_ports = gbe_dev->max_num_ports; in set_gbe_ethss14_priv()
3427 gbe_dev->host_port = GBE13_HOST_PORT_NUM; in set_gbe_ethss14_priv()
3428 gbe_dev->stats_en_mask = GBE13_REG_VAL_STAT_ENABLE_ALL; in set_gbe_ethss14_priv()
3454 gbe_dev->num_stats_mods = gbe_dev->max_num_ports; in set_gbenu_ethss_priv()
3455 gbe_dev->et_stats = gbenu_et_stats; in set_gbenu_ethss_priv()
3458 gbe_dev->num_et_stats = GBENU_ET_STATS_HOST_SIZE + in set_gbenu_ethss_priv()
3459 (gbe_dev->max_num_slaves * GBENU_ET_STATS_PORT_SIZE); in set_gbenu_ethss_priv()
3461 gbe_dev->num_et_stats = GBENU_ET_STATS_HOST_SIZE + in set_gbenu_ethss_priv()
3464 gbe_dev->hw_stats = devm_kcalloc(gbe_dev->dev, in set_gbenu_ethss_priv()
3465 gbe_dev->num_et_stats, sizeof(u64), in set_gbenu_ethss_priv()
3467 if (!gbe_dev->hw_stats) { in set_gbenu_ethss_priv()
3468 dev_err(gbe_dev->dev, "hw_stats memory allocation failed\n"); in set_gbenu_ethss_priv()
3469 return -ENOMEM; in set_gbenu_ethss_priv()
3472 gbe_dev->hw_stats_prev = in set_gbenu_ethss_priv()
3473 devm_kcalloc(gbe_dev->dev, in set_gbenu_ethss_priv()
3474 gbe_dev->num_et_stats, sizeof(u32), in set_gbenu_ethss_priv()
3476 if (!gbe_dev->hw_stats_prev) { in set_gbenu_ethss_priv()
3477 dev_err(gbe_dev->dev, in set_gbenu_ethss_priv()
3479 return -ENOMEM; in set_gbenu_ethss_priv()
3484 dev_err(gbe_dev->dev, in set_gbenu_ethss_priv()
3490 regs = devm_ioremap_resource(gbe_dev->dev, &res); in set_gbenu_ethss_priv()
3492 dev_err(gbe_dev->dev, in set_gbenu_ethss_priv()
3496 gbe_dev->switch_regs = regs; in set_gbenu_ethss_priv()
3499 gbe_dev->sgmii_port_regs = in set_gbenu_ethss_priv()
3500 gbe_dev->ss_regs + GBENU_SGMII_MODULE_OFFSET; in set_gbenu_ethss_priv()
3506 gbe_dev->sgmii_port34_regs = gbe_dev->sgmii_port_regs + in set_gbenu_ethss_priv()
3509 gbe_dev->host_port_regs = gbe_dev->switch_regs + GBENU_HOST_PORT_OFFSET; in set_gbenu_ethss_priv()
3511 for (i = 0; i < (gbe_dev->max_num_ports); i++) in set_gbenu_ethss_priv()
3512 gbe_dev->hw_stats_regs[i] = gbe_dev->switch_regs + in set_gbenu_ethss_priv()
3515 gbe_dev->cpts_reg = gbe_dev->switch_regs + GBENU_CPTS_OFFSET; in set_gbenu_ethss_priv()
3516 gbe_dev->ale_reg = gbe_dev->switch_regs + GBENU_ALE_OFFSET; in set_gbenu_ethss_priv()
3517 gbe_dev->ale_ports = gbe_dev->max_num_ports; in set_gbenu_ethss_priv()
3518 gbe_dev->host_port = GBENU_HOST_PORT_NUM; in set_gbenu_ethss_priv()
3519 gbe_dev->stats_en_mask = (1 << (gbe_dev->max_num_ports)) - 1; in set_gbenu_ethss_priv()
3537 * NU cppi port 0 tx pkt streaming interface has (n-1)*8 egress threads in set_gbenu_ethss_priv()
3544 static int gbe_probe(struct netcp_device *netcp_device, struct device *dev, in gbe_probe() argument
3555 dev_err(dev, "device tree info unavailable\n"); in gbe_probe()
3556 return -ENODEV; in gbe_probe()
3559 gbe_dev = devm_kzalloc(dev, sizeof(struct gbe_priv), GFP_KERNEL); in gbe_probe()
3561 return -ENOMEM; in gbe_probe()
3563 if (of_device_is_compatible(node, "ti,netcp-gbe-5") || in gbe_probe()
3564 of_device_is_compatible(node, "ti,netcp-gbe")) { in gbe_probe()
3565 gbe_dev->max_num_slaves = 4; in gbe_probe()
3566 } else if (of_device_is_compatible(node, "ti,netcp-gbe-9")) { in gbe_probe()
3567 gbe_dev->max_num_slaves = 8; in gbe_probe()
3568 } else if (of_device_is_compatible(node, "ti,netcp-gbe-2")) { in gbe_probe()
3569 gbe_dev->max_num_slaves = 1; in gbe_probe()
3571 } else if (of_device_is_compatible(node, "ti,netcp-xgbe")) { in gbe_probe()
3572 gbe_dev->max_num_slaves = 2; in gbe_probe()
3574 dev_err(dev, "device tree node for unknown device\n"); in gbe_probe()
3575 return -EINVAL; in gbe_probe()
3577 gbe_dev->max_num_ports = gbe_dev->max_num_slaves + 1; in gbe_probe()
3579 gbe_dev->dev = dev; in gbe_probe()
3580 gbe_dev->netcp_device = netcp_device; in gbe_probe()
3581 gbe_dev->rx_packet_max = NETCP_MAX_FRAME_SIZE; in gbe_probe()
3584 spin_lock_init(&gbe_dev->hw_stats_lock); in gbe_probe()
3586 gbe_dev->enable_ale = of_property_read_bool(node, "enable-ale"); in gbe_probe()
3587 if (gbe_dev->enable_ale) in gbe_probe()
3588 dev_info(dev, "ALE enabled\n"); in gbe_probe()
3590 dev_dbg(dev, "ALE bypass enabled*\n"); in gbe_probe()
3592 ret = of_property_read_u32(node, "tx-queue", in gbe_probe()
3593 &gbe_dev->tx_queue_id); in gbe_probe()
3595 dev_err(dev, "missing tx_queue parameter\n"); in gbe_probe()
3596 gbe_dev->tx_queue_id = GBE_TX_QUEUE; in gbe_probe()
3599 ret = of_property_read_string(node, "tx-channel", in gbe_probe()
3600 &gbe_dev->dma_chan_name); in gbe_probe()
3602 dev_err(dev, "missing \"tx-channel\" parameter\n"); in gbe_probe()
3603 return -EINVAL; in gbe_probe()
3611 dev_dbg(dev, "ss_version: 0x%08x\n", gbe_dev->ss_version); in gbe_probe()
3618 ret = -ENODEV; in gbe_probe()
3624 ret = netcp_xgbe_serdes_init(gbe_dev->xgbe_serdes_regs, in gbe_probe()
3625 gbe_dev->ss_regs); in gbe_probe()
3627 dev_err(dev, "unknown GBE node(%pOFn)\n", node); in gbe_probe()
3628 ret = -ENODEV; in gbe_probe()
3636 dev_err(dev, "could not find interfaces\n"); in gbe_probe()
3638 ret = netcp_txpipe_init(&gbe_dev->tx_pipe, netcp_device, in gbe_probe()
3639 gbe_dev->dma_chan_name, gbe_dev->tx_queue_id); in gbe_probe()
3645 ret = netcp_txpipe_open(&gbe_dev->tx_pipe); in gbe_probe()
3652 INIT_LIST_HEAD(&gbe_dev->gbe_intf_head); in gbe_probe()
3654 ret = of_property_read_u32(interface, "slave-port", &slave_num); in gbe_probe()
3656 dev_err(dev, "missing slave-port parameter, skipping interface configuration for %pOFn\n", in gbe_probe()
3660 gbe_dev->num_slaves++; in gbe_probe()
3661 if (gbe_dev->num_slaves >= gbe_dev->max_num_slaves) { in gbe_probe()
3668 if (!gbe_dev->num_slaves) in gbe_probe()
3669 dev_warn(dev, "No network interface configured\n"); in gbe_probe()
3671 /* Initialize Secondary slave ports */ in gbe_probe()
3672 secondary_ports = of_get_child_by_name(node, "secondary-slave-ports"); in gbe_probe()
3673 INIT_LIST_HEAD(&gbe_dev->secondary_slaves); in gbe_probe()
3674 if (secondary_ports && (gbe_dev->num_slaves < gbe_dev->max_num_slaves)) in gbe_probe()
3678 if (!gbe_dev->num_slaves) { in gbe_probe()
3679 dev_err(dev, in gbe_probe()
3681 ret = -ENODEV; in gbe_probe()
3686 ale_params.dev = gbe_dev->dev; in gbe_probe()
3687 ale_params.ale_regs = gbe_dev->ale_reg; in gbe_probe()
3689 ale_params.ale_ports = gbe_dev->ale_ports; in gbe_probe()
3696 ale_params.dev_id = "66ak2h-xgbe"; in gbe_probe()
3698 gbe_dev->ale = cpsw_ale_create(&ale_params); in gbe_probe()
3699 if (IS_ERR(gbe_dev->ale)) { in gbe_probe()
3700 dev_err(gbe_dev->dev, "error initializing ale engine\n"); in gbe_probe()
3701 ret = PTR_ERR(gbe_dev->ale); in gbe_probe()
3704 dev_dbg(gbe_dev->dev, "Created a gbe ale engine\n"); in gbe_probe()
3711 gbe_dev->cpts = cpts_create(gbe_dev->dev, gbe_dev->cpts_reg, in gbe_probe()
3714 if (IS_ENABLED(CONFIG_TI_CPTS) && IS_ERR(gbe_dev->cpts)) { in gbe_probe()
3715 ret = PTR_ERR(gbe_dev->cpts); in gbe_probe()
3722 spin_lock_bh(&gbe_dev->hw_stats_lock); in gbe_probe()
3723 for (i = 0; i < gbe_dev->num_stats_mods; i++) { in gbe_probe()
3729 spin_unlock_bh(&gbe_dev->hw_stats_lock); in gbe_probe()
3731 timer_setup(&gbe_dev->timer, netcp_ethss_timer, 0); in gbe_probe()
3732 gbe_dev->timer.expires = jiffies + GBE_TIMER_INTERVAL; in gbe_probe()
3733 add_timer(&gbe_dev->timer); in gbe_probe()
3750 dev_err(gbe_dev->dev, "interface node not available\n"); in gbe_attach()
3751 return -ENODEV; in gbe_attach()
3754 gbe_intf = devm_kzalloc(gbe_dev->dev, sizeof(*gbe_intf), GFP_KERNEL); in gbe_attach()
3756 return -ENOMEM; in gbe_attach()
3758 gbe_intf->ndev = ndev; in gbe_attach()
3759 gbe_intf->dev = gbe_dev->dev; in gbe_attach()
3760 gbe_intf->gbe_dev = gbe_dev; in gbe_attach()
3762 gbe_intf->slave = devm_kzalloc(gbe_dev->dev, in gbe_attach()
3763 sizeof(*gbe_intf->slave), in gbe_attach()
3765 if (!gbe_intf->slave) { in gbe_attach()
3766 ret = -ENOMEM; in gbe_attach()
3770 if (init_slave(gbe_dev, gbe_intf->slave, node)) { in gbe_attach()
3771 ret = -ENODEV; in gbe_attach()
3775 gbe_intf->tx_pipe = gbe_dev->tx_pipe; in gbe_attach()
3776 ndev->ethtool_ops = &keystone_ethtool_ops; in gbe_attach()
3777 list_add_tail(&gbe_intf->gbe_intf_list, &gbe_dev->gbe_intf_head); in gbe_attach()
3782 if (gbe_intf->slave) in gbe_attach()
3783 devm_kfree(gbe_dev->dev, gbe_intf->slave); in gbe_attach()
3785 devm_kfree(gbe_dev->dev, gbe_intf); in gbe_attach()
3793 gbe_intf->ndev->ethtool_ops = NULL; in gbe_release()
3794 list_del(&gbe_intf->gbe_intf_list); in gbe_release()
3795 devm_kfree(gbe_intf->dev, gbe_intf->slave); in gbe_release()
3796 devm_kfree(gbe_intf->dev, gbe_intf); in gbe_release()
3804 del_timer_sync(&gbe_dev->timer); in gbe_remove()
3805 cpts_release(gbe_dev->cpts); in gbe_remove()
3806 cpsw_ale_stop(gbe_dev->ale); in gbe_remove()
3807 netcp_txpipe_close(&gbe_dev->tx_pipe); in gbe_remove()
3810 if (!list_empty(&gbe_dev->gbe_intf_head)) in gbe_remove()
3811 dev_alert(gbe_dev->dev, in gbe_remove()