2008-04-20 19:06:39 +02:00
|
|
|
/*
|
|
|
|
* Intel IXP4xx Ethernet driver for Linux
|
|
|
|
*
|
|
|
|
* Copyright (C) 2007 Krzysztof Halasa <khc@pm.waw.pl>
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
|
|
* under the terms of version 2 of the GNU General Public License
|
|
|
|
* as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* Ethernet port config (0x00 is not present on IXP42X):
|
|
|
|
*
|
|
|
|
* logical port 0x00 0x10 0x20
|
|
|
|
* NPE 0 (NPE-A) 1 (NPE-B) 2 (NPE-C)
|
|
|
|
* physical PortId 2 0 1
|
|
|
|
* TX queue 23 24 25
|
|
|
|
* RX-free queue 26 27 28
|
|
|
|
* TX-done queue is always 31, per-port RX and TX-ready queues are configurable
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* Queue entries:
|
|
|
|
* bits 0 -> 1 - NPE ID (RX and TX-done)
|
|
|
|
* bits 0 -> 2 - priority (TX, per 802.1D)
|
|
|
|
* bits 3 -> 4 - port ID (user-set?)
|
|
|
|
* bits 5 -> 31 - physical descriptor address
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/dma-mapping.h>
|
|
|
|
#include <linux/dmapool.h>
|
|
|
|
#include <linux/etherdevice.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/kernel.h>
|
2011-04-22 12:04:31 +02:00
|
|
|
#include <linux/net_tstamp.h>
|
2008-12-20 01:53:08 +01:00
|
|
|
#include <linux/phy.h>
|
2008-04-20 19:06:39 +02:00
|
|
|
#include <linux/platform_device.h>
|
2011-04-22 12:04:31 +02:00
|
|
|
#include <linux/ptp_classify.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 09:04:11 +01:00
|
|
|
#include <linux/slab.h>
|
2011-07-03 21:21:01 +02:00
|
|
|
#include <linux/module.h>
|
2011-04-22 12:04:31 +02:00
|
|
|
#include <mach/ixp46x_ts.h>
|
2008-08-05 17:14:15 +02:00
|
|
|
#include <mach/npe.h>
|
|
|
|
#include <mach/qmgr.h>
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
#define DEBUG_DESC 0
|
|
|
|
#define DEBUG_RX 0
|
|
|
|
#define DEBUG_TX 0
|
|
|
|
#define DEBUG_PKT_BYTES 0
|
|
|
|
#define DEBUG_MDIO 0
|
|
|
|
#define DEBUG_CLOSE 0
|
|
|
|
|
|
|
|
#define DRV_NAME "ixp4xx_eth"
|
|
|
|
|
|
|
|
#define MAX_NPES 3
|
|
|
|
|
|
|
|
#define RX_DESCS 64 /* also length of all RX queues */
|
|
|
|
#define TX_DESCS 16 /* also length of all TX queues */
|
|
|
|
#define TXDONE_QUEUE_LEN 64 /* dwords */
|
|
|
|
|
|
|
|
#define POOL_ALLOC_SIZE (sizeof(struct desc) * (RX_DESCS + TX_DESCS))
|
|
|
|
#define REGS_SIZE 0x1000
|
|
|
|
#define MAX_MRU 1536 /* 0x600 */
|
|
|
|
#define RX_BUFF_SIZE ALIGN((NET_IP_ALIGN) + MAX_MRU, 4)
|
|
|
|
|
|
|
|
#define NAPI_WEIGHT 16
|
|
|
|
#define MDIO_INTERVAL (3 * HZ)
|
|
|
|
#define MAX_MDIO_RETRIES 100 /* microseconds, typically 30 cycles */
|
|
|
|
#define MAX_CLOSE_WAIT 1000 /* microseconds, typically 2-3 cycles */
|
|
|
|
|
|
|
|
#define NPE_ID(port_id) ((port_id) >> 4)
|
|
|
|
#define PHYSICAL_ID(port_id) ((NPE_ID(port_id) + 2) % 3)
|
|
|
|
#define TX_QUEUE(port_id) (NPE_ID(port_id) + 23)
|
|
|
|
#define RXFREE_QUEUE(port_id) (NPE_ID(port_id) + 26)
|
|
|
|
#define TXDONE_QUEUE 31
|
|
|
|
|
2011-04-22 12:04:31 +02:00
|
|
|
#define PTP_SLAVE_MODE 1
|
|
|
|
#define PTP_MASTER_MODE 2
|
|
|
|
#define PORT2CHANNEL(p) NPE_ID(p->id)
|
|
|
|
|
2008-04-20 19:06:39 +02:00
|
|
|
/* TX Control Registers */
|
|
|
|
#define TX_CNTRL0_TX_EN 0x01
|
|
|
|
#define TX_CNTRL0_HALFDUPLEX 0x02
|
|
|
|
#define TX_CNTRL0_RETRY 0x04
|
|
|
|
#define TX_CNTRL0_PAD_EN 0x08
|
|
|
|
#define TX_CNTRL0_APPEND_FCS 0x10
|
|
|
|
#define TX_CNTRL0_2DEFER 0x20
|
|
|
|
#define TX_CNTRL0_RMII 0x40 /* reduced MII */
|
|
|
|
#define TX_CNTRL1_RETRIES 0x0F /* 4 bits */
|
|
|
|
|
|
|
|
/* RX Control Registers */
|
|
|
|
#define RX_CNTRL0_RX_EN 0x01
|
|
|
|
#define RX_CNTRL0_PADSTRIP_EN 0x02
|
|
|
|
#define RX_CNTRL0_SEND_FCS 0x04
|
|
|
|
#define RX_CNTRL0_PAUSE_EN 0x08
|
|
|
|
#define RX_CNTRL0_LOOP_EN 0x10
|
|
|
|
#define RX_CNTRL0_ADDR_FLTR_EN 0x20
|
|
|
|
#define RX_CNTRL0_RX_RUNT_EN 0x40
|
|
|
|
#define RX_CNTRL0_BCAST_DIS 0x80
|
|
|
|
#define RX_CNTRL1_DEFER_EN 0x01
|
|
|
|
|
|
|
|
/* Core Control Register */
|
|
|
|
#define CORE_RESET 0x01
|
|
|
|
#define CORE_RX_FIFO_FLUSH 0x02
|
|
|
|
#define CORE_TX_FIFO_FLUSH 0x04
|
|
|
|
#define CORE_SEND_JAM 0x08
|
|
|
|
#define CORE_MDC_EN 0x10 /* MDIO using NPE-B ETH-0 only */
|
|
|
|
|
|
|
|
#define DEFAULT_TX_CNTRL0 (TX_CNTRL0_TX_EN | TX_CNTRL0_RETRY | \
|
|
|
|
TX_CNTRL0_PAD_EN | TX_CNTRL0_APPEND_FCS | \
|
|
|
|
TX_CNTRL0_2DEFER)
|
|
|
|
#define DEFAULT_RX_CNTRL0 RX_CNTRL0_RX_EN
|
|
|
|
#define DEFAULT_CORE_CNTRL CORE_MDC_EN
|
|
|
|
|
|
|
|
|
|
|
|
/* NPE message codes */
|
|
|
|
#define NPE_GETSTATUS 0x00
|
|
|
|
#define NPE_EDB_SETPORTADDRESS 0x01
|
|
|
|
#define NPE_EDB_GETMACADDRESSDATABASE 0x02
|
|
|
|
#define NPE_EDB_SETMACADDRESSSDATABASE 0x03
|
|
|
|
#define NPE_GETSTATS 0x04
|
|
|
|
#define NPE_RESETSTATS 0x05
|
|
|
|
#define NPE_SETMAXFRAMELENGTHS 0x06
|
|
|
|
#define NPE_VLAN_SETRXTAGMODE 0x07
|
|
|
|
#define NPE_VLAN_SETDEFAULTRXVID 0x08
|
|
|
|
#define NPE_VLAN_SETPORTVLANTABLEENTRY 0x09
|
|
|
|
#define NPE_VLAN_SETPORTVLANTABLERANGE 0x0A
|
|
|
|
#define NPE_VLAN_SETRXQOSENTRY 0x0B
|
|
|
|
#define NPE_VLAN_SETPORTIDEXTRACTIONMODE 0x0C
|
|
|
|
#define NPE_STP_SETBLOCKINGSTATE 0x0D
|
|
|
|
#define NPE_FW_SETFIREWALLMODE 0x0E
|
|
|
|
#define NPE_PC_SETFRAMECONTROLDURATIONID 0x0F
|
|
|
|
#define NPE_PC_SETAPMACTABLE 0x11
|
|
|
|
#define NPE_SETLOOPBACK_MODE 0x12
|
|
|
|
#define NPE_PC_SETBSSIDTABLE 0x13
|
|
|
|
#define NPE_ADDRESS_FILTER_CONFIG 0x14
|
|
|
|
#define NPE_APPENDFCSCONFIG 0x15
|
|
|
|
#define NPE_NOTIFY_MAC_RECOVERY_DONE 0x16
|
|
|
|
#define NPE_MAC_RECOVERY_START 0x17
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
typedef struct sk_buff buffer_t;
|
|
|
|
#define free_buffer dev_kfree_skb
|
|
|
|
#define free_buffer_irq dev_kfree_skb_irq
|
|
|
|
#else
|
|
|
|
typedef void buffer_t;
|
|
|
|
#define free_buffer kfree
|
|
|
|
#define free_buffer_irq kfree
|
|
|
|
#endif
|
|
|
|
|
|
|
|
struct eth_regs {
|
|
|
|
u32 tx_control[2], __res1[2]; /* 000 */
|
|
|
|
u32 rx_control[2], __res2[2]; /* 010 */
|
|
|
|
u32 random_seed, __res3[3]; /* 020 */
|
|
|
|
u32 partial_empty_threshold, __res4; /* 030 */
|
|
|
|
u32 partial_full_threshold, __res5; /* 038 */
|
|
|
|
u32 tx_start_bytes, __res6[3]; /* 040 */
|
|
|
|
u32 tx_deferral, rx_deferral, __res7[2];/* 050 */
|
|
|
|
u32 tx_2part_deferral[2], __res8[2]; /* 060 */
|
|
|
|
u32 slot_time, __res9[3]; /* 070 */
|
|
|
|
u32 mdio_command[4]; /* 080 */
|
|
|
|
u32 mdio_status[4]; /* 090 */
|
|
|
|
u32 mcast_mask[6], __res10[2]; /* 0A0 */
|
|
|
|
u32 mcast_addr[6], __res11[2]; /* 0C0 */
|
|
|
|
u32 int_clock_threshold, __res12[3]; /* 0E0 */
|
|
|
|
u32 hw_addr[6], __res13[61]; /* 0F0 */
|
|
|
|
u32 core_control; /* 1FC */
|
|
|
|
};
|
|
|
|
|
|
|
|
struct port {
|
|
|
|
struct resource *mem_res;
|
|
|
|
struct eth_regs __iomem *regs;
|
|
|
|
struct npe *npe;
|
|
|
|
struct net_device *netdev;
|
|
|
|
struct napi_struct napi;
|
2008-12-20 01:53:08 +01:00
|
|
|
struct phy_device *phydev;
|
2008-04-20 19:06:39 +02:00
|
|
|
struct eth_plat_info *plat;
|
|
|
|
buffer_t *rx_buff_tab[RX_DESCS], *tx_buff_tab[TX_DESCS];
|
|
|
|
struct desc *desc_tab; /* coherent */
|
|
|
|
u32 desc_tab_phys;
|
|
|
|
int id; /* logical port ID */
|
2008-12-20 01:53:08 +01:00
|
|
|
int speed, duplex;
|
2008-12-21 00:02:34 +01:00
|
|
|
u8 firmware[4];
|
2011-04-22 12:04:31 +02:00
|
|
|
int hwts_tx_en;
|
|
|
|
int hwts_rx_en;
|
2008-04-20 19:06:39 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
/* NPE message structure */
|
|
|
|
struct msg {
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
u8 cmd, eth_id, byte2, byte3;
|
|
|
|
u8 byte4, byte5, byte6, byte7;
|
|
|
|
#else
|
|
|
|
u8 byte3, byte2, eth_id, cmd;
|
|
|
|
u8 byte7, byte6, byte5, byte4;
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Ethernet packet descriptor */
|
|
|
|
struct desc {
|
|
|
|
u32 next; /* pointer to next buffer, unused */
|
|
|
|
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
u16 buf_len; /* buffer length */
|
|
|
|
u16 pkt_len; /* packet length */
|
|
|
|
u32 data; /* pointer to data buffer in RAM */
|
|
|
|
u8 dest_id;
|
|
|
|
u8 src_id;
|
|
|
|
u16 flags;
|
|
|
|
u8 qos;
|
|
|
|
u8 padlen;
|
|
|
|
u16 vlan_tci;
|
|
|
|
#else
|
|
|
|
u16 pkt_len; /* packet length */
|
|
|
|
u16 buf_len; /* buffer length */
|
|
|
|
u32 data; /* pointer to data buffer in RAM */
|
|
|
|
u16 flags;
|
|
|
|
u8 src_id;
|
|
|
|
u8 dest_id;
|
|
|
|
u16 vlan_tci;
|
|
|
|
u8 padlen;
|
|
|
|
u8 qos;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
u8 dst_mac_0, dst_mac_1, dst_mac_2, dst_mac_3;
|
|
|
|
u8 dst_mac_4, dst_mac_5, src_mac_0, src_mac_1;
|
|
|
|
u8 src_mac_2, src_mac_3, src_mac_4, src_mac_5;
|
|
|
|
#else
|
|
|
|
u8 dst_mac_3, dst_mac_2, dst_mac_1, dst_mac_0;
|
|
|
|
u8 src_mac_1, src_mac_0, dst_mac_5, dst_mac_4;
|
|
|
|
u8 src_mac_5, src_mac_4, src_mac_3, src_mac_2;
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
#define rx_desc_phys(port, n) ((port)->desc_tab_phys + \
|
|
|
|
(n) * sizeof(struct desc))
|
|
|
|
#define rx_desc_ptr(port, n) (&(port)->desc_tab[n])
|
|
|
|
|
|
|
|
#define tx_desc_phys(port, n) ((port)->desc_tab_phys + \
|
|
|
|
((n) + RX_DESCS) * sizeof(struct desc))
|
|
|
|
#define tx_desc_ptr(port, n) (&(port)->desc_tab[(n) + RX_DESCS])
|
|
|
|
|
|
|
|
#ifndef __ARMEB__
|
|
|
|
static inline void memcpy_swab32(u32 *dest, u32 *src, int cnt)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < cnt; i++)
|
|
|
|
dest[i] = swab32(src[i]);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
static spinlock_t mdio_lock;
|
|
|
|
static struct eth_regs __iomem *mdio_regs; /* mdio command and status only */
|
2010-01-10 13:56:13 +01:00
|
|
|
static struct mii_bus *mdio_bus;
|
2008-04-20 19:06:39 +02:00
|
|
|
static int ports_open;
|
|
|
|
static struct port *npe_port_tab[MAX_NPES];
|
|
|
|
static struct dma_pool *dma_pool;
|
|
|
|
|
2011-04-22 12:04:31 +02:00
|
|
|
static struct sock_filter ptp_filter[] = {
|
|
|
|
PTP_FILTER
|
|
|
|
};
|
|
|
|
|
|
|
|
static int ixp_ptp_match(struct sk_buff *skb, u16 uid_hi, u32 uid_lo, u16 seqid)
|
|
|
|
{
|
|
|
|
u8 *data = skb->data;
|
|
|
|
unsigned int offset;
|
|
|
|
u16 *hi, *id;
|
|
|
|
u32 lo;
|
|
|
|
|
|
|
|
if (sk_run_filter(skb, ptp_filter) != PTP_CLASS_V1_IPV4)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
offset = ETH_HLEN + IPV4_HLEN(data) + UDP_HLEN;
|
|
|
|
|
|
|
|
if (skb->len < offset + OFF_PTP_SEQUENCE_ID + sizeof(seqid))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
hi = (u16 *)(data + offset + OFF_PTP_SOURCE_UUID);
|
|
|
|
id = (u16 *)(data + offset + OFF_PTP_SEQUENCE_ID);
|
|
|
|
|
|
|
|
memcpy(&lo, &hi[1], sizeof(lo));
|
|
|
|
|
|
|
|
return (uid_hi == ntohs(*hi) &&
|
|
|
|
uid_lo == ntohl(lo) &&
|
|
|
|
seqid == ntohs(*id));
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ixp_rx_timestamp(struct port *port, struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
struct skb_shared_hwtstamps *shhwtstamps;
|
|
|
|
struct ixp46x_ts_regs *regs;
|
|
|
|
u64 ns;
|
|
|
|
u32 ch, hi, lo, val;
|
|
|
|
u16 uid, seq;
|
|
|
|
|
|
|
|
if (!port->hwts_rx_en)
|
|
|
|
return;
|
|
|
|
|
|
|
|
ch = PORT2CHANNEL(port);
|
|
|
|
|
|
|
|
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT;
|
|
|
|
|
|
|
|
val = __raw_readl(®s->channel[ch].ch_event);
|
|
|
|
|
|
|
|
if (!(val & RX_SNAPSHOT_LOCKED))
|
|
|
|
return;
|
|
|
|
|
|
|
|
lo = __raw_readl(®s->channel[ch].src_uuid_lo);
|
|
|
|
hi = __raw_readl(®s->channel[ch].src_uuid_hi);
|
|
|
|
|
|
|
|
uid = hi & 0xffff;
|
|
|
|
seq = (hi >> 16) & 0xffff;
|
|
|
|
|
|
|
|
if (!ixp_ptp_match(skb, htons(uid), htonl(lo), htons(seq)))
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
lo = __raw_readl(®s->channel[ch].rx_snap_lo);
|
|
|
|
hi = __raw_readl(®s->channel[ch].rx_snap_hi);
|
|
|
|
ns = ((u64) hi) << 32;
|
|
|
|
ns |= lo;
|
|
|
|
ns <<= TICKS_NS_SHIFT;
|
|
|
|
|
|
|
|
shhwtstamps = skb_hwtstamps(skb);
|
|
|
|
memset(shhwtstamps, 0, sizeof(*shhwtstamps));
|
|
|
|
shhwtstamps->hwtstamp = ns_to_ktime(ns);
|
|
|
|
out:
|
|
|
|
__raw_writel(RX_SNAPSHOT_LOCKED, ®s->channel[ch].ch_event);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void ixp_tx_timestamp(struct port *port, struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
struct skb_shared_hwtstamps shhwtstamps;
|
|
|
|
struct ixp46x_ts_regs *regs;
|
|
|
|
struct skb_shared_info *shtx;
|
|
|
|
u64 ns;
|
|
|
|
u32 ch, cnt, hi, lo, val;
|
|
|
|
|
|
|
|
shtx = skb_shinfo(skb);
|
|
|
|
if (unlikely(shtx->tx_flags & SKBTX_HW_TSTAMP && port->hwts_tx_en))
|
|
|
|
shtx->tx_flags |= SKBTX_IN_PROGRESS;
|
|
|
|
else
|
|
|
|
return;
|
|
|
|
|
|
|
|
ch = PORT2CHANNEL(port);
|
|
|
|
|
|
|
|
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* This really stinks, but we have to poll for the Tx time stamp.
|
|
|
|
* Usually, the time stamp is ready after 4 to 6 microseconds.
|
|
|
|
*/
|
|
|
|
for (cnt = 0; cnt < 100; cnt++) {
|
|
|
|
val = __raw_readl(®s->channel[ch].ch_event);
|
|
|
|
if (val & TX_SNAPSHOT_LOCKED)
|
|
|
|
break;
|
|
|
|
udelay(1);
|
|
|
|
}
|
|
|
|
if (!(val & TX_SNAPSHOT_LOCKED)) {
|
|
|
|
shtx->tx_flags &= ~SKBTX_IN_PROGRESS;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
lo = __raw_readl(®s->channel[ch].tx_snap_lo);
|
|
|
|
hi = __raw_readl(®s->channel[ch].tx_snap_hi);
|
|
|
|
ns = ((u64) hi) << 32;
|
|
|
|
ns |= lo;
|
|
|
|
ns <<= TICKS_NS_SHIFT;
|
|
|
|
|
|
|
|
memset(&shhwtstamps, 0, sizeof(shhwtstamps));
|
|
|
|
shhwtstamps.hwtstamp = ns_to_ktime(ns);
|
|
|
|
skb_tstamp_tx(skb, &shhwtstamps);
|
|
|
|
|
|
|
|
__raw_writel(TX_SNAPSHOT_LOCKED, ®s->channel[ch].ch_event);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int hwtstamp_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd)
|
|
|
|
{
|
|
|
|
struct hwtstamp_config cfg;
|
|
|
|
struct ixp46x_ts_regs *regs;
|
|
|
|
struct port *port = netdev_priv(netdev);
|
|
|
|
int ch;
|
|
|
|
|
|
|
|
if (copy_from_user(&cfg, ifr->ifr_data, sizeof(cfg)))
|
|
|
|
return -EFAULT;
|
|
|
|
|
|
|
|
if (cfg.flags) /* reserved for future extensions */
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
ch = PORT2CHANNEL(port);
|
|
|
|
regs = (struct ixp46x_ts_regs __iomem *) IXP4XX_TIMESYNC_BASE_VIRT;
|
|
|
|
|
|
|
|
switch (cfg.tx_type) {
|
|
|
|
case HWTSTAMP_TX_OFF:
|
|
|
|
port->hwts_tx_en = 0;
|
|
|
|
break;
|
|
|
|
case HWTSTAMP_TX_ON:
|
|
|
|
port->hwts_tx_en = 1;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -ERANGE;
|
|
|
|
}
|
|
|
|
|
|
|
|
switch (cfg.rx_filter) {
|
|
|
|
case HWTSTAMP_FILTER_NONE:
|
|
|
|
port->hwts_rx_en = 0;
|
|
|
|
break;
|
|
|
|
case HWTSTAMP_FILTER_PTP_V1_L4_SYNC:
|
|
|
|
port->hwts_rx_en = PTP_SLAVE_MODE;
|
|
|
|
__raw_writel(0, ®s->channel[ch].ch_control);
|
|
|
|
break;
|
|
|
|
case HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ:
|
|
|
|
port->hwts_rx_en = PTP_MASTER_MODE;
|
|
|
|
__raw_writel(MASTER_MODE, ®s->channel[ch].ch_control);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return -ERANGE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Clear out any old time stamps. */
|
|
|
|
__raw_writel(TX_SNAPSHOT_LOCKED | RX_SNAPSHOT_LOCKED,
|
|
|
|
®s->channel[ch].ch_event);
|
|
|
|
|
|
|
|
return copy_to_user(ifr->ifr_data, &cfg, sizeof(cfg)) ? -EFAULT : 0;
|
|
|
|
}
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static int ixp4xx_mdio_cmd(struct mii_bus *bus, int phy_id, int location,
|
|
|
|
int write, u16 cmd)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
|
|
|
int cycles = 0;
|
|
|
|
|
|
|
|
if (__raw_readl(&mdio_regs->mdio_command[3]) & 0x80) {
|
2008-12-20 01:53:08 +01:00
|
|
|
printk(KERN_ERR "%s: MII not ready to transmit\n", bus->name);
|
|
|
|
return -1;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (write) {
|
|
|
|
__raw_writel(cmd & 0xFF, &mdio_regs->mdio_command[0]);
|
|
|
|
__raw_writel(cmd >> 8, &mdio_regs->mdio_command[1]);
|
|
|
|
}
|
|
|
|
__raw_writel(((phy_id << 5) | location) & 0xFF,
|
|
|
|
&mdio_regs->mdio_command[2]);
|
|
|
|
__raw_writel((phy_id >> 3) | (write << 2) | 0x80 /* GO */,
|
|
|
|
&mdio_regs->mdio_command[3]);
|
|
|
|
|
|
|
|
while ((cycles < MAX_MDIO_RETRIES) &&
|
|
|
|
(__raw_readl(&mdio_regs->mdio_command[3]) & 0x80)) {
|
|
|
|
udelay(1);
|
|
|
|
cycles++;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (cycles == MAX_MDIO_RETRIES) {
|
2008-12-20 01:53:08 +01:00
|
|
|
printk(KERN_ERR "%s #%i: MII write failed\n", bus->name,
|
|
|
|
phy_id);
|
|
|
|
return -1;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
#if DEBUG_MDIO
|
2008-12-20 01:53:08 +01:00
|
|
|
printk(KERN_DEBUG "%s #%i: mdio_%s() took %i cycles\n", bus->name,
|
|
|
|
phy_id, write ? "write" : "read", cycles);
|
2008-04-20 19:06:39 +02:00
|
|
|
#endif
|
|
|
|
|
|
|
|
if (write)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (__raw_readl(&mdio_regs->mdio_status[3]) & 0x80) {
|
2008-12-20 01:53:08 +01:00
|
|
|
#if DEBUG_MDIO
|
|
|
|
printk(KERN_DEBUG "%s #%i: MII read failed\n", bus->name,
|
|
|
|
phy_id);
|
|
|
|
#endif
|
|
|
|
return 0xFFFF; /* don't return error */
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
return (__raw_readl(&mdio_regs->mdio_status[0]) & 0xFF) |
|
2008-12-20 01:53:08 +01:00
|
|
|
((__raw_readl(&mdio_regs->mdio_status[1]) & 0xFF) << 8);
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static int ixp4xx_mdio_read(struct mii_bus *bus, int phy_id, int location)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
|
|
|
unsigned long flags;
|
2008-12-20 01:53:08 +01:00
|
|
|
int ret;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
spin_lock_irqsave(&mdio_lock, flags);
|
2008-12-20 01:53:08 +01:00
|
|
|
ret = ixp4xx_mdio_cmd(bus, phy_id, location, 0, 0);
|
2008-04-20 19:06:39 +02:00
|
|
|
spin_unlock_irqrestore(&mdio_lock, flags);
|
2008-12-20 01:53:08 +01:00
|
|
|
#if DEBUG_MDIO
|
|
|
|
printk(KERN_DEBUG "%s #%i: MII read [%i] -> 0x%X\n", bus->name,
|
|
|
|
phy_id, location, ret);
|
|
|
|
#endif
|
|
|
|
return ret;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static int ixp4xx_mdio_write(struct mii_bus *bus, int phy_id, int location,
|
|
|
|
u16 val)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
|
|
|
unsigned long flags;
|
2008-12-20 01:53:08 +01:00
|
|
|
int ret;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
spin_lock_irqsave(&mdio_lock, flags);
|
2008-12-20 01:53:08 +01:00
|
|
|
ret = ixp4xx_mdio_cmd(bus, phy_id, location, 1, val);
|
2008-04-20 19:06:39 +02:00
|
|
|
spin_unlock_irqrestore(&mdio_lock, flags);
|
2008-12-20 01:53:08 +01:00
|
|
|
#if DEBUG_MDIO
|
2009-10-18 21:03:08 +02:00
|
|
|
printk(KERN_DEBUG "%s #%i: MII write [%i] <- 0x%X, err = %i\n",
|
2008-12-20 01:53:08 +01:00
|
|
|
bus->name, phy_id, location, val, ret);
|
|
|
|
#endif
|
|
|
|
return ret;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static int ixp4xx_mdio_register(void)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
2008-12-20 01:53:08 +01:00
|
|
|
int err;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
if (!(mdio_bus = mdiobus_alloc()))
|
|
|
|
return -ENOMEM;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2009-03-13 19:09:00 +01:00
|
|
|
if (cpu_is_ixp43x()) {
|
|
|
|
/* IXP43x lacks NPE-B and uses NPE-C for MII PHY access */
|
|
|
|
if (!(ixp4xx_read_feature_bits() & IXP4XX_FEATURE_NPEC_ETH))
|
2009-04-28 14:54:07 +02:00
|
|
|
return -ENODEV;
|
2009-03-13 19:09:00 +01:00
|
|
|
mdio_regs = (struct eth_regs __iomem *)IXP4XX_EthC_BASE_VIRT;
|
|
|
|
} else {
|
|
|
|
/* All MII PHY accesses use NPE-B Ethernet registers */
|
|
|
|
if (!(ixp4xx_read_feature_bits() & IXP4XX_FEATURE_NPEB_ETH0))
|
2009-04-28 14:54:07 +02:00
|
|
|
return -ENODEV;
|
2009-03-13 19:09:00 +01:00
|
|
|
mdio_regs = (struct eth_regs __iomem *)IXP4XX_EthB_BASE_VIRT;
|
|
|
|
}
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2009-03-13 19:09:00 +01:00
|
|
|
__raw_writel(DEFAULT_CORE_CNTRL, &mdio_regs->core_control);
|
|
|
|
spin_lock_init(&mdio_lock);
|
2008-12-20 01:53:08 +01:00
|
|
|
mdio_bus->name = "IXP4xx MII Bus";
|
|
|
|
mdio_bus->read = &ixp4xx_mdio_read;
|
|
|
|
mdio_bus->write = &ixp4xx_mdio_write;
|
2012-01-10 00:59:23 +01:00
|
|
|
snprintf(mdio_bus->id, MII_BUS_ID_SIZE, "ixp4xx-eth-0");
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
if ((err = mdiobus_register(mdio_bus)))
|
|
|
|
mdiobus_free(mdio_bus);
|
|
|
|
return err;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static void ixp4xx_mdio_remove(void)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
2008-12-20 01:53:08 +01:00
|
|
|
mdiobus_unregister(mdio_bus);
|
|
|
|
mdiobus_free(mdio_bus);
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
static void ixp4xx_adjust_link(struct net_device *dev)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
2008-12-20 01:53:08 +01:00
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
struct phy_device *phydev = port->phydev;
|
|
|
|
|
|
|
|
if (!phydev->link) {
|
|
|
|
if (port->speed) {
|
|
|
|
port->speed = 0;
|
2008-04-20 19:06:39 +02:00
|
|
|
printk(KERN_INFO "%s: link down\n", dev->name);
|
|
|
|
}
|
2008-12-20 01:53:08 +01:00
|
|
|
return;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
if (port->speed == phydev->speed && port->duplex == phydev->duplex)
|
|
|
|
return;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
port->speed = phydev->speed;
|
|
|
|
port->duplex = phydev->duplex;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
if (port->duplex)
|
|
|
|
__raw_writel(DEFAULT_TX_CNTRL0 & ~TX_CNTRL0_HALFDUPLEX,
|
|
|
|
&port->regs->tx_control[0]);
|
|
|
|
else
|
|
|
|
__raw_writel(DEFAULT_TX_CNTRL0 | TX_CNTRL0_HALFDUPLEX,
|
|
|
|
&port->regs->tx_control[0]);
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
printk(KERN_INFO "%s: link up, speed %u Mb/s, %s duplex\n",
|
|
|
|
dev->name, port->speed, port->duplex ? "full" : "half");
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static inline void debug_pkt(struct net_device *dev, const char *func,
|
|
|
|
u8 *data, int len)
|
|
|
|
{
|
|
|
|
#if DEBUG_PKT_BYTES
|
|
|
|
int i;
|
|
|
|
|
|
|
|
printk(KERN_DEBUG "%s: %s(%i) ", dev->name, func, len);
|
|
|
|
for (i = 0; i < len; i++) {
|
|
|
|
if (i >= DEBUG_PKT_BYTES)
|
|
|
|
break;
|
|
|
|
printk("%s%02X",
|
|
|
|
((i == 6) || (i == 12) || (i >= 14)) ? " " : "",
|
|
|
|
data[i]);
|
|
|
|
}
|
|
|
|
printk("\n");
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static inline void debug_desc(u32 phys, struct desc *desc)
|
|
|
|
{
|
|
|
|
#if DEBUG_DESC
|
|
|
|
printk(KERN_DEBUG "%X: %X %3X %3X %08X %2X < %2X %4X %X"
|
|
|
|
" %X %X %02X%02X%02X%02X%02X%02X < %02X%02X%02X%02X%02X%02X\n",
|
|
|
|
phys, desc->next, desc->buf_len, desc->pkt_len,
|
|
|
|
desc->data, desc->dest_id, desc->src_id, desc->flags,
|
|
|
|
desc->qos, desc->padlen, desc->vlan_tci,
|
|
|
|
desc->dst_mac_0, desc->dst_mac_1, desc->dst_mac_2,
|
|
|
|
desc->dst_mac_3, desc->dst_mac_4, desc->dst_mac_5,
|
|
|
|
desc->src_mac_0, desc->src_mac_1, desc->src_mac_2,
|
|
|
|
desc->src_mac_3, desc->src_mac_4, desc->src_mac_5);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline int queue_get_desc(unsigned int queue, struct port *port,
|
|
|
|
int is_tx)
|
|
|
|
{
|
|
|
|
u32 phys, tab_phys, n_desc;
|
|
|
|
struct desc *tab;
|
|
|
|
|
2008-12-22 00:26:38 +01:00
|
|
|
if (!(phys = qmgr_get_entry(queue)))
|
2008-04-20 19:06:39 +02:00
|
|
|
return -1;
|
|
|
|
|
|
|
|
phys &= ~0x1F; /* mask out non-address bits */
|
|
|
|
tab_phys = is_tx ? tx_desc_phys(port, 0) : rx_desc_phys(port, 0);
|
|
|
|
tab = is_tx ? tx_desc_ptr(port, 0) : rx_desc_ptr(port, 0);
|
|
|
|
n_desc = (phys - tab_phys) / sizeof(struct desc);
|
|
|
|
BUG_ON(n_desc >= (is_tx ? TX_DESCS : RX_DESCS));
|
|
|
|
debug_desc(phys, &tab[n_desc]);
|
|
|
|
BUG_ON(tab[n_desc].next);
|
|
|
|
return n_desc;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void queue_put_desc(unsigned int queue, u32 phys,
|
|
|
|
struct desc *desc)
|
|
|
|
{
|
|
|
|
debug_desc(phys, desc);
|
|
|
|
BUG_ON(phys & 0x1F);
|
|
|
|
qmgr_put_entry(queue, phys);
|
2009-05-23 23:14:10 +02:00
|
|
|
/* Don't check for queue overflow here, we've allocated sufficient
|
|
|
|
length and queues >= 32 don't support this check anyway. */
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static inline void dma_unmap_tx(struct port *port, struct desc *desc)
|
|
|
|
{
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
dma_unmap_single(&port->netdev->dev, desc->data,
|
|
|
|
desc->buf_len, DMA_TO_DEVICE);
|
|
|
|
#else
|
|
|
|
dma_unmap_single(&port->netdev->dev, desc->data & ~3,
|
|
|
|
ALIGN((desc->data & 3) + desc->buf_len, 4),
|
|
|
|
DMA_TO_DEVICE);
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void eth_rx_irq(void *pdev)
|
|
|
|
{
|
|
|
|
struct net_device *dev = pdev;
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
|
|
|
|
#if DEBUG_RX
|
|
|
|
printk(KERN_DEBUG "%s: eth_rx_irq\n", dev->name);
|
|
|
|
#endif
|
|
|
|
qmgr_disable_irq(port->plat->rxq);
|
2009-01-20 01:43:59 +01:00
|
|
|
napi_schedule(&port->napi);
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static int eth_poll(struct napi_struct *napi, int budget)
|
|
|
|
{
|
|
|
|
struct port *port = container_of(napi, struct port, napi);
|
|
|
|
struct net_device *dev = port->netdev;
|
|
|
|
unsigned int rxq = port->plat->rxq, rxfreeq = RXFREE_QUEUE(port->id);
|
|
|
|
int received = 0;
|
|
|
|
|
|
|
|
#if DEBUG_RX
|
|
|
|
printk(KERN_DEBUG "%s: eth_poll\n", dev->name);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
while (received < budget) {
|
|
|
|
struct sk_buff *skb;
|
|
|
|
struct desc *desc;
|
|
|
|
int n;
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
struct sk_buff *temp;
|
|
|
|
u32 phys;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if ((n = queue_get_desc(rxq, port, 0)) < 0) {
|
|
|
|
#if DEBUG_RX
|
2009-01-20 01:43:59 +01:00
|
|
|
printk(KERN_DEBUG "%s: eth_poll napi_complete\n",
|
2008-04-20 19:06:39 +02:00
|
|
|
dev->name);
|
|
|
|
#endif
|
2009-01-20 01:43:59 +01:00
|
|
|
napi_complete(napi);
|
2008-04-20 19:06:39 +02:00
|
|
|
qmgr_enable_irq(rxq);
|
2009-05-25 13:25:34 +02:00
|
|
|
if (!qmgr_stat_below_low_watermark(rxq) &&
|
|
|
|
napi_reschedule(napi)) { /* not empty again */
|
2008-04-20 19:06:39 +02:00
|
|
|
#if DEBUG_RX
|
|
|
|
printk(KERN_DEBUG "%s: eth_poll"
|
2009-01-20 01:43:59 +01:00
|
|
|
" napi_reschedule successed\n",
|
2008-04-20 19:06:39 +02:00
|
|
|
dev->name);
|
|
|
|
#endif
|
|
|
|
qmgr_disable_irq(rxq);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
#if DEBUG_RX
|
|
|
|
printk(KERN_DEBUG "%s: eth_poll all done\n",
|
|
|
|
dev->name);
|
|
|
|
#endif
|
2008-07-09 13:10:32 +02:00
|
|
|
return received; /* all work done */
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
desc = rx_desc_ptr(port, n);
|
|
|
|
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
if ((skb = netdev_alloc_skb(dev, RX_BUFF_SIZE))) {
|
|
|
|
phys = dma_map_single(&dev->dev, skb->data,
|
|
|
|
RX_BUFF_SIZE, DMA_FROM_DEVICE);
|
2008-08-13 21:08:14 +02:00
|
|
|
if (dma_mapping_error(&dev->dev, phys)) {
|
2008-04-20 19:06:39 +02:00
|
|
|
dev_kfree_skb(skb);
|
|
|
|
skb = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
skb = netdev_alloc_skb(dev,
|
|
|
|
ALIGN(NET_IP_ALIGN + desc->pkt_len, 4));
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (!skb) {
|
2008-12-20 01:58:59 +01:00
|
|
|
dev->stats.rx_dropped++;
|
2008-04-20 19:06:39 +02:00
|
|
|
/* put the desc back on RX-ready queue */
|
|
|
|
desc->buf_len = MAX_MRU;
|
|
|
|
desc->pkt_len = 0;
|
|
|
|
queue_put_desc(rxfreeq, rx_desc_phys(port, n), desc);
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* process received frame */
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
temp = skb;
|
|
|
|
skb = port->rx_buff_tab[n];
|
|
|
|
dma_unmap_single(&dev->dev, desc->data - NET_IP_ALIGN,
|
|
|
|
RX_BUFF_SIZE, DMA_FROM_DEVICE);
|
|
|
|
#else
|
2009-05-27 17:10:42 +02:00
|
|
|
dma_sync_single_for_cpu(&dev->dev, desc->data - NET_IP_ALIGN,
|
|
|
|
RX_BUFF_SIZE, DMA_FROM_DEVICE);
|
2008-04-20 19:06:39 +02:00
|
|
|
memcpy_swab32((u32 *)skb->data, (u32 *)port->rx_buff_tab[n],
|
|
|
|
ALIGN(NET_IP_ALIGN + desc->pkt_len, 4) / 4);
|
|
|
|
#endif
|
|
|
|
skb_reserve(skb, NET_IP_ALIGN);
|
|
|
|
skb_put(skb, desc->pkt_len);
|
|
|
|
|
|
|
|
debug_pkt(dev, "eth_poll", skb->data, skb->len);
|
|
|
|
|
2011-04-22 12:04:31 +02:00
|
|
|
ixp_rx_timestamp(port, skb);
|
2008-04-20 19:06:39 +02:00
|
|
|
skb->protocol = eth_type_trans(skb, dev);
|
2008-12-20 01:58:59 +01:00
|
|
|
dev->stats.rx_packets++;
|
|
|
|
dev->stats.rx_bytes += skb->len;
|
2008-04-20 19:06:39 +02:00
|
|
|
netif_receive_skb(skb);
|
|
|
|
|
|
|
|
/* put the new buffer on RX-free queue */
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
port->rx_buff_tab[n] = temp;
|
|
|
|
desc->data = phys + NET_IP_ALIGN;
|
|
|
|
#endif
|
|
|
|
desc->buf_len = MAX_MRU;
|
|
|
|
desc->pkt_len = 0;
|
|
|
|
queue_put_desc(rxfreeq, rx_desc_phys(port, n), desc);
|
|
|
|
received++;
|
|
|
|
}
|
|
|
|
|
|
|
|
#if DEBUG_RX
|
|
|
|
printk(KERN_DEBUG "eth_poll(): end, not all work done\n");
|
|
|
|
#endif
|
|
|
|
return received; /* not all work done */
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void eth_txdone_irq(void *unused)
|
|
|
|
{
|
|
|
|
u32 phys;
|
|
|
|
|
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG DRV_NAME ": eth_txdone_irq\n");
|
|
|
|
#endif
|
2008-12-22 00:26:38 +01:00
|
|
|
while ((phys = qmgr_get_entry(TXDONE_QUEUE)) != 0) {
|
2008-04-20 19:06:39 +02:00
|
|
|
u32 npe_id, n_desc;
|
|
|
|
struct port *port;
|
|
|
|
struct desc *desc;
|
|
|
|
int start;
|
|
|
|
|
|
|
|
npe_id = phys & 3;
|
|
|
|
BUG_ON(npe_id >= MAX_NPES);
|
|
|
|
port = npe_port_tab[npe_id];
|
|
|
|
BUG_ON(!port);
|
|
|
|
phys &= ~0x1F; /* mask out non-address bits */
|
|
|
|
n_desc = (phys - tx_desc_phys(port, 0)) / sizeof(struct desc);
|
|
|
|
BUG_ON(n_desc >= TX_DESCS);
|
|
|
|
desc = tx_desc_ptr(port, n_desc);
|
|
|
|
debug_desc(phys, desc);
|
|
|
|
|
|
|
|
if (port->tx_buff_tab[n_desc]) { /* not the draining packet */
|
2008-12-20 01:58:59 +01:00
|
|
|
port->netdev->stats.tx_packets++;
|
|
|
|
port->netdev->stats.tx_bytes += desc->pkt_len;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
dma_unmap_tx(port, desc);
|
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_txdone_irq free %p\n",
|
|
|
|
port->netdev->name, port->tx_buff_tab[n_desc]);
|
|
|
|
#endif
|
|
|
|
free_buffer_irq(port->tx_buff_tab[n_desc]);
|
|
|
|
port->tx_buff_tab[n_desc] = NULL;
|
|
|
|
}
|
|
|
|
|
2009-05-25 13:25:34 +02:00
|
|
|
start = qmgr_stat_below_low_watermark(port->plat->txreadyq);
|
2008-04-20 19:06:39 +02:00
|
|
|
queue_put_desc(port->plat->txreadyq, phys, desc);
|
2009-05-25 13:25:34 +02:00
|
|
|
if (start) { /* TX-ready queue was empty */
|
2008-04-20 19:06:39 +02:00
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_txdone_irq xmit ready\n",
|
|
|
|
port->netdev->name);
|
|
|
|
#endif
|
|
|
|
netif_wake_queue(port->netdev);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int eth_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
unsigned int txreadyq = port->plat->txreadyq;
|
|
|
|
int len, offset, bytes, n;
|
|
|
|
void *mem;
|
|
|
|
u32 phys;
|
|
|
|
struct desc *desc;
|
|
|
|
|
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_xmit\n", dev->name);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
if (unlikely(skb->len > MAX_MRU)) {
|
|
|
|
dev_kfree_skb(skb);
|
2008-12-20 01:58:59 +01:00
|
|
|
dev->stats.tx_errors++;
|
2008-04-20 19:06:39 +02:00
|
|
|
return NETDEV_TX_OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
debug_pkt(dev, "eth_xmit", skb->data, skb->len);
|
|
|
|
|
|
|
|
len = skb->len;
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
offset = 0; /* no need to keep alignment */
|
|
|
|
bytes = len;
|
|
|
|
mem = skb->data;
|
|
|
|
#else
|
|
|
|
offset = (int)skb->data & 3; /* keep 32-bit alignment */
|
|
|
|
bytes = ALIGN(offset + len, 4);
|
|
|
|
if (!(mem = kmalloc(bytes, GFP_ATOMIC))) {
|
|
|
|
dev_kfree_skb(skb);
|
2008-12-20 01:58:59 +01:00
|
|
|
dev->stats.tx_dropped++;
|
2008-04-20 19:06:39 +02:00
|
|
|
return NETDEV_TX_OK;
|
|
|
|
}
|
|
|
|
memcpy_swab32(mem, (u32 *)((int)skb->data & ~3), bytes / 4);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
phys = dma_map_single(&dev->dev, mem, bytes, DMA_TO_DEVICE);
|
2008-08-13 21:08:14 +02:00
|
|
|
if (dma_mapping_error(&dev->dev, phys)) {
|
2008-04-20 19:06:39 +02:00
|
|
|
dev_kfree_skb(skb);
|
2011-04-22 12:04:31 +02:00
|
|
|
#ifndef __ARMEB__
|
2008-04-20 19:06:39 +02:00
|
|
|
kfree(mem);
|
|
|
|
#endif
|
2008-12-20 01:58:59 +01:00
|
|
|
dev->stats.tx_dropped++;
|
2008-04-20 19:06:39 +02:00
|
|
|
return NETDEV_TX_OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
n = queue_get_desc(txreadyq, port, 1);
|
|
|
|
BUG_ON(n < 0);
|
|
|
|
desc = tx_desc_ptr(port, n);
|
|
|
|
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
port->tx_buff_tab[n] = skb;
|
|
|
|
#else
|
|
|
|
port->tx_buff_tab[n] = mem;
|
|
|
|
#endif
|
|
|
|
desc->data = phys + offset;
|
|
|
|
desc->buf_len = desc->pkt_len = len;
|
|
|
|
|
|
|
|
/* NPE firmware pads short frames with zeros internally */
|
|
|
|
wmb();
|
|
|
|
queue_put_desc(TX_QUEUE(port->id), tx_desc_phys(port, n), desc);
|
|
|
|
|
2009-05-25 13:25:34 +02:00
|
|
|
if (qmgr_stat_below_low_watermark(txreadyq)) { /* empty */
|
2008-04-20 19:06:39 +02:00
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_xmit queue full\n", dev->name);
|
|
|
|
#endif
|
|
|
|
netif_stop_queue(dev);
|
|
|
|
/* we could miss TX ready interrupt */
|
2009-05-23 23:14:10 +02:00
|
|
|
/* really empty in fact */
|
2009-05-25 13:25:34 +02:00
|
|
|
if (!qmgr_stat_below_low_watermark(txreadyq)) {
|
2008-04-20 19:06:39 +02:00
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_xmit ready again\n",
|
|
|
|
dev->name);
|
|
|
|
#endif
|
|
|
|
netif_wake_queue(dev);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
#if DEBUG_TX
|
|
|
|
printk(KERN_DEBUG "%s: eth_xmit end\n", dev->name);
|
|
|
|
#endif
|
2011-04-22 12:04:31 +02:00
|
|
|
|
|
|
|
ixp_tx_timestamp(port, skb);
|
|
|
|
skb_tx_timestamp(skb);
|
|
|
|
|
|
|
|
#ifndef __ARMEB__
|
|
|
|
dev_kfree_skb(skb);
|
|
|
|
#endif
|
2008-04-20 19:06:39 +02:00
|
|
|
return NETDEV_TX_OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void eth_set_mcast_list(struct net_device *dev)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
2010-04-01 23:22:57 +02:00
|
|
|
struct netdev_hw_addr *ha;
|
2008-04-20 19:06:39 +02:00
|
|
|
u8 diffs[ETH_ALEN], *addr;
|
2010-02-20 00:06:27 +01:00
|
|
|
int i;
|
2010-06-01 09:16:53 +02:00
|
|
|
static const u8 allmulti[] = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 };
|
|
|
|
|
|
|
|
if (dev->flags & IFF_ALLMULTI) {
|
|
|
|
for (i = 0; i < ETH_ALEN; i++) {
|
|
|
|
__raw_writel(allmulti[i], &port->regs->mcast_addr[i]);
|
|
|
|
__raw_writel(allmulti[i], &port->regs->mcast_mask[i]);
|
|
|
|
}
|
|
|
|
__raw_writel(DEFAULT_RX_CNTRL0 | RX_CNTRL0_ADDR_FLTR_EN,
|
|
|
|
&port->regs->rx_control[0]);
|
|
|
|
return;
|
|
|
|
}
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2010-02-20 00:06:27 +01:00
|
|
|
if ((dev->flags & IFF_PROMISC) || netdev_mc_empty(dev)) {
|
2008-04-20 19:06:39 +02:00
|
|
|
__raw_writel(DEFAULT_RX_CNTRL0 & ~RX_CNTRL0_ADDR_FLTR_EN,
|
|
|
|
&port->regs->rx_control[0]);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
memset(diffs, 0, ETH_ALEN);
|
|
|
|
|
2010-02-20 00:06:27 +01:00
|
|
|
addr = NULL;
|
2010-04-01 23:22:57 +02:00
|
|
|
netdev_for_each_mc_addr(ha, dev) {
|
2010-02-20 00:06:27 +01:00
|
|
|
if (!addr)
|
2010-04-01 23:22:57 +02:00
|
|
|
addr = ha->addr; /* first MAC address */
|
2008-04-20 19:06:39 +02:00
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
2010-04-01 23:22:57 +02:00
|
|
|
diffs[i] |= addr[i] ^ ha->addr[i];
|
2010-02-20 00:06:27 +01:00
|
|
|
}
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
for (i = 0; i < ETH_ALEN; i++) {
|
|
|
|
__raw_writel(addr[i], &port->regs->mcast_addr[i]);
|
|
|
|
__raw_writel(~diffs[i], &port->regs->mcast_mask[i]);
|
|
|
|
}
|
|
|
|
|
|
|
|
__raw_writel(DEFAULT_RX_CNTRL0 | RX_CNTRL0_ADDR_FLTR_EN,
|
|
|
|
&port->regs->rx_control[0]);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int eth_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
|
|
|
|
if (!netif_running(dev))
|
|
|
|
return -EINVAL;
|
2010-07-17 10:48:55 +02:00
|
|
|
|
2011-04-22 12:04:31 +02:00
|
|
|
if (cpu_is_ixp46x() && cmd == SIOCSHWTSTAMP)
|
|
|
|
return hwtstamp_ioctl(dev, req, cmd);
|
|
|
|
|
2010-07-17 10:48:55 +02:00
|
|
|
return phy_mii_ioctl(port->phydev, req, cmd);
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-21 00:02:34 +01:00
|
|
|
/* ethtool support */
|
|
|
|
|
|
|
|
static void ixp4xx_get_drvinfo(struct net_device *dev,
|
|
|
|
struct ethtool_drvinfo *info)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
2013-01-06 01:44:26 +01:00
|
|
|
|
|
|
|
strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
|
2008-12-21 00:02:34 +01:00
|
|
|
snprintf(info->fw_version, sizeof(info->fw_version), "%u:%u:%u:%u",
|
|
|
|
port->firmware[0], port->firmware[1],
|
|
|
|
port->firmware[2], port->firmware[3]);
|
2013-01-06 01:44:26 +01:00
|
|
|
strlcpy(info->bus_info, "internal", sizeof(info->bus_info));
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
2008-12-21 00:02:34 +01:00
|
|
|
static int ixp4xx_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
return phy_ethtool_gset(port->phydev, cmd);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ixp4xx_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
return phy_ethtool_sset(port->phydev, cmd);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int ixp4xx_nway_reset(struct net_device *dev)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
return phy_start_aneg(port->phydev);
|
|
|
|
}
|
|
|
|
|
2012-04-04 00:59:21 +02:00
|
|
|
int ixp46x_phc_index = -1;
|
2012-08-05 12:30:11 +02:00
|
|
|
EXPORT_SYMBOL_GPL(ixp46x_phc_index);
|
2012-04-04 00:59:21 +02:00
|
|
|
|
|
|
|
static int ixp4xx_get_ts_info(struct net_device *dev,
|
|
|
|
struct ethtool_ts_info *info)
|
|
|
|
{
|
|
|
|
if (!cpu_is_ixp46x()) {
|
|
|
|
info->so_timestamping =
|
|
|
|
SOF_TIMESTAMPING_TX_SOFTWARE |
|
|
|
|
SOF_TIMESTAMPING_RX_SOFTWARE |
|
|
|
|
SOF_TIMESTAMPING_SOFTWARE;
|
|
|
|
info->phc_index = -1;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
info->so_timestamping =
|
|
|
|
SOF_TIMESTAMPING_TX_HARDWARE |
|
|
|
|
SOF_TIMESTAMPING_RX_HARDWARE |
|
|
|
|
SOF_TIMESTAMPING_RAW_HARDWARE;
|
|
|
|
info->phc_index = ixp46x_phc_index;
|
|
|
|
info->tx_types =
|
|
|
|
(1 << HWTSTAMP_TX_OFF) |
|
|
|
|
(1 << HWTSTAMP_TX_ON);
|
|
|
|
info->rx_filters =
|
|
|
|
(1 << HWTSTAMP_FILTER_NONE) |
|
|
|
|
(1 << HWTSTAMP_FILTER_PTP_V1_L4_SYNC) |
|
|
|
|
(1 << HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-09-02 10:03:33 +02:00
|
|
|
static const struct ethtool_ops ixp4xx_ethtool_ops = {
|
2008-12-21 00:02:34 +01:00
|
|
|
.get_drvinfo = ixp4xx_get_drvinfo,
|
|
|
|
.get_settings = ixp4xx_get_settings,
|
|
|
|
.set_settings = ixp4xx_set_settings,
|
|
|
|
.nway_reset = ixp4xx_nway_reset,
|
|
|
|
.get_link = ethtool_op_get_link,
|
2012-04-04 00:59:21 +02:00
|
|
|
.get_ts_info = ixp4xx_get_ts_info,
|
2008-12-21 00:02:34 +01:00
|
|
|
};
|
|
|
|
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
static int request_queues(struct port *port)
|
|
|
|
{
|
|
|
|
int err;
|
|
|
|
|
2008-12-22 00:26:38 +01:00
|
|
|
err = qmgr_request_queue(RXFREE_QUEUE(port->id), RX_DESCS, 0, 0,
|
2009-05-23 23:14:59 +02:00
|
|
|
"%s:RX-free", port->netdev->name);
|
2008-04-20 19:06:39 +02:00
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
2008-12-22 00:26:38 +01:00
|
|
|
err = qmgr_request_queue(port->plat->rxq, RX_DESCS, 0, 0,
|
2009-05-23 23:14:59 +02:00
|
|
|
"%s:RX", port->netdev->name);
|
2008-04-20 19:06:39 +02:00
|
|
|
if (err)
|
|
|
|
goto rel_rxfree;
|
|
|
|
|
2008-12-22 00:26:38 +01:00
|
|
|
err = qmgr_request_queue(TX_QUEUE(port->id), TX_DESCS, 0, 0,
|
2009-05-23 23:14:59 +02:00
|
|
|
"%s:TX", port->netdev->name);
|
2008-04-20 19:06:39 +02:00
|
|
|
if (err)
|
|
|
|
goto rel_rx;
|
|
|
|
|
2008-12-22 00:26:38 +01:00
|
|
|
err = qmgr_request_queue(port->plat->txreadyq, TX_DESCS, 0, 0,
|
2009-05-23 23:14:59 +02:00
|
|
|
"%s:TX-ready", port->netdev->name);
|
2008-04-20 19:06:39 +02:00
|
|
|
if (err)
|
|
|
|
goto rel_tx;
|
|
|
|
|
|
|
|
/* TX-done queue handles skbs sent out by the NPEs */
|
|
|
|
if (!ports_open) {
|
2008-12-22 00:26:38 +01:00
|
|
|
err = qmgr_request_queue(TXDONE_QUEUE, TXDONE_QUEUE_LEN, 0, 0,
|
2009-05-23 23:14:59 +02:00
|
|
|
"%s:TX-done", DRV_NAME);
|
2008-04-20 19:06:39 +02:00
|
|
|
if (err)
|
|
|
|
goto rel_txready;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
rel_txready:
|
|
|
|
qmgr_release_queue(port->plat->txreadyq);
|
|
|
|
rel_tx:
|
|
|
|
qmgr_release_queue(TX_QUEUE(port->id));
|
|
|
|
rel_rx:
|
|
|
|
qmgr_release_queue(port->plat->rxq);
|
|
|
|
rel_rxfree:
|
|
|
|
qmgr_release_queue(RXFREE_QUEUE(port->id));
|
|
|
|
printk(KERN_DEBUG "%s: unable to request hardware queues\n",
|
|
|
|
port->netdev->name);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void release_queues(struct port *port)
|
|
|
|
{
|
|
|
|
qmgr_release_queue(RXFREE_QUEUE(port->id));
|
|
|
|
qmgr_release_queue(port->plat->rxq);
|
|
|
|
qmgr_release_queue(TX_QUEUE(port->id));
|
|
|
|
qmgr_release_queue(port->plat->txreadyq);
|
|
|
|
|
|
|
|
if (!ports_open)
|
|
|
|
qmgr_release_queue(TXDONE_QUEUE);
|
|
|
|
}
|
|
|
|
|
|
|
|
static int init_queues(struct port *port)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
2012-11-17 21:25:09 +01:00
|
|
|
if (!ports_open) {
|
|
|
|
dma_pool = dma_pool_create(DRV_NAME, &port->netdev->dev,
|
|
|
|
POOL_ALLOC_SIZE, 32, 0);
|
|
|
|
if (!dma_pool)
|
2008-04-20 19:06:39 +02:00
|
|
|
return -ENOMEM;
|
2012-11-17 21:25:09 +01:00
|
|
|
}
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
if (!(port->desc_tab = dma_pool_alloc(dma_pool, GFP_KERNEL,
|
|
|
|
&port->desc_tab_phys)))
|
|
|
|
return -ENOMEM;
|
|
|
|
memset(port->desc_tab, 0, POOL_ALLOC_SIZE);
|
|
|
|
memset(port->rx_buff_tab, 0, sizeof(port->rx_buff_tab)); /* tables */
|
|
|
|
memset(port->tx_buff_tab, 0, sizeof(port->tx_buff_tab));
|
|
|
|
|
|
|
|
/* Setup RX buffers */
|
|
|
|
for (i = 0; i < RX_DESCS; i++) {
|
|
|
|
struct desc *desc = rx_desc_ptr(port, i);
|
|
|
|
buffer_t *buff; /* skb or kmalloc()ated memory */
|
|
|
|
void *data;
|
|
|
|
#ifdef __ARMEB__
|
|
|
|
if (!(buff = netdev_alloc_skb(port->netdev, RX_BUFF_SIZE)))
|
|
|
|
return -ENOMEM;
|
|
|
|
data = buff->data;
|
|
|
|
#else
|
|
|
|
if (!(buff = kmalloc(RX_BUFF_SIZE, GFP_KERNEL)))
|
|
|
|
return -ENOMEM;
|
|
|
|
data = buff;
|
|
|
|
#endif
|
|
|
|
desc->buf_len = MAX_MRU;
|
|
|
|
desc->data = dma_map_single(&port->netdev->dev, data,
|
|
|
|
RX_BUFF_SIZE, DMA_FROM_DEVICE);
|
2008-08-13 21:08:14 +02:00
|
|
|
if (dma_mapping_error(&port->netdev->dev, desc->data)) {
|
2008-04-20 19:06:39 +02:00
|
|
|
free_buffer(buff);
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
desc->data += NET_IP_ALIGN;
|
|
|
|
port->rx_buff_tab[i] = buff;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void destroy_queues(struct port *port)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
if (port->desc_tab) {
|
|
|
|
for (i = 0; i < RX_DESCS; i++) {
|
|
|
|
struct desc *desc = rx_desc_ptr(port, i);
|
|
|
|
buffer_t *buff = port->rx_buff_tab[i];
|
|
|
|
if (buff) {
|
|
|
|
dma_unmap_single(&port->netdev->dev,
|
|
|
|
desc->data - NET_IP_ALIGN,
|
|
|
|
RX_BUFF_SIZE, DMA_FROM_DEVICE);
|
|
|
|
free_buffer(buff);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for (i = 0; i < TX_DESCS; i++) {
|
|
|
|
struct desc *desc = tx_desc_ptr(port, i);
|
|
|
|
buffer_t *buff = port->tx_buff_tab[i];
|
|
|
|
if (buff) {
|
|
|
|
dma_unmap_tx(port, desc);
|
|
|
|
free_buffer(buff);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
dma_pool_free(dma_pool, port->desc_tab, port->desc_tab_phys);
|
|
|
|
port->desc_tab = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!ports_open && dma_pool) {
|
|
|
|
dma_pool_destroy(dma_pool);
|
|
|
|
dma_pool = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int eth_open(struct net_device *dev)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
struct npe *npe = port->npe;
|
|
|
|
struct msg msg;
|
|
|
|
int i, err;
|
|
|
|
|
|
|
|
if (!npe_running(npe)) {
|
|
|
|
err = npe_load_firmware(npe, npe_name(npe), &dev->dev);
|
|
|
|
if (err)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
if (npe_recv_message(npe, &msg, "ETH_GET_STATUS")) {
|
|
|
|
printk(KERN_ERR "%s: %s not responding\n", dev->name,
|
|
|
|
npe_name(npe));
|
|
|
|
return -EIO;
|
|
|
|
}
|
2008-12-21 00:02:34 +01:00
|
|
|
port->firmware[0] = msg.byte4;
|
|
|
|
port->firmware[1] = msg.byte5;
|
|
|
|
port->firmware[2] = msg.byte6;
|
|
|
|
port->firmware[3] = msg.byte7;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
memset(&msg, 0, sizeof(msg));
|
|
|
|
msg.cmd = NPE_VLAN_SETRXQOSENTRY;
|
|
|
|
msg.eth_id = port->id;
|
|
|
|
msg.byte5 = port->plat->rxq | 0x80;
|
|
|
|
msg.byte7 = port->plat->rxq << 4;
|
|
|
|
for (i = 0; i < 8; i++) {
|
|
|
|
msg.byte3 = i;
|
|
|
|
if (npe_send_recv_message(port->npe, &msg, "ETH_SET_RXQ"))
|
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
|
|
|
msg.cmd = NPE_EDB_SETPORTADDRESS;
|
|
|
|
msg.eth_id = PHYSICAL_ID(port->id);
|
|
|
|
msg.byte2 = dev->dev_addr[0];
|
|
|
|
msg.byte3 = dev->dev_addr[1];
|
|
|
|
msg.byte4 = dev->dev_addr[2];
|
|
|
|
msg.byte5 = dev->dev_addr[3];
|
|
|
|
msg.byte6 = dev->dev_addr[4];
|
|
|
|
msg.byte7 = dev->dev_addr[5];
|
|
|
|
if (npe_send_recv_message(port->npe, &msg, "ETH_SET_MAC"))
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
memset(&msg, 0, sizeof(msg));
|
|
|
|
msg.cmd = NPE_FW_SETFIREWALLMODE;
|
|
|
|
msg.eth_id = port->id;
|
|
|
|
if (npe_send_recv_message(port->npe, &msg, "ETH_SET_FIREWALL_MODE"))
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
if ((err = request_queues(port)) != 0)
|
|
|
|
return err;
|
|
|
|
|
|
|
|
if ((err = init_queues(port)) != 0) {
|
|
|
|
destroy_queues(port);
|
|
|
|
release_queues(port);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
port->speed = 0; /* force "link up" message */
|
|
|
|
phy_start(port->phydev);
|
|
|
|
|
2008-04-20 19:06:39 +02:00
|
|
|
for (i = 0; i < ETH_ALEN; i++)
|
|
|
|
__raw_writel(dev->dev_addr[i], &port->regs->hw_addr[i]);
|
|
|
|
__raw_writel(0x08, &port->regs->random_seed);
|
|
|
|
__raw_writel(0x12, &port->regs->partial_empty_threshold);
|
|
|
|
__raw_writel(0x30, &port->regs->partial_full_threshold);
|
|
|
|
__raw_writel(0x08, &port->regs->tx_start_bytes);
|
|
|
|
__raw_writel(0x15, &port->regs->tx_deferral);
|
|
|
|
__raw_writel(0x08, &port->regs->tx_2part_deferral[0]);
|
|
|
|
__raw_writel(0x07, &port->regs->tx_2part_deferral[1]);
|
|
|
|
__raw_writel(0x80, &port->regs->slot_time);
|
|
|
|
__raw_writel(0x01, &port->regs->int_clock_threshold);
|
|
|
|
|
|
|
|
/* Populate queues with buffers, no failure after this point */
|
|
|
|
for (i = 0; i < TX_DESCS; i++)
|
|
|
|
queue_put_desc(port->plat->txreadyq,
|
|
|
|
tx_desc_phys(port, i), tx_desc_ptr(port, i));
|
|
|
|
|
|
|
|
for (i = 0; i < RX_DESCS; i++)
|
|
|
|
queue_put_desc(RXFREE_QUEUE(port->id),
|
|
|
|
rx_desc_phys(port, i), rx_desc_ptr(port, i));
|
|
|
|
|
|
|
|
__raw_writel(TX_CNTRL1_RETRIES, &port->regs->tx_control[1]);
|
|
|
|
__raw_writel(DEFAULT_TX_CNTRL0, &port->regs->tx_control[0]);
|
|
|
|
__raw_writel(0, &port->regs->rx_control[1]);
|
|
|
|
__raw_writel(DEFAULT_RX_CNTRL0, &port->regs->rx_control[0]);
|
|
|
|
|
|
|
|
napi_enable(&port->napi);
|
|
|
|
eth_set_mcast_list(dev);
|
|
|
|
netif_start_queue(dev);
|
|
|
|
|
|
|
|
qmgr_set_irq(port->plat->rxq, QUEUE_IRQ_SRC_NOT_EMPTY,
|
|
|
|
eth_rx_irq, dev);
|
|
|
|
if (!ports_open) {
|
|
|
|
qmgr_set_irq(TXDONE_QUEUE, QUEUE_IRQ_SRC_NOT_EMPTY,
|
|
|
|
eth_txdone_irq, NULL);
|
|
|
|
qmgr_enable_irq(TXDONE_QUEUE);
|
|
|
|
}
|
|
|
|
ports_open++;
|
|
|
|
/* we may already have RX data, enables IRQ */
|
2009-01-20 01:43:59 +01:00
|
|
|
napi_schedule(&port->napi);
|
2008-04-20 19:06:39 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int eth_close(struct net_device *dev)
|
|
|
|
{
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
struct msg msg;
|
|
|
|
int buffs = RX_DESCS; /* allocated RX buffers */
|
|
|
|
int i;
|
|
|
|
|
|
|
|
ports_open--;
|
|
|
|
qmgr_disable_irq(port->plat->rxq);
|
|
|
|
napi_disable(&port->napi);
|
|
|
|
netif_stop_queue(dev);
|
|
|
|
|
|
|
|
while (queue_get_desc(RXFREE_QUEUE(port->id), port, 0) >= 0)
|
|
|
|
buffs--;
|
|
|
|
|
|
|
|
memset(&msg, 0, sizeof(msg));
|
|
|
|
msg.cmd = NPE_SETLOOPBACK_MODE;
|
|
|
|
msg.eth_id = port->id;
|
|
|
|
msg.byte3 = 1;
|
|
|
|
if (npe_send_recv_message(port->npe, &msg, "ETH_ENABLE_LOOPBACK"))
|
|
|
|
printk(KERN_CRIT "%s: unable to enable loopback\n", dev->name);
|
|
|
|
|
|
|
|
i = 0;
|
|
|
|
do { /* drain RX buffers */
|
|
|
|
while (queue_get_desc(port->plat->rxq, port, 0) >= 0)
|
|
|
|
buffs--;
|
|
|
|
if (!buffs)
|
|
|
|
break;
|
|
|
|
if (qmgr_stat_empty(TX_QUEUE(port->id))) {
|
|
|
|
/* we have to inject some packet */
|
|
|
|
struct desc *desc;
|
|
|
|
u32 phys;
|
|
|
|
int n = queue_get_desc(port->plat->txreadyq, port, 1);
|
|
|
|
BUG_ON(n < 0);
|
|
|
|
desc = tx_desc_ptr(port, n);
|
|
|
|
phys = tx_desc_phys(port, n);
|
|
|
|
desc->buf_len = desc->pkt_len = 1;
|
|
|
|
wmb();
|
|
|
|
queue_put_desc(TX_QUEUE(port->id), phys, desc);
|
|
|
|
}
|
|
|
|
udelay(1);
|
|
|
|
} while (++i < MAX_CLOSE_WAIT);
|
|
|
|
|
|
|
|
if (buffs)
|
|
|
|
printk(KERN_CRIT "%s: unable to drain RX queue, %i buffer(s)"
|
|
|
|
" left in NPE\n", dev->name, buffs);
|
|
|
|
#if DEBUG_CLOSE
|
|
|
|
if (!buffs)
|
|
|
|
printk(KERN_DEBUG "Draining RX queue took %i cycles\n", i);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
buffs = TX_DESCS;
|
|
|
|
while (queue_get_desc(TX_QUEUE(port->id), port, 1) >= 0)
|
|
|
|
buffs--; /* cancel TX */
|
|
|
|
|
|
|
|
i = 0;
|
|
|
|
do {
|
|
|
|
while (queue_get_desc(port->plat->txreadyq, port, 1) >= 0)
|
|
|
|
buffs--;
|
|
|
|
if (!buffs)
|
|
|
|
break;
|
|
|
|
} while (++i < MAX_CLOSE_WAIT);
|
|
|
|
|
|
|
|
if (buffs)
|
|
|
|
printk(KERN_CRIT "%s: unable to drain TX queue, %i buffer(s) "
|
|
|
|
"left in NPE\n", dev->name, buffs);
|
|
|
|
#if DEBUG_CLOSE
|
|
|
|
if (!buffs)
|
|
|
|
printk(KERN_DEBUG "Draining TX queues took %i cycles\n", i);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
msg.byte3 = 0;
|
|
|
|
if (npe_send_recv_message(port->npe, &msg, "ETH_DISABLE_LOOPBACK"))
|
|
|
|
printk(KERN_CRIT "%s: unable to disable loopback\n",
|
|
|
|
dev->name);
|
|
|
|
|
2008-12-20 01:53:08 +01:00
|
|
|
phy_stop(port->phydev);
|
2008-04-20 19:06:39 +02:00
|
|
|
|
|
|
|
if (!ports_open)
|
|
|
|
qmgr_disable_irq(TXDONE_QUEUE);
|
|
|
|
destroy_queues(port);
|
|
|
|
release_queues(port);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-12-22 02:00:17 +01:00
|
|
|
static const struct net_device_ops ixp4xx_netdev_ops = {
|
|
|
|
.ndo_open = eth_open,
|
|
|
|
.ndo_stop = eth_close,
|
|
|
|
.ndo_start_xmit = eth_xmit,
|
2011-08-16 08:29:01 +02:00
|
|
|
.ndo_set_rx_mode = eth_set_mcast_list,
|
2008-12-22 02:00:17 +01:00
|
|
|
.ndo_do_ioctl = eth_ioctl,
|
2009-07-09 19:59:01 +02:00
|
|
|
.ndo_change_mtu = eth_change_mtu,
|
2009-07-09 19:54:35 +02:00
|
|
|
.ndo_set_mac_address = eth_mac_addr,
|
|
|
|
.ndo_validate_addr = eth_validate_addr,
|
2008-12-22 02:00:17 +01:00
|
|
|
};
|
|
|
|
|
2012-12-03 15:23:51 +01:00
|
|
|
static int eth_init_one(struct platform_device *pdev)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
|
|
|
struct port *port;
|
|
|
|
struct net_device *dev;
|
2013-08-30 07:08:22 +02:00
|
|
|
struct eth_plat_info *plat = dev_get_platdata(&pdev->dev);
|
2008-04-20 19:06:39 +02:00
|
|
|
u32 regs_phys;
|
2009-05-27 06:09:33 +02:00
|
|
|
char phy_id[MII_BUS_ID_SIZE + 3];
|
2008-04-20 19:06:39 +02:00
|
|
|
int err;
|
|
|
|
|
2011-04-22 12:04:31 +02:00
|
|
|
if (ptp_filter_init(ptp_filter, ARRAY_SIZE(ptp_filter))) {
|
|
|
|
pr_err("ixp4xx_eth: bad ptp filter\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2008-04-20 19:06:39 +02:00
|
|
|
if (!(dev = alloc_etherdev(sizeof(struct port))))
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
SET_NETDEV_DEV(dev, &pdev->dev);
|
|
|
|
port = netdev_priv(dev);
|
|
|
|
port->netdev = dev;
|
|
|
|
port->id = pdev->id;
|
|
|
|
|
|
|
|
switch (port->id) {
|
|
|
|
case IXP4XX_ETH_NPEA:
|
|
|
|
port->regs = (struct eth_regs __iomem *)IXP4XX_EthA_BASE_VIRT;
|
|
|
|
regs_phys = IXP4XX_EthA_BASE_PHYS;
|
|
|
|
break;
|
|
|
|
case IXP4XX_ETH_NPEB:
|
|
|
|
port->regs = (struct eth_regs __iomem *)IXP4XX_EthB_BASE_VIRT;
|
|
|
|
regs_phys = IXP4XX_EthB_BASE_PHYS;
|
|
|
|
break;
|
|
|
|
case IXP4XX_ETH_NPEC:
|
|
|
|
port->regs = (struct eth_regs __iomem *)IXP4XX_EthC_BASE_VIRT;
|
|
|
|
regs_phys = IXP4XX_EthC_BASE_PHYS;
|
|
|
|
break;
|
|
|
|
default:
|
2009-04-28 14:54:07 +02:00
|
|
|
err = -ENODEV;
|
2008-04-20 19:06:39 +02:00
|
|
|
goto err_free;
|
|
|
|
}
|
|
|
|
|
2008-12-22 02:00:17 +01:00
|
|
|
dev->netdev_ops = &ixp4xx_netdev_ops;
|
2008-12-21 00:02:34 +01:00
|
|
|
dev->ethtool_ops = &ixp4xx_ethtool_ops;
|
2008-04-20 19:06:39 +02:00
|
|
|
dev->tx_queue_len = 100;
|
|
|
|
|
|
|
|
netif_napi_add(dev, &port->napi, eth_poll, NAPI_WEIGHT);
|
|
|
|
|
|
|
|
if (!(port->npe = npe_request(NPE_ID(port->id)))) {
|
|
|
|
err = -EIO;
|
|
|
|
goto err_free;
|
|
|
|
}
|
|
|
|
|
|
|
|
port->mem_res = request_mem_region(regs_phys, REGS_SIZE, dev->name);
|
|
|
|
if (!port->mem_res) {
|
|
|
|
err = -EBUSY;
|
2009-05-04 21:31:52 +02:00
|
|
|
goto err_npe_rel;
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
port->plat = plat;
|
|
|
|
npe_port_tab[NPE_ID(port->id)] = port;
|
|
|
|
memcpy(dev->dev_addr, plat->hwaddr, ETH_ALEN);
|
|
|
|
|
|
|
|
platform_set_drvdata(pdev, dev);
|
|
|
|
|
|
|
|
__raw_writel(DEFAULT_CORE_CNTRL | CORE_RESET,
|
|
|
|
&port->regs->core_control);
|
|
|
|
udelay(50);
|
|
|
|
__raw_writel(DEFAULT_CORE_CNTRL, &port->regs->core_control);
|
|
|
|
udelay(50);
|
|
|
|
|
2012-02-13 02:23:24 +01:00
|
|
|
snprintf(phy_id, MII_BUS_ID_SIZE + 3, PHY_ID_FMT,
|
|
|
|
mdio_bus->id, plat->phy);
|
2013-01-14 01:52:52 +01:00
|
|
|
port->phydev = phy_connect(dev, phy_id, &ixp4xx_adjust_link,
|
2008-12-20 01:53:08 +01:00
|
|
|
PHY_INTERFACE_MODE_MII);
|
2011-01-04 20:24:06 +01:00
|
|
|
if (IS_ERR(port->phydev)) {
|
|
|
|
err = PTR_ERR(port->phydev);
|
2009-05-04 21:31:52 +02:00
|
|
|
goto err_free_mem;
|
2011-01-04 20:24:06 +01:00
|
|
|
}
|
2008-12-20 01:53:08 +01:00
|
|
|
|
|
|
|
port->phydev->irq = PHY_POLL;
|
2008-04-20 19:06:39 +02:00
|
|
|
|
2009-05-04 21:31:52 +02:00
|
|
|
if ((err = register_netdev(dev)))
|
|
|
|
goto err_phy_dis;
|
|
|
|
|
2008-04-20 19:06:39 +02:00
|
|
|
printk(KERN_INFO "%s: MII PHY %i on %s\n", dev->name, plat->phy,
|
|
|
|
npe_name(port->npe));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
2009-05-04 21:31:52 +02:00
|
|
|
err_phy_dis:
|
|
|
|
phy_disconnect(port->phydev);
|
|
|
|
err_free_mem:
|
|
|
|
npe_port_tab[NPE_ID(port->id)] = NULL;
|
|
|
|
release_resource(port->mem_res);
|
2008-04-20 19:06:39 +02:00
|
|
|
err_npe_rel:
|
|
|
|
npe_release(port->npe);
|
|
|
|
err_free:
|
|
|
|
free_netdev(dev);
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2012-12-03 15:23:51 +01:00
|
|
|
static int eth_remove_one(struct platform_device *pdev)
|
2008-04-20 19:06:39 +02:00
|
|
|
{
|
|
|
|
struct net_device *dev = platform_get_drvdata(pdev);
|
|
|
|
struct port *port = netdev_priv(dev);
|
|
|
|
|
|
|
|
unregister_netdev(dev);
|
2009-05-04 21:31:52 +02:00
|
|
|
phy_disconnect(port->phydev);
|
2008-04-20 19:06:39 +02:00
|
|
|
npe_port_tab[NPE_ID(port->id)] = NULL;
|
|
|
|
npe_release(port->npe);
|
|
|
|
release_resource(port->mem_res);
|
|
|
|
free_netdev(dev);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2008-11-26 22:59:18 +01:00
|
|
|
static struct platform_driver ixp4xx_eth_driver = {
|
2008-04-20 19:06:39 +02:00
|
|
|
.driver.name = DRV_NAME,
|
|
|
|
.probe = eth_init_one,
|
|
|
|
.remove = eth_remove_one,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init eth_init_module(void)
|
|
|
|
{
|
2008-12-20 01:53:08 +01:00
|
|
|
int err;
|
|
|
|
if ((err = ixp4xx_mdio_register()))
|
|
|
|
return err;
|
2008-11-26 22:59:18 +01:00
|
|
|
return platform_driver_register(&ixp4xx_eth_driver);
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static void __exit eth_cleanup_module(void)
|
|
|
|
{
|
2008-11-26 22:59:18 +01:00
|
|
|
platform_driver_unregister(&ixp4xx_eth_driver);
|
2008-12-20 01:53:08 +01:00
|
|
|
ixp4xx_mdio_remove();
|
2008-04-20 19:06:39 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Krzysztof Halasa");
|
|
|
|
MODULE_DESCRIPTION("Intel IXP4xx Ethernet driver");
|
|
|
|
MODULE_LICENSE("GPL v2");
|
|
|
|
MODULE_ALIAS("platform:ixp4xx_eth");
|
|
|
|
module_init(eth_init_module);
|
|
|
|
module_exit(eth_cleanup_module);
|