mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-04 09:34:12 +08:00
Merge branch 'systemport-lite'
Florian Fainelli says: ==================== net: systemport: Add support for SYSTEMPORT lite This patch series adds support for SYSTEMPORT Lite which is an evolution of the existing SYSTEMPORT adapter. The two generations are largely identical as far as the transmit/receive path are concerned, and there were just a few control path changes here and there. ==================== Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
David S. Miller
commit
b20b564b95
@ -1,7 +1,10 @@
|
||||
* Broadcom BCM7xxx Ethernet Systemport Controller (SYSTEMPORT)
|
||||
|
||||
Required properties:
|
||||
- compatible: should be one of "brcm,systemport-v1.00" or "brcm,systemport"
|
||||
- compatible: should be one of:
|
||||
"brcm,systemport-v1.00"
|
||||
"brcm,systemportlite-v1.00" or
|
||||
"brcm,systemport"
|
||||
- reg: address and length of the register set for the device.
|
||||
- interrupts: interrupts for the device, first cell must be for the rx
|
||||
interrupts, and the second cell should be for the transmit queues. An
|
||||
|
||||
@ -43,14 +43,43 @@ static inline void name##_writel(struct bcm_sysport_priv *priv, \
|
||||
BCM_SYSPORT_IO_MACRO(intrl2_0, SYS_PORT_INTRL2_0_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(intrl2_1, SYS_PORT_INTRL2_1_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(umac, SYS_PORT_UMAC_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(gib, SYS_PORT_GIB_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(tdma, SYS_PORT_TDMA_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(rdma, SYS_PORT_RDMA_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(rxchk, SYS_PORT_RXCHK_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(txchk, SYS_PORT_TXCHK_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(rbuf, SYS_PORT_RBUF_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(tbuf, SYS_PORT_TBUF_OFFSET);
|
||||
BCM_SYSPORT_IO_MACRO(topctrl, SYS_PORT_TOPCTRL_OFFSET);
|
||||
|
||||
/* On SYSTEMPORT Lite, any register after RDMA_STATUS has the exact
|
||||
* same layout, except it has been moved by 4 bytes up, *sigh*
|
||||
*/
|
||||
static inline u32 rdma_readl(struct bcm_sysport_priv *priv, u32 off)
|
||||
{
|
||||
if (priv->is_lite && off >= RDMA_STATUS)
|
||||
off += 4;
|
||||
return __raw_readl(priv->base + SYS_PORT_RDMA_OFFSET + off);
|
||||
}
|
||||
|
||||
static inline void rdma_writel(struct bcm_sysport_priv *priv, u32 val, u32 off)
|
||||
{
|
||||
if (priv->is_lite && off >= RDMA_STATUS)
|
||||
off += 4;
|
||||
__raw_writel(val, priv->base + SYS_PORT_RDMA_OFFSET + off);
|
||||
}
|
||||
|
||||
static inline u32 tdma_control_bit(struct bcm_sysport_priv *priv, u32 bit)
|
||||
{
|
||||
if (!priv->is_lite) {
|
||||
return BIT(bit);
|
||||
} else {
|
||||
if (bit >= ACB_ALGO)
|
||||
return BIT(bit + 1);
|
||||
else
|
||||
return BIT(bit);
|
||||
}
|
||||
}
|
||||
|
||||
/* L2-interrupt masking/unmasking helpers, does automatic saving of the applied
|
||||
* mask in a software copy to avoid CPU_MASK_STATUS reads in hot-paths.
|
||||
*/
|
||||
@ -143,9 +172,9 @@ static int bcm_sysport_set_tx_csum(struct net_device *dev,
|
||||
priv->tsb_en = !!(wanted & (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM));
|
||||
reg = tdma_readl(priv, TDMA_CONTROL);
|
||||
if (priv->tsb_en)
|
||||
reg |= TSB_EN;
|
||||
reg |= tdma_control_bit(priv, TSB_EN);
|
||||
else
|
||||
reg &= ~TSB_EN;
|
||||
reg &= ~tdma_control_bit(priv, TSB_EN);
|
||||
tdma_writel(priv, reg, TDMA_CONTROL);
|
||||
|
||||
return 0;
|
||||
@ -281,11 +310,35 @@ static void bcm_sysport_set_msglvl(struct net_device *dev, u32 enable)
|
||||
priv->msg_enable = enable;
|
||||
}
|
||||
|
||||
static inline bool bcm_sysport_lite_stat_valid(enum bcm_sysport_stat_type type)
|
||||
{
|
||||
switch (type) {
|
||||
case BCM_SYSPORT_STAT_NETDEV:
|
||||
case BCM_SYSPORT_STAT_RXCHK:
|
||||
case BCM_SYSPORT_STAT_RBUF:
|
||||
case BCM_SYSPORT_STAT_SOFT:
|
||||
return true;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
}
|
||||
|
||||
static int bcm_sysport_get_sset_count(struct net_device *dev, int string_set)
|
||||
{
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
const struct bcm_sysport_stats *s;
|
||||
unsigned int i, j;
|
||||
|
||||
switch (string_set) {
|
||||
case ETH_SS_STATS:
|
||||
return BCM_SYSPORT_STATS_LEN;
|
||||
for (i = 0, j = 0; i < BCM_SYSPORT_STATS_LEN; i++) {
|
||||
s = &bcm_sysport_gstrings_stats[i];
|
||||
if (priv->is_lite &&
|
||||
!bcm_sysport_lite_stat_valid(s->type))
|
||||
continue;
|
||||
j++;
|
||||
}
|
||||
return j;
|
||||
default:
|
||||
return -EOPNOTSUPP;
|
||||
}
|
||||
@ -294,14 +347,21 @@ static int bcm_sysport_get_sset_count(struct net_device *dev, int string_set)
|
||||
static void bcm_sysport_get_strings(struct net_device *dev,
|
||||
u32 stringset, u8 *data)
|
||||
{
|
||||
int i;
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
const struct bcm_sysport_stats *s;
|
||||
int i, j;
|
||||
|
||||
switch (stringset) {
|
||||
case ETH_SS_STATS:
|
||||
for (i = 0; i < BCM_SYSPORT_STATS_LEN; i++) {
|
||||
memcpy(data + i * ETH_GSTRING_LEN,
|
||||
bcm_sysport_gstrings_stats[i].stat_string,
|
||||
for (i = 0, j = 0; i < BCM_SYSPORT_STATS_LEN; i++) {
|
||||
s = &bcm_sysport_gstrings_stats[i];
|
||||
if (priv->is_lite &&
|
||||
!bcm_sysport_lite_stat_valid(s->type))
|
||||
continue;
|
||||
|
||||
memcpy(data + j * ETH_GSTRING_LEN, s->stat_string,
|
||||
ETH_GSTRING_LEN);
|
||||
j++;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
@ -327,6 +387,9 @@ static void bcm_sysport_update_mib_counters(struct bcm_sysport_priv *priv)
|
||||
case BCM_SYSPORT_STAT_MIB_RX:
|
||||
case BCM_SYSPORT_STAT_MIB_TX:
|
||||
case BCM_SYSPORT_STAT_RUNT:
|
||||
if (priv->is_lite)
|
||||
continue;
|
||||
|
||||
if (s->type != BCM_SYSPORT_STAT_MIB_RX)
|
||||
offset = UMAC_MIB_STAT_OFFSET;
|
||||
val = umac_readl(priv, UMAC_MIB_START + j + offset);
|
||||
@ -355,12 +418,12 @@ static void bcm_sysport_get_stats(struct net_device *dev,
|
||||
struct ethtool_stats *stats, u64 *data)
|
||||
{
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
int i;
|
||||
int i, j;
|
||||
|
||||
if (netif_running(dev))
|
||||
bcm_sysport_update_mib_counters(priv);
|
||||
|
||||
for (i = 0; i < BCM_SYSPORT_STATS_LEN; i++) {
|
||||
for (i = 0, j = 0; i < BCM_SYSPORT_STATS_LEN; i++) {
|
||||
const struct bcm_sysport_stats *s;
|
||||
char *p;
|
||||
|
||||
@ -370,7 +433,8 @@ static void bcm_sysport_get_stats(struct net_device *dev,
|
||||
else
|
||||
p = (char *)priv;
|
||||
p += s->stat_offset;
|
||||
data[i] = *(unsigned long *)p;
|
||||
data[j] = *(unsigned long *)p;
|
||||
j++;
|
||||
}
|
||||
}
|
||||
|
||||
@ -573,8 +637,14 @@ static unsigned int bcm_sysport_desc_rx(struct bcm_sysport_priv *priv,
|
||||
u16 len, status;
|
||||
struct bcm_rsb *rsb;
|
||||
|
||||
/* Determine how much we should process since last call */
|
||||
p_index = rdma_readl(priv, RDMA_PROD_INDEX);
|
||||
/* Determine how much we should process since last call, SYSTEMPORT Lite
|
||||
* groups the producer and consumer indexes into the same 32-bit
|
||||
* which we access using RDMA_CONS_INDEX
|
||||
*/
|
||||
if (!priv->is_lite)
|
||||
p_index = rdma_readl(priv, RDMA_PROD_INDEX);
|
||||
else
|
||||
p_index = rdma_readl(priv, RDMA_CONS_INDEX);
|
||||
p_index &= RDMA_PROD_INDEX_MASK;
|
||||
|
||||
if (p_index < priv->rx_c_index)
|
||||
@ -791,7 +861,11 @@ static int bcm_sysport_tx_poll(struct napi_struct *napi, int budget)
|
||||
if (work_done == 0) {
|
||||
napi_complete(napi);
|
||||
/* re-enable TX interrupt */
|
||||
intrl2_1_mask_clear(ring->priv, BIT(ring->index));
|
||||
if (!ring->priv->is_lite)
|
||||
intrl2_1_mask_clear(ring->priv, BIT(ring->index));
|
||||
else
|
||||
intrl2_0_mask_clear(ring->priv, BIT(ring->index +
|
||||
INTRL2_0_TDMA_MBDONE_SHIFT));
|
||||
|
||||
return 0;
|
||||
}
|
||||
@ -817,7 +891,15 @@ static int bcm_sysport_poll(struct napi_struct *napi, int budget)
|
||||
|
||||
priv->rx_c_index += work_done;
|
||||
priv->rx_c_index &= RDMA_CONS_INDEX_MASK;
|
||||
rdma_writel(priv, priv->rx_c_index, RDMA_CONS_INDEX);
|
||||
|
||||
/* SYSTEMPORT Lite groups the producer/consumer index, producer is
|
||||
* maintained by HW, but writes to it will be ignore while RDMA
|
||||
* is active
|
||||
*/
|
||||
if (!priv->is_lite)
|
||||
rdma_writel(priv, priv->rx_c_index, RDMA_CONS_INDEX);
|
||||
else
|
||||
rdma_writel(priv, priv->rx_c_index << 16, RDMA_CONS_INDEX);
|
||||
|
||||
if (work_done < budget) {
|
||||
napi_complete_done(napi, work_done);
|
||||
@ -848,6 +930,8 @@ static irqreturn_t bcm_sysport_rx_isr(int irq, void *dev_id)
|
||||
{
|
||||
struct net_device *dev = dev_id;
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
struct bcm_sysport_tx_ring *txr;
|
||||
unsigned int ring, ring_bit;
|
||||
|
||||
priv->irq0_stat = intrl2_0_readl(priv, INTRL2_CPU_STATUS) &
|
||||
~intrl2_0_readl(priv, INTRL2_CPU_MASK_STATUS);
|
||||
@ -877,6 +961,22 @@ static irqreturn_t bcm_sysport_rx_isr(int irq, void *dev_id)
|
||||
bcm_sysport_resume_from_wol(priv);
|
||||
}
|
||||
|
||||
if (!priv->is_lite)
|
||||
goto out;
|
||||
|
||||
for (ring = 0; ring < dev->num_tx_queues; ring++) {
|
||||
ring_bit = BIT(ring + INTRL2_0_TDMA_MBDONE_SHIFT);
|
||||
if (!(priv->irq0_stat & ring_bit))
|
||||
continue;
|
||||
|
||||
txr = &priv->tx_rings[ring];
|
||||
|
||||
if (likely(napi_schedule_prep(&txr->napi))) {
|
||||
intrl2_0_mask_set(priv, ring_bit);
|
||||
__napi_schedule(&txr->napi);
|
||||
}
|
||||
}
|
||||
out:
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
@ -930,9 +1030,11 @@ static void bcm_sysport_poll_controller(struct net_device *dev)
|
||||
bcm_sysport_rx_isr(priv->irq0, priv);
|
||||
enable_irq(priv->irq0);
|
||||
|
||||
disable_irq(priv->irq1);
|
||||
bcm_sysport_tx_isr(priv->irq1, priv);
|
||||
enable_irq(priv->irq1);
|
||||
if (!priv->is_lite) {
|
||||
disable_irq(priv->irq1);
|
||||
bcm_sysport_tx_isr(priv->irq1, priv);
|
||||
enable_irq(priv->irq1);
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
@ -1129,6 +1231,9 @@ static void bcm_sysport_adj_link(struct net_device *dev)
|
||||
priv->old_duplex = phydev->duplex;
|
||||
}
|
||||
|
||||
if (priv->is_lite)
|
||||
goto out;
|
||||
|
||||
switch (phydev->speed) {
|
||||
case SPEED_2500:
|
||||
cmd_bits = CMD_SPEED_2500;
|
||||
@ -1169,8 +1274,9 @@ static void bcm_sysport_adj_link(struct net_device *dev)
|
||||
reg |= cmd_bits;
|
||||
umac_writel(priv, reg, UMAC_CMD);
|
||||
}
|
||||
|
||||
phy_print_status(phydev);
|
||||
out:
|
||||
if (changed)
|
||||
phy_print_status(phydev);
|
||||
}
|
||||
|
||||
static int bcm_sysport_init_tx_ring(struct bcm_sysport_priv *priv,
|
||||
@ -1315,9 +1421,9 @@ static inline int tdma_enable_set(struct bcm_sysport_priv *priv,
|
||||
|
||||
reg = tdma_readl(priv, TDMA_CONTROL);
|
||||
if (enable)
|
||||
reg |= TDMA_EN;
|
||||
reg |= tdma_control_bit(priv, TDMA_EN);
|
||||
else
|
||||
reg &= ~TDMA_EN;
|
||||
reg &= ~tdma_control_bit(priv, TDMA_EN);
|
||||
tdma_writel(priv, reg, TDMA_CONTROL);
|
||||
|
||||
/* Poll for TMDA disabling completion */
|
||||
@ -1342,7 +1448,7 @@ static int bcm_sysport_init_rx_ring(struct bcm_sysport_priv *priv)
|
||||
int i;
|
||||
|
||||
/* Initialize SW view of the RX ring */
|
||||
priv->num_rx_bds = NUM_RX_DESC;
|
||||
priv->num_rx_bds = priv->num_rx_desc_words / WORDS_PER_DESC;
|
||||
priv->rx_bds = priv->base + SYS_PORT_RDMA_OFFSET;
|
||||
priv->rx_c_index = 0;
|
||||
priv->rx_read_ptr = 0;
|
||||
@ -1379,7 +1485,7 @@ static int bcm_sysport_init_rx_ring(struct bcm_sysport_priv *priv)
|
||||
rdma_writel(priv, 0, RDMA_START_ADDR_HI);
|
||||
rdma_writel(priv, 0, RDMA_START_ADDR_LO);
|
||||
rdma_writel(priv, 0, RDMA_END_ADDR_HI);
|
||||
rdma_writel(priv, NUM_HW_RX_DESC_WORDS - 1, RDMA_END_ADDR_LO);
|
||||
rdma_writel(priv, priv->num_rx_desc_words - 1, RDMA_END_ADDR_LO);
|
||||
|
||||
rdma_writel(priv, 1, RDMA_MBDONE_INTR);
|
||||
|
||||
@ -1421,6 +1527,9 @@ static void bcm_sysport_set_rx_mode(struct net_device *dev)
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
u32 reg;
|
||||
|
||||
if (priv->is_lite)
|
||||
return;
|
||||
|
||||
reg = umac_readl(priv, UMAC_CMD);
|
||||
if (dev->flags & IFF_PROMISC)
|
||||
reg |= CMD_PROMISC;
|
||||
@ -1438,12 +1547,21 @@ static inline void umac_enable_set(struct bcm_sysport_priv *priv,
|
||||
{
|
||||
u32 reg;
|
||||
|
||||
reg = umac_readl(priv, UMAC_CMD);
|
||||
if (enable)
|
||||
reg |= mask;
|
||||
else
|
||||
reg &= ~mask;
|
||||
umac_writel(priv, reg, UMAC_CMD);
|
||||
if (!priv->is_lite) {
|
||||
reg = umac_readl(priv, UMAC_CMD);
|
||||
if (enable)
|
||||
reg |= mask;
|
||||
else
|
||||
reg &= ~mask;
|
||||
umac_writel(priv, reg, UMAC_CMD);
|
||||
} else {
|
||||
reg = gib_readl(priv, GIB_CONTROL);
|
||||
if (enable)
|
||||
reg |= mask;
|
||||
else
|
||||
reg &= ~mask;
|
||||
gib_writel(priv, reg, GIB_CONTROL);
|
||||
}
|
||||
|
||||
/* UniMAC stops on a packet boundary, wait for a full-sized packet
|
||||
* to be processed (1 msec).
|
||||
@ -1456,6 +1574,9 @@ static inline void umac_reset(struct bcm_sysport_priv *priv)
|
||||
{
|
||||
u32 reg;
|
||||
|
||||
if (priv->is_lite)
|
||||
return;
|
||||
|
||||
reg = umac_readl(priv, UMAC_CMD);
|
||||
reg |= CMD_SW_RESET;
|
||||
umac_writel(priv, reg, UMAC_CMD);
|
||||
@ -1468,9 +1589,17 @@ static inline void umac_reset(struct bcm_sysport_priv *priv)
|
||||
static void umac_set_hw_addr(struct bcm_sysport_priv *priv,
|
||||
unsigned char *addr)
|
||||
{
|
||||
umac_writel(priv, (addr[0] << 24) | (addr[1] << 16) |
|
||||
(addr[2] << 8) | addr[3], UMAC_MAC0);
|
||||
umac_writel(priv, (addr[4] << 8) | addr[5], UMAC_MAC1);
|
||||
u32 mac0 = (addr[0] << 24) | (addr[1] << 16) | (addr[2] << 8) |
|
||||
addr[3];
|
||||
u32 mac1 = (addr[4] << 8) | addr[5];
|
||||
|
||||
if (!priv->is_lite) {
|
||||
umac_writel(priv, mac0, UMAC_MAC0);
|
||||
umac_writel(priv, mac1, UMAC_MAC1);
|
||||
} else {
|
||||
gib_writel(priv, mac0, GIB_MAC0);
|
||||
gib_writel(priv, mac1, GIB_MAC1);
|
||||
}
|
||||
}
|
||||
|
||||
static void topctrl_flush(struct bcm_sysport_priv *priv)
|
||||
@ -1515,8 +1644,11 @@ static void bcm_sysport_netif_start(struct net_device *dev)
|
||||
|
||||
phy_start(dev->phydev);
|
||||
|
||||
/* Enable TX interrupts for the 32 TXQs */
|
||||
intrl2_1_mask_clear(priv, 0xffffffff);
|
||||
/* Enable TX interrupts for the TXQs */
|
||||
if (!priv->is_lite)
|
||||
intrl2_1_mask_clear(priv, 0xffffffff);
|
||||
else
|
||||
intrl2_0_mask_clear(priv, INTRL2_0_TDMA_MBDONE_MASK);
|
||||
|
||||
/* Last call before we start the real business */
|
||||
netif_tx_start_all_queues(dev);
|
||||
@ -1528,9 +1660,37 @@ static void rbuf_init(struct bcm_sysport_priv *priv)
|
||||
|
||||
reg = rbuf_readl(priv, RBUF_CONTROL);
|
||||
reg |= RBUF_4B_ALGN | RBUF_RSB_EN;
|
||||
/* Set a correct RSB format on SYSTEMPORT Lite */
|
||||
if (priv->is_lite) {
|
||||
reg &= ~RBUF_RSB_SWAP1;
|
||||
reg |= RBUF_RSB_SWAP0;
|
||||
}
|
||||
rbuf_writel(priv, reg, RBUF_CONTROL);
|
||||
}
|
||||
|
||||
static inline void bcm_sysport_mask_all_intrs(struct bcm_sysport_priv *priv)
|
||||
{
|
||||
intrl2_0_mask_set(priv, 0xffffffff);
|
||||
intrl2_0_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
if (!priv->is_lite) {
|
||||
intrl2_1_mask_set(priv, 0xffffffff);
|
||||
intrl2_1_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
}
|
||||
}
|
||||
|
||||
static inline void gib_set_pad_extension(struct bcm_sysport_priv *priv)
|
||||
{
|
||||
u32 __maybe_unused reg;
|
||||
|
||||
/* Include Broadcom tag in pad extension */
|
||||
if (netdev_uses_dsa(priv->netdev)) {
|
||||
reg = gib_readl(priv, GIB_CONTROL);
|
||||
reg &= ~(GIB_PAD_EXTENSION_MASK << GIB_PAD_EXTENSION_SHIFT);
|
||||
reg |= ENET_BRCM_TAG_LEN << GIB_PAD_EXTENSION_SHIFT;
|
||||
gib_writel(priv, reg, GIB_CONTROL);
|
||||
}
|
||||
}
|
||||
|
||||
static int bcm_sysport_open(struct net_device *dev)
|
||||
{
|
||||
struct bcm_sysport_priv *priv = netdev_priv(dev);
|
||||
@ -1551,13 +1711,20 @@ static int bcm_sysport_open(struct net_device *dev)
|
||||
rbuf_init(priv);
|
||||
|
||||
/* Set maximum frame length */
|
||||
umac_writel(priv, UMAC_MAX_MTU_SIZE, UMAC_MAX_FRAME_LEN);
|
||||
if (!priv->is_lite)
|
||||
umac_writel(priv, UMAC_MAX_MTU_SIZE, UMAC_MAX_FRAME_LEN);
|
||||
else
|
||||
gib_set_pad_extension(priv);
|
||||
|
||||
/* Set MAC address */
|
||||
umac_set_hw_addr(priv, dev->dev_addr);
|
||||
|
||||
/* Read CRC forward */
|
||||
priv->crc_fwd = !!(umac_readl(priv, UMAC_CMD) & CMD_CRC_FWD);
|
||||
if (!priv->is_lite)
|
||||
priv->crc_fwd = !!(umac_readl(priv, UMAC_CMD) & CMD_CRC_FWD);
|
||||
else
|
||||
priv->crc_fwd = !!(gib_readl(priv, GIB_CONTROL) &
|
||||
GIB_FCS_STRIP);
|
||||
|
||||
phydev = of_phy_connect(dev, priv->phy_dn, bcm_sysport_adj_link,
|
||||
0, priv->phy_interface);
|
||||
@ -1572,12 +1739,7 @@ static int bcm_sysport_open(struct net_device *dev)
|
||||
priv->old_pause = -1;
|
||||
|
||||
/* mask all interrupts and request them */
|
||||
intrl2_0_writel(priv, 0xffffffff, INTRL2_CPU_MASK_SET);
|
||||
intrl2_0_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
intrl2_0_writel(priv, 0, INTRL2_CPU_MASK_CLEAR);
|
||||
intrl2_1_writel(priv, 0xffffffff, INTRL2_CPU_MASK_SET);
|
||||
intrl2_1_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
intrl2_1_writel(priv, 0, INTRL2_CPU_MASK_CLEAR);
|
||||
bcm_sysport_mask_all_intrs(priv);
|
||||
|
||||
ret = request_irq(priv->irq0, bcm_sysport_rx_isr, 0, dev->name, dev);
|
||||
if (ret) {
|
||||
@ -1585,10 +1747,13 @@ static int bcm_sysport_open(struct net_device *dev)
|
||||
goto out_phy_disconnect;
|
||||
}
|
||||
|
||||
ret = request_irq(priv->irq1, bcm_sysport_tx_isr, 0, dev->name, dev);
|
||||
if (ret) {
|
||||
netdev_err(dev, "failed to request TX interrupt\n");
|
||||
goto out_free_irq0;
|
||||
if (!priv->is_lite) {
|
||||
ret = request_irq(priv->irq1, bcm_sysport_tx_isr, 0,
|
||||
dev->name, dev);
|
||||
if (ret) {
|
||||
netdev_err(dev, "failed to request TX interrupt\n");
|
||||
goto out_free_irq0;
|
||||
}
|
||||
}
|
||||
|
||||
/* Initialize both hardware and software ring */
|
||||
@ -1635,7 +1800,8 @@ out_free_rx_ring:
|
||||
out_free_tx_ring:
|
||||
for (i = 0; i < dev->num_tx_queues; i++)
|
||||
bcm_sysport_fini_tx_ring(priv, i);
|
||||
free_irq(priv->irq1, dev);
|
||||
if (!priv->is_lite)
|
||||
free_irq(priv->irq1, dev);
|
||||
out_free_irq0:
|
||||
free_irq(priv->irq0, dev);
|
||||
out_phy_disconnect:
|
||||
@ -1653,10 +1819,7 @@ static void bcm_sysport_netif_stop(struct net_device *dev)
|
||||
phy_stop(dev->phydev);
|
||||
|
||||
/* mask all interrupts */
|
||||
intrl2_0_mask_set(priv, 0xffffffff);
|
||||
intrl2_0_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
intrl2_1_mask_set(priv, 0xffffffff);
|
||||
intrl2_1_writel(priv, 0xffffffff, INTRL2_CPU_CLEAR);
|
||||
bcm_sysport_mask_all_intrs(priv);
|
||||
}
|
||||
|
||||
static int bcm_sysport_stop(struct net_device *dev)
|
||||
@ -1694,7 +1857,8 @@ static int bcm_sysport_stop(struct net_device *dev)
|
||||
bcm_sysport_fini_rx_ring(priv);
|
||||
|
||||
free_irq(priv->irq0, dev);
|
||||
free_irq(priv->irq1, dev);
|
||||
if (!priv->is_lite)
|
||||
free_irq(priv->irq1, dev);
|
||||
|
||||
/* Disconnect from PHY */
|
||||
phy_disconnect(dev->phydev);
|
||||
@ -1733,8 +1897,32 @@ static const struct net_device_ops bcm_sysport_netdev_ops = {
|
||||
|
||||
#define REV_FMT "v%2x.%02x"
|
||||
|
||||
static const struct bcm_sysport_hw_params bcm_sysport_params[] = {
|
||||
[SYSTEMPORT] = {
|
||||
.is_lite = false,
|
||||
.num_rx_desc_words = SP_NUM_HW_RX_DESC_WORDS,
|
||||
},
|
||||
[SYSTEMPORT_LITE] = {
|
||||
.is_lite = true,
|
||||
.num_rx_desc_words = SP_LT_NUM_HW_RX_DESC_WORDS,
|
||||
},
|
||||
};
|
||||
|
||||
static const struct of_device_id bcm_sysport_of_match[] = {
|
||||
{ .compatible = "brcm,systemportlite-v1.00",
|
||||
.data = &bcm_sysport_params[SYSTEMPORT_LITE] },
|
||||
{ .compatible = "brcm,systemport-v1.00",
|
||||
.data = &bcm_sysport_params[SYSTEMPORT] },
|
||||
{ .compatible = "brcm,systemport",
|
||||
.data = &bcm_sysport_params[SYSTEMPORT] },
|
||||
{ /* sentinel */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, bcm_sysport_of_match);
|
||||
|
||||
static int bcm_sysport_probe(struct platform_device *pdev)
|
||||
{
|
||||
const struct bcm_sysport_hw_params *params;
|
||||
const struct of_device_id *of_id = NULL;
|
||||
struct bcm_sysport_priv *priv;
|
||||
struct device_node *dn;
|
||||
struct net_device *dev;
|
||||
@ -1745,6 +1933,12 @@ static int bcm_sysport_probe(struct platform_device *pdev)
|
||||
|
||||
dn = pdev->dev.of_node;
|
||||
r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
of_id = of_match_node(bcm_sysport_of_match, dn);
|
||||
if (!of_id || !of_id->data)
|
||||
return -EINVAL;
|
||||
|
||||
/* Fairly quickly we need to know the type of adapter we have */
|
||||
params = of_id->data;
|
||||
|
||||
/* Read the Transmit/Receive Queue properties */
|
||||
if (of_property_read_u32(dn, "systemport,num-txq", &txq))
|
||||
@ -1752,6 +1946,10 @@ static int bcm_sysport_probe(struct platform_device *pdev)
|
||||
if (of_property_read_u32(dn, "systemport,num-rxq", &rxq))
|
||||
rxq = 1;
|
||||
|
||||
/* Sanity check the number of transmit queues */
|
||||
if (!txq || txq > TDMA_NUM_RINGS)
|
||||
return -EINVAL;
|
||||
|
||||
dev = alloc_etherdev_mqs(sizeof(*priv), txq, rxq);
|
||||
if (!dev)
|
||||
return -ENOMEM;
|
||||
@ -1759,10 +1957,21 @@ static int bcm_sysport_probe(struct platform_device *pdev)
|
||||
/* Initialize private members */
|
||||
priv = netdev_priv(dev);
|
||||
|
||||
/* Allocate number of TX rings */
|
||||
priv->tx_rings = devm_kcalloc(&pdev->dev, txq,
|
||||
sizeof(struct bcm_sysport_tx_ring),
|
||||
GFP_KERNEL);
|
||||
if (!priv->tx_rings)
|
||||
return -ENOMEM;
|
||||
|
||||
priv->is_lite = params->is_lite;
|
||||
priv->num_rx_desc_words = params->num_rx_desc_words;
|
||||
|
||||
priv->irq0 = platform_get_irq(pdev, 0);
|
||||
priv->irq1 = platform_get_irq(pdev, 1);
|
||||
if (!priv->is_lite)
|
||||
priv->irq1 = platform_get_irq(pdev, 1);
|
||||
priv->wol_irq = platform_get_irq(pdev, 2);
|
||||
if (priv->irq0 <= 0 || priv->irq1 <= 0) {
|
||||
if (priv->irq0 <= 0 || (priv->irq1 <= 0 && !priv->is_lite)) {
|
||||
dev_err(&pdev->dev, "invalid interrupts\n");
|
||||
ret = -EINVAL;
|
||||
goto err_free_netdev;
|
||||
@ -1836,8 +2045,9 @@ static int bcm_sysport_probe(struct platform_device *pdev)
|
||||
|
||||
priv->rev = topctrl_readl(priv, REV_CNTL) & REV_MASK;
|
||||
dev_info(&pdev->dev,
|
||||
"Broadcom SYSTEMPORT" REV_FMT
|
||||
"Broadcom SYSTEMPORT%s" REV_FMT
|
||||
" at 0x%p (irqs: %d, %d, TXQs: %d, RXQs: %d)\n",
|
||||
priv->is_lite ? " Lite" : "",
|
||||
(priv->rev >> 8) & 0xff, priv->rev & 0xff,
|
||||
priv->base, priv->irq0, priv->irq1, txq, rxq);
|
||||
|
||||
@ -2033,7 +2243,10 @@ static int bcm_sysport_resume(struct device *d)
|
||||
rbuf_init(priv);
|
||||
|
||||
/* Set maximum frame length */
|
||||
umac_writel(priv, UMAC_MAX_MTU_SIZE, UMAC_MAX_FRAME_LEN);
|
||||
if (!priv->is_lite)
|
||||
umac_writel(priv, UMAC_MAX_MTU_SIZE, UMAC_MAX_FRAME_LEN);
|
||||
else
|
||||
gib_set_pad_extension(priv);
|
||||
|
||||
/* Set MAC address */
|
||||
umac_set_hw_addr(priv, dev->dev_addr);
|
||||
@ -2069,13 +2282,6 @@ out_free_tx_rings:
|
||||
static SIMPLE_DEV_PM_OPS(bcm_sysport_pm_ops,
|
||||
bcm_sysport_suspend, bcm_sysport_resume);
|
||||
|
||||
static const struct of_device_id bcm_sysport_of_match[] = {
|
||||
{ .compatible = "brcm,systemport-v1.00" },
|
||||
{ .compatible = "brcm,systemport" },
|
||||
{ /* sentinel */ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(of, bcm_sysport_of_match);
|
||||
|
||||
static struct platform_driver bcm_sysport_driver = {
|
||||
.probe = bcm_sysport_probe,
|
||||
.remove = bcm_sysport_remove,
|
||||
|
||||
@ -127,6 +127,10 @@ struct bcm_rsb {
|
||||
#define INTRL2_0_DESC_ALLOC_ERR (1 << 10)
|
||||
#define INTRL2_0_UNEXP_PKTSIZE_ACK (1 << 11)
|
||||
|
||||
/* SYSTEMPORT Lite groups the TX queues interrupts on instance 0 */
|
||||
#define INTRL2_0_TDMA_MBDONE_SHIFT 12
|
||||
#define INTRL2_0_TDMA_MBDONE_MASK (0xffff << INTRL2_0_TDMA_MBDONE_SHIFT)
|
||||
|
||||
/* RXCHK offset and defines */
|
||||
#define SYS_PORT_RXCHK_OFFSET 0x300
|
||||
|
||||
@ -176,7 +180,9 @@ struct bcm_rsb {
|
||||
#define RBUF_OK_TO_SEND_MASK 0xff
|
||||
#define RBUF_CRC_REPLACE (1 << 20)
|
||||
#define RBUF_OK_TO_SEND_MODE (1 << 21)
|
||||
#define RBUF_RSB_SWAP (1 << 22)
|
||||
/* SYSTEMPORT Lite uses two bits here */
|
||||
#define RBUF_RSB_SWAP0 (1 << 22)
|
||||
#define RBUF_RSB_SWAP1 (1 << 23)
|
||||
#define RBUF_ACPI_EN (1 << 23)
|
||||
|
||||
#define RBUF_PKT_RDY_THRESH 0x04
|
||||
@ -247,6 +253,7 @@ struct bcm_rsb {
|
||||
#define MIB_RUNT_CNT_RST (1 << 1)
|
||||
#define MIB_TX_CNT_RST (1 << 2)
|
||||
|
||||
/* These offsets are valid for SYSTEMPORT and SYSTEMPORT Lite */
|
||||
#define UMAC_MPD_CTRL 0x620
|
||||
#define MPD_EN (1 << 0)
|
||||
#define MSEQ_LEN_SHIFT 16
|
||||
@ -258,6 +265,34 @@ struct bcm_rsb {
|
||||
#define UMAC_MDF_CTRL 0x650
|
||||
#define UMAC_MDF_ADDR 0x654
|
||||
|
||||
/* Only valid on SYSTEMPORT Lite */
|
||||
#define SYS_PORT_GIB_OFFSET 0x1000
|
||||
|
||||
#define GIB_CONTROL 0x00
|
||||
#define GIB_TX_EN (1 << 0)
|
||||
#define GIB_RX_EN (1 << 1)
|
||||
#define GIB_TX_FLUSH (1 << 2)
|
||||
#define GIB_RX_FLUSH (1 << 3)
|
||||
#define GIB_GTX_CLK_SEL_SHIFT 4
|
||||
#define GIB_GTX_CLK_EXT_CLK (0 << GIB_GTX_CLK_SEL_SHIFT)
|
||||
#define GIB_GTX_CLK_125MHZ (1 << GIB_GTX_CLK_SEL_SHIFT)
|
||||
#define GIB_GTX_CLK_250MHZ (2 << GIB_GTX_CLK_SEL_SHIFT)
|
||||
#define GIB_FCS_STRIP (1 << 6)
|
||||
#define GIB_LCL_LOOP_EN (1 << 7)
|
||||
#define GIB_LCL_LOOP_TXEN (1 << 8)
|
||||
#define GIB_RMT_LOOP_EN (1 << 9)
|
||||
#define GIB_RMT_LOOP_RXEN (1 << 10)
|
||||
#define GIB_RX_PAUSE_EN (1 << 11)
|
||||
#define GIB_PREAMBLE_LEN_SHIFT 12
|
||||
#define GIB_PREAMBLE_LEN_MASK 0xf
|
||||
#define GIB_IPG_LEN_SHIFT 16
|
||||
#define GIB_IPG_LEN_MASK 0x3f
|
||||
#define GIB_PAD_EXTENSION_SHIFT 22
|
||||
#define GIB_PAD_EXTENSION_MASK 0x3f
|
||||
|
||||
#define GIB_MAC1 0x08
|
||||
#define GIB_MAC0 0x0c
|
||||
|
||||
/* Receive DMA offset and defines */
|
||||
#define SYS_PORT_RDMA_OFFSET 0x2000
|
||||
|
||||
@ -409,16 +444,19 @@ struct bcm_rsb {
|
||||
RING_PCP_DEI_VID)
|
||||
|
||||
#define TDMA_CONTROL 0x600
|
||||
#define TDMA_EN (1 << 0)
|
||||
#define TSB_EN (1 << 1)
|
||||
#define TSB_SWAP (1 << 2)
|
||||
#define ACB_ALGO (1 << 3)
|
||||
#define TDMA_EN 0
|
||||
#define TSB_EN 1
|
||||
/* Uses 2 bits on SYSTEMPORT Lite and shifts everything by 1 bit, we
|
||||
* keep the SYSTEMPORT layout here and adjust with tdma_control_bit()
|
||||
*/
|
||||
#define TSB_SWAP 2
|
||||
#define ACB_ALGO 3
|
||||
#define BUF_DATA_OFFSET_SHIFT 4
|
||||
#define BUF_DATA_OFFSET_MASK 0x3ff
|
||||
#define VLAN_EN (1 << 14)
|
||||
#define SW_BRCM_TAG (1 << 15)
|
||||
#define WNC_KPT_SIZE_UPDATE (1 << 16)
|
||||
#define SYNC_PKT_SIZE (1 << 17)
|
||||
#define VLAN_EN 14
|
||||
#define SW_BRCM_TAG 15
|
||||
#define WNC_KPT_SIZE_UPDATE 16
|
||||
#define SYNC_PKT_SIZE 17
|
||||
#define ACH_TXDONE_DELAY_SHIFT 18
|
||||
#define ACH_TXDONE_DELAY_MASK 0xff
|
||||
|
||||
@ -475,12 +513,12 @@ struct dma_desc {
|
||||
};
|
||||
|
||||
/* Number of Receive hardware descriptor words */
|
||||
#define NUM_HW_RX_DESC_WORDS 1024
|
||||
/* Real number of usable descriptors */
|
||||
#define NUM_RX_DESC (NUM_HW_RX_DESC_WORDS / WORDS_PER_DESC)
|
||||
#define SP_NUM_HW_RX_DESC_WORDS 1024
|
||||
#define SP_LT_NUM_HW_RX_DESC_WORDS 256
|
||||
|
||||
/* Internal linked-list RAM has up to 1536 entries */
|
||||
#define NUM_TX_DESC 1536
|
||||
/* Internal linked-list RAM size */
|
||||
#define SP_NUM_TX_DESC 1536
|
||||
#define SP_LT_NUM_TX_DESC 256
|
||||
|
||||
#define WORDS_PER_DESC (sizeof(struct dma_desc) / sizeof(u32))
|
||||
|
||||
@ -627,6 +665,16 @@ struct bcm_sysport_cb {
|
||||
DEFINE_DMA_UNMAP_LEN(dma_len);
|
||||
};
|
||||
|
||||
enum bcm_sysport_type {
|
||||
SYSTEMPORT = 0,
|
||||
SYSTEMPORT_LITE,
|
||||
};
|
||||
|
||||
struct bcm_sysport_hw_params {
|
||||
bool is_lite;
|
||||
unsigned int num_rx_desc_words;
|
||||
};
|
||||
|
||||
/* Software view of the TX ring */
|
||||
struct bcm_sysport_tx_ring {
|
||||
spinlock_t lock; /* Ring lock for tx reclaim/xmit */
|
||||
@ -651,6 +699,8 @@ struct bcm_sysport_priv {
|
||||
u32 irq0_mask;
|
||||
u32 irq1_stat;
|
||||
u32 irq1_mask;
|
||||
bool is_lite;
|
||||
unsigned int num_rx_desc_words;
|
||||
struct napi_struct napi ____cacheline_aligned;
|
||||
struct net_device *netdev;
|
||||
struct platform_device *pdev;
|
||||
@ -659,7 +709,7 @@ struct bcm_sysport_priv {
|
||||
int wol_irq;
|
||||
|
||||
/* Transmit rings */
|
||||
struct bcm_sysport_tx_ring tx_rings[TDMA_NUM_RINGS];
|
||||
struct bcm_sysport_tx_ring *tx_rings;
|
||||
|
||||
/* Receive queue */
|
||||
void __iomem *rx_bds;
|
||||
|
||||
Loading…
Reference in New Issue
Block a user