Kernel/linux-next
1
0
Fork 0
mirror of https://git.kernel.org/pub/scm/linux/kernel/git/next/linux-next.git synced 2025-01-12 16:58:53 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

[PATCH] mv643xx_eth: Make port queue enable/disable code consistent

Browse Source 
Add and use the following functions:
	mv643xx_eth_port_enable_tx()
	mv643xx_eth_port_enable_rx()
	mv643xx_eth_port_disable_tx()
	mv643xx_eth_port_disable_rx()

so that ports are enabled/disabled consistently.

Signed-off-by: Dale Farnsworth <dale@farnsworth.org>
Signed-off-by: Jeff Garzik <jgarzik@pobox.com>
This commit is contained in:
Dale Farnsworth 2006-01-27 01:10:47 -07:00 committed by Jeff Garzik
parent f98e36f1f7
commit 9f8dd31945
1 changed files with 79 additions and 54 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

133
drivers/net/mv643xx_eth.c
View File

@ -83,6 +83,12 @@ static int eth_port_link_is_up(unsigned int eth_port_num);
static void eth_port_uc_addr_get(struct net_device *dev, static void eth_port_uc_addr_get(struct net_device *dev,
unsigned char *MacAddr); unsigned char *MacAddr);
static void eth_port_set_multicast_list(struct net_device *); static void eth_port_set_multicast_list(struct net_device *);
static void mv643xx_eth_port_enable_tx(unsigned int port_num,
unsigned int channels);
static void mv643xx_eth_port_enable_rx(unsigned int port_num,
unsigned int channels);
static unsigned int mv643xx_eth_port_disable_tx(unsigned int port_num);
static unsigned int mv643xx_eth_port_disable_rx(unsigned int port_num);
static int mv643xx_eth_open(struct net_device *); static int mv643xx_eth_open(struct net_device *);
static int mv643xx_eth_stop(struct net_device *); static int mv643xx_eth_stop(struct net_device *);
static int mv643xx_eth_change_mtu(struct net_device *, int); static int mv643xx_eth_change_mtu(struct net_device *, int);
@ -535,8 +541,7 @@ static irqreturn_t mv643xx_eth_int_handler(int irq, void *dev_id,
netif_carrier_on(dev); netif_carrier_on(dev);
netif_wake_queue(dev); netif_wake_queue(dev);
/* Start TX queue */ /* Start TX queue */
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG mv643xx_eth_port_enable_tx(port_num, mp->port_tx_queue_command);
(port_num), 1);
} else { } else {
netif_carrier_off(dev); netif_carrier_off(dev);
netif_stop_queue(dev); netif_stop_queue(dev);
@ -668,8 +673,8 @@ static void ether_init_rx_desc_ring(struct mv643xx_private *mp)
mp->rx_desc_area_size = rx_desc_num * sizeof(struct eth_rx_desc); mp->rx_desc_area_size = rx_desc_num * sizeof(struct eth_rx_desc);
/* Add the queue to the list of RX queues of this port */ /* Enable queue 0 for this port */
mp->port_rx_queue_command |= 1; mp->port_rx_queue_command = 1;
} }
/* /*
@ -715,8 +720,8 @@ static void ether_init_tx_desc_ring(struct mv643xx_private *mp)
mp->tx_desc_area_size = tx_desc_num * sizeof(struct eth_tx_desc); mp->tx_desc_area_size = tx_desc_num * sizeof(struct eth_tx_desc);
/* Add the queue to the list of Tx queues of this port */ /* Enable queue 0 for this port */
mp->port_tx_queue_command |= 1; mp->port_tx_queue_command = 1;
} }
/* /*
@ -747,9 +752,6 @@ static int mv643xx_eth_open(struct net_device *dev)
return -EAGAIN; return -EAGAIN;
} }
/* Stop RX Queues */
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num), 0x0000ff00);
eth_port_init(mp); eth_port_init(mp);
INIT_WORK(&mp->rx_task, (void (*)(void *))mv643xx_eth_rx_task, dev); INIT_WORK(&mp->rx_task, (void (*)(void *))mv643xx_eth_rx_task, dev);
@ -877,7 +879,7 @@ static void mv643xx_eth_free_tx_rings(struct net_device *dev)
struct sk_buff *skb; struct sk_buff *skb;
/* Stop Tx Queues */ /* Stop Tx Queues */
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num), 0x0000ff00); mv643xx_eth_port_disable_tx(port_num);
/* Free outstanding skb's on TX rings */ /* Free outstanding skb's on TX rings */
for (curr = 0; mp->tx_desc_count && curr < mp->tx_ring_size; curr++) { for (curr = 0; mp->tx_desc_count && curr < mp->tx_ring_size; curr++) {
@ -907,7 +909,7 @@ static void mv643xx_eth_free_rx_rings(struct net_device *dev)
int curr; int curr;
/* Stop RX Queues */ /* Stop RX Queues */
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num), 0x0000ff00); mv643xx_eth_port_disable_rx(port_num);
/* Free preallocated skb's on RX rings */ /* Free preallocated skb's on RX rings */
for (curr = 0; mp->rx_desc_count && curr < mp->rx_ring_size; curr++) { for (curr = 0; mp->rx_desc_count && curr < mp->rx_ring_size; curr++) {
@ -1719,13 +1721,6 @@ MODULE_DESCRIPTION("Ethernet driver for Marvell MV643XX");
* return_info Tx/Rx user resource return information. * return_info Tx/Rx user resource return information.
*/ */
/* defines */
/* SDMA command macros */
#define ETH_ENABLE_TX_QUEUE(eth_port) \
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(eth_port), 1)
/* locals */
/* PHY routines */ /* PHY routines */
static int ethernet_phy_get(unsigned int eth_port_num); static int ethernet_phy_get(unsigned int eth_port_num);
static void ethernet_phy_set(unsigned int eth_port_num, int phy_addr); static void ethernet_phy_set(unsigned int eth_port_num, int phy_addr);
@ -1759,9 +1754,6 @@ static void eth_port_set_filter_table_entry(int table, unsigned char entry);
*/ */
static void eth_port_init(struct mv643xx_private *mp) static void eth_port_init(struct mv643xx_private *mp)
{ {
mp->port_rx_queue_command = 0;
mp->port_tx_queue_command = 0;
mp->rx_resource_err = 0; mp->rx_resource_err = 0;
mp->tx_resource_err = 0; mp->tx_resource_err = 0;
@ -1842,8 +1834,7 @@ static void eth_port_start(struct net_device *dev)
mp->port_sdma_config); mp->port_sdma_config);
/* Enable port Rx. */ /* Enable port Rx. */
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num), mv643xx_eth_port_enable_rx(port_num, mp->port_rx_queue_command);
mp->port_rx_queue_command);
/* Disable port bandwidth limits by clearing MTU register */ /* Disable port bandwidth limits by clearing MTU register */
mv_write(MV643XX_ETH_MAXIMUM_TRANSMIT_UNIT(port_num), 0); mv_write(MV643XX_ETH_MAXIMUM_TRANSMIT_UNIT(port_num), 0);
@ -2320,6 +2311,67 @@ static void ethernet_phy_reset(unsigned int eth_port_num)
eth_port_write_smi_reg(eth_port_num, 0, phy_reg_data); eth_port_write_smi_reg(eth_port_num, 0, phy_reg_data);
} }
static void mv643xx_eth_port_enable_tx(unsigned int port_num,
unsigned int channels)
{
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num), channels);
}
static void mv643xx_eth_port_enable_rx(unsigned int port_num,
unsigned int channels)
{
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num), channels);
}
static unsigned int mv643xx_eth_port_disable_tx(unsigned int port_num)
{
u32 channels;
/* Stop Tx port activity. Check port Tx activity. */
channels = mv_read(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num))
& 0xFF;
if (channels) {
/* Issue stop command for active channels only */
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num),
(channels << 8));
/* Wait for all Tx activity to terminate. */
/* Check port cause register that all Tx queues are stopped */
while (mv_read(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num))
& 0xFF)
udelay(PHY_WAIT_MICRO_SECONDS);
/* Wait for Tx FIFO to empty */
while (mv_read(MV643XX_ETH_PORT_STATUS_REG(port_num)) &
ETH_PORT_TX_FIFO_EMPTY)
udelay(PHY_WAIT_MICRO_SECONDS);
}
return channels;
}
static unsigned int mv643xx_eth_port_disable_rx(unsigned int port_num)
{
u32 channels;
/* Stop Rx port activity. Check port Rx activity. */
channels = mv_read(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num)
& 0xFF);
if (channels) {
/* Issue stop command for active channels only */
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num),
(channels << 8));
/* Wait for all Rx activity to terminate. */
/* Check port cause register that all Rx queues are stopped */
while (mv_read(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num))
& 0xFF)
udelay(PHY_WAIT_MICRO_SECONDS);
}
return channels;
}
/* /*
* eth_port_reset - Reset Ethernet port * eth_port_reset - Reset Ethernet port
* *
@ -2342,35 +2394,8 @@ static void eth_port_reset(unsigned int port_num)
{ {
unsigned int reg_data; unsigned int reg_data;
/* Stop Tx port activity. Check port Tx activity. */ mv643xx_eth_port_disable_tx(port_num);
reg_data = mv_read(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num)); mv643xx_eth_port_disable_rx(port_num);
if (reg_data & 0xFF) {
/* Issue stop command for active channels only */
mv_write(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num),
(reg_data << 8));
/* Wait for all Tx activity to terminate. */
/* Check port cause register that all Tx queues are stopped */
while (mv_read(MV643XX_ETH_TRANSMIT_QUEUE_COMMAND_REG(port_num))
& 0xFF)
udelay(10);
}
/* Stop Rx port activity. Check port Rx activity. */
reg_data = mv_read(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num));
if (reg_data & 0xFF) {
/* Issue stop command for active channels only */
mv_write(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num),
(reg_data << 8));
/* Wait for all Rx activity to terminate. */
/* Check port cause register that all Rx queues are stopped */
while (mv_read(MV643XX_ETH_RECEIVE_QUEUE_COMMAND_REG(port_num))
& 0xFF)
udelay(10);
}
/* Clear all MIB counters */ /* Clear all MIB counters */
eth_clear_mib_counters(port_num); eth_clear_mib_counters(port_num);
@ -2599,7 +2624,7 @@ static ETH_FUNC_RET_STATUS eth_port_send(struct mv643xx_private *mp,
first_descriptor->cmd_sts = mp->tx_first_command; first_descriptor->cmd_sts = mp->tx_first_command;
wmb(); wmb();
ETH_ENABLE_TX_QUEUE(mp->port_num); mv643xx_eth_port_enable_tx(mp->port_num, mp->port_tx_queue_command);
/* /*
* Finish Tx packet. Update first desc in case of Tx resource * Finish Tx packet. Update first desc in case of Tx resource
@ -2652,7 +2677,7 @@ static ETH_FUNC_RET_STATUS eth_port_send(struct mv643xx_private *mp,
ETH_BUFFER_OWNED_BY_DMA | ETH_TX_ENABLE_INTERRUPT; ETH_BUFFER_OWNED_BY_DMA | ETH_TX_ENABLE_INTERRUPT;
wmb(); wmb();
ETH_ENABLE_TX_QUEUE(mp->port_num); mv643xx_eth_port_enable_tx(mp->port_num, mp->port_tx_queue_command);
/* Finish Tx packet. Update first desc in case of Tx resource error */ /* Finish Tx packet. Update first desc in case of Tx resource error */
tx_desc_curr = (tx_desc_curr + 1) % mp->tx_ring_size; tx_desc_curr = (tx_desc_curr + 1) % mp->tx_ring_size;