blob: 6d74cb7aaae8ab9426d63e50f05a190a6d14c816 [file] [log] [blame]
Anant Golea6286ee2009-05-18 15:19:01 -07001/*
2 * DaVinci Ethernet Medium Access Controller
3 *
4 * DaVinci EMAC is based upon CPPI 3.0 TI DMA engine
5 *
6 * Copyright (C) 2009 Texas Instruments.
7 *
8 * ---------------------------------------------------------------------------
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 * ---------------------------------------------------------------------------
24 * History:
25 * 0-5 A number of folks worked on this driver in bits and pieces but the major
26 * contribution came from Suraj Iyer and Anant Gole
27 * 6.0 Anant Gole - rewrote the driver as per Linux conventions
28 * 6.1 Chaithrika U S - added support for Gigabit and RMII features,
29 * PHY layer usage
30 */
31
Anant Golea6286ee2009-05-18 15:19:01 -070032#include <linux/module.h>
33#include <linux/kernel.h>
34#include <linux/sched.h>
35#include <linux/string.h>
36#include <linux/timer.h>
37#include <linux/errno.h>
38#include <linux/in.h>
39#include <linux/ioport.h>
40#include <linux/slab.h>
41#include <linux/mm.h>
42#include <linux/interrupt.h>
43#include <linux/init.h>
44#include <linux/netdevice.h>
45#include <linux/etherdevice.h>
46#include <linux/skbuff.h>
47#include <linux/ethtool.h>
48#include <linux/highmem.h>
49#include <linux/proc_fs.h>
50#include <linux/ctype.h>
Anant Golea6286ee2009-05-18 15:19:01 -070051#include <linux/spinlock.h>
52#include <linux/dma-mapping.h>
53#include <linux/clk.h>
54#include <linux/platform_device.h>
55#include <linux/semaphore.h>
56#include <linux/phy.h>
57#include <linux/bitops.h>
58#include <linux/io.h>
59#include <linux/uaccess.h>
Sriramakrishnan8ee2bf92009-11-19 15:58:25 +053060#include <linux/davinci_emac.h>
Anant Golea6286ee2009-05-18 15:19:01 -070061
62#include <asm/irq.h>
63#include <asm/page.h>
64
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -040065#include "davinci_cpdma.h"
66
Anant Golea6286ee2009-05-18 15:19:01 -070067static int debug_level;
68module_param(debug_level, int, 0);
69MODULE_PARM_DESC(debug_level, "DaVinci EMAC debug level (NETIF_MSG bits)");
70
71/* Netif debug messages possible */
72#define DAVINCI_EMAC_DEBUG (NETIF_MSG_DRV | \
73 NETIF_MSG_PROBE | \
74 NETIF_MSG_LINK | \
75 NETIF_MSG_TIMER | \
76 NETIF_MSG_IFDOWN | \
77 NETIF_MSG_IFUP | \
78 NETIF_MSG_RX_ERR | \
79 NETIF_MSG_TX_ERR | \
80 NETIF_MSG_TX_QUEUED | \
81 NETIF_MSG_INTR | \
82 NETIF_MSG_TX_DONE | \
83 NETIF_MSG_RX_STATUS | \
84 NETIF_MSG_PKTDATA | \
85 NETIF_MSG_HW | \
86 NETIF_MSG_WOL)
87
88/* version info */
89#define EMAC_MAJOR_VERSION 6
90#define EMAC_MINOR_VERSION 1
91#define EMAC_MODULE_VERSION "6.1"
92MODULE_VERSION(EMAC_MODULE_VERSION);
93static const char emac_version_string[] = "TI DaVinci EMAC Linux v6.1";
94
95/* Configuration items */
Lucas De Marchi25985ed2011-03-30 22:57:33 -030096#define EMAC_DEF_PASS_CRC (0) /* Do not pass CRC up to frames */
Anant Golea6286ee2009-05-18 15:19:01 -070097#define EMAC_DEF_QOS_EN (0) /* EMAC proprietary QoS disabled */
98#define EMAC_DEF_NO_BUFF_CHAIN (0) /* No buffer chain */
99#define EMAC_DEF_MACCTRL_FRAME_EN (0) /* Discard Maccontrol frames */
100#define EMAC_DEF_SHORT_FRAME_EN (0) /* Discard short frames */
101#define EMAC_DEF_ERROR_FRAME_EN (0) /* Discard error frames */
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300102#define EMAC_DEF_PROM_EN (0) /* Promiscuous disabled */
103#define EMAC_DEF_PROM_CH (0) /* Promiscuous channel is 0 */
Anant Golea6286ee2009-05-18 15:19:01 -0700104#define EMAC_DEF_BCAST_EN (1) /* Broadcast enabled */
105#define EMAC_DEF_BCAST_CH (0) /* Broadcast channel is 0 */
106#define EMAC_DEF_MCAST_EN (1) /* Multicast enabled */
107#define EMAC_DEF_MCAST_CH (0) /* Multicast channel is 0 */
108
109#define EMAC_DEF_TXPRIO_FIXED (1) /* TX Priority is fixed */
110#define EMAC_DEF_TXPACING_EN (0) /* TX pacing NOT supported*/
111
112#define EMAC_DEF_BUFFER_OFFSET (0) /* Buffer offset to DMA (future) */
113#define EMAC_DEF_MIN_ETHPKTSIZE (60) /* Minimum ethernet pkt size */
114#define EMAC_DEF_MAX_FRAME_SIZE (1500 + 14 + 4 + 4)
115#define EMAC_DEF_TX_CH (0) /* Default 0th channel */
116#define EMAC_DEF_RX_CH (0) /* Default 0th channel */
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400117#define EMAC_DEF_RX_NUM_DESC (128)
Sascha Hauer86d8c072012-01-03 05:27:47 +0000118#define EMAC_DEF_TX_NUM_DESC (128)
Anant Golea6286ee2009-05-18 15:19:01 -0700119#define EMAC_DEF_MAX_TX_CH (1) /* Max TX channels configured */
120#define EMAC_DEF_MAX_RX_CH (1) /* Max RX channels configured */
121#define EMAC_POLL_WEIGHT (64) /* Default NAPI poll weight */
122
123/* Buffer descriptor parameters */
124#define EMAC_DEF_TX_MAX_SERVICE (32) /* TX max service BD's */
125#define EMAC_DEF_RX_MAX_SERVICE (64) /* should = netdev->weight */
126
127/* EMAC register related defines */
128#define EMAC_ALL_MULTI_REG_VALUE (0xFFFFFFFF)
129#define EMAC_NUM_MULTICAST_BITS (64)
Anant Golea6286ee2009-05-18 15:19:01 -0700130#define EMAC_TX_CONTROL_TX_ENABLE_VAL (0x1)
131#define EMAC_RX_CONTROL_RX_ENABLE_VAL (0x1)
132#define EMAC_MAC_HOST_ERR_INTMASK_VAL (0x2)
133#define EMAC_RX_UNICAST_CLEAR_ALL (0xFF)
134#define EMAC_INT_MASK_CLEAR (0xFF)
135
136/* RX MBP register bit positions */
137#define EMAC_RXMBP_PASSCRC_MASK BIT(30)
138#define EMAC_RXMBP_QOSEN_MASK BIT(29)
139#define EMAC_RXMBP_NOCHAIN_MASK BIT(28)
140#define EMAC_RXMBP_CMFEN_MASK BIT(24)
141#define EMAC_RXMBP_CSFEN_MASK BIT(23)
142#define EMAC_RXMBP_CEFEN_MASK BIT(22)
143#define EMAC_RXMBP_CAFEN_MASK BIT(21)
144#define EMAC_RXMBP_PROMCH_SHIFT (16)
145#define EMAC_RXMBP_PROMCH_MASK (0x7 << 16)
146#define EMAC_RXMBP_BROADEN_MASK BIT(13)
147#define EMAC_RXMBP_BROADCH_SHIFT (8)
148#define EMAC_RXMBP_BROADCH_MASK (0x7 << 8)
149#define EMAC_RXMBP_MULTIEN_MASK BIT(5)
150#define EMAC_RXMBP_MULTICH_SHIFT (0)
151#define EMAC_RXMBP_MULTICH_MASK (0x7)
152#define EMAC_RXMBP_CHMASK (0x7)
153
154/* EMAC register definitions/bit maps used */
155# define EMAC_MBP_RXPROMISC (0x00200000)
156# define EMAC_MBP_PROMISCCH(ch) (((ch) & 0x7) << 16)
157# define EMAC_MBP_RXBCAST (0x00002000)
158# define EMAC_MBP_BCASTCHAN(ch) (((ch) & 0x7) << 8)
159# define EMAC_MBP_RXMCAST (0x00000020)
160# define EMAC_MBP_MCASTCHAN(ch) ((ch) & 0x7)
161
162/* EMAC mac_control register */
chaithrika@ti.com69ef9692009-10-01 10:25:19 +0000163#define EMAC_MACCONTROL_TXPTYPE BIT(9)
164#define EMAC_MACCONTROL_TXPACEEN BIT(6)
165#define EMAC_MACCONTROL_GMIIEN BIT(5)
166#define EMAC_MACCONTROL_GIGABITEN BIT(7)
167#define EMAC_MACCONTROL_FULLDUPLEXEN BIT(0)
Anant Golea6286ee2009-05-18 15:19:01 -0700168#define EMAC_MACCONTROL_RMIISPEED_MASK BIT(15)
169
170/* GIGABIT MODE related bits */
Anant Golea6286ee2009-05-18 15:19:01 -0700171#define EMAC_DM646X_MACCONTORL_GIG BIT(7)
172#define EMAC_DM646X_MACCONTORL_GIGFORCE BIT(17)
173
174/* EMAC mac_status register */
175#define EMAC_MACSTATUS_TXERRCODE_MASK (0xF00000)
176#define EMAC_MACSTATUS_TXERRCODE_SHIFT (20)
177#define EMAC_MACSTATUS_TXERRCH_MASK (0x7)
178#define EMAC_MACSTATUS_TXERRCH_SHIFT (16)
179#define EMAC_MACSTATUS_RXERRCODE_MASK (0xF000)
180#define EMAC_MACSTATUS_RXERRCODE_SHIFT (12)
181#define EMAC_MACSTATUS_RXERRCH_MASK (0x7)
182#define EMAC_MACSTATUS_RXERRCH_SHIFT (8)
183
184/* EMAC RX register masks */
185#define EMAC_RX_MAX_LEN_MASK (0xFFFF)
186#define EMAC_RX_BUFFER_OFFSET_MASK (0xFFFF)
187
188/* MAC_IN_VECTOR (0x180) register bit fields */
chaithrika@ti.com69ef9692009-10-01 10:25:19 +0000189#define EMAC_DM644X_MAC_IN_VECTOR_HOST_INT BIT(17)
190#define EMAC_DM644X_MAC_IN_VECTOR_STATPEND_INT BIT(16)
191#define EMAC_DM644X_MAC_IN_VECTOR_RX_INT_VEC BIT(8)
192#define EMAC_DM644X_MAC_IN_VECTOR_TX_INT_VEC BIT(0)
Anant Golea6286ee2009-05-18 15:19:01 -0700193
194/** NOTE:: For DM646x the IN_VECTOR has changed */
195#define EMAC_DM646X_MAC_IN_VECTOR_RX_INT_VEC BIT(EMAC_DEF_RX_CH)
196#define EMAC_DM646X_MAC_IN_VECTOR_TX_INT_VEC BIT(16 + EMAC_DEF_TX_CH)
Sriram43c2ed82009-09-24 19:15:18 +0000197#define EMAC_DM646X_MAC_IN_VECTOR_HOST_INT BIT(26)
198#define EMAC_DM646X_MAC_IN_VECTOR_STATPEND_INT BIT(27)
199
Anant Golea6286ee2009-05-18 15:19:01 -0700200/* CPPI bit positions */
201#define EMAC_CPPI_SOP_BIT BIT(31)
202#define EMAC_CPPI_EOP_BIT BIT(30)
203#define EMAC_CPPI_OWNERSHIP_BIT BIT(29)
204#define EMAC_CPPI_EOQ_BIT BIT(28)
205#define EMAC_CPPI_TEARDOWN_COMPLETE_BIT BIT(27)
206#define EMAC_CPPI_PASS_CRC_BIT BIT(26)
207#define EMAC_RX_BD_BUF_SIZE (0xFFFF)
208#define EMAC_BD_LENGTH_FOR_CACHE (16) /* only CPPI bytes */
209#define EMAC_RX_BD_PKT_LENGTH_MASK (0xFFFF)
210
211/* Max hardware defines */
212#define EMAC_MAX_TXRX_CHANNELS (8) /* Max hardware channels */
213#define EMAC_DEF_MAX_MULTICAST_ADDRESSES (64) /* Max mcast addr's */
214
215/* EMAC Peripheral Device Register Memory Layout structure */
Anant Golea6286ee2009-05-18 15:19:01 -0700216#define EMAC_MACINVECTOR 0x90
217
218#define EMAC_DM646X_MACEOIVECTOR 0x94
219
Anant Golea6286ee2009-05-18 15:19:01 -0700220#define EMAC_MACINTSTATRAW 0xB0
221#define EMAC_MACINTSTATMASKED 0xB4
222#define EMAC_MACINTMASKSET 0xB8
223#define EMAC_MACINTMASKCLEAR 0xBC
224
225#define EMAC_RXMBPENABLE 0x100
226#define EMAC_RXUNICASTSET 0x104
227#define EMAC_RXUNICASTCLEAR 0x108
228#define EMAC_RXMAXLEN 0x10C
229#define EMAC_RXBUFFEROFFSET 0x110
230#define EMAC_RXFILTERLOWTHRESH 0x114
231
232#define EMAC_MACCONTROL 0x160
233#define EMAC_MACSTATUS 0x164
234#define EMAC_EMCONTROL 0x168
235#define EMAC_FIFOCONTROL 0x16C
236#define EMAC_MACCONFIG 0x170
237#define EMAC_SOFTRESET 0x174
238#define EMAC_MACSRCADDRLO 0x1D0
239#define EMAC_MACSRCADDRHI 0x1D4
240#define EMAC_MACHASH1 0x1D8
241#define EMAC_MACHASH2 0x1DC
242#define EMAC_MACADDRLO 0x500
243#define EMAC_MACADDRHI 0x504
244#define EMAC_MACINDEX 0x508
245
Anant Golea6286ee2009-05-18 15:19:01 -0700246/* EMAC statistics registers */
247#define EMAC_RXGOODFRAMES 0x200
248#define EMAC_RXBCASTFRAMES 0x204
249#define EMAC_RXMCASTFRAMES 0x208
250#define EMAC_RXPAUSEFRAMES 0x20C
251#define EMAC_RXCRCERRORS 0x210
252#define EMAC_RXALIGNCODEERRORS 0x214
253#define EMAC_RXOVERSIZED 0x218
254#define EMAC_RXJABBER 0x21C
255#define EMAC_RXUNDERSIZED 0x220
256#define EMAC_RXFRAGMENTS 0x224
257#define EMAC_RXFILTERED 0x228
258#define EMAC_RXQOSFILTERED 0x22C
259#define EMAC_RXOCTETS 0x230
260#define EMAC_TXGOODFRAMES 0x234
261#define EMAC_TXBCASTFRAMES 0x238
262#define EMAC_TXMCASTFRAMES 0x23C
263#define EMAC_TXPAUSEFRAMES 0x240
264#define EMAC_TXDEFERRED 0x244
265#define EMAC_TXCOLLISION 0x248
266#define EMAC_TXSINGLECOLL 0x24C
267#define EMAC_TXMULTICOLL 0x250
268#define EMAC_TXEXCESSIVECOLL 0x254
269#define EMAC_TXLATECOLL 0x258
270#define EMAC_TXUNDERRUN 0x25C
271#define EMAC_TXCARRIERSENSE 0x260
272#define EMAC_TXOCTETS 0x264
273#define EMAC_NETOCTETS 0x280
274#define EMAC_RXSOFOVERRUNS 0x284
275#define EMAC_RXMOFOVERRUNS 0x288
276#define EMAC_RXDMAOVERRUNS 0x28C
277
278/* EMAC DM644x control registers */
279#define EMAC_CTRL_EWCTL (0x4)
280#define EMAC_CTRL_EWINTTCNT (0x8)
281
Sriram84da2652010-07-29 02:33:58 +0000282/* EMAC DM644x control module masks */
283#define EMAC_DM644X_EWINTCNT_MASK 0x1FFFF
284#define EMAC_DM644X_INTMIN_INTVL 0x1
285#define EMAC_DM644X_INTMAX_INTVL (EMAC_DM644X_EWINTCNT_MASK)
286
Anant Golea6286ee2009-05-18 15:19:01 -0700287/* EMAC DM646X control module registers */
Sriram84da2652010-07-29 02:33:58 +0000288#define EMAC_DM646X_CMINTCTRL 0x0C
289#define EMAC_DM646X_CMRXINTEN 0x14
290#define EMAC_DM646X_CMTXINTEN 0x18
291#define EMAC_DM646X_CMRXINTMAX 0x70
292#define EMAC_DM646X_CMTXINTMAX 0x74
293
294/* EMAC DM646X control module masks */
295#define EMAC_DM646X_INTPACEEN (0x3 << 16)
296#define EMAC_DM646X_INTPRESCALE_MASK (0x7FF << 0)
297#define EMAC_DM646X_CMINTMAX_CNT 63
298#define EMAC_DM646X_CMINTMIN_CNT 2
299#define EMAC_DM646X_CMINTMAX_INTVL (1000 / EMAC_DM646X_CMINTMIN_CNT)
300#define EMAC_DM646X_CMINTMIN_INTVL ((1000 / EMAC_DM646X_CMINTMAX_CNT) + 1)
301
Anant Golea6286ee2009-05-18 15:19:01 -0700302
303/* EMAC EOI codes for C0 */
304#define EMAC_DM646X_MAC_EOI_C0_RXEN (0x01)
305#define EMAC_DM646X_MAC_EOI_C0_TXEN (0x02)
306
Sriram0fe74632009-10-07 02:44:30 +0000307/* EMAC Stats Clear Mask */
308#define EMAC_STATS_CLR_MASK (0xFFFFFFFF)
309
Anant Golea6286ee2009-05-18 15:19:01 -0700310/* emac_priv: EMAC private data structure
311 *
312 * EMAC adapter private data structure
313 */
314struct emac_priv {
315 u32 msg_enable;
316 struct net_device *ndev;
317 struct platform_device *pdev;
318 struct napi_struct napi;
319 char mac_addr[6];
Anant Golea6286ee2009-05-18 15:19:01 -0700320 void __iomem *remap_addr;
321 u32 emac_base_phys;
322 void __iomem *emac_base;
323 void __iomem *ctrl_base;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400324 struct cpdma_ctlr *dma;
325 struct cpdma_chan *txchan;
326 struct cpdma_chan *rxchan;
Anant Golea6286ee2009-05-18 15:19:01 -0700327 u32 link; /* 1=link on, 0=link off */
328 u32 speed; /* 0=Auto Neg, 1=No PHY, 10,100, 1000 - mbps */
329 u32 duplex; /* Link duplex: 0=Half, 1=Full */
330 u32 rx_buf_size;
331 u32 isr_count;
Sriram84da2652010-07-29 02:33:58 +0000332 u32 coal_intvl;
333 u32 bus_freq_mhz;
Anant Golea6286ee2009-05-18 15:19:01 -0700334 u8 rmii_en;
335 u8 version;
Anant Golea6286ee2009-05-18 15:19:01 -0700336 u32 mac_hash1;
337 u32 mac_hash2;
338 u32 multicast_hash_cnt[EMAC_NUM_MULTICAST_BITS];
339 u32 rx_addr_type;
Sascha Hauer86d8c072012-01-03 05:27:47 +0000340 atomic_t cur_tx;
Cyril Chemparathy5d69e002010-09-15 10:11:24 -0400341 const char *phy_id;
Anant Golea6286ee2009-05-18 15:19:01 -0700342 struct phy_device *phydev;
343 spinlock_t lock;
Sriramakrishnan01a9af32009-11-19 15:58:26 +0530344 /*platform specific members*/
345 void (*int_enable) (void);
346 void (*int_disable) (void);
Anant Golea6286ee2009-05-18 15:19:01 -0700347};
348
349/* clock frequency for EMAC */
350static struct clk *emac_clk;
351static unsigned long emac_bus_frequency;
Anant Golea6286ee2009-05-18 15:19:01 -0700352
Anant Golea6286ee2009-05-18 15:19:01 -0700353/* EMAC TX Host Error description strings */
354static char *emac_txhost_errcodes[16] = {
355 "No error", "SOP error", "Ownership bit not set in SOP buffer",
356 "Zero Next Buffer Descriptor Pointer Without EOP",
357 "Zero Buffer Pointer", "Zero Buffer Length", "Packet Length Error",
358 "Reserved", "Reserved", "Reserved", "Reserved", "Reserved",
359 "Reserved", "Reserved", "Reserved", "Reserved"
360};
361
362/* EMAC RX Host Error description strings */
363static char *emac_rxhost_errcodes[16] = {
364 "No error", "Reserved", "Ownership bit not set in input buffer",
365 "Reserved", "Zero Buffer Pointer", "Reserved", "Reserved",
366 "Reserved", "Reserved", "Reserved", "Reserved", "Reserved",
367 "Reserved", "Reserved", "Reserved", "Reserved"
368};
369
370/* Helper macros */
371#define emac_read(reg) ioread32(priv->emac_base + (reg))
372#define emac_write(reg, val) iowrite32(val, priv->emac_base + (reg))
373
374#define emac_ctrl_read(reg) ioread32((priv->ctrl_base + (reg)))
375#define emac_ctrl_write(reg, val) iowrite32(val, (priv->ctrl_base + (reg)))
376
Anant Golea6286ee2009-05-18 15:19:01 -0700377/**
378 * emac_dump_regs: Dump important EMAC registers to debug terminal
379 * @priv: The DaVinci EMAC private adapter structure
380 *
381 * Executes ethtool set cmd & sets phy mode
382 *
383 */
384static void emac_dump_regs(struct emac_priv *priv)
385{
386 struct device *emac_dev = &priv->ndev->dev;
387
388 /* Print important registers in EMAC */
389 dev_info(emac_dev, "EMAC Basic registers\n");
Srirame9947622010-07-29 02:34:00 +0000390 if (priv->version == EMAC_VERSION_1) {
391 dev_info(emac_dev, "EMAC: EWCTL: %08X, EWINTTCNT: %08X\n",
392 emac_ctrl_read(EMAC_CTRL_EWCTL),
393 emac_ctrl_read(EMAC_CTRL_EWINTTCNT));
394 }
Anant Golea6286ee2009-05-18 15:19:01 -0700395 dev_info(emac_dev, "EMAC: EmuControl:%08X, FifoControl: %08X\n",
396 emac_read(EMAC_EMCONTROL), emac_read(EMAC_FIFOCONTROL));
397 dev_info(emac_dev, "EMAC: MBPEnable:%08X, RXUnicastSet: %08X, "\
398 "RXMaxLen=%08X\n", emac_read(EMAC_RXMBPENABLE),
399 emac_read(EMAC_RXUNICASTSET), emac_read(EMAC_RXMAXLEN));
400 dev_info(emac_dev, "EMAC: MacControl:%08X, MacStatus: %08X, "\
401 "MacConfig=%08X\n", emac_read(EMAC_MACCONTROL),
402 emac_read(EMAC_MACSTATUS), emac_read(EMAC_MACCONFIG));
Anant Golea6286ee2009-05-18 15:19:01 -0700403 dev_info(emac_dev, "EMAC Statistics\n");
404 dev_info(emac_dev, "EMAC: rx_good_frames:%d\n",
405 emac_read(EMAC_RXGOODFRAMES));
406 dev_info(emac_dev, "EMAC: rx_broadcast_frames:%d\n",
407 emac_read(EMAC_RXBCASTFRAMES));
408 dev_info(emac_dev, "EMAC: rx_multicast_frames:%d\n",
409 emac_read(EMAC_RXMCASTFRAMES));
410 dev_info(emac_dev, "EMAC: rx_pause_frames:%d\n",
411 emac_read(EMAC_RXPAUSEFRAMES));
412 dev_info(emac_dev, "EMAC: rx_crcerrors:%d\n",
413 emac_read(EMAC_RXCRCERRORS));
414 dev_info(emac_dev, "EMAC: rx_align_code_errors:%d\n",
415 emac_read(EMAC_RXALIGNCODEERRORS));
416 dev_info(emac_dev, "EMAC: rx_oversized_frames:%d\n",
417 emac_read(EMAC_RXOVERSIZED));
418 dev_info(emac_dev, "EMAC: rx_jabber_frames:%d\n",
419 emac_read(EMAC_RXJABBER));
420 dev_info(emac_dev, "EMAC: rx_undersized_frames:%d\n",
421 emac_read(EMAC_RXUNDERSIZED));
422 dev_info(emac_dev, "EMAC: rx_fragments:%d\n",
423 emac_read(EMAC_RXFRAGMENTS));
424 dev_info(emac_dev, "EMAC: rx_filtered_frames:%d\n",
425 emac_read(EMAC_RXFILTERED));
426 dev_info(emac_dev, "EMAC: rx_qos_filtered_frames:%d\n",
427 emac_read(EMAC_RXQOSFILTERED));
428 dev_info(emac_dev, "EMAC: rx_octets:%d\n",
429 emac_read(EMAC_RXOCTETS));
430 dev_info(emac_dev, "EMAC: tx_goodframes:%d\n",
431 emac_read(EMAC_TXGOODFRAMES));
432 dev_info(emac_dev, "EMAC: tx_bcastframes:%d\n",
433 emac_read(EMAC_TXBCASTFRAMES));
434 dev_info(emac_dev, "EMAC: tx_mcastframes:%d\n",
435 emac_read(EMAC_TXMCASTFRAMES));
436 dev_info(emac_dev, "EMAC: tx_pause_frames:%d\n",
437 emac_read(EMAC_TXPAUSEFRAMES));
438 dev_info(emac_dev, "EMAC: tx_deferred_frames:%d\n",
439 emac_read(EMAC_TXDEFERRED));
440 dev_info(emac_dev, "EMAC: tx_collision_frames:%d\n",
441 emac_read(EMAC_TXCOLLISION));
442 dev_info(emac_dev, "EMAC: tx_single_coll_frames:%d\n",
443 emac_read(EMAC_TXSINGLECOLL));
444 dev_info(emac_dev, "EMAC: tx_mult_coll_frames:%d\n",
445 emac_read(EMAC_TXMULTICOLL));
446 dev_info(emac_dev, "EMAC: tx_excessive_collisions:%d\n",
447 emac_read(EMAC_TXEXCESSIVECOLL));
448 dev_info(emac_dev, "EMAC: tx_late_collisions:%d\n",
449 emac_read(EMAC_TXLATECOLL));
450 dev_info(emac_dev, "EMAC: tx_underrun:%d\n",
451 emac_read(EMAC_TXUNDERRUN));
452 dev_info(emac_dev, "EMAC: tx_carrier_sense_errors:%d\n",
453 emac_read(EMAC_TXCARRIERSENSE));
454 dev_info(emac_dev, "EMAC: tx_octets:%d\n",
455 emac_read(EMAC_TXOCTETS));
456 dev_info(emac_dev, "EMAC: net_octets:%d\n",
457 emac_read(EMAC_NETOCTETS));
458 dev_info(emac_dev, "EMAC: rx_sof_overruns:%d\n",
459 emac_read(EMAC_RXSOFOVERRUNS));
460 dev_info(emac_dev, "EMAC: rx_mof_overruns:%d\n",
461 emac_read(EMAC_RXMOFOVERRUNS));
462 dev_info(emac_dev, "EMAC: rx_dma_overruns:%d\n",
463 emac_read(EMAC_RXDMAOVERRUNS));
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400464
465 cpdma_ctlr_dump(priv->dma);
Anant Golea6286ee2009-05-18 15:19:01 -0700466}
467
Anant Golea6286ee2009-05-18 15:19:01 -0700468/**
469 * emac_get_drvinfo: Get EMAC driver information
470 * @ndev: The DaVinci EMAC network adapter
471 * @info: ethtool info structure containing name and version
472 *
473 * Returns EMAC driver information (name and version)
474 *
475 */
476static void emac_get_drvinfo(struct net_device *ndev,
477 struct ethtool_drvinfo *info)
478{
479 strcpy(info->driver, emac_version_string);
480 strcpy(info->version, EMAC_MODULE_VERSION);
481}
482
483/**
484 * emac_get_settings: Get EMAC settings
485 * @ndev: The DaVinci EMAC network adapter
486 * @ecmd: ethtool command
487 *
488 * Executes ethool get command
489 *
490 */
491static int emac_get_settings(struct net_device *ndev,
492 struct ethtool_cmd *ecmd)
493{
494 struct emac_priv *priv = netdev_priv(ndev);
Cyril Chemparathy5d69e002010-09-15 10:11:24 -0400495 if (priv->phydev)
Anant Golea6286ee2009-05-18 15:19:01 -0700496 return phy_ethtool_gset(priv->phydev, ecmd);
497 else
498 return -EOPNOTSUPP;
499
500}
501
502/**
503 * emac_set_settings: Set EMAC settings
504 * @ndev: The DaVinci EMAC network adapter
505 * @ecmd: ethtool command
506 *
507 * Executes ethool set command
508 *
509 */
510static int emac_set_settings(struct net_device *ndev, struct ethtool_cmd *ecmd)
511{
512 struct emac_priv *priv = netdev_priv(ndev);
Cyril Chemparathy5d69e002010-09-15 10:11:24 -0400513 if (priv->phydev)
Anant Golea6286ee2009-05-18 15:19:01 -0700514 return phy_ethtool_sset(priv->phydev, ecmd);
515 else
516 return -EOPNOTSUPP;
517
518}
519
520/**
Sriram84da2652010-07-29 02:33:58 +0000521 * emac_get_coalesce : Get interrupt coalesce settings for this device
522 * @ndev : The DaVinci EMAC network adapter
523 * @coal : ethtool coalesce settings structure
524 *
525 * Fetch the current interrupt coalesce settings
526 *
527 */
528static int emac_get_coalesce(struct net_device *ndev,
529 struct ethtool_coalesce *coal)
530{
531 struct emac_priv *priv = netdev_priv(ndev);
532
533 coal->rx_coalesce_usecs = priv->coal_intvl;
534 return 0;
535
536}
537
538/**
539 * emac_set_coalesce : Set interrupt coalesce settings for this device
540 * @ndev : The DaVinci EMAC network adapter
541 * @coal : ethtool coalesce settings structure
542 *
543 * Set interrupt coalesce parameters
544 *
545 */
546static int emac_set_coalesce(struct net_device *ndev,
547 struct ethtool_coalesce *coal)
548{
549 struct emac_priv *priv = netdev_priv(ndev);
550 u32 int_ctrl, num_interrupts = 0;
551 u32 prescale = 0, addnl_dvdr = 1, coal_intvl = 0;
552
553 if (!coal->rx_coalesce_usecs)
554 return -EINVAL;
555
556 coal_intvl = coal->rx_coalesce_usecs;
557
558 switch (priv->version) {
559 case EMAC_VERSION_2:
560 int_ctrl = emac_ctrl_read(EMAC_DM646X_CMINTCTRL);
561 prescale = priv->bus_freq_mhz * 4;
562
563 if (coal_intvl < EMAC_DM646X_CMINTMIN_INTVL)
564 coal_intvl = EMAC_DM646X_CMINTMIN_INTVL;
565
566 if (coal_intvl > EMAC_DM646X_CMINTMAX_INTVL) {
567 /*
568 * Interrupt pacer works with 4us Pulse, we can
569 * throttle further by dilating the 4us pulse.
570 */
571 addnl_dvdr = EMAC_DM646X_INTPRESCALE_MASK / prescale;
572
573 if (addnl_dvdr > 1) {
574 prescale *= addnl_dvdr;
575 if (coal_intvl > (EMAC_DM646X_CMINTMAX_INTVL
576 * addnl_dvdr))
577 coal_intvl = (EMAC_DM646X_CMINTMAX_INTVL
578 * addnl_dvdr);
579 } else {
580 addnl_dvdr = 1;
581 coal_intvl = EMAC_DM646X_CMINTMAX_INTVL;
582 }
583 }
584
585 num_interrupts = (1000 * addnl_dvdr) / coal_intvl;
586
587 int_ctrl |= EMAC_DM646X_INTPACEEN;
588 int_ctrl &= (~EMAC_DM646X_INTPRESCALE_MASK);
589 int_ctrl |= (prescale & EMAC_DM646X_INTPRESCALE_MASK);
590 emac_ctrl_write(EMAC_DM646X_CMINTCTRL, int_ctrl);
591
592 emac_ctrl_write(EMAC_DM646X_CMRXINTMAX, num_interrupts);
593 emac_ctrl_write(EMAC_DM646X_CMTXINTMAX, num_interrupts);
594
595 break;
596 default:
597 int_ctrl = emac_ctrl_read(EMAC_CTRL_EWINTTCNT);
598 int_ctrl &= (~EMAC_DM644X_EWINTCNT_MASK);
599 prescale = coal_intvl * priv->bus_freq_mhz;
600 if (prescale > EMAC_DM644X_EWINTCNT_MASK) {
601 prescale = EMAC_DM644X_EWINTCNT_MASK;
602 coal_intvl = prescale / priv->bus_freq_mhz;
603 }
604 emac_ctrl_write(EMAC_CTRL_EWINTTCNT, (int_ctrl | prescale));
605
606 break;
607 }
608
609 printk(KERN_INFO"Set coalesce to %d usecs.\n", coal_intvl);
610 priv->coal_intvl = coal_intvl;
611
612 return 0;
613
614}
615
616
617/**
Anant Golea6286ee2009-05-18 15:19:01 -0700618 * ethtool_ops: DaVinci EMAC Ethtool structure
619 *
620 * Ethtool support for EMAC adapter
621 *
622 */
623static const struct ethtool_ops ethtool_ops = {
624 .get_drvinfo = emac_get_drvinfo,
625 .get_settings = emac_get_settings,
626 .set_settings = emac_set_settings,
627 .get_link = ethtool_op_get_link,
Sriram84da2652010-07-29 02:33:58 +0000628 .get_coalesce = emac_get_coalesce,
629 .set_coalesce = emac_set_coalesce,
Anant Golea6286ee2009-05-18 15:19:01 -0700630};
631
632/**
633 * emac_update_phystatus: Update Phy status
634 * @priv: The DaVinci EMAC private adapter structure
635 *
636 * Updates phy status and takes action for network queue if required
637 * based upon link status
638 *
639 */
640static void emac_update_phystatus(struct emac_priv *priv)
641{
642 u32 mac_control;
643 u32 new_duplex;
644 u32 cur_duplex;
645 struct net_device *ndev = priv->ndev;
646
647 mac_control = emac_read(EMAC_MACCONTROL);
648 cur_duplex = (mac_control & EMAC_MACCONTROL_FULLDUPLEXEN) ?
649 DUPLEX_FULL : DUPLEX_HALF;
Cyril Chemparathy5d69e002010-09-15 10:11:24 -0400650 if (priv->phydev)
Anant Golea6286ee2009-05-18 15:19:01 -0700651 new_duplex = priv->phydev->duplex;
652 else
653 new_duplex = DUPLEX_FULL;
654
655 /* We get called only if link has changed (speed/duplex/status) */
656 if ((priv->link) && (new_duplex != cur_duplex)) {
657 priv->duplex = new_duplex;
658 if (DUPLEX_FULL == priv->duplex)
659 mac_control |= (EMAC_MACCONTROL_FULLDUPLEXEN);
660 else
661 mac_control &= ~(EMAC_MACCONTROL_FULLDUPLEXEN);
662 }
663
664 if (priv->speed == SPEED_1000 && (priv->version == EMAC_VERSION_2)) {
665 mac_control = emac_read(EMAC_MACCONTROL);
chaithrika@ti.com69ef9692009-10-01 10:25:19 +0000666 mac_control |= (EMAC_DM646X_MACCONTORL_GIG |
Anant Golea6286ee2009-05-18 15:19:01 -0700667 EMAC_DM646X_MACCONTORL_GIGFORCE);
668 } else {
669 /* Clear the GIG bit and GIGFORCE bit */
670 mac_control &= ~(EMAC_DM646X_MACCONTORL_GIGFORCE |
671 EMAC_DM646X_MACCONTORL_GIG);
672
673 if (priv->rmii_en && (priv->speed == SPEED_100))
674 mac_control |= EMAC_MACCONTROL_RMIISPEED_MASK;
675 else
676 mac_control &= ~EMAC_MACCONTROL_RMIISPEED_MASK;
677 }
678
679 /* Update mac_control if changed */
680 emac_write(EMAC_MACCONTROL, mac_control);
681
682 if (priv->link) {
683 /* link ON */
684 if (!netif_carrier_ok(ndev))
685 netif_carrier_on(ndev);
686 /* reactivate the transmit queue if it is stopped */
687 if (netif_running(ndev) && netif_queue_stopped(ndev))
688 netif_wake_queue(ndev);
689 } else {
690 /* link OFF */
691 if (netif_carrier_ok(ndev))
692 netif_carrier_off(ndev);
693 if (!netif_queue_stopped(ndev))
694 netif_stop_queue(ndev);
695 }
696}
697
698/**
699 * hash_get: Calculate hash value from mac address
700 * @addr: mac address to delete from hash table
701 *
702 * Calculates hash value from mac address
703 *
704 */
705static u32 hash_get(u8 *addr)
706{
707 u32 hash;
708 u8 tmpval;
709 int cnt;
710 hash = 0;
711
712 for (cnt = 0; cnt < 2; cnt++) {
713 tmpval = *addr++;
714 hash ^= (tmpval >> 2) ^ (tmpval << 4);
715 tmpval = *addr++;
716 hash ^= (tmpval >> 4) ^ (tmpval << 2);
717 tmpval = *addr++;
718 hash ^= (tmpval >> 6) ^ (tmpval);
719 }
720
721 return hash & 0x3F;
722}
723
724/**
725 * hash_add: Hash function to add mac addr from hash table
726 * @priv: The DaVinci EMAC private adapter structure
727 * mac_addr: mac address to delete from hash table
728 *
729 * Adds mac address to the internal hash table
730 *
731 */
732static int hash_add(struct emac_priv *priv, u8 *mac_addr)
733{
734 struct device *emac_dev = &priv->ndev->dev;
735 u32 rc = 0;
736 u32 hash_bit;
737 u32 hash_value = hash_get(mac_addr);
738
739 if (hash_value >= EMAC_NUM_MULTICAST_BITS) {
740 if (netif_msg_drv(priv)) {
741 dev_err(emac_dev, "DaVinci EMAC: hash_add(): Invalid "\
742 "Hash %08x, should not be greater than %08x",
743 hash_value, (EMAC_NUM_MULTICAST_BITS - 1));
744 }
745 return -1;
746 }
747
748 /* set the hash bit only if not previously set */
749 if (priv->multicast_hash_cnt[hash_value] == 0) {
750 rc = 1; /* hash value changed */
751 if (hash_value < 32) {
752 hash_bit = BIT(hash_value);
753 priv->mac_hash1 |= hash_bit;
754 } else {
755 hash_bit = BIT((hash_value - 32));
756 priv->mac_hash2 |= hash_bit;
757 }
758 }
759
760 /* incr counter for num of mcast addr's mapped to "this" hash bit */
761 ++priv->multicast_hash_cnt[hash_value];
762
763 return rc;
764}
765
766/**
767 * hash_del: Hash function to delete mac addr from hash table
768 * @priv: The DaVinci EMAC private adapter structure
769 * mac_addr: mac address to delete from hash table
770 *
771 * Removes mac address from the internal hash table
772 *
773 */
774static int hash_del(struct emac_priv *priv, u8 *mac_addr)
775{
776 u32 hash_value;
777 u32 hash_bit;
778
779 hash_value = hash_get(mac_addr);
780 if (priv->multicast_hash_cnt[hash_value] > 0) {
781 /* dec cntr for num of mcast addr's mapped to this hash bit */
782 --priv->multicast_hash_cnt[hash_value];
783 }
784
785 /* if counter still > 0, at least one multicast address refers
786 * to this hash bit. so return 0 */
787 if (priv->multicast_hash_cnt[hash_value] > 0)
788 return 0;
789
790 if (hash_value < 32) {
791 hash_bit = BIT(hash_value);
792 priv->mac_hash1 &= ~hash_bit;
793 } else {
794 hash_bit = BIT((hash_value - 32));
795 priv->mac_hash2 &= ~hash_bit;
796 }
797
798 /* return 1 to indicate change in mac_hash registers reqd */
799 return 1;
800}
801
802/* EMAC multicast operation */
803#define EMAC_MULTICAST_ADD 0
804#define EMAC_MULTICAST_DEL 1
805#define EMAC_ALL_MULTI_SET 2
806#define EMAC_ALL_MULTI_CLR 3
807
808/**
809 * emac_add_mcast: Set multicast address in the EMAC adapter (Internal)
810 * @priv: The DaVinci EMAC private adapter structure
811 * @action: multicast operation to perform
812 * mac_addr: mac address to set
813 *
814 * Set multicast addresses in EMAC adapter - internal function
815 *
816 */
817static void emac_add_mcast(struct emac_priv *priv, u32 action, u8 *mac_addr)
818{
819 struct device *emac_dev = &priv->ndev->dev;
820 int update = -1;
821
822 switch (action) {
823 case EMAC_MULTICAST_ADD:
824 update = hash_add(priv, mac_addr);
825 break;
826 case EMAC_MULTICAST_DEL:
827 update = hash_del(priv, mac_addr);
828 break;
829 case EMAC_ALL_MULTI_SET:
830 update = 1;
831 priv->mac_hash1 = EMAC_ALL_MULTI_REG_VALUE;
832 priv->mac_hash2 = EMAC_ALL_MULTI_REG_VALUE;
833 break;
834 case EMAC_ALL_MULTI_CLR:
835 update = 1;
836 priv->mac_hash1 = 0;
837 priv->mac_hash2 = 0;
838 memset(&(priv->multicast_hash_cnt[0]), 0,
839 sizeof(priv->multicast_hash_cnt[0]) *
840 EMAC_NUM_MULTICAST_BITS);
841 break;
842 default:
843 if (netif_msg_drv(priv))
844 dev_err(emac_dev, "DaVinci EMAC: add_mcast"\
845 ": bad operation %d", action);
846 break;
847 }
848
849 /* write to the hardware only if the register status chances */
850 if (update > 0) {
851 emac_write(EMAC_MACHASH1, priv->mac_hash1);
852 emac_write(EMAC_MACHASH2, priv->mac_hash2);
853 }
854}
855
856/**
857 * emac_dev_mcast_set: Set multicast address in the EMAC adapter
858 * @ndev: The DaVinci EMAC network adapter
859 *
860 * Set multicast addresses in EMAC adapter
861 *
862 */
863static void emac_dev_mcast_set(struct net_device *ndev)
864{
865 u32 mbp_enable;
866 struct emac_priv *priv = netdev_priv(ndev);
867
868 mbp_enable = emac_read(EMAC_RXMBPENABLE);
869 if (ndev->flags & IFF_PROMISC) {
870 mbp_enable &= (~EMAC_MBP_PROMISCCH(EMAC_DEF_PROM_CH));
871 mbp_enable |= (EMAC_MBP_RXPROMISC);
872 } else {
873 mbp_enable = (mbp_enable & ~EMAC_MBP_RXPROMISC);
874 if ((ndev->flags & IFF_ALLMULTI) ||
Jiri Pirko4cd24ea2010-02-08 04:30:35 +0000875 netdev_mc_count(ndev) > EMAC_DEF_MAX_MULTICAST_ADDRESSES) {
Anant Golea6286ee2009-05-18 15:19:01 -0700876 mbp_enable = (mbp_enable | EMAC_MBP_RXMCAST);
877 emac_add_mcast(priv, EMAC_ALL_MULTI_SET, NULL);
878 }
Jiri Pirko4cd24ea2010-02-08 04:30:35 +0000879 if (!netdev_mc_empty(ndev)) {
Jiri Pirko22bedad32010-04-01 21:22:57 +0000880 struct netdev_hw_addr *ha;
881
Anant Golea6286ee2009-05-18 15:19:01 -0700882 mbp_enable = (mbp_enable | EMAC_MBP_RXMCAST);
883 emac_add_mcast(priv, EMAC_ALL_MULTI_CLR, NULL);
884 /* program multicast address list into EMAC hardware */
Jiri Pirko22bedad32010-04-01 21:22:57 +0000885 netdev_for_each_mc_addr(ha, ndev) {
Anant Golea6286ee2009-05-18 15:19:01 -0700886 emac_add_mcast(priv, EMAC_MULTICAST_ADD,
Jiri Pirko22bedad32010-04-01 21:22:57 +0000887 (u8 *) ha->addr);
Anant Golea6286ee2009-05-18 15:19:01 -0700888 }
889 } else {
890 mbp_enable = (mbp_enable & ~EMAC_MBP_RXMCAST);
891 emac_add_mcast(priv, EMAC_ALL_MULTI_CLR, NULL);
892 }
893 }
894 /* Set mbp config register */
895 emac_write(EMAC_RXMBPENABLE, mbp_enable);
896}
897
898/*************************************************************************
899 * EMAC Hardware manipulation
900 *************************************************************************/
901
902/**
903 * emac_int_disable: Disable EMAC module interrupt (from adapter)
904 * @priv: The DaVinci EMAC private adapter structure
905 *
906 * Disable EMAC interrupt on the adapter
907 *
908 */
909static void emac_int_disable(struct emac_priv *priv)
910{
911 if (priv->version == EMAC_VERSION_2) {
912 unsigned long flags;
913
914 local_irq_save(flags);
915
916 /* Program C0_Int_En to zero to turn off
917 * interrupts to the CPU */
918 emac_ctrl_write(EMAC_DM646X_CMRXINTEN, 0x0);
919 emac_ctrl_write(EMAC_DM646X_CMTXINTEN, 0x0);
920 /* NOTE: Rx Threshold and Misc interrupts are not disabled */
Sriramakrishnan01a9af32009-11-19 15:58:26 +0530921 if (priv->int_disable)
922 priv->int_disable();
Anant Golea6286ee2009-05-18 15:19:01 -0700923
924 local_irq_restore(flags);
925
926 } else {
927 /* Set DM644x control registers for interrupt control */
928 emac_ctrl_write(EMAC_CTRL_EWCTL, 0x0);
929 }
930}
931
932/**
933 * emac_int_enable: Enable EMAC module interrupt (from adapter)
934 * @priv: The DaVinci EMAC private adapter structure
935 *
936 * Enable EMAC interrupt on the adapter
937 *
938 */
939static void emac_int_enable(struct emac_priv *priv)
940{
941 if (priv->version == EMAC_VERSION_2) {
Sriramakrishnan01a9af32009-11-19 15:58:26 +0530942 if (priv->int_enable)
943 priv->int_enable();
944
Anant Golea6286ee2009-05-18 15:19:01 -0700945 emac_ctrl_write(EMAC_DM646X_CMRXINTEN, 0xff);
946 emac_ctrl_write(EMAC_DM646X_CMTXINTEN, 0xff);
947
948 /* In addition to turning on interrupt Enable, we need
949 * ack by writing appropriate values to the EOI
950 * register */
951
952 /* NOTE: Rx Threshold and Misc interrupts are not enabled */
953
954 /* ack rxen only then a new pulse will be generated */
955 emac_write(EMAC_DM646X_MACEOIVECTOR,
956 EMAC_DM646X_MAC_EOI_C0_RXEN);
957
958 /* ack txen- only then a new pulse will be generated */
959 emac_write(EMAC_DM646X_MACEOIVECTOR,
960 EMAC_DM646X_MAC_EOI_C0_TXEN);
961
962 } else {
963 /* Set DM644x control registers for interrupt control */
964 emac_ctrl_write(EMAC_CTRL_EWCTL, 0x1);
965 }
966}
967
968/**
969 * emac_irq: EMAC interrupt handler
970 * @irq: interrupt number
971 * @dev_id: EMAC network adapter data structure ptr
972 *
973 * EMAC Interrupt handler - we only schedule NAPI and not process any packets
974 * here. EVen the interrupt status is checked (TX/RX/Err) in NAPI poll function
975 *
976 * Returns interrupt handled condition
977 */
978static irqreturn_t emac_irq(int irq, void *dev_id)
979{
980 struct net_device *ndev = (struct net_device *)dev_id;
981 struct emac_priv *priv = netdev_priv(ndev);
982
983 ++priv->isr_count;
984 if (likely(netif_running(priv->ndev))) {
985 emac_int_disable(priv);
986 napi_schedule(&priv->napi);
987 } else {
988 /* we are closing down, so dont process anything */
989 }
990 return IRQ_HANDLED;
991}
992
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400993static struct sk_buff *emac_rx_alloc(struct emac_priv *priv)
994{
Pradeep A. Dalvidae2e9f2012-02-06 11:16:13 +0000995 struct sk_buff *skb = netdev_alloc_skb(priv->ndev, priv->rx_buf_size);
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400996 if (WARN_ON(!skb))
997 return NULL;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -0400998 skb_reserve(skb, NET_IP_ALIGN);
999 return skb;
1000}
1001
1002static void emac_rx_handler(void *token, int len, int status)
1003{
1004 struct sk_buff *skb = token;
1005 struct net_device *ndev = skb->dev;
1006 struct emac_priv *priv = netdev_priv(ndev);
1007 struct device *emac_dev = &ndev->dev;
1008 int ret;
1009
1010 /* free and bail if we are shutting down */
Hegde, Vinay0a5f3842011-02-24 23:56:28 +00001011 if (unlikely(!netif_running(ndev) || !netif_carrier_ok(ndev))) {
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001012 dev_kfree_skb_any(skb);
1013 return;
1014 }
1015
Lucas De Marchi25985ed2011-03-30 22:57:33 -03001016 /* recycle on receive error */
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001017 if (status < 0) {
1018 ndev->stats.rx_errors++;
1019 goto recycle;
1020 }
1021
1022 /* feed received packet up the stack */
1023 skb_put(skb, len);
1024 skb->protocol = eth_type_trans(skb, ndev);
1025 netif_receive_skb(skb);
1026 ndev->stats.rx_bytes += len;
1027 ndev->stats.rx_packets++;
1028
1029 /* alloc a new packet for receive */
1030 skb = emac_rx_alloc(priv);
1031 if (!skb) {
1032 if (netif_msg_rx_err(priv) && net_ratelimit())
1033 dev_err(emac_dev, "failed rx buffer alloc\n");
1034 return;
1035 }
1036
1037recycle:
1038 ret = cpdma_chan_submit(priv->rxchan, skb, skb->data,
1039 skb_tailroom(skb), GFP_KERNEL);
1040 if (WARN_ON(ret < 0))
1041 dev_kfree_skb_any(skb);
1042}
1043
1044static void emac_tx_handler(void *token, int len, int status)
1045{
1046 struct sk_buff *skb = token;
1047 struct net_device *ndev = skb->dev;
Sascha Hauer86d8c072012-01-03 05:27:47 +00001048 struct emac_priv *priv = netdev_priv(ndev);
1049
1050 atomic_dec(&priv->cur_tx);
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001051
1052 if (unlikely(netif_queue_stopped(ndev)))
1053 netif_start_queue(ndev);
1054 ndev->stats.tx_packets++;
1055 ndev->stats.tx_bytes += len;
1056 dev_kfree_skb_any(skb);
1057}
1058
Anant Golea6286ee2009-05-18 15:19:01 -07001059/**
1060 * emac_dev_xmit: EMAC Transmit function
1061 * @skb: SKB pointer
1062 * @ndev: The DaVinci EMAC network adapter
1063 *
1064 * Called by the system to transmit a packet - we queue the packet in
1065 * EMAC hardware transmit queue
1066 *
1067 * Returns success(NETDEV_TX_OK) or error code (typically out of desc's)
1068 */
1069static int emac_dev_xmit(struct sk_buff *skb, struct net_device *ndev)
1070{
1071 struct device *emac_dev = &ndev->dev;
1072 int ret_code;
Anant Golea6286ee2009-05-18 15:19:01 -07001073 struct emac_priv *priv = netdev_priv(ndev);
1074
1075 /* If no link, return */
1076 if (unlikely(!priv->link)) {
1077 if (netif_msg_tx_err(priv) && net_ratelimit())
1078 dev_err(emac_dev, "DaVinci EMAC: No link to transmit");
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001079 goto fail_tx;
Anant Golea6286ee2009-05-18 15:19:01 -07001080 }
1081
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001082 ret_code = skb_padto(skb, EMAC_DEF_MIN_ETHPKTSIZE);
1083 if (unlikely(ret_code < 0)) {
1084 if (netif_msg_tx_err(priv) && net_ratelimit())
1085 dev_err(emac_dev, "DaVinci EMAC: packet pad failed");
1086 goto fail_tx;
1087 }
1088
Richard Cochran5bf0c192011-06-19 03:31:45 +00001089 skb_tx_timestamp(skb);
1090
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001091 ret_code = cpdma_chan_submit(priv->txchan, skb, skb->data, skb->len,
1092 GFP_KERNEL);
Anant Golea6286ee2009-05-18 15:19:01 -07001093 if (unlikely(ret_code != 0)) {
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001094 if (netif_msg_tx_err(priv) && net_ratelimit())
1095 dev_err(emac_dev, "DaVinci EMAC: desc submit failed");
1096 goto fail_tx;
Anant Golea6286ee2009-05-18 15:19:01 -07001097 }
1098
Sascha Hauer86d8c072012-01-03 05:27:47 +00001099 if (atomic_inc_return(&priv->cur_tx) >= EMAC_DEF_TX_NUM_DESC)
1100 netif_stop_queue(ndev);
1101
Anant Golea6286ee2009-05-18 15:19:01 -07001102 return NETDEV_TX_OK;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001103
1104fail_tx:
1105 ndev->stats.tx_dropped++;
1106 netif_stop_queue(ndev);
1107 return NETDEV_TX_BUSY;
Anant Golea6286ee2009-05-18 15:19:01 -07001108}
1109
1110/**
1111 * emac_dev_tx_timeout: EMAC Transmit timeout function
1112 * @ndev: The DaVinci EMAC network adapter
1113 *
1114 * Called when system detects that a skb timeout period has expired
1115 * potentially due to a fault in the adapter in not being able to send
1116 * it out on the wire. We teardown the TX channel assuming a hardware
1117 * error and re-initialize the TX channel for hardware operation
1118 *
1119 */
1120static void emac_dev_tx_timeout(struct net_device *ndev)
1121{
1122 struct emac_priv *priv = netdev_priv(ndev);
1123 struct device *emac_dev = &ndev->dev;
1124
1125 if (netif_msg_tx_err(priv))
1126 dev_err(emac_dev, "DaVinci EMAC: xmit timeout, restarting TX");
1127
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001128 emac_dump_regs(priv);
1129
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001130 ndev->stats.tx_errors++;
Anant Golea6286ee2009-05-18 15:19:01 -07001131 emac_int_disable(priv);
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001132 cpdma_chan_stop(priv->txchan);
1133 cpdma_chan_start(priv->txchan);
Anant Golea6286ee2009-05-18 15:19:01 -07001134 emac_int_enable(priv);
1135}
1136
1137/**
Anant Golea6286ee2009-05-18 15:19:01 -07001138 * emac_set_type0addr: Set EMAC Type0 mac address
1139 * @priv: The DaVinci EMAC private adapter structure
1140 * @ch: RX channel number
1141 * @mac_addr: MAC address to set in device
1142 *
1143 * Called internally to set Type0 mac address of the adapter (Device)
1144 *
1145 * Returns success (0) or appropriate error code (none as of now)
1146 */
1147static void emac_set_type0addr(struct emac_priv *priv, u32 ch, char *mac_addr)
1148{
1149 u32 val;
1150 val = ((mac_addr[5] << 8) | (mac_addr[4]));
1151 emac_write(EMAC_MACSRCADDRLO, val);
1152
1153 val = ((mac_addr[3] << 24) | (mac_addr[2] << 16) | \
1154 (mac_addr[1] << 8) | (mac_addr[0]));
1155 emac_write(EMAC_MACSRCADDRHI, val);
1156 val = emac_read(EMAC_RXUNICASTSET);
1157 val |= BIT(ch);
1158 emac_write(EMAC_RXUNICASTSET, val);
1159 val = emac_read(EMAC_RXUNICASTCLEAR);
1160 val &= ~BIT(ch);
1161 emac_write(EMAC_RXUNICASTCLEAR, val);
1162}
1163
1164/**
1165 * emac_set_type1addr: Set EMAC Type1 mac address
1166 * @priv: The DaVinci EMAC private adapter structure
1167 * @ch: RX channel number
1168 * @mac_addr: MAC address to set in device
1169 *
1170 * Called internally to set Type1 mac address of the adapter (Device)
1171 *
1172 * Returns success (0) or appropriate error code (none as of now)
1173 */
1174static void emac_set_type1addr(struct emac_priv *priv, u32 ch, char *mac_addr)
1175{
1176 u32 val;
1177 emac_write(EMAC_MACINDEX, ch);
1178 val = ((mac_addr[5] << 8) | mac_addr[4]);
1179 emac_write(EMAC_MACADDRLO, val);
1180 val = ((mac_addr[3] << 24) | (mac_addr[2] << 16) | \
1181 (mac_addr[1] << 8) | (mac_addr[0]));
1182 emac_write(EMAC_MACADDRHI, val);
1183 emac_set_type0addr(priv, ch, mac_addr);
1184}
1185
1186/**
1187 * emac_set_type2addr: Set EMAC Type2 mac address
1188 * @priv: The DaVinci EMAC private adapter structure
1189 * @ch: RX channel number
1190 * @mac_addr: MAC address to set in device
1191 * @index: index into RX address entries
1192 * @match: match parameter for RX address matching logic
1193 *
1194 * Called internally to set Type2 mac address of the adapter (Device)
1195 *
1196 * Returns success (0) or appropriate error code (none as of now)
1197 */
1198static void emac_set_type2addr(struct emac_priv *priv, u32 ch,
1199 char *mac_addr, int index, int match)
1200{
1201 u32 val;
1202 emac_write(EMAC_MACINDEX, index);
1203 val = ((mac_addr[3] << 24) | (mac_addr[2] << 16) | \
1204 (mac_addr[1] << 8) | (mac_addr[0]));
1205 emac_write(EMAC_MACADDRHI, val);
1206 val = ((mac_addr[5] << 8) | mac_addr[4] | ((ch & 0x7) << 16) | \
1207 (match << 19) | BIT(20));
1208 emac_write(EMAC_MACADDRLO, val);
1209 emac_set_type0addr(priv, ch, mac_addr);
1210}
1211
1212/**
1213 * emac_setmac: Set mac address in the adapter (internal function)
1214 * @priv: The DaVinci EMAC private adapter structure
1215 * @ch: RX channel number
1216 * @mac_addr: MAC address to set in device
1217 *
1218 * Called internally to set the mac address of the adapter (Device)
1219 *
1220 * Returns success (0) or appropriate error code (none as of now)
1221 */
1222static void emac_setmac(struct emac_priv *priv, u32 ch, char *mac_addr)
1223{
1224 struct device *emac_dev = &priv->ndev->dev;
1225
1226 if (priv->rx_addr_type == 0) {
1227 emac_set_type0addr(priv, ch, mac_addr);
1228 } else if (priv->rx_addr_type == 1) {
1229 u32 cnt;
1230 for (cnt = 0; cnt < EMAC_MAX_TXRX_CHANNELS; cnt++)
1231 emac_set_type1addr(priv, ch, mac_addr);
1232 } else if (priv->rx_addr_type == 2) {
1233 emac_set_type2addr(priv, ch, mac_addr, ch, 1);
1234 emac_set_type0addr(priv, ch, mac_addr);
1235 } else {
1236 if (netif_msg_drv(priv))
1237 dev_err(emac_dev, "DaVinci EMAC: Wrong addressing\n");
1238 }
1239}
1240
1241/**
1242 * emac_dev_setmac_addr: Set mac address in the adapter
1243 * @ndev: The DaVinci EMAC network adapter
1244 * @addr: MAC address to set in device
1245 *
1246 * Called by the system to set the mac address of the adapter (Device)
1247 *
1248 * Returns success (0) or appropriate error code (none as of now)
1249 */
1250static int emac_dev_setmac_addr(struct net_device *ndev, void *addr)
1251{
1252 struct emac_priv *priv = netdev_priv(ndev);
Anant Golea6286ee2009-05-18 15:19:01 -07001253 struct device *emac_dev = &priv->ndev->dev;
1254 struct sockaddr *sa = addr;
Anant Golea6286ee2009-05-18 15:19:01 -07001255
Pablo Bitton64c81652009-07-07 19:11:10 -07001256 if (!is_valid_ether_addr(sa->sa_data))
Danny Kukawka504f9b52012-02-21 02:07:49 +00001257 return -EADDRNOTAVAIL;
Pablo Bitton64c81652009-07-07 19:11:10 -07001258
Anant Golea6286ee2009-05-18 15:19:01 -07001259 /* Store mac addr in priv and rx channel and set it in EMAC hw */
1260 memcpy(priv->mac_addr, sa->sa_data, ndev->addr_len);
Anant Golea6286ee2009-05-18 15:19:01 -07001261 memcpy(ndev->dev_addr, sa->sa_data, ndev->addr_len);
Danny Kukawkabaf1d372012-02-17 05:43:24 +00001262 ndev->addr_assign_type &= ~NET_ADDR_RANDOM;
Pablo Bitton64c81652009-07-07 19:11:10 -07001263
Pablo Bitton64c81652009-07-07 19:11:10 -07001264 /* MAC address is configured only after the interface is enabled. */
1265 if (netif_running(ndev)) {
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001266 emac_setmac(priv, EMAC_DEF_RX_CH, priv->mac_addr);
Pablo Bitton64c81652009-07-07 19:11:10 -07001267 }
Anant Golea6286ee2009-05-18 15:19:01 -07001268
1269 if (netif_msg_drv(priv))
Chaithrika U S5c726162009-06-03 21:54:29 -07001270 dev_notice(emac_dev, "DaVinci EMAC: emac_dev_setmac_addr %pM\n",
1271 priv->mac_addr);
Anant Golea6286ee2009-05-18 15:19:01 -07001272
1273 return 0;
1274}
1275
1276/**
Anant Golea6286ee2009-05-18 15:19:01 -07001277 * emac_hw_enable: Enable EMAC hardware for packet transmission/reception
1278 * @priv: The DaVinci EMAC private adapter structure
1279 *
1280 * Enables EMAC hardware for packet processing - enables PHY, enables RX
1281 * for packet reception and enables device interrupts and then NAPI
1282 *
1283 * Returns success (0) or appropriate error code (none right now)
1284 */
1285static int emac_hw_enable(struct emac_priv *priv)
1286{
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001287 u32 val, mbp_enable, mac_control;
Anant Golea6286ee2009-05-18 15:19:01 -07001288
1289 /* Soft reset */
1290 emac_write(EMAC_SOFTRESET, 1);
1291 while (emac_read(EMAC_SOFTRESET))
1292 cpu_relax();
1293
1294 /* Disable interrupt & Set pacing for more interrupts initially */
1295 emac_int_disable(priv);
1296
1297 /* Full duplex enable bit set when auto negotiation happens */
1298 mac_control =
1299 (((EMAC_DEF_TXPRIO_FIXED) ? (EMAC_MACCONTROL_TXPTYPE) : 0x0) |
1300 ((priv->speed == 1000) ? EMAC_MACCONTROL_GIGABITEN : 0x0) |
1301 ((EMAC_DEF_TXPACING_EN) ? (EMAC_MACCONTROL_TXPACEEN) : 0x0) |
1302 ((priv->duplex == DUPLEX_FULL) ? 0x1 : 0));
1303 emac_write(EMAC_MACCONTROL, mac_control);
1304
1305 mbp_enable =
1306 (((EMAC_DEF_PASS_CRC) ? (EMAC_RXMBP_PASSCRC_MASK) : 0x0) |
1307 ((EMAC_DEF_QOS_EN) ? (EMAC_RXMBP_QOSEN_MASK) : 0x0) |
1308 ((EMAC_DEF_NO_BUFF_CHAIN) ? (EMAC_RXMBP_NOCHAIN_MASK) : 0x0) |
1309 ((EMAC_DEF_MACCTRL_FRAME_EN) ? (EMAC_RXMBP_CMFEN_MASK) : 0x0) |
1310 ((EMAC_DEF_SHORT_FRAME_EN) ? (EMAC_RXMBP_CSFEN_MASK) : 0x0) |
1311 ((EMAC_DEF_ERROR_FRAME_EN) ? (EMAC_RXMBP_CEFEN_MASK) : 0x0) |
1312 ((EMAC_DEF_PROM_EN) ? (EMAC_RXMBP_CAFEN_MASK) : 0x0) |
1313 ((EMAC_DEF_PROM_CH & EMAC_RXMBP_CHMASK) << \
1314 EMAC_RXMBP_PROMCH_SHIFT) |
1315 ((EMAC_DEF_BCAST_EN) ? (EMAC_RXMBP_BROADEN_MASK) : 0x0) |
1316 ((EMAC_DEF_BCAST_CH & EMAC_RXMBP_CHMASK) << \
1317 EMAC_RXMBP_BROADCH_SHIFT) |
1318 ((EMAC_DEF_MCAST_EN) ? (EMAC_RXMBP_MULTIEN_MASK) : 0x0) |
1319 ((EMAC_DEF_MCAST_CH & EMAC_RXMBP_CHMASK) << \
1320 EMAC_RXMBP_MULTICH_SHIFT));
1321 emac_write(EMAC_RXMBPENABLE, mbp_enable);
1322 emac_write(EMAC_RXMAXLEN, (EMAC_DEF_MAX_FRAME_SIZE &
1323 EMAC_RX_MAX_LEN_MASK));
1324 emac_write(EMAC_RXBUFFEROFFSET, (EMAC_DEF_BUFFER_OFFSET &
1325 EMAC_RX_BUFFER_OFFSET_MASK));
1326 emac_write(EMAC_RXFILTERLOWTHRESH, 0);
1327 emac_write(EMAC_RXUNICASTCLEAR, EMAC_RX_UNICAST_CLEAR_ALL);
1328 priv->rx_addr_type = (emac_read(EMAC_MACCONFIG) >> 8) & 0xFF;
1329
Anant Golea6286ee2009-05-18 15:19:01 -07001330 emac_write(EMAC_MACINTMASKSET, EMAC_MAC_HOST_ERR_INTMASK_VAL);
1331
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001332 emac_setmac(priv, EMAC_DEF_RX_CH, priv->mac_addr);
Anant Golea6286ee2009-05-18 15:19:01 -07001333
1334 /* Enable MII */
1335 val = emac_read(EMAC_MACCONTROL);
chaithrika@ti.com69ef9692009-10-01 10:25:19 +00001336 val |= (EMAC_MACCONTROL_GMIIEN);
Anant Golea6286ee2009-05-18 15:19:01 -07001337 emac_write(EMAC_MACCONTROL, val);
1338
1339 /* Enable NAPI and interrupts */
1340 napi_enable(&priv->napi);
1341 emac_int_enable(priv);
1342 return 0;
1343
1344}
1345
1346/**
1347 * emac_poll: EMAC NAPI Poll function
1348 * @ndev: The DaVinci EMAC network adapter
1349 * @budget: Number of receive packets to process (as told by NAPI layer)
1350 *
1351 * NAPI Poll function implemented to process packets as per budget. We check
1352 * the type of interrupt on the device and accordingly call the TX or RX
1353 * packet processing functions. We follow the budget for RX processing and
1354 * also put a cap on number of TX pkts processed through config param. The
1355 * NAPI schedule function is called if more packets pending.
1356 *
1357 * Returns number of packets received (in most cases; else TX pkts - rarely)
1358 */
1359static int emac_poll(struct napi_struct *napi, int budget)
1360{
1361 unsigned int mask;
1362 struct emac_priv *priv = container_of(napi, struct emac_priv, napi);
1363 struct net_device *ndev = priv->ndev;
1364 struct device *emac_dev = &ndev->dev;
1365 u32 status = 0;
Sriram3725b1f2010-07-29 02:33:59 +00001366 u32 num_tx_pkts = 0, num_rx_pkts = 0;
Anant Golea6286ee2009-05-18 15:19:01 -07001367
Anant Golea6286ee2009-05-18 15:19:01 -07001368 /* Check interrupt vectors and call packet processing */
1369 status = emac_read(EMAC_MACINVECTOR);
1370
1371 mask = EMAC_DM644X_MAC_IN_VECTOR_TX_INT_VEC;
1372
1373 if (priv->version == EMAC_VERSION_2)
1374 mask = EMAC_DM646X_MAC_IN_VECTOR_TX_INT_VEC;
1375
1376 if (status & mask) {
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001377 num_tx_pkts = cpdma_chan_process(priv->txchan,
1378 EMAC_DEF_TX_MAX_SERVICE);
Anant Golea6286ee2009-05-18 15:19:01 -07001379 } /* TX processing */
1380
Anant Golea6286ee2009-05-18 15:19:01 -07001381 mask = EMAC_DM644X_MAC_IN_VECTOR_RX_INT_VEC;
1382
1383 if (priv->version == EMAC_VERSION_2)
1384 mask = EMAC_DM646X_MAC_IN_VECTOR_RX_INT_VEC;
1385
1386 if (status & mask) {
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001387 num_rx_pkts = cpdma_chan_process(priv->rxchan, budget);
Anant Golea6286ee2009-05-18 15:19:01 -07001388 } /* RX processing */
1389
Sriram43c2ed82009-09-24 19:15:18 +00001390 mask = EMAC_DM644X_MAC_IN_VECTOR_HOST_INT;
1391 if (priv->version == EMAC_VERSION_2)
1392 mask = EMAC_DM646X_MAC_IN_VECTOR_HOST_INT;
1393
1394 if (unlikely(status & mask)) {
Anant Golea6286ee2009-05-18 15:19:01 -07001395 u32 ch, cause;
1396 dev_err(emac_dev, "DaVinci EMAC: Fatal Hardware Error\n");
1397 netif_stop_queue(ndev);
1398 napi_disable(&priv->napi);
1399
1400 status = emac_read(EMAC_MACSTATUS);
1401 cause = ((status & EMAC_MACSTATUS_TXERRCODE_MASK) >>
1402 EMAC_MACSTATUS_TXERRCODE_SHIFT);
1403 if (cause) {
1404 ch = ((status & EMAC_MACSTATUS_TXERRCH_MASK) >>
1405 EMAC_MACSTATUS_TXERRCH_SHIFT);
1406 if (net_ratelimit()) {
1407 dev_err(emac_dev, "TX Host error %s on ch=%d\n",
1408 &emac_txhost_errcodes[cause][0], ch);
1409 }
1410 }
1411 cause = ((status & EMAC_MACSTATUS_RXERRCODE_MASK) >>
1412 EMAC_MACSTATUS_RXERRCODE_SHIFT);
1413 if (cause) {
1414 ch = ((status & EMAC_MACSTATUS_RXERRCH_MASK) >>
1415 EMAC_MACSTATUS_RXERRCH_SHIFT);
1416 if (netif_msg_hw(priv) && net_ratelimit())
1417 dev_err(emac_dev, "RX Host error %s on ch=%d\n",
1418 &emac_rxhost_errcodes[cause][0], ch);
1419 }
Sriram3725b1f2010-07-29 02:33:59 +00001420 } else if (num_rx_pkts < budget) {
1421 napi_complete(napi);
1422 emac_int_enable(priv);
1423 }
Anant Golea6286ee2009-05-18 15:19:01 -07001424
Sriram3725b1f2010-07-29 02:33:59 +00001425 return num_rx_pkts;
Anant Golea6286ee2009-05-18 15:19:01 -07001426}
1427
1428#ifdef CONFIG_NET_POLL_CONTROLLER
1429/**
1430 * emac_poll_controller: EMAC Poll controller function
1431 * @ndev: The DaVinci EMAC network adapter
1432 *
1433 * Polled functionality used by netconsole and others in non interrupt mode
1434 *
1435 */
1436void emac_poll_controller(struct net_device *ndev)
1437{
1438 struct emac_priv *priv = netdev_priv(ndev);
1439
1440 emac_int_disable(priv);
Tonyliuc8ee5532009-11-04 05:45:02 -08001441 emac_irq(ndev->irq, ndev);
Anant Golea6286ee2009-05-18 15:19:01 -07001442 emac_int_enable(priv);
1443}
1444#endif
1445
Anant Golea6286ee2009-05-18 15:19:01 -07001446static void emac_adjust_link(struct net_device *ndev)
1447{
1448 struct emac_priv *priv = netdev_priv(ndev);
1449 struct phy_device *phydev = priv->phydev;
1450 unsigned long flags;
1451 int new_state = 0;
1452
1453 spin_lock_irqsave(&priv->lock, flags);
1454
1455 if (phydev->link) {
1456 /* check the mode of operation - full/half duplex */
1457 if (phydev->duplex != priv->duplex) {
1458 new_state = 1;
1459 priv->duplex = phydev->duplex;
1460 }
1461 if (phydev->speed != priv->speed) {
1462 new_state = 1;
1463 priv->speed = phydev->speed;
1464 }
1465 if (!priv->link) {
1466 new_state = 1;
1467 priv->link = 1;
1468 }
1469
1470 } else if (priv->link) {
1471 new_state = 1;
1472 priv->link = 0;
1473 priv->speed = 0;
1474 priv->duplex = ~0;
1475 }
1476 if (new_state) {
1477 emac_update_phystatus(priv);
1478 phy_print_status(priv->phydev);
1479 }
1480
1481 spin_unlock_irqrestore(&priv->lock, flags);
1482}
1483
1484/*************************************************************************
1485 * Linux Driver Model
1486 *************************************************************************/
1487
1488/**
1489 * emac_devioctl: EMAC adapter ioctl
1490 * @ndev: The DaVinci EMAC network adapter
1491 * @ifrq: request parameter
1492 * @cmd: command parameter
1493 *
1494 * EMAC driver ioctl function
1495 *
1496 * Returns success(0) or appropriate error code
1497 */
1498static int emac_devioctl(struct net_device *ndev, struct ifreq *ifrq, int cmd)
1499{
Richard Cochranfb290cd2011-06-12 02:19:00 +00001500 struct emac_priv *priv = netdev_priv(ndev);
Anant Golea6286ee2009-05-18 15:19:01 -07001501
1502 if (!(netif_running(ndev)))
1503 return -EINVAL;
1504
1505 /* TODO: Add phy read and write and private statistics get feature */
1506
Richard Cochranfb290cd2011-06-12 02:19:00 +00001507 return phy_mii_ioctl(priv->phydev, ifrq, cmd);
Anant Golea6286ee2009-05-18 15:19:01 -07001508}
1509
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001510static int match_first_device(struct device *dev, void *data)
1511{
1512 return 1;
1513}
1514
Anant Golea6286ee2009-05-18 15:19:01 -07001515/**
1516 * emac_dev_open: EMAC device open
1517 * @ndev: The DaVinci EMAC network adapter
1518 *
1519 * Called when system wants to start the interface. We init TX/RX channels
1520 * and enable the hardware for packet reception/transmission and start the
1521 * network queue.
1522 *
1523 * Returns 0 for a successful open, or appropriate error code
1524 */
1525static int emac_dev_open(struct net_device *ndev)
1526{
1527 struct device *emac_dev = &ndev->dev;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001528 u32 cnt;
Anant Golea6286ee2009-05-18 15:19:01 -07001529 struct resource *res;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001530 int q, m, ret;
Anant Golea6286ee2009-05-18 15:19:01 -07001531 int i = 0;
1532 int k = 0;
1533 struct emac_priv *priv = netdev_priv(ndev);
1534
1535 netif_carrier_off(ndev);
Dan Carpenter4d27b872010-03-02 21:07:24 +00001536 for (cnt = 0; cnt < ETH_ALEN; cnt++)
Anant Golea6286ee2009-05-18 15:19:01 -07001537 ndev->dev_addr[cnt] = priv->mac_addr[cnt];
1538
1539 /* Configuration items */
1540 priv->rx_buf_size = EMAC_DEF_MAX_FRAME_SIZE + NET_IP_ALIGN;
1541
Anant Golea6286ee2009-05-18 15:19:01 -07001542 priv->mac_hash1 = 0;
1543 priv->mac_hash2 = 0;
1544 emac_write(EMAC_MACHASH1, 0);
1545 emac_write(EMAC_MACHASH2, 0);
1546
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001547 for (i = 0; i < EMAC_DEF_RX_NUM_DESC; i++) {
1548 struct sk_buff *skb = emac_rx_alloc(priv);
1549
1550 if (!skb)
1551 break;
1552
1553 ret = cpdma_chan_submit(priv->rxchan, skb, skb->data,
1554 skb_tailroom(skb), GFP_KERNEL);
1555 if (WARN_ON(ret < 0))
1556 break;
Anant Golea6286ee2009-05-18 15:19:01 -07001557 }
1558
1559 /* Request IRQ */
1560
1561 while ((res = platform_get_resource(priv->pdev, IORESOURCE_IRQ, k))) {
1562 for (i = res->start; i <= res->end; i++) {
1563 if (request_irq(i, emac_irq, IRQF_DISABLED,
1564 ndev->name, ndev))
1565 goto rollback;
1566 }
1567 k++;
1568 }
1569
1570 /* Start/Enable EMAC hardware */
1571 emac_hw_enable(priv);
1572
Sriram84da2652010-07-29 02:33:58 +00001573 /* Enable Interrupt pacing if configured */
1574 if (priv->coal_intvl != 0) {
1575 struct ethtool_coalesce coal;
1576
1577 coal.rx_coalesce_usecs = (priv->coal_intvl << 4);
1578 emac_set_coalesce(ndev, &coal);
1579 }
1580
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001581 cpdma_ctlr_start(priv->dma);
1582
Anant Golea6286ee2009-05-18 15:19:01 -07001583 priv->phydev = NULL;
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001584 /* use the first phy on the bus if pdata did not give us a phy id */
1585 if (!priv->phy_id) {
1586 struct device *phy;
Anant Golea6286ee2009-05-18 15:19:01 -07001587
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001588 phy = bus_find_device(&mdio_bus_type, NULL, NULL,
1589 match_first_device);
1590 if (phy)
1591 priv->phy_id = dev_name(phy);
1592 }
Anant Golea6286ee2009-05-18 15:19:01 -07001593
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001594 if (priv->phy_id && *priv->phy_id) {
1595 priv->phydev = phy_connect(ndev, priv->phy_id,
1596 &emac_adjust_link, 0,
1597 PHY_INTERFACE_MODE_MII);
Anant Golea6286ee2009-05-18 15:19:01 -07001598
1599 if (IS_ERR(priv->phydev)) {
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001600 dev_err(emac_dev, "could not connect to phy %s\n",
1601 priv->phy_id);
Julia Lawallcb0a1782012-02-02 04:53:01 +00001602 ret = PTR_ERR(priv->phydev);
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001603 priv->phydev = NULL;
Julia Lawallcb0a1782012-02-02 04:53:01 +00001604 return ret;
Anant Golea6286ee2009-05-18 15:19:01 -07001605 }
1606
1607 priv->link = 0;
1608 priv->speed = 0;
1609 priv->duplex = ~0;
1610
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001611 dev_info(emac_dev, "attached PHY driver [%s] "
1612 "(mii_bus:phy_addr=%s, id=%x)\n",
Anant Golea6286ee2009-05-18 15:19:01 -07001613 priv->phydev->drv->name, dev_name(&priv->phydev->dev),
1614 priv->phydev->phy_id);
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001615 } else {
Anant Golea6286ee2009-05-18 15:19:01 -07001616 /* No PHY , fix the link, speed and duplex settings */
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001617 dev_notice(emac_dev, "no phy, defaulting to 100/full\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001618 priv->link = 1;
1619 priv->speed = SPEED_100;
1620 priv->duplex = DUPLEX_FULL;
1621 emac_update_phystatus(priv);
1622 }
1623
1624 if (!netif_running(ndev)) /* debug only - to avoid compiler warning */
1625 emac_dump_regs(priv);
1626
1627 if (netif_msg_drv(priv))
1628 dev_notice(emac_dev, "DaVinci EMAC: Opened %s\n", ndev->name);
1629
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001630 if (priv->phydev)
Anant Golea6286ee2009-05-18 15:19:01 -07001631 phy_start(priv->phydev);
1632
1633 return 0;
1634
1635rollback:
1636
1637 dev_err(emac_dev, "DaVinci EMAC: request_irq() failed");
1638
1639 for (q = k; k >= 0; k--) {
1640 for (m = i; m >= res->start; m--)
1641 free_irq(m, ndev);
1642 res = platform_get_resource(priv->pdev, IORESOURCE_IRQ, k-1);
1643 m = res->end;
1644 }
1645 return -EBUSY;
1646}
1647
1648/**
1649 * emac_dev_stop: EMAC device stop
1650 * @ndev: The DaVinci EMAC network adapter
1651 *
1652 * Called when system wants to stop or down the interface. We stop the network
1653 * queue, disable interrupts and cleanup TX/RX channels.
1654 *
1655 * We return the statistics in net_device_stats structure pulled from emac
1656 */
1657static int emac_dev_stop(struct net_device *ndev)
1658{
1659 struct resource *res;
1660 int i = 0;
1661 int irq_num;
1662 struct emac_priv *priv = netdev_priv(ndev);
1663 struct device *emac_dev = &ndev->dev;
1664
1665 /* inform the upper layers. */
1666 netif_stop_queue(ndev);
1667 napi_disable(&priv->napi);
1668
1669 netif_carrier_off(ndev);
1670 emac_int_disable(priv);
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001671 cpdma_ctlr_stop(priv->dma);
Anant Golea6286ee2009-05-18 15:19:01 -07001672 emac_write(EMAC_SOFTRESET, 1);
1673
1674 if (priv->phydev)
1675 phy_disconnect(priv->phydev);
1676
1677 /* Free IRQ */
1678 while ((res = platform_get_resource(priv->pdev, IORESOURCE_IRQ, i))) {
1679 for (irq_num = res->start; irq_num <= res->end; irq_num++)
1680 free_irq(irq_num, priv->ndev);
1681 i++;
1682 }
1683
1684 if (netif_msg_drv(priv))
1685 dev_notice(emac_dev, "DaVinci EMAC: %s stopped\n", ndev->name);
1686
1687 return 0;
1688}
1689
1690/**
1691 * emac_dev_getnetstats: EMAC get statistics function
1692 * @ndev: The DaVinci EMAC network adapter
1693 *
1694 * Called when system wants to get statistics from the device.
1695 *
1696 * We return the statistics in net_device_stats structure pulled from emac
1697 */
1698static struct net_device_stats *emac_dev_getnetstats(struct net_device *ndev)
1699{
1700 struct emac_priv *priv = netdev_priv(ndev);
Sriram0fe74632009-10-07 02:44:30 +00001701 u32 mac_control;
1702 u32 stats_clear_mask;
Anant Golea6286ee2009-05-18 15:19:01 -07001703
1704 /* update emac hardware stats and reset the registers*/
1705
Sriram0fe74632009-10-07 02:44:30 +00001706 mac_control = emac_read(EMAC_MACCONTROL);
1707
1708 if (mac_control & EMAC_MACCONTROL_GMIIEN)
1709 stats_clear_mask = EMAC_STATS_CLR_MASK;
1710 else
1711 stats_clear_mask = 0;
1712
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001713 ndev->stats.multicast += emac_read(EMAC_RXMCASTFRAMES);
Sriram0fe74632009-10-07 02:44:30 +00001714 emac_write(EMAC_RXMCASTFRAMES, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001715
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001716 ndev->stats.collisions += (emac_read(EMAC_TXCOLLISION) +
Anant Golea6286ee2009-05-18 15:19:01 -07001717 emac_read(EMAC_TXSINGLECOLL) +
1718 emac_read(EMAC_TXMULTICOLL));
Sriram0fe74632009-10-07 02:44:30 +00001719 emac_write(EMAC_TXCOLLISION, stats_clear_mask);
1720 emac_write(EMAC_TXSINGLECOLL, stats_clear_mask);
1721 emac_write(EMAC_TXMULTICOLL, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001722
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001723 ndev->stats.rx_length_errors += (emac_read(EMAC_RXOVERSIZED) +
Anant Golea6286ee2009-05-18 15:19:01 -07001724 emac_read(EMAC_RXJABBER) +
1725 emac_read(EMAC_RXUNDERSIZED));
Sriram0fe74632009-10-07 02:44:30 +00001726 emac_write(EMAC_RXOVERSIZED, stats_clear_mask);
1727 emac_write(EMAC_RXJABBER, stats_clear_mask);
1728 emac_write(EMAC_RXUNDERSIZED, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001729
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001730 ndev->stats.rx_over_errors += (emac_read(EMAC_RXSOFOVERRUNS) +
Anant Golea6286ee2009-05-18 15:19:01 -07001731 emac_read(EMAC_RXMOFOVERRUNS));
Sriram0fe74632009-10-07 02:44:30 +00001732 emac_write(EMAC_RXSOFOVERRUNS, stats_clear_mask);
1733 emac_write(EMAC_RXMOFOVERRUNS, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001734
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001735 ndev->stats.rx_fifo_errors += emac_read(EMAC_RXDMAOVERRUNS);
Sriram0fe74632009-10-07 02:44:30 +00001736 emac_write(EMAC_RXDMAOVERRUNS, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001737
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001738 ndev->stats.tx_carrier_errors +=
Anant Golea6286ee2009-05-18 15:19:01 -07001739 emac_read(EMAC_TXCARRIERSENSE);
Sriram0fe74632009-10-07 02:44:30 +00001740 emac_write(EMAC_TXCARRIERSENSE, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001741
Thomas Lange60aeba22011-03-09 04:41:16 +00001742 ndev->stats.tx_fifo_errors += emac_read(EMAC_TXUNDERRUN);
Sriram0fe74632009-10-07 02:44:30 +00001743 emac_write(EMAC_TXUNDERRUN, stats_clear_mask);
Anant Golea6286ee2009-05-18 15:19:01 -07001744
Kulikov Vasiliy78e8c532010-07-05 02:13:26 +00001745 return &ndev->stats;
Anant Golea6286ee2009-05-18 15:19:01 -07001746}
1747
1748static const struct net_device_ops emac_netdev_ops = {
1749 .ndo_open = emac_dev_open,
1750 .ndo_stop = emac_dev_stop,
1751 .ndo_start_xmit = emac_dev_xmit,
Jiri Pirkoafc4b132011-08-16 06:29:01 +00001752 .ndo_set_rx_mode = emac_dev_mcast_set,
Anant Golea6286ee2009-05-18 15:19:01 -07001753 .ndo_set_mac_address = emac_dev_setmac_addr,
1754 .ndo_do_ioctl = emac_devioctl,
1755 .ndo_tx_timeout = emac_dev_tx_timeout,
1756 .ndo_get_stats = emac_dev_getnetstats,
1757#ifdef CONFIG_NET_POLL_CONTROLLER
1758 .ndo_poll_controller = emac_poll_controller,
1759#endif
1760};
1761
1762/**
1763 * davinci_emac_probe: EMAC device probe
1764 * @pdev: The DaVinci EMAC device that we are removing
1765 *
1766 * Called when probing for emac devicesr. We get details of instances and
1767 * resource information from platform init and register a network device
1768 * and allocate resources necessary for driver to perform
1769 */
1770static int __devinit davinci_emac_probe(struct platform_device *pdev)
1771{
1772 int rc = 0;
1773 struct resource *res;
1774 struct net_device *ndev;
1775 struct emac_priv *priv;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001776 unsigned long size, hw_ram_addr;
Anant Golea6286ee2009-05-18 15:19:01 -07001777 struct emac_platform_data *pdata;
1778 struct device *emac_dev;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001779 struct cpdma_params dma_params;
Anant Golea6286ee2009-05-18 15:19:01 -07001780
1781 /* obtain emac clock from kernel */
1782 emac_clk = clk_get(&pdev->dev, NULL);
1783 if (IS_ERR(emac_clk)) {
Johan Hovold240b2622011-05-26 04:37:32 +00001784 dev_err(&pdev->dev, "failed to get EMAC clock\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001785 return -EBUSY;
1786 }
1787 emac_bus_frequency = clk_get_rate(emac_clk);
1788 /* TODO: Probe PHY here if possible */
1789
1790 ndev = alloc_etherdev(sizeof(struct emac_priv));
1791 if (!ndev) {
Julia Lawallb722dbf2011-06-01 07:10:10 +00001792 rc = -ENOMEM;
1793 goto free_clk;
Anant Golea6286ee2009-05-18 15:19:01 -07001794 }
1795
1796 platform_set_drvdata(pdev, ndev);
1797 priv = netdev_priv(ndev);
1798 priv->pdev = pdev;
1799 priv->ndev = ndev;
1800 priv->msg_enable = netif_msg_init(debug_level, DAVINCI_EMAC_DEBUG);
1801
Anant Golea6286ee2009-05-18 15:19:01 -07001802 spin_lock_init(&priv->lock);
1803
1804 pdata = pdev->dev.platform_data;
1805 if (!pdata) {
Johan Hovold240b2622011-05-26 04:37:32 +00001806 dev_err(&pdev->dev, "no platform data\n");
Julia Lawallb722dbf2011-06-01 07:10:10 +00001807 rc = -ENODEV;
1808 goto probe_quit;
Anant Golea6286ee2009-05-18 15:19:01 -07001809 }
1810
1811 /* MAC addr and PHY mask , RMII enable info from platform_data */
1812 memcpy(priv->mac_addr, pdata->mac_addr, 6);
Cyril Chemparathy5d69e002010-09-15 10:11:24 -04001813 priv->phy_id = pdata->phy_id;
Anant Golea6286ee2009-05-18 15:19:01 -07001814 priv->rmii_en = pdata->rmii_en;
1815 priv->version = pdata->version;
Sriramakrishnan01a9af32009-11-19 15:58:26 +05301816 priv->int_enable = pdata->interrupt_enable;
1817 priv->int_disable = pdata->interrupt_disable;
1818
Sriram84da2652010-07-29 02:33:58 +00001819 priv->coal_intvl = 0;
1820 priv->bus_freq_mhz = (u32)(emac_bus_frequency / 1000000);
1821
Anant Golea6286ee2009-05-18 15:19:01 -07001822 emac_dev = &ndev->dev;
1823 /* Get EMAC platform data */
1824 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1825 if (!res) {
Johan Hovold240b2622011-05-26 04:37:32 +00001826 dev_err(&pdev->dev,"error getting res\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001827 rc = -ENOENT;
1828 goto probe_quit;
1829 }
1830
1831 priv->emac_base_phys = res->start + pdata->ctrl_reg_offset;
Joe Perches28f65c112011-06-09 09:13:32 -07001832 size = resource_size(res);
Anant Golea6286ee2009-05-18 15:19:01 -07001833 if (!request_mem_region(res->start, size, ndev->name)) {
Johan Hovold240b2622011-05-26 04:37:32 +00001834 dev_err(&pdev->dev, "failed request_mem_region() for regs\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001835 rc = -ENXIO;
1836 goto probe_quit;
1837 }
1838
1839 priv->remap_addr = ioremap(res->start, size);
1840 if (!priv->remap_addr) {
Johan Hovold240b2622011-05-26 04:37:32 +00001841 dev_err(&pdev->dev, "unable to map IO\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001842 rc = -ENOMEM;
1843 release_mem_region(res->start, size);
1844 goto probe_quit;
1845 }
1846 priv->emac_base = priv->remap_addr + pdata->ctrl_reg_offset;
1847 ndev->base_addr = (unsigned long)priv->remap_addr;
1848
1849 priv->ctrl_base = priv->remap_addr + pdata->ctrl_mod_reg_offset;
Anant Golea6286ee2009-05-18 15:19:01 -07001850
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001851 hw_ram_addr = pdata->hw_ram_addr;
1852 if (!hw_ram_addr)
1853 hw_ram_addr = (u32 __force)res->start + pdata->ctrl_ram_offset;
1854
1855 memset(&dma_params, 0, sizeof(dma_params));
1856 dma_params.dev = emac_dev;
1857 dma_params.dmaregs = priv->emac_base;
1858 dma_params.rxthresh = priv->emac_base + 0x120;
1859 dma_params.rxfree = priv->emac_base + 0x140;
1860 dma_params.txhdp = priv->emac_base + 0x600;
1861 dma_params.rxhdp = priv->emac_base + 0x620;
1862 dma_params.txcp = priv->emac_base + 0x640;
1863 dma_params.rxcp = priv->emac_base + 0x660;
1864 dma_params.num_chan = EMAC_MAX_TXRX_CHANNELS;
1865 dma_params.min_packet_size = EMAC_DEF_MIN_ETHPKTSIZE;
Sriram6a1fef62011-03-22 02:31:03 +00001866 dma_params.desc_hw_addr = hw_ram_addr;
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001867 dma_params.desc_mem_size = pdata->ctrl_ram_size;
1868 dma_params.desc_align = 16;
1869
Sriram6a1fef62011-03-22 02:31:03 +00001870 dma_params.desc_mem_phys = pdata->no_bd_ram ? 0 :
1871 (u32 __force)res->start + pdata->ctrl_ram_offset;
1872
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001873 priv->dma = cpdma_ctlr_create(&dma_params);
1874 if (!priv->dma) {
Johan Hovold240b2622011-05-26 04:37:32 +00001875 dev_err(&pdev->dev, "error initializing DMA\n");
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001876 rc = -ENOMEM;
1877 goto no_dma;
1878 }
1879
1880 priv->txchan = cpdma_chan_create(priv->dma, tx_chan_num(EMAC_DEF_TX_CH),
1881 emac_tx_handler);
1882 priv->rxchan = cpdma_chan_create(priv->dma, rx_chan_num(EMAC_DEF_RX_CH),
1883 emac_rx_handler);
1884 if (WARN_ON(!priv->txchan || !priv->rxchan)) {
1885 rc = -ENOMEM;
1886 goto no_irq_res;
1887 }
Sriramakrishnanad021ae2009-11-19 15:58:27 +05301888
Anant Golea6286ee2009-05-18 15:19:01 -07001889 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1890 if (!res) {
Johan Hovold240b2622011-05-26 04:37:32 +00001891 dev_err(&pdev->dev, "error getting irq res\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001892 rc = -ENOENT;
1893 goto no_irq_res;
1894 }
1895 ndev->irq = res->start;
1896
1897 if (!is_valid_ether_addr(priv->mac_addr)) {
Anant Golea6286ee2009-05-18 15:19:01 -07001898 /* Use random MAC if none passed */
Danny Kukawkabaf1d372012-02-17 05:43:24 +00001899 eth_hw_addr_random(ndev);
1900 memcpy(priv->mac_addr, ndev->dev_addr, ndev->addr_len);
Johan Hovold240b2622011-05-26 04:37:32 +00001901 dev_warn(&pdev->dev, "using random MAC addr: %pM\n",
1902 priv->mac_addr);
Anant Golea6286ee2009-05-18 15:19:01 -07001903 }
1904
1905 ndev->netdev_ops = &emac_netdev_ops;
1906 SET_ETHTOOL_OPS(ndev, &ethtool_ops);
1907 netif_napi_add(ndev, &priv->napi, emac_poll, EMAC_POLL_WEIGHT);
1908
Sriram1ca518b2010-01-07 00:22:37 +00001909 clk_enable(emac_clk);
1910
Anant Golea6286ee2009-05-18 15:19:01 -07001911 /* register the network device */
1912 SET_NETDEV_DEV(ndev, &pdev->dev);
1913 rc = register_netdev(ndev);
1914 if (rc) {
Johan Hovold240b2622011-05-26 04:37:32 +00001915 dev_err(&pdev->dev, "error in register_netdev\n");
Anant Golea6286ee2009-05-18 15:19:01 -07001916 rc = -ENODEV;
1917 goto netdev_reg_err;
1918 }
1919
Anant Golea6286ee2009-05-18 15:19:01 -07001920
Anant Golea6286ee2009-05-18 15:19:01 -07001921 if (netif_msg_probe(priv)) {
1922 dev_notice(emac_dev, "DaVinci EMAC Probe found device "\
1923 "(regs: %p, irq: %d)\n",
1924 (void *)priv->emac_base_phys, ndev->irq);
1925 }
1926 return 0;
1927
Anant Golea6286ee2009-05-18 15:19:01 -07001928netdev_reg_err:
Sriram1ca518b2010-01-07 00:22:37 +00001929 clk_disable(emac_clk);
Anant Golea6286ee2009-05-18 15:19:01 -07001930no_irq_res:
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001931 if (priv->txchan)
1932 cpdma_chan_destroy(priv->txchan);
1933 if (priv->rxchan)
1934 cpdma_chan_destroy(priv->rxchan);
1935 cpdma_ctlr_destroy(priv->dma);
1936no_dma:
Anant Golea6286ee2009-05-18 15:19:01 -07001937 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Joe Perches28f65c112011-06-09 09:13:32 -07001938 release_mem_region(res->start, resource_size(res));
Anant Golea6286ee2009-05-18 15:19:01 -07001939 iounmap(priv->remap_addr);
1940
1941probe_quit:
Anant Golea6286ee2009-05-18 15:19:01 -07001942 free_netdev(ndev);
Julia Lawallb722dbf2011-06-01 07:10:10 +00001943free_clk:
1944 clk_put(emac_clk);
Anant Golea6286ee2009-05-18 15:19:01 -07001945 return rc;
1946}
1947
1948/**
1949 * davinci_emac_remove: EMAC device remove
1950 * @pdev: The DaVinci EMAC device that we are removing
1951 *
1952 * Called when removing the device driver. We disable clock usage and release
1953 * the resources taken up by the driver and unregister network device
1954 */
1955static int __devexit davinci_emac_remove(struct platform_device *pdev)
1956{
1957 struct resource *res;
1958 struct net_device *ndev = platform_get_drvdata(pdev);
1959 struct emac_priv *priv = netdev_priv(ndev);
1960
1961 dev_notice(&ndev->dev, "DaVinci EMAC: davinci_emac_remove()\n");
1962
Anant Golea6286ee2009-05-18 15:19:01 -07001963 platform_set_drvdata(pdev, NULL);
1964 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
Anant Golea6286ee2009-05-18 15:19:01 -07001965
Cyril Chemparathy3ef0fdb2010-09-15 10:11:29 -04001966 if (priv->txchan)
1967 cpdma_chan_destroy(priv->txchan);
1968 if (priv->rxchan)
1969 cpdma_chan_destroy(priv->rxchan);
1970 cpdma_ctlr_destroy(priv->dma);
1971
Joe Perches28f65c112011-06-09 09:13:32 -07001972 release_mem_region(res->start, resource_size(res));
Anant Golea6286ee2009-05-18 15:19:01 -07001973
1974 unregister_netdev(ndev);
Anant Golea6286ee2009-05-18 15:19:01 -07001975 iounmap(priv->remap_addr);
Stefan Weil2a1bc0d2010-08-03 08:53:45 +00001976 free_netdev(ndev);
Anant Golea6286ee2009-05-18 15:19:01 -07001977
1978 clk_disable(emac_clk);
1979 clk_put(emac_clk);
1980
1981 return 0;
1982}
1983
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00001984static int davinci_emac_suspend(struct device *dev)
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08001985{
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00001986 struct platform_device *pdev = to_platform_device(dev);
1987 struct net_device *ndev = platform_get_drvdata(pdev);
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08001988
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00001989 if (netif_running(ndev))
1990 emac_dev_stop(ndev);
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08001991
1992 clk_disable(emac_clk);
1993
1994 return 0;
1995}
1996
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00001997static int davinci_emac_resume(struct device *dev)
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08001998{
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00001999 struct platform_device *pdev = to_platform_device(dev);
2000 struct net_device *ndev = platform_get_drvdata(pdev);
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08002001
2002 clk_enable(emac_clk);
2003
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00002004 if (netif_running(ndev))
2005 emac_dev_open(ndev);
Ranjith Lohithakshan8d044fe2009-11-04 22:06:20 -08002006
2007 return 0;
2008}
2009
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00002010static const struct dev_pm_ops davinci_emac_pm_ops = {
2011 .suspend = davinci_emac_suspend,
2012 .resume = davinci_emac_resume,
2013};
2014
Anant Golea6286ee2009-05-18 15:19:01 -07002015/**
2016 * davinci_emac_driver: EMAC platform driver structure
Anant Golea6286ee2009-05-18 15:19:01 -07002017 */
2018static struct platform_driver davinci_emac_driver = {
2019 .driver = {
2020 .name = "davinci_emac",
2021 .owner = THIS_MODULE,
chaithrika@ti.comd4fdcd92010-03-10 22:37:56 +00002022 .pm = &davinci_emac_pm_ops,
Anant Golea6286ee2009-05-18 15:19:01 -07002023 },
2024 .probe = davinci_emac_probe,
2025 .remove = __devexit_p(davinci_emac_remove),
2026};
2027
2028/**
2029 * davinci_emac_init: EMAC driver module init
2030 *
2031 * Called when initializing the driver. We register the driver with
2032 * the platform.
2033 */
2034static int __init davinci_emac_init(void)
2035{
2036 return platform_driver_register(&davinci_emac_driver);
2037}
Rajashekhara, Sudhakar2db95172009-08-19 10:39:55 +00002038late_initcall(davinci_emac_init);
Anant Golea6286ee2009-05-18 15:19:01 -07002039
2040/**
2041 * davinci_emac_exit: EMAC driver module exit
2042 *
2043 * Called when exiting the driver completely. We unregister the driver with
2044 * the platform and exit
2045 */
2046static void __exit davinci_emac_exit(void)
2047{
2048 platform_driver_unregister(&davinci_emac_driver);
2049}
2050module_exit(davinci_emac_exit);
2051
2052MODULE_LICENSE("GPL");
2053MODULE_AUTHOR("DaVinci EMAC Maintainer: Anant Gole <anantgole@ti.com>");
2054MODULE_AUTHOR("DaVinci EMAC Maintainer: Chaithrika U S <chaithrika@ti.com>");
2055MODULE_DESCRIPTION("DaVinci EMAC Ethernet driver");