cpsw.c revision 3995d265b3640fb7dc843a3c5f62ced4f121fb89
1df828598a755732e717b0adca82f884e44d37576Mugunthan V N/* 2df828598a755732e717b0adca82f884e44d37576Mugunthan V N * Texas Instruments Ethernet Switch Driver 3df828598a755732e717b0adca82f884e44d37576Mugunthan V N * 4df828598a755732e717b0adca82f884e44d37576Mugunthan V N * Copyright (C) 2012 Texas Instruments 5df828598a755732e717b0adca82f884e44d37576Mugunthan V N * 6df828598a755732e717b0adca82f884e44d37576Mugunthan V N * This program is free software; you can redistribute it and/or 7df828598a755732e717b0adca82f884e44d37576Mugunthan V N * modify it under the terms of the GNU General Public License as 8df828598a755732e717b0adca82f884e44d37576Mugunthan V N * published by the Free Software Foundation version 2. 9df828598a755732e717b0adca82f884e44d37576Mugunthan V N * 10df828598a755732e717b0adca82f884e44d37576Mugunthan V N * This program is distributed "as is" WITHOUT ANY WARRANTY of any 11df828598a755732e717b0adca82f884e44d37576Mugunthan V N * kind, whether express or implied; without even the implied warranty 12df828598a755732e717b0adca82f884e44d37576Mugunthan V N * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 13df828598a755732e717b0adca82f884e44d37576Mugunthan V N * GNU General Public License for more details. 14df828598a755732e717b0adca82f884e44d37576Mugunthan V N */ 15df828598a755732e717b0adca82f884e44d37576Mugunthan V N 16df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/kernel.h> 17df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/io.h> 18df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/clk.h> 19df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/timer.h> 20df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/module.h> 21df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/platform_device.h> 22df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/irqreturn.h> 23df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/interrupt.h> 24df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/if_ether.h> 25df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/etherdevice.h> 26df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/netdevice.h> 272e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#include <linux/net_tstamp.h> 28df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/phy.h> 29df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/workqueue.h> 30df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include <linux/delay.h> 31f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N#include <linux/pm_runtime.h> 322eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N#include <linux/of.h> 332eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N#include <linux/of_net.h> 342eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N#include <linux/of_device.h> 353b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N#include <linux/if_vlan.h> 36df828598a755732e717b0adca82f884e44d37576Mugunthan V N 37739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N#include <linux/pinctrl/consumer.h> 38df828598a755732e717b0adca82f884e44d37576Mugunthan V N 39dbe34724c08ea25d39d31735120077013fbbb6fbMugunthan V N#include "cpsw.h" 40df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include "cpsw_ale.h" 412e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#include "cpts.h" 42df828598a755732e717b0adca82f884e44d37576Mugunthan V N#include "davinci_cpdma.h" 43df828598a755732e717b0adca82f884e44d37576Mugunthan V N 44df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_DEBUG (NETIF_MSG_HW | NETIF_MSG_WOL | \ 45df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_DRV | NETIF_MSG_LINK | \ 46df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_IFUP | NETIF_MSG_INTR | \ 47df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_PROBE | NETIF_MSG_TIMER | \ 48df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_IFDOWN | NETIF_MSG_RX_ERR | \ 49df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_TX_ERR | NETIF_MSG_TX_DONE | \ 50df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_PKTDATA | NETIF_MSG_TX_QUEUED | \ 51df828598a755732e717b0adca82f884e44d37576Mugunthan V N NETIF_MSG_RX_STATUS) 52df828598a755732e717b0adca82f884e44d37576Mugunthan V N 53df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_info(priv, type, format, ...) \ 54df828598a755732e717b0adca82f884e44d37576Mugunthan V Ndo { \ 55df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_msg_##type(priv) && net_ratelimit()) \ 56df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_info(priv->dev, format, ## __VA_ARGS__); \ 57df828598a755732e717b0adca82f884e44d37576Mugunthan V N} while (0) 58df828598a755732e717b0adca82f884e44d37576Mugunthan V N 59df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_err(priv, type, format, ...) \ 60df828598a755732e717b0adca82f884e44d37576Mugunthan V Ndo { \ 61df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_msg_##type(priv) && net_ratelimit()) \ 62df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, format, ## __VA_ARGS__); \ 63df828598a755732e717b0adca82f884e44d37576Mugunthan V N} while (0) 64df828598a755732e717b0adca82f884e44d37576Mugunthan V N 65df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_dbg(priv, type, format, ...) \ 66df828598a755732e717b0adca82f884e44d37576Mugunthan V Ndo { \ 67df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_msg_##type(priv) && net_ratelimit()) \ 68df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_dbg(priv->dev, format, ## __VA_ARGS__); \ 69df828598a755732e717b0adca82f884e44d37576Mugunthan V N} while (0) 70df828598a755732e717b0adca82f884e44d37576Mugunthan V N 71df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_notice(priv, type, format, ...) \ 72df828598a755732e717b0adca82f884e44d37576Mugunthan V Ndo { \ 73df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_msg_##type(priv) && net_ratelimit()) \ 74df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_notice(priv->dev, format, ## __VA_ARGS__); \ 75df828598a755732e717b0adca82f884e44d37576Mugunthan V N} while (0) 76df828598a755732e717b0adca82f884e44d37576Mugunthan V N 775c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N#define ALE_ALL_PORTS 0x7 785c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 79df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_MAJOR_VERSION(reg) (reg >> 8 & 0x7) 80df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_MINOR_VERSION(reg) (reg & 0xff) 81df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_RTL_VERSION(reg) ((reg >> 11) & 0x1f) 82df828598a755732e717b0adca82f884e44d37576Mugunthan V N 83e90cfac6c281da3c8b89dba0eb783c23872705b1Richard Cochran#define CPSW_VERSION_1 0x19010a 84e90cfac6c281da3c8b89dba0eb783c23872705b1Richard Cochran#define CPSW_VERSION_2 0x19010c 85c193f3655d9b916a3b8cb685c6b4327397507b2fMugunthan V N#define CPSW_VERSION_3 0x19010f 86926489be1d2b030c17d38fa10b5921bf3409d91dMugunthan V N#define CPSW_VERSION_4 0x190112 87549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 88549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define HOST_PORT_NUM 0 89549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define SLIVER_SIZE 0x40 90549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 91549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_HOST_PORT_OFFSET 0x028 92549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_SLAVE_OFFSET 0x050 93549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_SLAVE_SIZE 0x040 94549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_CPDMA_OFFSET 0x100 95549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_STATERAM_OFFSET 0x200 96d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPSW1_HW_STATS 0x400 97549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_CPTS_OFFSET 0x500 98549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_ALE_OFFSET 0x600 99549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW1_SLIVER_OFFSET 0x700 100549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 101549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_HOST_PORT_OFFSET 0x108 102549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_SLAVE_OFFSET 0x200 103549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_SLAVE_SIZE 0x100 104549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_CPDMA_OFFSET 0x800 105d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPSW2_HW_STATS 0x900 106549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_STATERAM_OFFSET 0xa00 107549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_CPTS_OFFSET 0xc00 108549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_ALE_OFFSET 0xd00 109549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_SLIVER_OFFSET 0xd80 110549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran#define CPSW2_BD_OFFSET 0x2000 111549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 112df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_RXTHRESH 0x0c0 113df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_RXFREE 0x0e0 114df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_TXHDP 0x00 115df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_RXHDP 0x20 116df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_TXCP 0x40 117df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_RXCP 0x60 118df828598a755732e717b0adca82f884e44d37576Mugunthan V N 119df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_POLL_WEIGHT 64 120df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_MIN_PACKET_SIZE 60 121df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPSW_MAX_PACKET_SIZE (1500 + 14 + 4 + 4) 122df828598a755732e717b0adca82f884e44d37576Mugunthan V N 123df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define RX_PRIORITY_MAPPING 0x76543210 124df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define TX_PRIORITY_MAPPING 0x33221100 125df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define CPDMA_TX_PRIORITY_MAP 0x76543210 126df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1273b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N#define CPSW_VLAN_AWARE BIT(1) 1283b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N#define CPSW_ALE_VLAN_AWARE 1 1293b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 130d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define CPSW_FIFO_NORMAL_MODE (0 << 15) 131d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define CPSW_FIFO_DUAL_MAC_MODE (1 << 15) 132d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define CPSW_FIFO_RATE_LIMIT_MODE (2 << 15) 133d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 134ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_INTPACEEN (0x3f << 16) 135ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_INTPRESCALE_MASK (0x7FF << 0) 136ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_CMINTMAX_CNT 63 137ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_CMINTMIN_CNT 2 138ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_CMINTMAX_INTVL (1000 / CPSW_CMINTMIN_CNT) 139ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N#define CPSW_CMINTMIN_INTVL ((1000 / CPSW_CMINTMAX_CNT) + 1) 140ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 141df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_enable_irq(priv) \ 142df828598a755732e717b0adca82f884e44d37576Mugunthan V N do { \ 143df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 i; \ 144df828598a755732e717b0adca82f884e44d37576Mugunthan V N for (i = 0; i < priv->num_irqs; i++) \ 145df828598a755732e717b0adca82f884e44d37576Mugunthan V N enable_irq(priv->irqs_table[i]); \ 146df828598a755732e717b0adca82f884e44d37576Mugunthan V N } while (0); 147df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define cpsw_disable_irq(priv) \ 148df828598a755732e717b0adca82f884e44d37576Mugunthan V N do { \ 149df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 i; \ 150df828598a755732e717b0adca82f884e44d37576Mugunthan V N for (i = 0; i < priv->num_irqs; i++) \ 151df828598a755732e717b0adca82f884e44d37576Mugunthan V N disable_irq_nosync(priv->irqs_table[i]); \ 152df828598a755732e717b0adca82f884e44d37576Mugunthan V N } while (0); 153df828598a755732e717b0adca82f884e44d37576Mugunthan V N 154d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N#define cpsw_slave_index(priv) \ 155d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N ((priv->data.dual_emac) ? priv->emac_port : \ 156d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N priv->data.active_slave) 157d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N 158df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int debug_level; 159df828598a755732e717b0adca82f884e44d37576Mugunthan V Nmodule_param(debug_level, int, 0); 160df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_PARM_DESC(debug_level, "cpsw debug level (NETIF_MSG bits)"); 161df828598a755732e717b0adca82f884e44d37576Mugunthan V N 162df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int ale_ageout = 10; 163df828598a755732e717b0adca82f884e44d37576Mugunthan V Nmodule_param(ale_ageout, int, 0); 164df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_PARM_DESC(ale_ageout, "cpsw ale ageout interval (seconds)"); 165df828598a755732e717b0adca82f884e44d37576Mugunthan V N 166df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int rx_packet_max = CPSW_MAX_PACKET_SIZE; 167df828598a755732e717b0adca82f884e44d37576Mugunthan V Nmodule_param(rx_packet_max, int, 0); 168df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_PARM_DESC(rx_packet_max, "maximum receive packet size (bytes)"); 169df828598a755732e717b0adca82f884e44d37576Mugunthan V N 170996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochranstruct cpsw_wr_regs { 171df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 id_ver; 172df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 soft_reset; 173df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 control; 174df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 int_control; 175df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 rx_thresh_en; 176df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 rx_en; 177df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 tx_en; 178df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 misc_en; 179ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 mem_allign1[8]; 180ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 rx_thresh_stat; 181ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 rx_stat; 182ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 tx_stat; 183ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 misc_stat; 184ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 mem_allign2[8]; 185ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 rx_imax; 186ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 tx_imax; 187ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 188df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 189df828598a755732e717b0adca82f884e44d37576Mugunthan V N 190996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochranstruct cpsw_ss_regs { 191df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 id_ver; 192df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 control; 193df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 soft_reset; 194df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 stat_port_en; 195df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 ptype; 196bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 soft_idle; 197bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 thru_rate; 198bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 gap_thresh; 199bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 tx_start_wds; 200bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 flow_control; 201bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 vlan_ltype; 202bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 ts_ltype; 203bd357af2a52259778dfcc06482dc70463b7b1301Richard Cochran u32 dlr_ltype; 204df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 205df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2069750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* CPSW_PORT_V1 */ 2079750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_MAX_BLKS 0x00 /* Maximum FIFO Blocks */ 2089750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_BLK_CNT 0x04 /* FIFO Block Usage Count (Read Only) */ 2099750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_TX_IN_CTL 0x08 /* Transmit FIFO Control */ 2109750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_PORT_VLAN 0x0c /* VLAN Register */ 2119750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_TX_PRI_MAP 0x10 /* Tx Header Priority to Switch Pri Mapping */ 2129750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_TS_CTL 0x14 /* Time Sync Control */ 2139750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_TS_SEQ_LTYPE 0x18 /* Time Sync Sequence ID Offset and Msg Type */ 2149750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW1_TS_VLAN 0x1c /* Time Sync VLAN1 and VLAN2 */ 2159750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2169750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* CPSW_PORT_V2 */ 2179750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_CONTROL 0x00 /* Control Register */ 2189750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_MAX_BLKS 0x08 /* Maximum FIFO Blocks */ 2199750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_BLK_CNT 0x0c /* FIFO Block Usage Count (Read Only) */ 2209750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_TX_IN_CTL 0x10 /* Transmit FIFO Control */ 2219750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_PORT_VLAN 0x14 /* VLAN Register */ 2229750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_TX_PRI_MAP 0x18 /* Tx Header Priority to Switch Pri Mapping */ 2239750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CPSW2_TS_SEQ_MTYPE 0x1c /* Time Sync Sequence ID Offset and Msg Type */ 2249750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2259750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* CPSW_PORT_V1 and V2 */ 2269750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define SA_LO 0x20 /* CPGMAC_SL Source Address Low */ 2279750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define SA_HI 0x24 /* CPGMAC_SL Source Address High */ 2289750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define SEND_PERCENT 0x28 /* Transmit Queue Send Percentages */ 2299750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2309750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* CPSW_PORT_V2 only */ 2319750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP0 0x30 /* Rx DSCP Priority to Rx Packet Mapping */ 2329750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP1 0x34 /* Rx DSCP Priority to Rx Packet Mapping */ 2339750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP2 0x38 /* Rx DSCP Priority to Rx Packet Mapping */ 2349750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP3 0x3c /* Rx DSCP Priority to Rx Packet Mapping */ 2359750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP4 0x40 /* Rx DSCP Priority to Rx Packet Mapping */ 2369750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP5 0x44 /* Rx DSCP Priority to Rx Packet Mapping */ 2379750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP6 0x48 /* Rx DSCP Priority to Rx Packet Mapping */ 2389750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define RX_DSCP_PRI_MAP7 0x4c /* Rx DSCP Priority to Rx Packet Mapping */ 2399750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2409750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* Bit definitions for the CPSW2_CONTROL register */ 2419750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define PASS_PRI_TAGGED (1<<24) /* Pass Priority Tagged */ 2429750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define VLAN_LTYPE2_EN (1<<21) /* VLAN LTYPE 2 enable */ 2439750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define VLAN_LTYPE1_EN (1<<20) /* VLAN LTYPE 1 enable */ 2449750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define DSCP_PRI_EN (1<<16) /* DSCP Priority Enable */ 2459750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_320 (1<<14) /* Time Sync Dest Port 320 enable */ 2469750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_319 (1<<13) /* Time Sync Dest Port 319 enable */ 2479750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_132 (1<<12) /* Time Sync Dest IP Addr 132 enable */ 2489750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_131 (1<<11) /* Time Sync Dest IP Addr 131 enable */ 2499750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_130 (1<<10) /* Time Sync Dest IP Addr 130 enable */ 2509750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_129 (1<<9) /* Time Sync Dest IP Addr 129 enable */ 2519750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_BIT8 (1<<8) /* ts_ttl_nonzero? */ 2529750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_ANNEX_D_EN (1<<4) /* Time Sync Annex D enable */ 2539750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_LTYPE2_EN (1<<3) /* Time Sync LTYPE 2 enable */ 2549750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_LTYPE1_EN (1<<2) /* Time Sync LTYPE 1 enable */ 2559750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_TX_EN (1<<1) /* Time Sync Transmit Enable */ 2569750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_RX_EN (1<<0) /* Time Sync Receive Enable */ 2579750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2589750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CTRL_TS_BITS \ 2599750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran (TS_320 | TS_319 | TS_132 | TS_131 | TS_130 | TS_129 | TS_BIT8 | \ 2609750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran TS_ANNEX_D_EN | TS_LTYPE1_EN) 2619750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2629750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CTRL_ALL_TS_MASK (CTRL_TS_BITS | TS_TX_EN | TS_RX_EN) 2639750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CTRL_TX_TS_BITS (CTRL_TS_BITS | TS_TX_EN) 2649750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define CTRL_RX_TS_BITS (CTRL_TS_BITS | TS_RX_EN) 2659750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2669750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* Bit definitions for the CPSW2_TS_SEQ_MTYPE register */ 2679750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_SEQ_ID_OFFSET_SHIFT (16) /* Time Sync Sequence ID Offset */ 2689750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_SEQ_ID_OFFSET_MASK (0x3f) 2699750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_MSG_TYPE_EN_SHIFT (0) /* Time Sync Message Type Enable */ 2709750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define TS_MSG_TYPE_EN_MASK (0xffff) 2719750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 2729750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran/* The PTP event messages - Sync, Delay_Req, Pdelay_Req, and Pdelay_Resp. */ 2739750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran#define EVENT_MSG_BITS ((1<<0) | (1<<1) | (1<<2) | (1<<3)) 274df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2752e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran/* Bit definitions for the CPSW1_TS_CTL register */ 2762e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#define CPSW_V1_TS_RX_EN BIT(0) 2772e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#define CPSW_V1_TS_TX_EN BIT(4) 2782e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#define CPSW_V1_MSG_TYPE_OFS 16 2792e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 2802e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran/* Bit definitions for the CPSW1_TS_SEQ_LTYPE register */ 2812e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#define CPSW_V1_SEQ_ID_OFS_SHIFT 16 2822e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 283df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstruct cpsw_host_regs { 284df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 max_blks; 285df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 blk_cnt; 286d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 tx_in_ctl; 287df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 port_vlan; 288df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 tx_pri_map; 289df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 cpdma_tx_pri_map; 290df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 cpdma_rx_chan_map; 291df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 292df828598a755732e717b0adca82f884e44d37576Mugunthan V N 293df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstruct cpsw_sliver_regs { 294df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 id_ver; 295df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 mac_control; 296df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 mac_status; 297df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 soft_reset; 298df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 rx_maxlen; 299df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 __reserved_0; 300df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 rx_pause; 301df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 tx_pause; 302df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 __reserved_1; 303df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 rx_pri_map; 304df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 305df828598a755732e717b0adca82f884e44d37576Mugunthan V N 306d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstruct cpsw_hw_stats { 307d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxgoodframes; 308d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxbroadcastframes; 309d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxmulticastframes; 310d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxpauseframes; 311d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxcrcerrors; 312d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxaligncodeerrors; 313d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxoversizedframes; 314d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxjabberframes; 315d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxundersizedframes; 316d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxfragments; 317d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 __pad_0[2]; 318d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxoctets; 319d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txgoodframes; 320d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txbroadcastframes; 321d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txmulticastframes; 322d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txpauseframes; 323d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txdeferredframes; 324d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txcollisionframes; 325d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txsinglecollframes; 326d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txmultcollframes; 327d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txexcessivecollisions; 328d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txlatecollisions; 329d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txunderrun; 330d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txcarriersenseerrors; 331d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 txoctets; 332d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes64; 333d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes65t127; 334d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes128t255; 335d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes256t511; 336d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes512t1023; 337d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 octetframes1024tup; 338d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 netoctets; 339d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxsofoverruns; 340d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxmofoverruns; 341d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 rxdmaoverruns; 342d97185466cc83902de49c7bea512651c7af12566Mugunthan V N}; 343d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 344df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstruct cpsw_slave { 3459750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran void __iomem *regs; 346df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_sliver_regs __iomem *sliver; 347df828598a755732e717b0adca82f884e44d37576Mugunthan V N int slave_num; 348df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 mac_control; 349df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_slave_data *data; 350df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct phy_device *phy; 351d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct net_device *ndev; 352d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 port_vlan; 353d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 open_stat; 354df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 355df828598a755732e717b0adca82f884e44d37576Mugunthan V N 3569750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochranstatic inline u32 slave_read(struct cpsw_slave *slave, u32 offset) 3579750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran{ 3589750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran return __raw_readl(slave->regs + offset); 3599750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran} 3609750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 3619750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochranstatic inline void slave_write(struct cpsw_slave *slave, u32 val, u32 offset) 3629750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran{ 3639750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran __raw_writel(val, slave->regs + offset); 3649750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran} 3659750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 366df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstruct cpsw_priv { 367df828598a755732e717b0adca82f884e44d37576Mugunthan V N spinlock_t lock; 368df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct platform_device *pdev; 369df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev; 370df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct napi_struct napi; 371df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct device *dev; 372df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_platform_data data; 373996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran struct cpsw_ss_regs __iomem *regs; 374996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran struct cpsw_wr_regs __iomem *wr_regs; 375d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u8 __iomem *hw_stats; 376df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_host_regs __iomem *host_port_regs; 377df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 msg_enable; 378e90cfac6c281da3c8b89dba0eb783c23872705b1Richard Cochran u32 version; 379ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 coal_intvl; 380ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 bus_freq_mhz; 381df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device_stats stats; 382df828598a755732e717b0adca82f884e44d37576Mugunthan V N int rx_packet_max; 383df828598a755732e717b0adca82f884e44d37576Mugunthan V N int host_port; 384df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct clk *clk; 385df828598a755732e717b0adca82f884e44d37576Mugunthan V N u8 mac_addr[ETH_ALEN]; 386df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_slave *slaves; 387df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpdma_ctlr *dma; 388df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpdma_chan *txch, *rxch; 389df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_ale *ale; 390df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* snapshot of IRQ numbers */ 391df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 irqs_table[4]; 392df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 num_irqs; 393a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior bool irq_enabled; 3949232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N struct cpts *cpts; 395d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 emac_port; 396df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 397df828598a755732e717b0adca82f884e44d37576Mugunthan V N 398d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstruct cpsw_stats { 399d97185466cc83902de49c7bea512651c7af12566Mugunthan V N char stat_string[ETH_GSTRING_LEN]; 400d97185466cc83902de49c7bea512651c7af12566Mugunthan V N int type; 401d97185466cc83902de49c7bea512651c7af12566Mugunthan V N int sizeof_stat; 402d97185466cc83902de49c7bea512651c7af12566Mugunthan V N int stat_offset; 403d97185466cc83902de49c7bea512651c7af12566Mugunthan V N}; 404d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 405d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nenum { 406d97185466cc83902de49c7bea512651c7af12566Mugunthan V N CPSW_STATS, 407d97185466cc83902de49c7bea512651c7af12566Mugunthan V N CPDMA_RX_STATS, 408d97185466cc83902de49c7bea512651c7af12566Mugunthan V N CPDMA_TX_STATS, 409d97185466cc83902de49c7bea512651c7af12566Mugunthan V N}; 410d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 411d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPSW_STAT(m) CPSW_STATS, \ 412d97185466cc83902de49c7bea512651c7af12566Mugunthan V N sizeof(((struct cpsw_hw_stats *)0)->m), \ 413d97185466cc83902de49c7bea512651c7af12566Mugunthan V N offsetof(struct cpsw_hw_stats, m) 414d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPDMA_RX_STAT(m) CPDMA_RX_STATS, \ 415d97185466cc83902de49c7bea512651c7af12566Mugunthan V N sizeof(((struct cpdma_chan_stats *)0)->m), \ 416d97185466cc83902de49c7bea512651c7af12566Mugunthan V N offsetof(struct cpdma_chan_stats, m) 417d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPDMA_TX_STAT(m) CPDMA_TX_STATS, \ 418d97185466cc83902de49c7bea512651c7af12566Mugunthan V N sizeof(((struct cpdma_chan_stats *)0)->m), \ 419d97185466cc83902de49c7bea512651c7af12566Mugunthan V N offsetof(struct cpdma_chan_stats, m) 420d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 421d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstatic const struct cpsw_stats cpsw_gstrings_stats[] = { 422d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Good Rx Frames", CPSW_STAT(rxgoodframes) }, 423d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Broadcast Rx Frames", CPSW_STAT(rxbroadcastframes) }, 424d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Multicast Rx Frames", CPSW_STAT(rxmulticastframes) }, 425d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Pause Rx Frames", CPSW_STAT(rxpauseframes) }, 426d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx CRC Errors", CPSW_STAT(rxcrcerrors) }, 427d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Align/Code Errors", CPSW_STAT(rxaligncodeerrors) }, 428d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Oversize Rx Frames", CPSW_STAT(rxoversizedframes) }, 429d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Jabbers", CPSW_STAT(rxjabberframes) }, 430d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Undersize (Short) Rx Frames", CPSW_STAT(rxundersizedframes) }, 431d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Fragments", CPSW_STAT(rxfragments) }, 432d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Octets", CPSW_STAT(rxoctets) }, 433d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Good Tx Frames", CPSW_STAT(txgoodframes) }, 434d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Broadcast Tx Frames", CPSW_STAT(txbroadcastframes) }, 435d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Multicast Tx Frames", CPSW_STAT(txmulticastframes) }, 436d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Pause Tx Frames", CPSW_STAT(txpauseframes) }, 437d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Deferred Tx Frames", CPSW_STAT(txdeferredframes) }, 438d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Collisions", CPSW_STAT(txcollisionframes) }, 439d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Single Collision Tx Frames", CPSW_STAT(txsinglecollframes) }, 440d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Multiple Collision Tx Frames", CPSW_STAT(txmultcollframes) }, 441d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Excessive Collisions", CPSW_STAT(txexcessivecollisions) }, 442d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Late Collisions", CPSW_STAT(txlatecollisions) }, 443d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx Underrun", CPSW_STAT(txunderrun) }, 444d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Carrier Sense Errors", CPSW_STAT(txcarriersenseerrors) }, 445d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx Octets", CPSW_STAT(txoctets) }, 446d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 64 Octet Frames", CPSW_STAT(octetframes64) }, 447d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 65-127 Octet Frames", CPSW_STAT(octetframes65t127) }, 448d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 128-255 Octet Frames", CPSW_STAT(octetframes128t255) }, 449d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 256-511 Octet Frames", CPSW_STAT(octetframes256t511) }, 450d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 512-1023 Octet Frames", CPSW_STAT(octetframes512t1023) }, 451d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx + Tx 1024-Up Octet Frames", CPSW_STAT(octetframes1024tup) }, 452d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Net Octets", CPSW_STAT(netoctets) }, 453d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Start of Frame Overruns", CPSW_STAT(rxsofoverruns) }, 454d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx Middle of Frame Overruns", CPSW_STAT(rxmofoverruns) }, 455d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA Overruns", CPSW_STAT(rxdmaoverruns) }, 456d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: head_enqueue", CPDMA_RX_STAT(head_enqueue) }, 457d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: tail_enqueue", CPDMA_RX_STAT(tail_enqueue) }, 458d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: pad_enqueue", CPDMA_RX_STAT(pad_enqueue) }, 459d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: misqueued", CPDMA_RX_STAT(misqueued) }, 460d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: desc_alloc_fail", CPDMA_RX_STAT(desc_alloc_fail) }, 461d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: pad_alloc_fail", CPDMA_RX_STAT(pad_alloc_fail) }, 462d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: runt_receive_buf", CPDMA_RX_STAT(runt_receive_buff) }, 463d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: runt_transmit_buf", CPDMA_RX_STAT(runt_transmit_buff) }, 464d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: empty_dequeue", CPDMA_RX_STAT(empty_dequeue) }, 465d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: busy_dequeue", CPDMA_RX_STAT(busy_dequeue) }, 466d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: good_dequeue", CPDMA_RX_STAT(good_dequeue) }, 467d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: requeue", CPDMA_RX_STAT(requeue) }, 468d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Rx DMA chan: teardown_dequeue", CPDMA_RX_STAT(teardown_dequeue) }, 469d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: head_enqueue", CPDMA_TX_STAT(head_enqueue) }, 470d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: tail_enqueue", CPDMA_TX_STAT(tail_enqueue) }, 471d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: pad_enqueue", CPDMA_TX_STAT(pad_enqueue) }, 472d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: misqueued", CPDMA_TX_STAT(misqueued) }, 473d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: desc_alloc_fail", CPDMA_TX_STAT(desc_alloc_fail) }, 474d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: pad_alloc_fail", CPDMA_TX_STAT(pad_alloc_fail) }, 475d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: runt_receive_buf", CPDMA_TX_STAT(runt_receive_buff) }, 476d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: runt_transmit_buf", CPDMA_TX_STAT(runt_transmit_buff) }, 477d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: empty_dequeue", CPDMA_TX_STAT(empty_dequeue) }, 478d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: busy_dequeue", CPDMA_TX_STAT(busy_dequeue) }, 479d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: good_dequeue", CPDMA_TX_STAT(good_dequeue) }, 480d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: requeue", CPDMA_TX_STAT(requeue) }, 481d97185466cc83902de49c7bea512651c7af12566Mugunthan V N { "Tx DMA chan: teardown_dequeue", CPDMA_TX_STAT(teardown_dequeue) }, 482d97185466cc83902de49c7bea512651c7af12566Mugunthan V N}; 483d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 484d97185466cc83902de49c7bea512651c7af12566Mugunthan V N#define CPSW_STATS_LEN ARRAY_SIZE(cpsw_gstrings_stats) 485d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 486df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define napi_to_priv(napi) container_of(napi, struct cpsw_priv, napi) 487d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define for_each_slave(priv, func, arg...) \ 488d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N do { \ 4896e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior struct cpsw_slave *slave; \ 4906e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior int n; \ 491d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) \ 492d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N (func)((priv)->slaves + priv->emac_port, ##arg);\ 493d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else \ 4946e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior for (n = (priv)->data.slaves, \ 4956e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior slave = (priv)->slaves; \ 4966e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior n; n--) \ 4976e6ceaedb5901c7ebd23e5222726dab5362938bdSebastian Siewior (func)(slave++, ##arg); \ 498d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } while (0) 499d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define cpsw_get_slave_ndev(priv, __slave_no__) \ 500d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N (priv->slaves[__slave_no__].ndev) 501d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define cpsw_get_slave_priv(priv, __slave_no__) \ 502d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ((priv->slaves[__slave_no__].ndev) ? \ 503d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N netdev_priv(priv->slaves[__slave_no__].ndev) : NULL) \ 504d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 505d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define cpsw_dual_emac_src_port_detect(status, priv, ndev, skb) \ 506d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N do { \ 507d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!priv->data.dual_emac) \ 508d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N break; \ 509d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (CPDMA_RX_SOURCE_PORT(status) == 1) { \ 510d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ndev = cpsw_get_slave_ndev(priv, 0); \ 511d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv = netdev_priv(ndev); \ 512d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N skb->dev = ndev; \ 513d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } else if (CPDMA_RX_SOURCE_PORT(status) == 2) { \ 514d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ndev = cpsw_get_slave_ndev(priv, 1); \ 515d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv = netdev_priv(ndev); \ 516d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N skb->dev = ndev; \ 517d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } \ 518df828598a755732e717b0adca82f884e44d37576Mugunthan V N } while (0) 519d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N#define cpsw_add_mcast(priv, addr) \ 520d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N do { \ 521d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) { \ 522d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_slave *slave = priv->slaves + \ 523d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->emac_port; \ 524d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N int slave_port = cpsw_get_slave_port(priv, \ 525d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave->slave_num); \ 526d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_mcast(priv->ale, addr, \ 527d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1 << slave_port | 1 << priv->host_port, \ 528d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ALE_VLAN, slave->port_vlan, 0); \ 529d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } else { \ 530d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_mcast(priv->ale, addr, \ 531d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ALE_ALL_PORTS << priv->host_port, \ 532d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 0, 0, 0); \ 533d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } \ 534d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } while (0) 535d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 536d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V Nstatic inline int cpsw_get_slave_port(struct cpsw_priv *priv, u32 slave_num) 537d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N{ 538d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->host_port == 0) 539d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return slave_num + 1; 540d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else 541d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return slave_num; 542d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N} 543df828598a755732e717b0adca82f884e44d37576Mugunthan V N 5440cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V Nstatic void cpsw_set_promiscious(struct net_device *ndev, bool enable) 5450cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N{ 5460cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 5470cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N struct cpsw_ale *ale = priv->ale; 5480cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N int i; 5490cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5500cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (priv->data.dual_emac) { 5510cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N bool flag = false; 5520cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5530cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Enabling promiscuous mode for one interface will be 5540cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N * common for both the interface as the interface shares 5550cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N * the same hardware resource. 5560cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N */ 5570d961b3b52f566f823070ce2366511a7f64b928cHeiko Schocher for (i = 0; i < priv->data.slaves; i++) 5580cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (priv->slaves[i].ndev->flags & IFF_PROMISC) 5590cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N flag = true; 5600cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5610cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (!enable && flag) { 5620cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N enable = true; 5630cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N dev_err(&ndev->dev, "promiscuity not disabled as the other interface is still in promiscuity mode\n"); 5640cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 5650cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5660cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (enable) { 5670cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Enable Bypass */ 5680cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_BYPASS, 1); 5690cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5700cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N dev_dbg(&ndev->dev, "promiscuity enabled\n"); 5710cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } else { 5720cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Disable Bypass */ 5730cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_BYPASS, 0); 5740cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N dev_dbg(&ndev->dev, "promiscuity disabled\n"); 5750cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 5760cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } else { 5770cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (enable) { 5780cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N unsigned long timeout = jiffies + HZ; 5790cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5800cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Disable Learn for all ports */ 5810d961b3b52f566f823070ce2366511a7f64b928cHeiko Schocher for (i = 0; i < priv->data.slaves; i++) { 5820cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, i, 5830cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N ALE_PORT_NOLEARN, 1); 5840cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, i, 5850cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N ALE_PORT_NO_SA_UPDATE, 1); 5860cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 5870cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5880cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Clear All Untouched entries */ 5890cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_AGEOUT, 1); 5900cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N do { 5910cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpu_relax(); 5920cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N if (cpsw_ale_control_get(ale, 0, ALE_AGEOUT)) 5930cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N break; 5940cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } while (time_after(timeout, jiffies)); 5950cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_AGEOUT, 1); 5960cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 5970cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Clear all mcast from ALE */ 5980cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_flush_multicast(ale, ALE_ALL_PORTS << 5990cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N priv->host_port); 6000cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 6010cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Flood All Unicast Packets to Host port */ 6020cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_P0_UNI_FLOOD, 1); 6030cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N dev_dbg(&ndev->dev, "promiscuity enabled\n"); 6040cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } else { 6050cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Flood All Unicast Packets to Host port */ 6060cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, 0, ALE_P0_UNI_FLOOD, 0); 6070cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 6080cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Enable Learn for all ports */ 6090d961b3b52f566f823070ce2366511a7f64b928cHeiko Schocher for (i = 0; i < priv->data.slaves; i++) { 6100cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, i, 6110cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N ALE_PORT_NOLEARN, 0); 6120cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_ale_control_set(ale, i, 6130cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N ALE_PORT_NO_SA_UPDATE, 0); 6140cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 6150cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N dev_dbg(&ndev->dev, "promiscuity disabled\n"); 6160cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 6170cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } 6180cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N} 6190cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N 6205c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V Nstatic void cpsw_ndo_set_rx_mode(struct net_device *ndev) 6215c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N{ 6225c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 6235c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 6245c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N if (ndev->flags & IFF_PROMISC) { 6255c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N /* Enable promiscuous mode */ 6260cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_set_promiscious(ndev, true); 6275c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N return; 6280cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N } else { 6290cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N /* Disable promiscuous mode */ 6300cd8f9cc0654c06adde353c6532114c5f53a18e8Mugunthan V N cpsw_set_promiscious(ndev, false); 6315c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N } 6325c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 6335c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N /* Clear all mcast from ALE */ 6345c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N cpsw_ale_flush_multicast(priv->ale, ALE_ALL_PORTS << priv->host_port); 6355c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 6365c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N if (!netdev_mc_empty(ndev)) { 6375c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N struct netdev_hw_addr *ha; 6385c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 6395c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N /* program multicast address list into ALE register */ 6405c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N netdev_for_each_mc_addr(ha, ndev) { 641d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_add_mcast(priv, (u8 *)ha->addr); 6425c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N } 6435c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N } 6445c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N} 6455c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N 646df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_intr_enable(struct cpsw_priv *priv) 647df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 648996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran __raw_writel(0xFF, &priv->wr_regs->tx_en); 649996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran __raw_writel(0xFF, &priv->wr_regs->rx_en); 650df828598a755732e717b0adca82f884e44d37576Mugunthan V N 651df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, true); 652df828598a755732e717b0adca82f884e44d37576Mugunthan V N return; 653df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 654df828598a755732e717b0adca82f884e44d37576Mugunthan V N 655df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_intr_disable(struct cpsw_priv *priv) 656df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 657996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran __raw_writel(0, &priv->wr_regs->tx_en); 658996a5c27880e40a7e5be2687ee9e486c09bbb29cRichard Cochran __raw_writel(0, &priv->wr_regs->rx_en); 659df828598a755732e717b0adca82f884e44d37576Mugunthan V N 660df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, false); 661df828598a755732e717b0adca82f884e44d37576Mugunthan V N return; 662df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 663df828598a755732e717b0adca82f884e44d37576Mugunthan V N 6641a3b50566f259eb79039b720dbfdbb97a7a1b9c5Olof Johanssonstatic void cpsw_tx_handler(void *token, int len, int status) 665df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 666df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct sk_buff *skb = token; 667df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev = skb->dev; 668df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 669df828598a755732e717b0adca82f884e44d37576Mugunthan V N 670fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N /* Check whether the queue is stopped due to stalled tx dma, if the 671fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N * queue is stopped then start the queue as we have free desc for tx 672fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N */ 673df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (unlikely(netif_queue_stopped(ndev))) 674b56d6b3fca6d1214dbc9c5655f26e5d4ec04afc8Mugunthan V N netif_wake_queue(ndev); 6759232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N cpts_tx_timestamp(priv->cpts, skb); 676df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.tx_packets++; 677df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.tx_bytes += len; 678df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_kfree_skb_any(skb); 679df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 680df828598a755732e717b0adca82f884e44d37576Mugunthan V N 6811a3b50566f259eb79039b720dbfdbb97a7a1b9c5Olof Johanssonstatic void cpsw_rx_handler(void *token, int len, int status) 682df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 683df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct sk_buff *skb = token; 684b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior struct sk_buff *new_skb; 685df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev = skb->dev; 686df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 687df828598a755732e717b0adca82f884e44d37576Mugunthan V N int ret = 0; 688df828598a755732e717b0adca82f884e44d37576Mugunthan V N 689d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_dual_emac_src_port_detect(status, priv, ndev, skb); 690d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 691b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior if (unlikely(status < 0)) { 692b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior /* the interface is going down, skbs are purged */ 693df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_kfree_skb_any(skb); 694df828598a755732e717b0adca82f884e44d37576Mugunthan V N return; 695df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 696b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior 697b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior new_skb = netdev_alloc_skb_ip_align(ndev, priv->rx_packet_max); 698b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior if (new_skb) { 699df828598a755732e717b0adca82f884e44d37576Mugunthan V N skb_put(skb, len); 7009232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N cpts_rx_timestamp(priv->cpts, skb); 701df828598a755732e717b0adca82f884e44d37576Mugunthan V N skb->protocol = eth_type_trans(skb, ndev); 702df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_receive_skb(skb); 703df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.rx_bytes += len; 704df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.rx_packets++; 705b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior } else { 706b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior priv->stats.rx_dropped++; 707b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior new_skb = skb; 708df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 709df828598a755732e717b0adca82f884e44d37576Mugunthan V N 710b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior ret = cpdma_chan_submit(priv->rxch, new_skb, new_skb->data, 711b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior skb_tailroom(new_skb), 0); 712b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior if (WARN_ON(ret < 0)) 713b4727e69b81b71c6e9696185091e8256d863f9beSebastian Siewior dev_kfree_skb_any(new_skb); 714df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 715df828598a755732e717b0adca82f884e44d37576Mugunthan V N 716df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic irqreturn_t cpsw_interrupt(int irq, void *dev_id) 717df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 718df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = dev_id; 719fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior 720fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior cpsw_intr_disable(priv); 721a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior if (priv->irq_enabled == true) { 722a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior cpsw_disable_irq(priv); 723a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior priv->irq_enabled = false; 724a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior } 725fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior 726fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior if (netif_running(priv->ndev)) { 727df828598a755732e717b0adca82f884e44d37576Mugunthan V N napi_schedule(&priv->napi); 728fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior return IRQ_HANDLED; 729fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior } 730fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior 731fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior priv = cpsw_get_slave_priv(priv, 1); 732fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior if (!priv) 733fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior return IRQ_NONE; 734fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior 735fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior if (netif_running(priv->ndev)) { 736fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior napi_schedule(&priv->napi); 737fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior return IRQ_HANDLED; 738df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 739fd51cf199421197d14099b4ba382301cc28e5544Sebastian Siewior return IRQ_NONE; 740df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 741df828598a755732e717b0adca82f884e44d37576Mugunthan V N 742df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int cpsw_poll(struct napi_struct *napi, int budget) 743df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 744df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = napi_to_priv(napi); 745df828598a755732e717b0adca82f884e44d37576Mugunthan V N int num_tx, num_rx; 746df828598a755732e717b0adca82f884e44d37576Mugunthan V N 747df828598a755732e717b0adca82f884e44d37576Mugunthan V N num_tx = cpdma_chan_process(priv->txch, 128); 748510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N if (num_tx) 749510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_TX); 750df828598a755732e717b0adca82f884e44d37576Mugunthan V N 751510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N num_rx = cpdma_chan_process(priv->rxch, budget); 752df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (num_rx < budget) { 753a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior struct cpsw_priv *prim_cpsw; 754a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior 755df828598a755732e717b0adca82f884e44d37576Mugunthan V N napi_complete(napi); 756df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_enable(priv); 757510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_RX); 758a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior prim_cpsw = cpsw_get_slave_priv(priv, 0); 759a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior if (prim_cpsw->irq_enabled == false) { 760a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior prim_cpsw->irq_enabled = true; 761af5c6df704af46f2cfebea329887f3d70ccb7b3dMugunthan V N cpsw_enable_irq(priv); 762a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior } 763df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 764df828598a755732e717b0adca82f884e44d37576Mugunthan V N 765510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N if (num_rx || num_tx) 766510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpsw_dbg(priv, intr, "poll %d rx, %d tx pkts\n", 767510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N num_rx, num_tx); 768510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N 769df828598a755732e717b0adca82f884e44d37576Mugunthan V N return num_rx; 770df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 771df828598a755732e717b0adca82f884e44d37576Mugunthan V N 772df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic inline void soft_reset(const char *module, void __iomem *reg) 773df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 774df828598a755732e717b0adca82f884e44d37576Mugunthan V N unsigned long timeout = jiffies + HZ; 775df828598a755732e717b0adca82f884e44d37576Mugunthan V N 776df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(1, reg); 777df828598a755732e717b0adca82f884e44d37576Mugunthan V N do { 778df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpu_relax(); 779df828598a755732e717b0adca82f884e44d37576Mugunthan V N } while ((__raw_readl(reg) & 1) && time_after(timeout, jiffies)); 780df828598a755732e717b0adca82f884e44d37576Mugunthan V N 781df828598a755732e717b0adca82f884e44d37576Mugunthan V N WARN(__raw_readl(reg) & 1, "failed to soft-reset %s\n", module); 782df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 783df828598a755732e717b0adca82f884e44d37576Mugunthan V N 784df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define mac_hi(mac) (((mac)[0] << 0) | ((mac)[1] << 8) | \ 785df828598a755732e717b0adca82f884e44d37576Mugunthan V N ((mac)[2] << 16) | ((mac)[3] << 24)) 786df828598a755732e717b0adca82f884e44d37576Mugunthan V N#define mac_lo(mac) (((mac)[4] << 0) | ((mac)[5] << 8)) 787df828598a755732e717b0adca82f884e44d37576Mugunthan V N 788df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_set_slave_mac(struct cpsw_slave *slave, 789df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv) 790df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 7919750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran slave_write(slave, mac_hi(priv->mac_addr), SA_HI); 7929750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran slave_write(slave, mac_lo(priv->mac_addr), SA_LO); 793df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 794df828598a755732e717b0adca82f884e44d37576Mugunthan V N 795df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void _cpsw_adjust_link(struct cpsw_slave *slave, 796df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv, bool *link) 797df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 798df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct phy_device *phy = slave->phy; 799df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 mac_control = 0; 800df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 slave_port; 801df828598a755732e717b0adca82f884e44d37576Mugunthan V N 802df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!phy) 803df828598a755732e717b0adca82f884e44d37576Mugunthan V N return; 804df828598a755732e717b0adca82f884e44d37576Mugunthan V N 805df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave_port = cpsw_get_slave_port(priv, slave->slave_num); 806df828598a755732e717b0adca82f884e44d37576Mugunthan V N 807df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (phy->link) { 808df828598a755732e717b0adca82f884e44d37576Mugunthan V N mac_control = priv->data.mac_control; 809df828598a755732e717b0adca82f884e44d37576Mugunthan V N 810df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* enable forwarding */ 811df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_control_set(priv->ale, slave_port, 812df828598a755732e717b0adca82f884e44d37576Mugunthan V N ALE_PORT_STATE, ALE_PORT_STATE_FORWARD); 813df828598a755732e717b0adca82f884e44d37576Mugunthan V N 814df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (phy->speed == 1000) 815df828598a755732e717b0adca82f884e44d37576Mugunthan V N mac_control |= BIT(7); /* GIGABITEN */ 816df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (phy->duplex) 817df828598a755732e717b0adca82f884e44d37576Mugunthan V N mac_control |= BIT(0); /* FULLDUPLEXEN */ 818342b7b741d76bc8aadeff844634348bb2a343d19Daniel Mack 819342b7b741d76bc8aadeff844634348bb2a343d19Daniel Mack /* set speed_in input in case RMII mode is used in 100Mbps */ 820342b7b741d76bc8aadeff844634348bb2a343d19Daniel Mack if (phy->speed == 100) 821342b7b741d76bc8aadeff844634348bb2a343d19Daniel Mack mac_control |= BIT(15); 822a81d8762d71396f69d27187a909fcc69f1a7be75Mugunthan V N else if (phy->speed == 10) 823a81d8762d71396f69d27187a909fcc69f1a7be75Mugunthan V N mac_control |= BIT(18); /* In Band mode */ 824342b7b741d76bc8aadeff844634348bb2a343d19Daniel Mack 825df828598a755732e717b0adca82f884e44d37576Mugunthan V N *link = true; 826df828598a755732e717b0adca82f884e44d37576Mugunthan V N } else { 827df828598a755732e717b0adca82f884e44d37576Mugunthan V N mac_control = 0; 828df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* disable forwarding */ 829df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_control_set(priv->ale, slave_port, 830df828598a755732e717b0adca82f884e44d37576Mugunthan V N ALE_PORT_STATE, ALE_PORT_STATE_DISABLE); 831df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 832df828598a755732e717b0adca82f884e44d37576Mugunthan V N 833df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (mac_control != slave->mac_control) { 834df828598a755732e717b0adca82f884e44d37576Mugunthan V N phy_print_status(phy); 835df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(mac_control, &slave->sliver->mac_control); 836df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 837df828598a755732e717b0adca82f884e44d37576Mugunthan V N 838df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->mac_control = mac_control; 839df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 840df828598a755732e717b0adca82f884e44d37576Mugunthan V N 841df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_adjust_link(struct net_device *ndev) 842df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 843df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 844df828598a755732e717b0adca82f884e44d37576Mugunthan V N bool link = false; 845df828598a755732e717b0adca82f884e44d37576Mugunthan V N 846df828598a755732e717b0adca82f884e44d37576Mugunthan V N for_each_slave(priv, _cpsw_adjust_link, priv, &link); 847df828598a755732e717b0adca82f884e44d37576Mugunthan V N 848df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (link) { 849df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_carrier_on(ndev); 850df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_running(ndev)) 851df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_wake_queue(ndev); 852df828598a755732e717b0adca82f884e44d37576Mugunthan V N } else { 853df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_carrier_off(ndev); 854df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_stop_queue(ndev); 855df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 856df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 857df828598a755732e717b0adca82f884e44d37576Mugunthan V N 858ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V Nstatic int cpsw_get_coalesce(struct net_device *ndev, 859ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N struct ethtool_coalesce *coal) 860ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N{ 861ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 862ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 863ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal->rx_coalesce_usecs = priv->coal_intvl; 864ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N return 0; 865ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N} 866ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 867ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V Nstatic int cpsw_set_coalesce(struct net_device *ndev, 868ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N struct ethtool_coalesce *coal) 869ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N{ 870ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 871ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 int_ctrl; 872ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 num_interrupts = 0; 873ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 prescale = 0; 874ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 addnl_dvdr = 1; 875ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N u32 coal_intvl = 0; 876ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 877ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (!coal->rx_coalesce_usecs) 878ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N return -EINVAL; 879ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 880ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal_intvl = coal->rx_coalesce_usecs; 881ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 882ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N int_ctrl = readl(&priv->wr_regs->int_control); 883ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N prescale = priv->bus_freq_mhz * 4; 884ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 885ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (coal_intvl < CPSW_CMINTMIN_INTVL) 886ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal_intvl = CPSW_CMINTMIN_INTVL; 887ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 888ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (coal_intvl > CPSW_CMINTMAX_INTVL) { 889ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N /* Interrupt pacer works with 4us Pulse, we can 890ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N * throttle further by dilating the 4us pulse. 891ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N */ 892ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N addnl_dvdr = CPSW_INTPRESCALE_MASK / prescale; 893ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 894ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (addnl_dvdr > 1) { 895ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N prescale *= addnl_dvdr; 896ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (coal_intvl > (CPSW_CMINTMAX_INTVL * addnl_dvdr)) 897ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal_intvl = (CPSW_CMINTMAX_INTVL 898ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N * addnl_dvdr); 899ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } else { 900ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N addnl_dvdr = 1; 901ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal_intvl = CPSW_CMINTMAX_INTVL; 902ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } 903ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } 904ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 905ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N num_interrupts = (1000 * addnl_dvdr) / coal_intvl; 906ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N writel(num_interrupts, &priv->wr_regs->rx_imax); 907ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N writel(num_interrupts, &priv->wr_regs->tx_imax); 908ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 909ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N int_ctrl |= CPSW_INTPACEEN; 910ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N int_ctrl &= (~CPSW_INTPRESCALE_MASK); 911ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N int_ctrl |= (prescale & CPSW_INTPRESCALE_MASK); 912ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N writel(int_ctrl, &priv->wr_regs->int_control); 913ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 914ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N cpsw_notice(priv, timer, "Set coalesce to %d usecs.\n", coal_intvl); 915ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (priv->data.dual_emac) { 916ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N int i; 917ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 918ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N for (i = 0; i < priv->data.slaves; i++) { 919ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv = netdev_priv(priv->slaves[i].ndev); 920ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv->coal_intvl = coal_intvl; 921ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } 922ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } else { 923ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv->coal_intvl = coal_intvl; 924ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } 925ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 926ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N return 0; 927ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N} 928ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 929d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstatic int cpsw_get_sset_count(struct net_device *ndev, int sset) 930d97185466cc83902de49c7bea512651c7af12566Mugunthan V N{ 931d97185466cc83902de49c7bea512651c7af12566Mugunthan V N switch (sset) { 932d97185466cc83902de49c7bea512651c7af12566Mugunthan V N case ETH_SS_STATS: 933d97185466cc83902de49c7bea512651c7af12566Mugunthan V N return CPSW_STATS_LEN; 934d97185466cc83902de49c7bea512651c7af12566Mugunthan V N default: 935d97185466cc83902de49c7bea512651c7af12566Mugunthan V N return -EOPNOTSUPP; 936d97185466cc83902de49c7bea512651c7af12566Mugunthan V N } 937d97185466cc83902de49c7bea512651c7af12566Mugunthan V N} 938d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 939d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstatic void cpsw_get_strings(struct net_device *ndev, u32 stringset, u8 *data) 940d97185466cc83902de49c7bea512651c7af12566Mugunthan V N{ 941d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u8 *p = data; 942d97185466cc83902de49c7bea512651c7af12566Mugunthan V N int i; 943d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 944d97185466cc83902de49c7bea512651c7af12566Mugunthan V N switch (stringset) { 945d97185466cc83902de49c7bea512651c7af12566Mugunthan V N case ETH_SS_STATS: 946d97185466cc83902de49c7bea512651c7af12566Mugunthan V N for (i = 0; i < CPSW_STATS_LEN; i++) { 947d97185466cc83902de49c7bea512651c7af12566Mugunthan V N memcpy(p, cpsw_gstrings_stats[i].stat_string, 948d97185466cc83902de49c7bea512651c7af12566Mugunthan V N ETH_GSTRING_LEN); 949d97185466cc83902de49c7bea512651c7af12566Mugunthan V N p += ETH_GSTRING_LEN; 950d97185466cc83902de49c7bea512651c7af12566Mugunthan V N } 951d97185466cc83902de49c7bea512651c7af12566Mugunthan V N break; 952d97185466cc83902de49c7bea512651c7af12566Mugunthan V N } 953d97185466cc83902de49c7bea512651c7af12566Mugunthan V N} 954d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 955d97185466cc83902de49c7bea512651c7af12566Mugunthan V Nstatic void cpsw_get_ethtool_stats(struct net_device *ndev, 956d97185466cc83902de49c7bea512651c7af12566Mugunthan V N struct ethtool_stats *stats, u64 *data) 957d97185466cc83902de49c7bea512651c7af12566Mugunthan V N{ 958d97185466cc83902de49c7bea512651c7af12566Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 959d97185466cc83902de49c7bea512651c7af12566Mugunthan V N struct cpdma_chan_stats rx_stats; 960d97185466cc83902de49c7bea512651c7af12566Mugunthan V N struct cpdma_chan_stats tx_stats; 961d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u32 val; 962d97185466cc83902de49c7bea512651c7af12566Mugunthan V N u8 *p; 963d97185466cc83902de49c7bea512651c7af12566Mugunthan V N int i; 964d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 965d97185466cc83902de49c7bea512651c7af12566Mugunthan V N /* Collect Davinci CPDMA stats for Rx and Tx Channel */ 966d97185466cc83902de49c7bea512651c7af12566Mugunthan V N cpdma_chan_get_stats(priv->rxch, &rx_stats); 967d97185466cc83902de49c7bea512651c7af12566Mugunthan V N cpdma_chan_get_stats(priv->txch, &tx_stats); 968d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 969d97185466cc83902de49c7bea512651c7af12566Mugunthan V N for (i = 0; i < CPSW_STATS_LEN; i++) { 970d97185466cc83902de49c7bea512651c7af12566Mugunthan V N switch (cpsw_gstrings_stats[i].type) { 971d97185466cc83902de49c7bea512651c7af12566Mugunthan V N case CPSW_STATS: 972d97185466cc83902de49c7bea512651c7af12566Mugunthan V N val = readl(priv->hw_stats + 973d97185466cc83902de49c7bea512651c7af12566Mugunthan V N cpsw_gstrings_stats[i].stat_offset); 974d97185466cc83902de49c7bea512651c7af12566Mugunthan V N data[i] = val; 975d97185466cc83902de49c7bea512651c7af12566Mugunthan V N break; 976d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 977d97185466cc83902de49c7bea512651c7af12566Mugunthan V N case CPDMA_RX_STATS: 978d97185466cc83902de49c7bea512651c7af12566Mugunthan V N p = (u8 *)&rx_stats + 979d97185466cc83902de49c7bea512651c7af12566Mugunthan V N cpsw_gstrings_stats[i].stat_offset; 980d97185466cc83902de49c7bea512651c7af12566Mugunthan V N data[i] = *(u32 *)p; 981d97185466cc83902de49c7bea512651c7af12566Mugunthan V N break; 982d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 983d97185466cc83902de49c7bea512651c7af12566Mugunthan V N case CPDMA_TX_STATS: 984d97185466cc83902de49c7bea512651c7af12566Mugunthan V N p = (u8 *)&tx_stats + 985d97185466cc83902de49c7bea512651c7af12566Mugunthan V N cpsw_gstrings_stats[i].stat_offset; 986d97185466cc83902de49c7bea512651c7af12566Mugunthan V N data[i] = *(u32 *)p; 987d97185466cc83902de49c7bea512651c7af12566Mugunthan V N break; 988d97185466cc83902de49c7bea512651c7af12566Mugunthan V N } 989d97185466cc83902de49c7bea512651c7af12566Mugunthan V N } 990d97185466cc83902de49c7bea512651c7af12566Mugunthan V N} 991d97185466cc83902de49c7bea512651c7af12566Mugunthan V N 992df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic inline int __show_stat(char *buf, int maxlen, const char *name, u32 val) 993df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 994df828598a755732e717b0adca82f884e44d37576Mugunthan V N static char *leader = "........................................"; 995df828598a755732e717b0adca82f884e44d37576Mugunthan V N 996df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!val) 997df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 998df828598a755732e717b0adca82f884e44d37576Mugunthan V N else 999df828598a755732e717b0adca82f884e44d37576Mugunthan V N return snprintf(buf, maxlen, "%s %s %10d\n", name, 1000df828598a755732e717b0adca82f884e44d37576Mugunthan V N leader + strlen(name), val); 1001df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1002df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1003d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V Nstatic int cpsw_common_res_usage_state(struct cpsw_priv *priv) 1004d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N{ 1005d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 i; 1006d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 usage_count = 0; 1007d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1008d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!priv->data.dual_emac) 1009d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return 0; 1010d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1011d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N for (i = 0; i < priv->data.slaves; i++) 1012d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->slaves[i].open_stat) 1013d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N usage_count++; 1014d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1015d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return usage_count; 1016d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N} 1017d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1018d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V Nstatic inline int cpsw_tx_packet_submit(struct net_device *ndev, 1019d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_priv *priv, struct sk_buff *skb) 1020d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N{ 1021d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!priv->data.dual_emac) 1022d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return cpdma_chan_submit(priv->txch, skb, skb->data, 1023aef614e13dfbdd3b9ae44ad110159f75b9029bbaSebastian Siewior skb->len, 0); 1024d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1025d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (ndev == cpsw_get_slave_ndev(priv, 0)) 1026d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return cpdma_chan_submit(priv->txch, skb, skb->data, 1027aef614e13dfbdd3b9ae44ad110159f75b9029bbaSebastian Siewior skb->len, 1); 1028d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else 1029d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return cpdma_chan_submit(priv->txch, skb, skb->data, 1030aef614e13dfbdd3b9ae44ad110159f75b9029bbaSebastian Siewior skb->len, 2); 1031d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N} 1032d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1033d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V Nstatic inline void cpsw_add_dual_emac_def_ale_entries( 1034d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_priv *priv, struct cpsw_slave *slave, 1035d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 slave_port) 1036d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N{ 1037d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 port_mask = 1 << slave_port | 1 << priv->host_port; 1038d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1039d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->version == CPSW_VERSION_1) 1040d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave_write(slave, slave->port_vlan, CPSW1_PORT_VLAN); 1041d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else 1042d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave_write(slave, slave->port_vlan, CPSW2_PORT_VLAN); 1043d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_vlan(priv->ale, slave->port_vlan, port_mask, 1044d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N port_mask, port_mask, 0); 1045d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast, 1046d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N port_mask, ALE_VLAN, slave->port_vlan, 0); 1047d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_ucast(priv->ale, priv->mac_addr, 1048d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->host_port, ALE_VLAN, slave->port_vlan); 1049d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N} 1050d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 10511e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mackstatic void soft_reset_slave(struct cpsw_slave *slave) 1052df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1053df828598a755732e717b0adca82f884e44d37576Mugunthan V N char name[32]; 1054df828598a755732e717b0adca82f884e44d37576Mugunthan V N 10551e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack snprintf(name, sizeof(name), "slave-%d", slave->slave_num); 1056df828598a755732e717b0adca82f884e44d37576Mugunthan V N soft_reset(name, &slave->sliver->soft_reset); 10571e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack} 10581e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack 10591e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mackstatic void cpsw_slave_open(struct cpsw_slave *slave, struct cpsw_priv *priv) 10601e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack{ 10611e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack u32 slave_port; 10621e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack 10631e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack soft_reset_slave(slave); 1064df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1065df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* setup priority mapping */ 1066df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(RX_PRIORITY_MAPPING, &slave->sliver->rx_pri_map); 10679750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran 10689750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran switch (priv->version) { 10699750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran case CPSW_VERSION_1: 10709750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran slave_write(slave, TX_PRIORITY_MAPPING, CPSW1_TX_PRI_MAP); 10719750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran break; 10729750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran case CPSW_VERSION_2: 1073c193f3655d9b916a3b8cb685c6b4327397507b2fMugunthan V N case CPSW_VERSION_3: 1074926489be1d2b030c17d38fa10b5921bf3409d91dMugunthan V N case CPSW_VERSION_4: 10759750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran slave_write(slave, TX_PRIORITY_MAPPING, CPSW2_TX_PRI_MAP); 10769750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran break; 10779750a3ade7b635a18f04371b4fddad0de0b4e6d8Richard Cochran } 1078df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1079df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* setup max packet size, and mac address */ 1080df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(priv->rx_packet_max, &slave->sliver->rx_maxlen); 1081df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_set_slave_mac(slave, priv); 1082df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1083df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->mac_control = 0; /* no link yet */ 1084df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1085df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave_port = cpsw_get_slave_port(priv, slave->slave_num); 1086df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1087d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) 1088d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_add_dual_emac_def_ale_entries(priv, slave, slave_port); 1089d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else 1090d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast, 1091d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1 << slave_port, 0, 0, ALE_MCAST_FWD_2); 1092df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1093df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->phy = phy_connect(priv->ndev, slave->data->phy_id, 1094f9a8f83b04e0c362a2fc660dbad980d24af209fcFlorian Fainelli &cpsw_adjust_link, slave->data->phy_if); 1095df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (IS_ERR(slave->phy)) { 1096df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "phy %s not found on slave %d\n", 1097df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->data->phy_id, slave->slave_num); 1098df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->phy = NULL; 1099df828598a755732e717b0adca82f884e44d37576Mugunthan V N } else { 1100df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_info(priv->dev, "phy found : id is : 0x%x\n", 1101df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->phy->phy_id); 1102df828598a755732e717b0adca82f884e44d37576Mugunthan V N phy_start(slave->phy); 1103388367a5a9fbbb86db815ab069c8d5e970d2b86eMugunthan V N 1104388367a5a9fbbb86db815ab069c8d5e970d2b86eMugunthan V N /* Configure GMII_SEL register */ 1105388367a5a9fbbb86db815ab069c8d5e970d2b86eMugunthan V N cpsw_phy_sel(&priv->pdev->dev, slave->phy->interface, 1106388367a5a9fbbb86db815ab069c8d5e970d2b86eMugunthan V N slave->slave_num); 1107df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 1108df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1109df828598a755732e717b0adca82f884e44d37576Mugunthan V N 11103b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nstatic inline void cpsw_add_default_vlan(struct cpsw_priv *priv) 11113b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N{ 11123b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N const int vlan = priv->data.default_vlan; 11133b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N const int port = priv->host_port; 11143b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N u32 reg; 11153b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N int i; 11163b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 11173b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N reg = (priv->version == CPSW_VERSION_1) ? CPSW1_PORT_VLAN : 11183b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N CPSW2_PORT_VLAN; 11193b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 11203b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N writel(vlan, &priv->host_port_regs->port_vlan); 11213b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 11220237c11044b3670adcbe80cd6dd721285347f497Daniel Mack for (i = 0; i < priv->data.slaves; i++) 11233b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N slave_write(priv->slaves + i, vlan, reg); 11243b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 11253b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N cpsw_ale_add_vlan(priv->ale, vlan, ALE_ALL_PORTS << port, 11263b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ALE_ALL_PORTS << port, ALE_ALL_PORTS << port, 11273b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N (ALE_PORT_1 | ALE_PORT_2) << port); 11283b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N} 11293b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 1130df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_init_host_port(struct cpsw_priv *priv) 1131df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 11323b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N u32 control_reg; 1133d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N u32 fifo_mode; 11343b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 1135df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* soft reset the controller and initialize ale */ 1136df828598a755732e717b0adca82f884e44d37576Mugunthan V N soft_reset("cpsw", &priv->regs->soft_reset); 1137df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_start(priv->ale); 1138df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1139df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* switch to vlan unaware mode */ 11403b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N cpsw_ale_control_set(priv->ale, priv->host_port, ALE_VLAN_AWARE, 11413b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N CPSW_ALE_VLAN_AWARE); 11423b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N control_reg = readl(&priv->regs->control); 11433b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N control_reg |= CPSW_VLAN_AWARE; 11443b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N writel(control_reg, &priv->regs->control); 1145d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N fifo_mode = (priv->data.dual_emac) ? CPSW_FIFO_DUAL_MAC_MODE : 1146d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N CPSW_FIFO_NORMAL_MODE; 1147d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N writel(fifo_mode, &priv->host_port_regs->tx_in_ctl); 1148df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1149df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* setup host port priority mapping */ 1150df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(CPDMA_TX_PRIORITY_MAP, 1151df828598a755732e717b0adca82f884e44d37576Mugunthan V N &priv->host_port_regs->cpdma_tx_pri_map); 1152df828598a755732e717b0adca82f884e44d37576Mugunthan V N __raw_writel(0, &priv->host_port_regs->cpdma_rx_chan_map); 1153df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1154df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_control_set(priv->ale, priv->host_port, 1155df828598a755732e717b0adca82f884e44d37576Mugunthan V N ALE_PORT_STATE, ALE_PORT_STATE_FORWARD); 1156df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1157d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!priv->data.dual_emac) { 1158d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_ucast(priv->ale, priv->mac_addr, priv->host_port, 1159d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 0, 0); 1160d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast, 1161d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1 << priv->host_port, 0, 0, ALE_MCAST_FWD_2); 1162d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1163df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1164df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1165aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewiorstatic void cpsw_slave_stop(struct cpsw_slave *slave, struct cpsw_priv *priv) 1166aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior{ 11673995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton u32 slave_port; 11683995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton 11693995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton slave_port = cpsw_get_slave_port(priv, slave->slave_num); 11703995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton 1171aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior if (!slave->phy) 1172aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior return; 1173aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior phy_stop(slave->phy); 1174aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior phy_disconnect(slave->phy); 1175aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior slave->phy = NULL; 11763995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton cpsw_ale_control_set(priv->ale, slave_port, 11773995d265b3640fb7dc843a3c5f62ced4f121fb89Schuyler Patton ALE_PORT_STATE, ALE_PORT_STATE_DISABLE); 1178aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior} 1179aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior 1180df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int cpsw_ndo_open(struct net_device *ndev) 1181df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1182df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1183a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior struct cpsw_priv *prim_cpsw; 1184df828598a755732e717b0adca82f884e44d37576Mugunthan V N int i, ret; 1185df828598a755732e717b0adca82f884e44d37576Mugunthan V N u32 reg; 1186df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1187d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!cpsw_common_res_usage_state(priv)) 1188d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_intr_disable(priv); 1189df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_carrier_off(ndev); 1190df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1191f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_get_sync(&priv->pdev->dev); 1192df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1193549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran reg = priv->version; 1194df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1195df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_info(priv->dev, "initializing cpsw version %d.%d (%d)\n", 1196df828598a755732e717b0adca82f884e44d37576Mugunthan V N CPSW_MAJOR_VERSION(reg), CPSW_MINOR_VERSION(reg), 1197df828598a755732e717b0adca82f884e44d37576Mugunthan V N CPSW_RTL_VERSION(reg)); 1198df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1199df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* initialize host and slave ports */ 1200d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!cpsw_common_res_usage_state(priv)) 1201d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_init_host_port(priv); 1202df828598a755732e717b0adca82f884e44d37576Mugunthan V N for_each_slave(priv, cpsw_slave_open, priv); 1203df828598a755732e717b0adca82f884e44d37576Mugunthan V N 12043b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N /* Add default VLAN */ 1205d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!priv->data.dual_emac) 1206d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_add_default_vlan(priv); 12073b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 1208d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!cpsw_common_res_usage_state(priv)) { 1209d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N /* setup tx dma to fixed prio and zero offset */ 1210d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpdma_control_set(priv->dma, CPDMA_TX_PRIO_FIXED, 1); 1211d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpdma_control_set(priv->dma, CPDMA_RX_BUFFER_OFFSET, 0); 1212df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1213d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N /* disable priority elevation */ 1214d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N __raw_writel(0, &priv->regs->ptype); 1215df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1216d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N /* enable statistics collection only on all ports */ 1217d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N __raw_writel(0x7, &priv->regs->stat_port_en); 1218df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1219d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (WARN_ON(!priv->data.rx_descs)) 1220d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->data.rx_descs = 128; 1221df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1222d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N for (i = 0; i < priv->data.rx_descs; i++) { 1223d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct sk_buff *skb; 1224df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1225d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = -ENOMEM; 1226aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior skb = __netdev_alloc_skb_ip_align(priv->ndev, 1227aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior priv->rx_packet_max, GFP_KERNEL); 1228d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!skb) 1229aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior goto err_cleanup; 1230d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = cpdma_chan_submit(priv->rxch, skb, skb->data, 1231aef614e13dfbdd3b9ae44ad110159f75b9029bbaSebastian Siewior skb_tailroom(skb), 0); 1232aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior if (ret < 0) { 1233aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior kfree_skb(skb); 1234aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior goto err_cleanup; 1235aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior } 1236d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1237d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N /* continue even if we didn't manage to submit all 1238d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N * receive descs 1239d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N */ 1240d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_info(priv, ifup, "submitted %d rx descriptors\n", i); 1241f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N 1242f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N if (cpts_register(&priv->pdev->dev, priv->cpts, 1243f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N priv->data.cpts_clock_mult, 1244f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N priv->data.cpts_clock_shift)) 1245f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N dev_err(priv->dev, "error registering cpts device\n"); 1246f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N 1247df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 1248df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1249ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N /* Enable Interrupt pacing if configured */ 1250ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N if (priv->coal_intvl != 0) { 1251ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N struct ethtool_coalesce coal; 1252ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 1253ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N coal.rx_coalesce_usecs = (priv->coal_intvl << 4); 1254ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N cpsw_set_coalesce(ndev, &coal); 1255ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N } 1256ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 1257a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior prim_cpsw = cpsw_get_slave_priv(priv, 0); 1258a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior if (prim_cpsw->irq_enabled == false) { 1259a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior if ((priv == prim_cpsw) || !netif_running(prim_cpsw->ndev)) { 1260a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior prim_cpsw->irq_enabled = true; 1261a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior cpsw_enable_irq(prim_cpsw); 1262a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior } 1263a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior } 1264a11fbba9a7d338c4a4e4be624af0334bbf2c9a5aSebastian Siewior 1265dbbd2ad89bb1f86b94b23bb2e56d4935717f9b94Markus Pargmann napi_enable(&priv->napi); 1266df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_start(priv->dma); 1267df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_enable(priv); 1268510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_RX); 1269510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_TX); 1270df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1271d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) 1272d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->slaves[priv->emac_port].open_stat = true; 1273df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 1274df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1275aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewiorerr_cleanup: 1276aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior cpdma_ctlr_stop(priv->dma); 1277aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior for_each_slave(priv, cpsw_slave_stop, priv); 1278aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior pm_runtime_put_sync(&priv->pdev->dev); 1279aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior netif_carrier_off(priv->ndev); 1280aacebbf8026ecdae1b55db3912e65c6b1308f5edSebastian Siewior return ret; 1281df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1282df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1283df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int cpsw_ndo_stop(struct net_device *ndev) 1284df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1285df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1286df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1287df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_info(priv, ifdown, "shutting down cpsw device\n"); 1288df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_stop_queue(priv->ndev); 1289df828598a755732e717b0adca82f884e44d37576Mugunthan V N napi_disable(&priv->napi); 1290df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_carrier_off(priv->ndev); 1291d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1292d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (cpsw_common_res_usage_state(priv) <= 1) { 1293f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N cpts_unregister(priv->cpts); 1294d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_intr_disable(priv); 1295d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, false); 1296d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpdma_ctlr_stop(priv->dma); 1297d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_ale_stop(priv->ale); 1298d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1299df828598a755732e717b0adca82f884e44d37576Mugunthan V N for_each_slave(priv, cpsw_slave_stop, priv); 1300f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_put_sync(&priv->pdev->dev); 1301d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) 1302d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->slaves[priv->emac_port].open_stat = false; 1303df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 1304df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1305df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1306df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic netdev_tx_t cpsw_ndo_start_xmit(struct sk_buff *skb, 1307df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev) 1308df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1309df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1310df828598a755732e717b0adca82f884e44d37576Mugunthan V N int ret; 1311df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1312df828598a755732e717b0adca82f884e44d37576Mugunthan V N ndev->trans_start = jiffies; 1313df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1314df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (skb_padto(skb, CPSW_MIN_PACKET_SIZE)) { 1315df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_err(priv, tx_err, "packet pad failed\n"); 1316df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.tx_dropped++; 1317df828598a755732e717b0adca82f884e44d37576Mugunthan V N return NETDEV_TX_OK; 1318df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 1319df828598a755732e717b0adca82f884e44d37576Mugunthan V N 13209232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (skb_shinfo(skb)->tx_flags & SKBTX_HW_TSTAMP && 13219232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N priv->cpts->tx_enable) 13222e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran skb_shinfo(skb)->tx_flags |= SKBTX_IN_PROGRESS; 13232e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13242e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran skb_tx_timestamp(skb); 13252e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1326d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = cpsw_tx_packet_submit(ndev, priv, skb); 1327df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (unlikely(ret != 0)) { 1328df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_err(priv, tx_err, "desc submit failed\n"); 1329df828598a755732e717b0adca82f884e44d37576Mugunthan V N goto fail; 1330df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 1331df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1332fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N /* If there is no more tx desc left free then we need to 1333fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N * tell the kernel to stop sending us tx frames. 1334fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N */ 1335d35162f89b8f00537d7b240b76d2d0e8b8d29aa0Daniel Mack if (unlikely(!cpdma_check_free_tx_desc(priv->txch))) 1336fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N netif_stop_queue(ndev); 1337fae50823d0ee579e006a7ba2b20880e354388b25Mugunthan V N 1338df828598a755732e717b0adca82f884e44d37576Mugunthan V N return NETDEV_TX_OK; 1339df828598a755732e717b0adca82f884e44d37576Mugunthan V Nfail: 1340df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.tx_dropped++; 1341df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_stop_queue(ndev); 1342df828598a755732e717b0adca82f884e44d37576Mugunthan V N return NETDEV_TX_BUSY; 1343df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1344df828598a755732e717b0adca82f884e44d37576Mugunthan V N 13452e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#ifdef CONFIG_TI_CPTS 13462e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13472e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochranstatic void cpsw_hwtstamp_v1(struct cpsw_priv *priv) 13482e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran{ 1349e86ac13b031cf71d8f40ff513e627aac80e6b765Mugunthan V N struct cpsw_slave *slave = &priv->slaves[priv->data.active_slave]; 13502e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran u32 ts_en, seq_id; 13512e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13529232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (!priv->cpts->tx_enable && !priv->cpts->rx_enable) { 13532e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran slave_write(slave, 0, CPSW1_TS_CTL); 13542e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return; 13552e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran } 13562e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13572e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran seq_id = (30 << CPSW_V1_SEQ_ID_OFS_SHIFT) | ETH_P_1588; 13582e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ts_en = EVENT_MSG_BITS << CPSW_V1_MSG_TYPE_OFS; 13592e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13609232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (priv->cpts->tx_enable) 13612e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ts_en |= CPSW_V1_TS_TX_EN; 13622e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13639232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (priv->cpts->rx_enable) 13642e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ts_en |= CPSW_V1_TS_RX_EN; 13652e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13662e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran slave_write(slave, ts_en, CPSW1_TS_CTL); 13672e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran slave_write(slave, seq_id, CPSW1_TS_SEQ_LTYPE); 13682e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran} 13692e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13702e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochranstatic void cpsw_hwtstamp_v2(struct cpsw_priv *priv) 13712e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran{ 1372d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_slave *slave; 13732e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran u32 ctrl, mtype; 13742e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1375d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) 1376d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave = &priv->slaves[priv->emac_port]; 1377d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N else 1378e86ac13b031cf71d8f40ff513e627aac80e6b765Mugunthan V N slave = &priv->slaves[priv->data.active_slave]; 1379d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 13802e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ctrl = slave_read(slave, CPSW2_CONTROL); 13812e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ctrl &= ~CTRL_ALL_TS_MASK; 13822e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13839232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (priv->cpts->tx_enable) 13842e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ctrl |= CTRL_TX_TS_BITS; 13852e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13869232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (priv->cpts->rx_enable) 13872e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran ctrl |= CTRL_RX_TS_BITS; 13882e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13892e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran mtype = (30 << TS_SEQ_ID_OFFSET_SHIFT) | EVENT_MSG_BITS; 13902e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 13912e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran slave_write(slave, mtype, CPSW2_TS_SEQ_MTYPE); 13922e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran slave_write(slave, ctrl, CPSW2_CONTROL); 13932e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran __raw_writel(ETH_P_1588, &priv->regs->ts_ltype); 13942e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran} 13952e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1396a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchingsstatic int cpsw_hwtstamp_set(struct net_device *dev, struct ifreq *ifr) 13972e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran{ 13983177bf6f922f62743133abbcbbbb5545f4133b2dMugunthan V N struct cpsw_priv *priv = netdev_priv(dev); 13999232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N struct cpts *cpts = priv->cpts; 14002e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran struct hwtstamp_config cfg; 14012e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14022ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings if (priv->version != CPSW_VERSION_1 && 14032ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings priv->version != CPSW_VERSION_2) 14042ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings return -EOPNOTSUPP; 14052ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings 14062e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg))) 14072e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -EFAULT; 14082e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14092e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran /* reserved for future extensions */ 14102e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran if (cfg.flags) 14112e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -EINVAL; 14122e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14132ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings if (cfg.tx_type != HWTSTAMP_TX_OFF && cfg.tx_type != HWTSTAMP_TX_ON) 14142e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -ERANGE; 14152e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14162e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran switch (cfg.rx_filter) { 14172e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_NONE: 14182e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran cpts->rx_enable = 0; 14192e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran break; 14202e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_ALL: 14212e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V1_L4_EVENT: 14222e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V1_L4_SYNC: 14232e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ: 14242e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -ERANGE; 14252e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L4_EVENT: 14262e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L4_SYNC: 14272e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ: 14282e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L2_EVENT: 14292e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L2_SYNC: 14302e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ: 14312e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_EVENT: 14322e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_SYNC: 14332e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case HWTSTAMP_FILTER_PTP_V2_DELAY_REQ: 14342e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran cpts->rx_enable = 1; 14352e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran cfg.rx_filter = HWTSTAMP_FILTER_PTP_V2_EVENT; 14362e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran break; 14372e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran default: 14382e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -ERANGE; 14392e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran } 14402e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14412ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings cpts->tx_enable = cfg.tx_type == HWTSTAMP_TX_ON; 14422ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings 14432e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran switch (priv->version) { 14442e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case CPSW_VERSION_1: 14452e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran cpsw_hwtstamp_v1(priv); 14462e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran break; 14472e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran case CPSW_VERSION_2: 14482e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran cpsw_hwtstamp_v2(priv); 14492e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran break; 14502e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran default: 14512ee91e54bd5367bf4123719a4f7203857b28e046Ben Hutchings WARN_ON(1); 14522e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran } 14532e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14542e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0; 14552e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran} 14562e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1457a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchingsstatic int cpsw_hwtstamp_get(struct net_device *dev, struct ifreq *ifr) 1458a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings{ 1459a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings struct cpsw_priv *priv = netdev_priv(dev); 1460a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings struct cpts *cpts = priv->cpts; 1461a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings struct hwtstamp_config cfg; 1462a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings 1463a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings if (priv->version != CPSW_VERSION_1 && 1464a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings priv->version != CPSW_VERSION_2) 1465a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings return -EOPNOTSUPP; 1466a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings 1467a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings cfg.flags = 0; 1468a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings cfg.tx_type = cpts->tx_enable ? HWTSTAMP_TX_ON : HWTSTAMP_TX_OFF; 1469a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings cfg.rx_filter = (cpts->rx_enable ? 1470a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings HWTSTAMP_FILTER_PTP_V2_EVENT : HWTSTAMP_FILTER_NONE); 1471a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings 1472a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0; 1473a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings} 1474a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings 14752e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#endif /*CONFIG_TI_CPTS*/ 14762e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 14772e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochranstatic int cpsw_ndo_ioctl(struct net_device *dev, struct ifreq *req, int cmd) 14782e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran{ 147911f2c988382b880e602a005c26436043c5d2c274Mugunthan V N struct cpsw_priv *priv = netdev_priv(dev); 148011f2c988382b880e602a005c26436043c5d2c274Mugunthan V N struct mii_ioctl_data *data = if_mii(req); 148111f2c988382b880e602a005c26436043c5d2c274Mugunthan V N int slave_no = cpsw_slave_index(priv); 148211f2c988382b880e602a005c26436043c5d2c274Mugunthan V N 14832e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran if (!netif_running(dev)) 14842e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return -EINVAL; 14852e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 148611f2c988382b880e602a005c26436043c5d2c274Mugunthan V N switch (cmd) { 14872e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#ifdef CONFIG_TI_CPTS 148811f2c988382b880e602a005c26436043c5d2c274Mugunthan V N case SIOCSHWTSTAMP: 1489a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings return cpsw_hwtstamp_set(dev, req); 1490a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings case SIOCGHWTSTAMP: 1491a5b4145ba937b76dd698ad6fe5c5f37e0edbac43Ben Hutchings return cpsw_hwtstamp_get(dev, req); 14922e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#endif 149311f2c988382b880e602a005c26436043c5d2c274Mugunthan V N case SIOCGMIIPHY: 149411f2c988382b880e602a005c26436043c5d2c274Mugunthan V N data->phy_id = priv->slaves[slave_no].phy->addr; 149511f2c988382b880e602a005c26436043c5d2c274Mugunthan V N break; 149611f2c988382b880e602a005c26436043c5d2c274Mugunthan V N default: 149711f2c988382b880e602a005c26436043c5d2c274Mugunthan V N return -ENOTSUPP; 149811f2c988382b880e602a005c26436043c5d2c274Mugunthan V N } 149911f2c988382b880e602a005c26436043c5d2c274Mugunthan V N 150011f2c988382b880e602a005c26436043c5d2c274Mugunthan V N return 0; 15012e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran} 15022e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1503df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_ndo_tx_timeout(struct net_device *ndev) 1504df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1505df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1506df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1507df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_err(priv, tx_err, "transmit timeout, restarting dma\n"); 1508df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->stats.tx_errors++; 1509df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_disable(priv); 1510df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, false); 1511df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_stop(priv->txch); 1512df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_start(priv->txch); 1513df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, true); 1514df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_enable(priv); 1515510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_RX); 1516510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_TX); 1517510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N 1518df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1519df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1520dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V Nstatic int cpsw_ndo_set_mac_address(struct net_device *ndev, void *p) 1521dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N{ 1522dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1523dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N struct sockaddr *addr = (struct sockaddr *)p; 1524dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N int flags = 0; 1525dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N u16 vid = 0; 1526dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1527dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N if (!is_valid_ether_addr(addr->sa_data)) 1528dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N return -EADDRNOTAVAIL; 1529dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1530dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N if (priv->data.dual_emac) { 1531dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N vid = priv->slaves[priv->emac_port].port_vlan; 1532dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N flags = ALE_VLAN; 1533dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N } 1534dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1535dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N cpsw_ale_del_ucast(priv->ale, priv->mac_addr, priv->host_port, 1536dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N flags, vid); 1537dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N cpsw_ale_add_ucast(priv->ale, addr->sa_data, priv->host_port, 1538dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N flags, vid); 1539dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1540dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N memcpy(priv->mac_addr, addr->sa_data, ETH_ALEN); 1541dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N memcpy(ndev->dev_addr, priv->mac_addr, ETH_ALEN); 1542dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N for_each_slave(priv, cpsw_set_slave_mac, priv); 1543dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1544dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N return 0; 1545dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N} 1546dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N 1547df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic struct net_device_stats *cpsw_ndo_get_stats(struct net_device *ndev) 1548df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1549df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1550df828598a755732e717b0adca82f884e44d37576Mugunthan V N return &priv->stats; 1551df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1552df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1553df828598a755732e717b0adca82f884e44d37576Mugunthan V N#ifdef CONFIG_NET_POLL_CONTROLLER 1554df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_ndo_poll_controller(struct net_device *ndev) 1555df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1556df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1557df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1558df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_disable(priv); 1559df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, false); 1560df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_interrupt(ndev->irq, priv); 1561df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_int_ctrl(priv->dma, true); 1562df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_intr_enable(priv); 1563510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_RX); 1564510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N cpdma_ctlr_eoi(priv->dma, CPDMA_EOI_TX); 1565510a1e7249298f6bbd049e1ec98041ddf5ef6452Mugunthan V N 1566df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1567df828598a755732e717b0adca82f884e44d37576Mugunthan V N#endif 1568df828598a755732e717b0adca82f884e44d37576Mugunthan V N 15693b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nstatic inline int cpsw_add_vlan_ale_entry(struct cpsw_priv *priv, 15703b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N unsigned short vid) 15713b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N{ 15723b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N int ret; 15733b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 15743b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ret = cpsw_ale_add_vlan(priv->ale, vid, 15753b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ALE_ALL_PORTS << priv->host_port, 15763b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 0, ALE_ALL_PORTS << priv->host_port, 15773b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N (ALE_PORT_1 | ALE_PORT_2) << priv->host_port); 15783b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (ret != 0) 15793b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return ret; 15803b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 15813b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ret = cpsw_ale_add_ucast(priv->ale, priv->mac_addr, 15823b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N priv->host_port, ALE_VLAN, vid); 15833b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (ret != 0) 15843b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N goto clean_vid; 15853b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 15863b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ret = cpsw_ale_add_mcast(priv->ale, priv->ndev->broadcast, 15873b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ALE_ALL_PORTS << priv->host_port, 15883b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ALE_VLAN, vid, 0); 15893b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (ret != 0) 15903b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N goto clean_vlan_ucast; 15913b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return 0; 15923b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 15933b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nclean_vlan_ucast: 15943b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N cpsw_ale_del_ucast(priv->ale, priv->mac_addr, 15953b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N priv->host_port, ALE_VLAN, vid); 15963b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nclean_vid: 15973b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N cpsw_ale_del_vlan(priv->ale, vid, 0); 15983b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return ret; 15993b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N} 16003b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16013b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nstatic int cpsw_ndo_vlan_rx_add_vid(struct net_device *ndev, 160280d5c3689b886308247da295a228a54df49a44f6Patrick McHardy __be16 proto, u16 vid) 16033b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N{ 16043b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 16053b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16063b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (vid == priv->data.default_vlan) 16073b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return 0; 16083b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16093b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N dev_info(priv->dev, "Adding vlanid %d to vlan filter\n", vid); 16103b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return cpsw_add_vlan_ale_entry(priv, vid); 16113b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N} 16123b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16133b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V Nstatic int cpsw_ndo_vlan_rx_kill_vid(struct net_device *ndev, 161480d5c3689b886308247da295a228a54df49a44f6Patrick McHardy __be16 proto, u16 vid) 16153b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N{ 16163b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 16173b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N int ret; 16183b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16193b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (vid == priv->data.default_vlan) 16203b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return 0; 16213b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16223b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N dev_info(priv->dev, "removing vlanid %d from vlan filter\n", vid); 16233b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ret = cpsw_ale_del_vlan(priv->ale, vid, 0); 16243b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (ret != 0) 16253b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return ret; 16263b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16273b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N ret = cpsw_ale_del_ucast(priv->ale, priv->mac_addr, 16283b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N priv->host_port, ALE_VLAN, vid); 16293b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N if (ret != 0) 16303b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return ret; 16313b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 16323b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N return cpsw_ale_del_mcast(priv->ale, priv->ndev->broadcast, 16333b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 0, ALE_VLAN, vid); 16343b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N} 16353b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N 1636df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic const struct net_device_ops cpsw_netdev_ops = { 1637df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_open = cpsw_ndo_open, 1638df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_stop = cpsw_ndo_stop, 1639df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_start_xmit = cpsw_ndo_start_xmit, 1640dcfd8d5830f8cc9062eb7040f455c034e8d160e6Mugunthan V N .ndo_set_mac_address = cpsw_ndo_set_mac_address, 16412e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran .ndo_do_ioctl = cpsw_ndo_ioctl, 1642df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_validate_addr = eth_validate_addr, 16435c473ed26dba609622c9a625f896f8f59d86066cDavid S. Miller .ndo_change_mtu = eth_change_mtu, 1644df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_tx_timeout = cpsw_ndo_tx_timeout, 1645df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_get_stats = cpsw_ndo_get_stats, 16465c50a856d550b3bf6a731f6e33a794ed5c519817Mugunthan V N .ndo_set_rx_mode = cpsw_ndo_set_rx_mode, 1647df828598a755732e717b0adca82f884e44d37576Mugunthan V N#ifdef CONFIG_NET_POLL_CONTROLLER 1648df828598a755732e717b0adca82f884e44d37576Mugunthan V N .ndo_poll_controller = cpsw_ndo_poll_controller, 1649df828598a755732e717b0adca82f884e44d37576Mugunthan V N#endif 16503b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N .ndo_vlan_rx_add_vid = cpsw_ndo_vlan_rx_add_vid, 16513b72c2fe0c6bbec42ed7f899931daef227b80322Mugunthan V N .ndo_vlan_rx_kill_vid = cpsw_ndo_vlan_rx_kill_vid, 1652df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 1653df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1654df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_get_drvinfo(struct net_device *ndev, 1655df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct ethtool_drvinfo *info) 1656df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1657df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 16587826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko 16597826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko strlcpy(info->driver, "TI CPSW Driver v1.0", sizeof(info->driver)); 16607826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko strlcpy(info->version, "1.0", sizeof(info->version)); 16617826d43f2db45c9305a6e0ba165650e1a203f517Jiri Pirko strlcpy(info->bus_info, priv->pdev->name, sizeof(info->bus_info)); 1662df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1663df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1664df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic u32 cpsw_get_msglevel(struct net_device *ndev) 1665df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1666df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1667df828598a755732e717b0adca82f884e44d37576Mugunthan V N return priv->msg_enable; 1668df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1669df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1670df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void cpsw_set_msglevel(struct net_device *ndev, u32 value) 1671df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1672df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1673df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->msg_enable = value; 1674df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1675df828598a755732e717b0adca82f884e44d37576Mugunthan V N 16762e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochranstatic int cpsw_get_ts_info(struct net_device *ndev, 16772e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran struct ethtool_ts_info *info) 16782e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran{ 16792e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#ifdef CONFIG_TI_CPTS 16802e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran struct cpsw_priv *priv = netdev_priv(ndev); 16812e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 16822e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->so_timestamping = 16832e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_TX_HARDWARE | 16842e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_TX_SOFTWARE | 16852e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_RX_HARDWARE | 16862e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_RX_SOFTWARE | 16872e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_SOFTWARE | 16882e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_RAW_HARDWARE; 16899232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N info->phc_index = priv->cpts->phc_index; 16902e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->tx_types = 16912e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran (1 << HWTSTAMP_TX_OFF) | 16922e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran (1 << HWTSTAMP_TX_ON); 16932e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->rx_filters = 16942e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran (1 << HWTSTAMP_FILTER_NONE) | 16952e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran (1 << HWTSTAMP_FILTER_PTP_V2_EVENT); 16962e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#else 16972e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->so_timestamping = 16982e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_TX_SOFTWARE | 16992e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_RX_SOFTWARE | 17002e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran SOF_TIMESTAMPING_SOFTWARE; 17012e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->phc_index = -1; 17022e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->tx_types = 0; 17032e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran info->rx_filters = 0; 17042e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran#endif 17052e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran return 0; 17062e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran} 17072e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 1708d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V Nstatic int cpsw_get_settings(struct net_device *ndev, 1709d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N struct ethtool_cmd *ecmd) 1710d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N{ 1711d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1712d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N int slave_no = cpsw_slave_index(priv); 1713d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N 1714d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N if (priv->slaves[slave_no].phy) 1715d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N return phy_ethtool_gset(priv->slaves[slave_no].phy, ecmd); 1716d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N else 1717d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N return -EOPNOTSUPP; 1718d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N} 1719d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N 1720d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V Nstatic int cpsw_set_settings(struct net_device *ndev, struct ethtool_cmd *ecmd) 1721d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N{ 1722d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 1723d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N int slave_no = cpsw_slave_index(priv); 1724d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N 1725d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N if (priv->slaves[slave_no].phy) 1726d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N return phy_ethtool_sset(priv->slaves[slave_no].phy, ecmd); 1727d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N else 1728d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N return -EOPNOTSUPP; 1729d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N} 1730d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N 1731d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyistatic void cpsw_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) 1732d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi{ 1733d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi struct cpsw_priv *priv = netdev_priv(ndev); 1734d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi int slave_no = cpsw_slave_index(priv); 1735d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi 1736d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi wol->supported = 0; 1737d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi wol->wolopts = 0; 1738d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi 1739d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi if (priv->slaves[slave_no].phy) 1740d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi phy_ethtool_get_wol(priv->slaves[slave_no].phy, wol); 1741d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi} 1742d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi 1743d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyistatic int cpsw_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol) 1744d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi{ 1745d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi struct cpsw_priv *priv = netdev_priv(ndev); 1746d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi int slave_no = cpsw_slave_index(priv); 1747d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi 1748d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi if (priv->slaves[slave_no].phy) 1749d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi return phy_ethtool_set_wol(priv->slaves[slave_no].phy, wol); 1750d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi else 1751d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi return -EOPNOTSUPP; 1752d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi} 1753d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi 1754df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic const struct ethtool_ops cpsw_ethtool_ops = { 1755df828598a755732e717b0adca82f884e44d37576Mugunthan V N .get_drvinfo = cpsw_get_drvinfo, 1756df828598a755732e717b0adca82f884e44d37576Mugunthan V N .get_msglevel = cpsw_get_msglevel, 1757df828598a755732e717b0adca82f884e44d37576Mugunthan V N .set_msglevel = cpsw_set_msglevel, 1758df828598a755732e717b0adca82f884e44d37576Mugunthan V N .get_link = ethtool_op_get_link, 17592e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran .get_ts_info = cpsw_get_ts_info, 1760d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N .get_settings = cpsw_get_settings, 1761d3bb9c58b567d240eaaa2dc8bd778696eaed5fbdMugunthan V N .set_settings = cpsw_set_settings, 1762ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N .get_coalesce = cpsw_get_coalesce, 1763ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N .set_coalesce = cpsw_set_coalesce, 1764d97185466cc83902de49c7bea512651c7af12566Mugunthan V N .get_sset_count = cpsw_get_sset_count, 1765d97185466cc83902de49c7bea512651c7af12566Mugunthan V N .get_strings = cpsw_get_strings, 1766d97185466cc83902de49c7bea512651c7af12566Mugunthan V N .get_ethtool_stats = cpsw_get_ethtool_stats, 1767d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi .get_wol = cpsw_get_wol, 1768d8a64420eb267bec9f4c99627deee4fa3bf4133eMatus Ujhelyi .set_wol = cpsw_set_wol, 1769df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 1770df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1771549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochranstatic void cpsw_slave_init(struct cpsw_slave *slave, struct cpsw_priv *priv, 1772549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran u32 slave_reg_ofs, u32 sliver_reg_ofs) 1773df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 1774df828598a755732e717b0adca82f884e44d37576Mugunthan V N void __iomem *regs = priv->regs; 1775df828598a755732e717b0adca82f884e44d37576Mugunthan V N int slave_num = slave->slave_num; 1776df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_slave_data *data = priv->data.slave_data + slave_num; 1777df828598a755732e717b0adca82f884e44d37576Mugunthan V N 1778df828598a755732e717b0adca82f884e44d37576Mugunthan V N slave->data = data; 1779549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave->regs = regs + slave_reg_ofs; 1780549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave->sliver = regs + sliver_reg_ofs; 1781d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave->port_vlan = data->dual_emac_res_vlan; 1782df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 1783df828598a755732e717b0adca82f884e44d37576Mugunthan V N 17842eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V Nstatic int cpsw_probe_dt(struct cpsw_platform_data *data, 17852eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N struct platform_device *pdev) 17862eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N{ 17872eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N struct device_node *node = pdev->dev.of_node; 17882eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N struct device_node *slave_node; 17892eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N int i = 0, ret; 17902eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N u32 prop; 17912eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 17922eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (!node) 17932eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N return -EINVAL; 17942eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 17952eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "slaves", &prop)) { 17962eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing slaves property in the DT.\n"); 17972eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N return -EINVAL; 17982eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 17992eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->slaves = prop; 18002eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 1801e86ac13b031cf71d8f40ff513e627aac80e6b765Mugunthan V N if (of_property_read_u32(node, "active_slave", &prop)) { 1802e86ac13b031cf71d8f40ff513e627aac80e6b765Mugunthan V N pr_err("Missing active_slave property in the DT.\n"); 1803aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 180478ca0b287314ad6b7b06161b3ff9b13e8a8bcce0Richard Cochran } 1805e86ac13b031cf71d8f40ff513e627aac80e6b765Mugunthan V N data->active_slave = prop; 180678ca0b287314ad6b7b06161b3ff9b13e8a8bcce0Richard Cochran 180700ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran if (of_property_read_u32(node, "cpts_clock_mult", &prop)) { 180800ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran pr_err("Missing cpts_clock_mult property in the DT.\n"); 1809aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 181000ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran } 181100ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran data->cpts_clock_mult = prop; 181200ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran 181300ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran if (of_property_read_u32(node, "cpts_clock_shift", &prop)) { 181400ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran pr_err("Missing cpts_clock_shift property in the DT.\n"); 1815aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 181600ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran } 181700ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran data->cpts_clock_shift = prop; 181800ab94eeaf6c1ad38ad7368c5148fed31403c8a2Richard Cochran 1819aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack data->slave_data = devm_kzalloc(&pdev->dev, data->slaves 1820aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack * sizeof(struct cpsw_slave_data), 1821aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack GFP_KERNEL); 1822b2adaca92c63b9bb8beb021d554f656e387a7648Joe Perches if (!data->slave_data) 1823aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -ENOMEM; 18242eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 18252eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "cpdma_channels", &prop)) { 18262eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing cpdma_channels property in the DT.\n"); 1827aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18282eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 18292eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->channels = prop; 18302eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 18312eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "ale_entries", &prop)) { 18322eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing ale_entries property in the DT.\n"); 1833aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18342eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 18352eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->ale_entries = prop; 18362eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 18372eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "bd_ram_size", &prop)) { 18382eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing bd_ram_size property in the DT.\n"); 1839aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18402eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 18412eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->bd_ram_size = prop; 18422eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 18432eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "rx_descs", &prop)) { 18442eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing rx_descs property in the DT.\n"); 1845aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18462eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 18472eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->rx_descs = prop; 18482eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 18492eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (of_property_read_u32(node, "mac_control", &prop)) { 18502eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing mac_control property in the DT.\n"); 1851aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18522eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 18532eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data->mac_control = prop; 18542eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 1855281abd965fedfe7c31927d84e01a5bfa554b5502Markus Pargmann if (of_property_read_bool(node, "dual_emac")) 1856281abd965fedfe7c31927d84e01a5bfa554b5502Markus Pargmann data->dual_emac = 1; 1857d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1858549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran /* 1859549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran * Populate all the child nodes here... 1860549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran */ 1861549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran ret = of_platform_populate(node, NULL, NULL, &pdev->dev); 1862549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran /* We do not want to force this, as in some cases may not have child */ 1863549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran if (ret) 1864549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran pr_warn("Doesn't have any child node\n"); 1865549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 1866f468b10e3de6c5f90a14b9c82f1403a2651cef35Markus Pargmann for_each_child_of_node(node, slave_node) { 18672eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N struct cpsw_slave_data *slave_data = data->slave_data + i; 18682eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N const void *mac_addr = NULL; 1869549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran u32 phyid; 1870549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran int lenp; 1871549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran const __be32 *parp; 1872549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran struct device_node *mdio_node; 1873549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran struct platform_device *mdio; 1874549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 1875f468b10e3de6c5f90a14b9c82f1403a2651cef35Markus Pargmann /* This is no slave child node, continue */ 1876f468b10e3de6c5f90a14b9c82f1403a2651cef35Markus Pargmann if (strcmp(slave_node->name, "slave")) 1877f468b10e3de6c5f90a14b9c82f1403a2651cef35Markus Pargmann continue; 1878f468b10e3de6c5f90a14b9c82f1403a2651cef35Markus Pargmann 1879549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran parp = of_get_property(slave_node, "phy_id", &lenp); 1880ce16294fda230c787ce5c35f61b2f80d14d70a72Lothar Waßmann if ((parp == NULL) || (lenp != (sizeof(void *) * 2))) { 18812eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("Missing slave[%d] phy_id property\n", i); 1882aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack return -EINVAL; 18832eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 1884549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran mdio_node = of_find_node_by_phandle(be32_to_cpup(parp)); 1885549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran phyid = be32_to_cpup(parp+1); 1886549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran mdio = of_find_device_by_node(mdio_node); 1887f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese 1888f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese if (strncmp(mdio->name, "gpio", 4) == 0) { 1889f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese /* GPIO bitbang MDIO driver attached */ 1890f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese struct mii_bus *bus = dev_get_drvdata(&mdio->dev); 1891f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese 1892f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese snprintf(slave_data->phy_id, sizeof(slave_data->phy_id), 1893f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese PHY_ID_FMT, bus->id, phyid); 1894f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese } else { 1895f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese /* davinci MDIO driver attached */ 1896f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese snprintf(slave_data->phy_id, sizeof(slave_data->phy_id), 1897f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese PHY_ID_FMT, mdio->name, phyid); 1898f8d56d8f892be43a2404356073e16401eb5a42e6Stefan Roese } 18992eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 19002eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N mac_addr = of_get_mac_address(slave_node); 19012eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (mac_addr) 19022eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N memcpy(slave_data->mac_addr, mac_addr, ETH_ALEN); 19032eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 1904c5ceea7a2813fecded01567383cca4d6855164abMugunthan V N slave_data->phy_if = of_get_phy_mode(slave_node); 190589e101729be4cacd5847fef7e7c99680772c6e3cUwe Kleine-König if (slave_data->phy_if < 0) { 190689e101729be4cacd5847fef7e7c99680772c6e3cUwe Kleine-König pr_err("Missing or malformed slave[%d] phy-mode property\n", 190789e101729be4cacd5847fef7e7c99680772c6e3cUwe Kleine-König i); 190889e101729be4cacd5847fef7e7c99680772c6e3cUwe Kleine-König return slave_data->phy_if; 190989e101729be4cacd5847fef7e7c99680772c6e3cUwe Kleine-König } 1910c5ceea7a2813fecded01567383cca4d6855164abMugunthan V N 1911d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (data->dual_emac) { 191291c4166c1a01c00b8bed74f7a7defa620071de88Mugunthan V N if (of_property_read_u32(slave_node, "dual_emac_res_vlan", 1913d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N &prop)) { 1914d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_err("Missing dual_emac_res_vlan in DT.\n"); 1915d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave_data->dual_emac_res_vlan = i+1; 1916d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_err("Using %d as Reserved VLAN for %d slave\n", 1917d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave_data->dual_emac_res_vlan, i); 1918d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } else { 1919d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N slave_data->dual_emac_res_vlan = prop; 1920d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1921d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1922d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 19232eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N i++; 19243a27bfac17fe375539c4e0a53478679645eb5ae2Mugunthan V N if (i == data->slaves) 19253a27bfac17fe375539c4e0a53478679645eb5ae2Mugunthan V N break; 19262eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 19272eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 19282eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N return 0; 19292eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N} 19302eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 1931d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V Nstatic int cpsw_probe_dual_emac(struct platform_device *pdev, 1932d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_priv *priv) 1933d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N{ 1934d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_platform_data *data = &priv->data; 1935d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct net_device *ndev; 1936d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N struct cpsw_priv *priv_sl2; 1937d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N int ret = 0, i; 1938d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1939d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ndev = alloc_etherdev(sizeof(struct cpsw_priv)); 1940d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (!ndev) { 1941d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_err("cpsw: error allocating net_device\n"); 1942d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return -ENOMEM; 1943d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1944d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1945d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2 = netdev_priv(ndev); 1946d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N spin_lock_init(&priv_sl2->lock); 1947d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->data = *data; 1948d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->pdev = pdev; 1949d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->ndev = ndev; 1950d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->dev = &ndev->dev; 1951d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->msg_enable = netif_msg_init(debug_level, CPSW_DEBUG); 1952d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->rx_packet_max = max(rx_packet_max, 128); 1953d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1954d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (is_valid_ether_addr(data->slave_data[1].mac_addr)) { 1955d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N memcpy(priv_sl2->mac_addr, data->slave_data[1].mac_addr, 1956d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ETH_ALEN); 1957d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_info("cpsw: Detected MACID = %pM\n", priv_sl2->mac_addr); 1958d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } else { 1959d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N random_ether_addr(priv_sl2->mac_addr); 1960d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_info("cpsw: Random MACID = %pM\n", priv_sl2->mac_addr); 1961d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1962d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N memcpy(ndev->dev_addr, priv_sl2->mac_addr, ETH_ALEN); 1963d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1964d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->slaves = priv->slaves; 1965d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->clk = priv->clk; 1966d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1967ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv_sl2->coal_intvl = 0; 1968ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv_sl2->bus_freq_mhz = priv->bus_freq_mhz; 1969ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N 1970d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->regs = priv->regs; 1971d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->host_port = priv->host_port; 1972d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->host_port_regs = priv->host_port_regs; 1973d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->wr_regs = priv->wr_regs; 1974d97185466cc83902de49c7bea512651c7af12566Mugunthan V N priv_sl2->hw_stats = priv->hw_stats; 1975d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->dma = priv->dma; 1976d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->txch = priv->txch; 1977d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->rxch = priv->rxch; 1978d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->ale = priv->ale; 1979d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->emac_port = 1; 1980d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->slaves[1].ndev = ndev; 1981d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->cpts = priv->cpts; 1982d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->version = priv->version; 1983d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1984d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N for (i = 0; i < priv->num_irqs; i++) { 1985d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->irqs_table[i] = priv->irqs_table[i]; 1986d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv_sl2->num_irqs = priv->num_irqs; 1987d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 1988f646968f8f7c624587de729115d802372b9063ddPatrick McHardy ndev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 1989d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1990d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ndev->netdev_ops = &cpsw_netdev_ops; 1991d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N SET_ETHTOOL_OPS(ndev, &cpsw_ethtool_ops); 1992d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N netif_napi_add(ndev, &priv_sl2->napi, cpsw_poll, CPSW_POLL_WEIGHT); 1993d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 1994d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N /* register the network device */ 1995d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N SET_NETDEV_DEV(ndev, &pdev->dev); 1996d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = register_netdev(ndev); 1997d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (ret) { 1998d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N pr_err("cpsw: error registering net device\n"); 1999d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N free_netdev(ndev); 2000d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = -ENODEV; 2001d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 2002d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 2003d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N return ret; 2004d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N} 2005d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 2006663e12e61d8764ce342588325d1050d9cb5460c0Bill Pembertonstatic int cpsw_probe(struct platform_device *pdev) 2007df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2008d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior struct cpsw_platform_data *data; 2009df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev; 2010df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv; 2011df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpdma_params dma_params; 2012df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_ale_params ale_params; 2013aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack void __iomem *ss_regs; 2014aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack struct resource *res, *ss_res; 2015549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran u32 slave_offset, sliver_offset, slave_size; 2016df828598a755732e717b0adca82f884e44d37576Mugunthan V N int ret = 0, i, k = 0; 2017df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2018df828598a755732e717b0adca82f884e44d37576Mugunthan V N ndev = alloc_etherdev(sizeof(struct cpsw_priv)); 2019df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!ndev) { 2020df828598a755732e717b0adca82f884e44d37576Mugunthan V N pr_err("error allocating net_device\n"); 2021df828598a755732e717b0adca82f884e44d37576Mugunthan V N return -ENOMEM; 2022df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2023df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2024df828598a755732e717b0adca82f884e44d37576Mugunthan V N platform_set_drvdata(pdev, ndev); 2025df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv = netdev_priv(ndev); 2026df828598a755732e717b0adca82f884e44d37576Mugunthan V N spin_lock_init(&priv->lock); 2027df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->pdev = pdev; 2028df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->ndev = ndev; 2029df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->dev = &ndev->dev; 2030df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->msg_enable = netif_msg_init(debug_level, CPSW_DEBUG); 2031df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->rx_packet_max = max(rx_packet_max, 128); 20329232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N priv->cpts = devm_kzalloc(&pdev->dev, sizeof(struct cpts), GFP_KERNEL); 20337dcf313a7a68adc9a060e4e41a55245c0f9a3d31Mugunthan V N priv->irq_enabled = true; 2034ab8e99d276d4b72d1532bda4423b14c9e2ce053cSebastian Siewior if (!priv->cpts) { 20359232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N pr_err("error allocating cpts\n"); 20369232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N goto clean_ndev_ret; 20379232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N } 2038df828598a755732e717b0adca82f884e44d37576Mugunthan V N 20391fb19aa730e400e474b562c55227849060549733Vaibhav Hiremath /* 20401fb19aa730e400e474b562c55227849060549733Vaibhav Hiremath * This may be required here for child devices. 20411fb19aa730e400e474b562c55227849060549733Vaibhav Hiremath */ 20421fb19aa730e400e474b562c55227849060549733Vaibhav Hiremath pm_runtime_enable(&pdev->dev); 20431fb19aa730e400e474b562c55227849060549733Vaibhav Hiremath 2044739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N /* Select default pin state */ 2045739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N pinctrl_pm_select_default_state(&pdev->dev); 2046739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N 20472eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N if (cpsw_probe_dt(&priv->data, pdev)) { 20482eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N pr_err("cpsw: platform data missing\n"); 20492eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N ret = -ENODEV; 2050aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 20512eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N } 20522eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N data = &priv->data; 20532eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 2054df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (is_valid_ether_addr(data->slave_data[0].mac_addr)) { 2055df828598a755732e717b0adca82f884e44d37576Mugunthan V N memcpy(priv->mac_addr, data->slave_data[0].mac_addr, ETH_ALEN); 2056cf6122be45de68bc773f64e4266db76129ea556fDaniel Mack pr_info("Detected MACID = %pM\n", priv->mac_addr); 2057df828598a755732e717b0adca82f884e44d37576Mugunthan V N } else { 20587efd26d0db5917b9e53d72e76e52338b2600ae20Joe Perches eth_random_addr(priv->mac_addr); 2059cf6122be45de68bc773f64e4266db76129ea556fDaniel Mack pr_info("Random MACID = %pM\n", priv->mac_addr); 2060df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2061df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2062df828598a755732e717b0adca82f884e44d37576Mugunthan V N memcpy(ndev->dev_addr, priv->mac_addr, ETH_ALEN); 2063df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2064aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack priv->slaves = devm_kzalloc(&pdev->dev, 2065aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack sizeof(struct cpsw_slave) * data->slaves, 2066aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack GFP_KERNEL); 2067df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!priv->slaves) { 2068aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack ret = -ENOMEM; 2069aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2070df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2071df828598a755732e717b0adca82f884e44d37576Mugunthan V N for (i = 0; i < data->slaves; i++) 2072df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->slaves[i].slave_num = i; 2073df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2074d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->slaves[0].ndev = ndev; 2075d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N priv->emac_port = 0; 2076d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 2077aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack priv->clk = devm_clk_get(&pdev->dev, "fck"); 2078df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (IS_ERR(priv->clk)) { 2079aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack dev_err(priv->dev, "fck is not found\n"); 2080f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N ret = -ENODEV; 2081aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2082df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2083ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv->coal_intvl = 0; 2084ff5b8ef2ef3af0fd7e1cf6c8c1ed9ec5afbda422Mugunthan V N priv->bus_freq_mhz = clk_get_rate(priv->clk) / 1000000; 2085df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2086aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack ss_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 2087aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack ss_regs = devm_ioremap_resource(&pdev->dev, ss_res); 2088aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack if (IS_ERR(ss_regs)) { 2089aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack ret = PTR_ERR(ss_regs); 2090aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2091df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2092549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran priv->regs = ss_regs; 2093549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran priv->host_port = HOST_PORT_NUM; 2094df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2095f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N /* Need to enable clocks with runtime PM api to access module 2096f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N * registers 2097f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N */ 2098f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N pm_runtime_get_sync(&pdev->dev); 2099f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N priv->version = readl(&priv->regs->id_ver); 2100f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N pm_runtime_put_sync(&pdev->dev); 2101f280e89ad6a29d9969cb6b216123c798e1689bc4Mugunthan V N 2102aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack res = platform_get_resource(pdev, IORESOURCE_MEM, 1); 2103aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack priv->wr_regs = devm_ioremap_resource(&pdev->dev, res); 2104aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack if (IS_ERR(priv->wr_regs)) { 2105aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack ret = PTR_ERR(priv->wr_regs); 2106aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2107df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2108df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2109df828598a755732e717b0adca82f884e44d37576Mugunthan V N memset(&dma_params, 0, sizeof(dma_params)); 2110549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran memset(&ale_params, 0, sizeof(ale_params)); 2111549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 2112549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran switch (priv->version) { 2113549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran case CPSW_VERSION_1: 2114549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran priv->host_port_regs = ss_regs + CPSW1_HOST_PORT_OFFSET; 2115d97185466cc83902de49c7bea512651c7af12566Mugunthan V N priv->cpts->reg = ss_regs + CPSW1_CPTS_OFFSET; 2116d97185466cc83902de49c7bea512651c7af12566Mugunthan V N priv->hw_stats = ss_regs + CPSW1_HW_STATS; 2117549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.dmaregs = ss_regs + CPSW1_CPDMA_OFFSET; 2118549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.txhdp = ss_regs + CPSW1_STATERAM_OFFSET; 2119549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran ale_params.ale_regs = ss_regs + CPSW1_ALE_OFFSET; 2120549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave_offset = CPSW1_SLAVE_OFFSET; 2121549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave_size = CPSW1_SLAVE_SIZE; 2122549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran sliver_offset = CPSW1_SLIVER_OFFSET; 2123549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.desc_mem_phys = 0; 2124549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran break; 2125549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran case CPSW_VERSION_2: 2126c193f3655d9b916a3b8cb685c6b4327397507b2fMugunthan V N case CPSW_VERSION_3: 2127926489be1d2b030c17d38fa10b5921bf3409d91dMugunthan V N case CPSW_VERSION_4: 2128549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran priv->host_port_regs = ss_regs + CPSW2_HOST_PORT_OFFSET; 2129d97185466cc83902de49c7bea512651c7af12566Mugunthan V N priv->cpts->reg = ss_regs + CPSW2_CPTS_OFFSET; 2130d97185466cc83902de49c7bea512651c7af12566Mugunthan V N priv->hw_stats = ss_regs + CPSW2_HW_STATS; 2131549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.dmaregs = ss_regs + CPSW2_CPDMA_OFFSET; 2132549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.txhdp = ss_regs + CPSW2_STATERAM_OFFSET; 2133549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran ale_params.ale_regs = ss_regs + CPSW2_ALE_OFFSET; 2134549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave_offset = CPSW2_SLAVE_OFFSET; 2135549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave_size = CPSW2_SLAVE_SIZE; 2136549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran sliver_offset = CPSW2_SLIVER_OFFSET; 2137549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.desc_mem_phys = 2138aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack (u32 __force) ss_res->start + CPSW2_BD_OFFSET; 2139549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran break; 2140549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran default: 2141549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dev_err(priv->dev, "unknown version 0x%08x\n", priv->version); 2142549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran ret = -ENODEV; 2143aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2144549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran } 2145549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran for (i = 0; i < priv->data.slaves; i++) { 2146549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran struct cpsw_slave *slave = &priv->slaves[i]; 2147549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran cpsw_slave_init(slave, priv, slave_offset, sliver_offset); 2148549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran slave_offset += slave_size; 2149549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran sliver_offset += SLIVER_SIZE; 2150549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran } 2151549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran 2152df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.dev = &pdev->dev; 2153549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.rxthresh = dma_params.dmaregs + CPDMA_RXTHRESH; 2154549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.rxfree = dma_params.dmaregs + CPDMA_RXFREE; 2155549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.rxhdp = dma_params.txhdp + CPDMA_RXHDP; 2156549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.txcp = dma_params.txhdp + CPDMA_TXCP; 2157549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.rxcp = dma_params.txhdp + CPDMA_RXCP; 2158df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2159df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.num_chan = data->channels; 2160df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.has_soft_reset = true; 2161df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.min_packet_size = CPSW_MIN_PACKET_SIZE; 2162df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.desc_mem_size = data->bd_ram_size; 2163df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.desc_align = 16; 2164df828598a755732e717b0adca82f884e44d37576Mugunthan V N dma_params.has_ext_regs = true; 2165549985ee9c723fea8fd7759b5046fb8249896d50Richard Cochran dma_params.desc_hw_addr = dma_params.desc_mem_phys; 2166df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2167df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->dma = cpdma_ctlr_create(&dma_params); 2168df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!priv->dma) { 2169df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error initializing dma\n"); 2170df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = -ENOMEM; 2171aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_runtime_disable_ret; 2172df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2173df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2174df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->txch = cpdma_chan_create(priv->dma, tx_chan_num(0), 2175df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_tx_handler); 2176df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->rxch = cpdma_chan_create(priv->dma, rx_chan_num(0), 2177df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_rx_handler); 2178df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2179df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (WARN_ON(!priv->txch || !priv->rxch)) { 2180df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error initializing dma channels\n"); 2181df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = -ENOMEM; 2182df828598a755732e717b0adca82f884e44d37576Mugunthan V N goto clean_dma_ret; 2183df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2184df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2185df828598a755732e717b0adca82f884e44d37576Mugunthan V N ale_params.dev = &ndev->dev; 2186df828598a755732e717b0adca82f884e44d37576Mugunthan V N ale_params.ale_ageout = ale_ageout; 2187df828598a755732e717b0adca82f884e44d37576Mugunthan V N ale_params.ale_entries = data->ale_entries; 2188df828598a755732e717b0adca82f884e44d37576Mugunthan V N ale_params.ale_ports = data->slaves; 2189df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2190df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->ale = cpsw_ale_create(&ale_params); 2191df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (!priv->ale) { 2192df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error initializing ale engine\n"); 2193df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = -ENODEV; 2194df828598a755732e717b0adca82f884e44d37576Mugunthan V N goto clean_dma_ret; 2195df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2196df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2197df828598a755732e717b0adca82f884e44d37576Mugunthan V N ndev->irq = platform_get_irq(pdev, 0); 2198df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (ndev->irq < 0) { 2199df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error getting irq resource\n"); 2200df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = -ENOENT; 2201df828598a755732e717b0adca82f884e44d37576Mugunthan V N goto clean_ale_ret; 2202df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2203df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2204df828598a755732e717b0adca82f884e44d37576Mugunthan V N while ((res = platform_get_resource(priv->pdev, IORESOURCE_IRQ, k))) { 2205df828598a755732e717b0adca82f884e44d37576Mugunthan V N for (i = res->start; i <= res->end; i++) { 2206aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack if (devm_request_irq(&pdev->dev, i, cpsw_interrupt, 0, 2207db850559a303dc9459d7dd7339bd19a66907a15aMugunthan V N dev_name(&pdev->dev), priv)) { 2208df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error attaching irq\n"); 2209df828598a755732e717b0adca82f884e44d37576Mugunthan V N goto clean_ale_ret; 2210df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2211df828598a755732e717b0adca82f884e44d37576Mugunthan V N priv->irqs_table[k] = i; 2212d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior priv->num_irqs = k + 1; 2213df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2214df828598a755732e717b0adca82f884e44d37576Mugunthan V N k++; 2215df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2216df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2217f646968f8f7c624587de729115d802372b9063ddPatrick McHardy ndev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 2218df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2219df828598a755732e717b0adca82f884e44d37576Mugunthan V N ndev->netdev_ops = &cpsw_netdev_ops; 2220df828598a755732e717b0adca82f884e44d37576Mugunthan V N SET_ETHTOOL_OPS(ndev, &cpsw_ethtool_ops); 2221df828598a755732e717b0adca82f884e44d37576Mugunthan V N netif_napi_add(ndev, &priv->napi, cpsw_poll, CPSW_POLL_WEIGHT); 2222df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2223df828598a755732e717b0adca82f884e44d37576Mugunthan V N /* register the network device */ 2224df828598a755732e717b0adca82f884e44d37576Mugunthan V N SET_NETDEV_DEV(ndev, &pdev->dev); 2225df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = register_netdev(ndev); 2226df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (ret) { 2227df828598a755732e717b0adca82f884e44d37576Mugunthan V N dev_err(priv->dev, "error registering net device\n"); 2228df828598a755732e717b0adca82f884e44d37576Mugunthan V N ret = -ENODEV; 2229aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_ale_ret; 2230df828598a755732e717b0adca82f884e44d37576Mugunthan V N } 2231df828598a755732e717b0adca82f884e44d37576Mugunthan V N 22329232b16df2167c8afcb89de39ee85f5091ebacffMugunthan V N if (cpts_register(&pdev->dev, priv->cpts, 22332e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran data->cpts_clock_mult, data->cpts_clock_shift)) 22342e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran dev_err(priv->dev, "error registering cpts device\n"); 22352e5b38abcfad3049608a051826a5aaec2122cdacRichard Cochran 22361a3b50566f259eb79039b720dbfdbb97a7a1b9c5Olof Johansson cpsw_notice(priv, probe, "initialized device (regs %pa, irq %d)\n", 22371a3b50566f259eb79039b720dbfdbb97a7a1b9c5Olof Johansson &ss_res->start, ndev->irq); 2238df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2239d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (priv->data.dual_emac) { 2240d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N ret = cpsw_probe_dual_emac(pdev, priv); 2241d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N if (ret) { 2242d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N cpsw_err(priv, probe, "error probe slave 2 emac interface\n"); 2243aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mack goto clean_ale_ret; 2244d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 2245d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N } 2246d9ba8f9e6298af71ec1c1fd3d88c3ef68abd0ec3Mugunthan V N 2247df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 2248df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2249df828598a755732e717b0adca82f884e44d37576Mugunthan V Nclean_ale_ret: 2250df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_destroy(priv->ale); 2251df828598a755732e717b0adca82f884e44d37576Mugunthan V Nclean_dma_ret: 2252df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_destroy(priv->txch); 2253df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_destroy(priv->rxch); 2254df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_destroy(priv->dma); 2255aa1a15e2d9199711cdcc9399fdb22544ab835a83Daniel Mackclean_runtime_disable_ret: 2256f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_disable(&pdev->dev); 2257df828598a755732e717b0adca82f884e44d37576Mugunthan V Nclean_ndev_ret: 2258d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior free_netdev(priv->ndev); 2259df828598a755732e717b0adca82f884e44d37576Mugunthan V N return ret; 2260df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2261df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2262663e12e61d8764ce342588325d1050d9cb5460c0Bill Pembertonstatic int cpsw_remove(struct platform_device *pdev) 2263df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2264df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev = platform_get_drvdata(pdev); 2265df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 2266df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2267d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior if (priv->data.dual_emac) 2268d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior unregister_netdev(cpsw_get_slave_ndev(priv, 1)); 2269d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior unregister_netdev(ndev); 2270df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2271df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ale_destroy(priv->ale); 2272df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_destroy(priv->txch); 2273df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_chan_destroy(priv->rxch); 2274df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpdma_ctlr_destroy(priv->dma); 2275f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_disable(&pdev->dev); 2276d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior if (priv->data.dual_emac) 2277d1bd9acfa3419dc9d5c32589b34a370ca6ae100eSebastian Siewior free_netdev(cpsw_get_slave_ndev(priv, 1)); 2278df828598a755732e717b0adca82f884e44d37576Mugunthan V N free_netdev(ndev); 2279df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 2280df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2281df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2282df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int cpsw_suspend(struct device *dev) 2283df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2284df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct platform_device *pdev = to_platform_device(dev); 2285df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev = platform_get_drvdata(pdev); 2286b90fc27a64a57b273351ceef7ae298558ff8a6acMugunthan V N struct cpsw_priv *priv = netdev_priv(ndev); 2287df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2288df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_running(ndev)) 2289df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ndo_stop(ndev); 22901e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack 22911e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack for_each_slave(priv, soft_reset_slave); 22921e7a2e219ab6bc57ed901485a0d0be85235ebe61Daniel Mack 2293f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_put_sync(&pdev->dev); 2294f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N 2295739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N /* Select sleep pin state */ 2296739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N pinctrl_pm_select_sleep_state(&pdev->dev); 2297739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N 2298df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 2299df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2300df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2301df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int cpsw_resume(struct device *dev) 2302df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2303df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct platform_device *pdev = to_platform_device(dev); 2304df828598a755732e717b0adca82f884e44d37576Mugunthan V N struct net_device *ndev = platform_get_drvdata(pdev); 2305df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2306f150bd7f8cf742c4cdd0c929aa494ef72f7f5b13Mugunthan V N pm_runtime_get_sync(&pdev->dev); 2307739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N 2308739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N /* Select default pin state */ 2309739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N pinctrl_pm_select_default_state(&pdev->dev); 2310739683b48d088bd7dcf91bcd255d7340bb76ccbdMugunthan V N 2311df828598a755732e717b0adca82f884e44d37576Mugunthan V N if (netif_running(ndev)) 2312df828598a755732e717b0adca82f884e44d37576Mugunthan V N cpsw_ndo_open(ndev); 2313df828598a755732e717b0adca82f884e44d37576Mugunthan V N return 0; 2314df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2315df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2316df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic const struct dev_pm_ops cpsw_pm_ops = { 2317df828598a755732e717b0adca82f884e44d37576Mugunthan V N .suspend = cpsw_suspend, 2318df828598a755732e717b0adca82f884e44d37576Mugunthan V N .resume = cpsw_resume, 2319df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 2320df828598a755732e717b0adca82f884e44d37576Mugunthan V N 23212eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V Nstatic const struct of_device_id cpsw_of_mtable[] = { 23222eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N { .compatible = "ti,cpsw", }, 23232eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N { /* sentinel */ }, 23242eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N}; 23254bc21d4162366bb892dc1a4a92110c656e2622caSebastian SiewiorMODULE_DEVICE_TABLE(of, cpsw_of_mtable); 23262eb32b0a6f9d73fafc6b2c00ac0b705de13ae143Mugunthan V N 2327df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic struct platform_driver cpsw_driver = { 2328df828598a755732e717b0adca82f884e44d37576Mugunthan V N .driver = { 2329df828598a755732e717b0adca82f884e44d37576Mugunthan V N .name = "cpsw", 2330df828598a755732e717b0adca82f884e44d37576Mugunthan V N .owner = THIS_MODULE, 2331df828598a755732e717b0adca82f884e44d37576Mugunthan V N .pm = &cpsw_pm_ops, 23321e5c76d40fd41194472b4c1b369d7d63df0bea03Sachin Kamat .of_match_table = cpsw_of_mtable, 2333df828598a755732e717b0adca82f884e44d37576Mugunthan V N }, 2334df828598a755732e717b0adca82f884e44d37576Mugunthan V N .probe = cpsw_probe, 2335663e12e61d8764ce342588325d1050d9cb5460c0Bill Pemberton .remove = cpsw_remove, 2336df828598a755732e717b0adca82f884e44d37576Mugunthan V N}; 2337df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2338df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic int __init cpsw_init(void) 2339df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2340df828598a755732e717b0adca82f884e44d37576Mugunthan V N return platform_driver_register(&cpsw_driver); 2341df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2342df828598a755732e717b0adca82f884e44d37576Mugunthan V Nlate_initcall(cpsw_init); 2343df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2344df828598a755732e717b0adca82f884e44d37576Mugunthan V Nstatic void __exit cpsw_exit(void) 2345df828598a755732e717b0adca82f884e44d37576Mugunthan V N{ 2346df828598a755732e717b0adca82f884e44d37576Mugunthan V N platform_driver_unregister(&cpsw_driver); 2347df828598a755732e717b0adca82f884e44d37576Mugunthan V N} 2348df828598a755732e717b0adca82f884e44d37576Mugunthan V Nmodule_exit(cpsw_exit); 2349df828598a755732e717b0adca82f884e44d37576Mugunthan V N 2350df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_LICENSE("GPL"); 2351df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_AUTHOR("Cyril Chemparathy <cyril@ti.com>"); 2352df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_AUTHOR("Mugunthan V N <mugunthanvnm@ti.com>"); 2353df828598a755732e717b0adca82f884e44d37576Mugunthan V NMODULE_DESCRIPTION("TI CPSW Ethernet driver"); 2354