Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* via-rhine.c: A Linux Ethernet device driver for VIA Rhine family chips. */ |
| 2 | /* |
| 3 | Written 1998-2001 by Donald Becker. |
| 4 | |
| 5 | Current Maintainer: Roger Luethi <rl@hellgate.ch> |
| 6 | |
| 7 | This software may be used and distributed according to the terms of |
| 8 | the GNU General Public License (GPL), incorporated herein by reference. |
| 9 | Drivers based on or derived from this code fall under the GPL and must |
| 10 | retain the authorship, copyright and license notice. This file is not |
| 11 | a complete program and may only be used when the entire operating |
| 12 | system is licensed under the GPL. |
| 13 | |
| 14 | This driver is designed for the VIA VT86C100A Rhine-I. |
| 15 | It also works with the Rhine-II (6102) and Rhine-III (6105/6105L/6105LOM |
| 16 | and management NIC 6105M). |
| 17 | |
| 18 | The author may be reached as becker@scyld.com, or C/O |
| 19 | Scyld Computing Corporation |
| 20 | 410 Severn Ave., Suite 210 |
| 21 | Annapolis MD 21403 |
| 22 | |
| 23 | |
| 24 | This driver contains some changes from the original Donald Becker |
| 25 | version. He may or may not be interested in bug reports on this |
| 26 | code. You can find his versions at: |
| 27 | http://www.scyld.com/network/via-rhine.html |
Jeff Garzik | 03a8c66 | 2006-06-27 07:57:22 -0400 | [diff] [blame] | 28 | [link no longer provides useful info -jgarzik] |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | |
| 30 | */ |
| 31 | |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 32 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 33 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | #define DRV_NAME "via-rhine" |
Roger Luethi | 207070f | 2013-09-21 14:24:11 +0200 | [diff] [blame] | 35 | #define DRV_VERSION "1.5.1" |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 36 | #define DRV_RELDATE "2010-10-09" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 | |
Rusty Russell | eb93992 | 2011-12-19 14:08:01 +0000 | [diff] [blame] | 38 | #include <linux/types.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | |
| 40 | /* A few user-configurable values. |
| 41 | These may be modified when a driver module is loaded. */ |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 42 | static int debug = 0; |
| 43 | #define RHINE_MSG_DEFAULT \ |
| 44 | (0x0000) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | |
| 46 | /* Set the copy breakpoint for the copy-only-tiny-frames scheme. |
| 47 | Setting to > 1518 effectively disables this feature. */ |
Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 48 | #if defined(__alpha__) || defined(__arm__) || defined(__hppa__) || \ |
| 49 | defined(CONFIG_SPARC) || defined(__ia64__) || \ |
| 50 | defined(__sh__) || defined(__mips__) |
Dustin Marquess | b47157f | 2007-08-10 14:05:15 -0700 | [diff] [blame] | 51 | static int rx_copybreak = 1518; |
| 52 | #else |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | static int rx_copybreak; |
Dustin Marquess | b47157f | 2007-08-10 14:05:15 -0700 | [diff] [blame] | 54 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | |
Roger Luethi | b933b4d | 2006-08-14 23:00:21 -0700 | [diff] [blame] | 56 | /* Work-around for broken BIOSes: they are unable to get the chip back out of |
| 57 | power state D3 so PXE booting fails. bootparam(7): via-rhine.avoid_D3=1 */ |
Rusty Russell | eb93992 | 2011-12-19 14:08:01 +0000 | [diff] [blame] | 58 | static bool avoid_D3; |
Roger Luethi | b933b4d | 2006-08-14 23:00:21 -0700 | [diff] [blame] | 59 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 60 | /* |
| 61 | * In case you are looking for 'options[]' or 'full_duplex[]', they |
| 62 | * are gone. Use ethtool(8) instead. |
| 63 | */ |
| 64 | |
| 65 | /* Maximum number of multicast addresses to filter (vs. rx-all-multicast). |
| 66 | The Rhine has a 64 element 8390-like hash table. */ |
| 67 | static const int multicast_filter_limit = 32; |
| 68 | |
| 69 | |
| 70 | /* Operational parameters that are set at compile time. */ |
| 71 | |
| 72 | /* Keep the ring sizes a power of two for compile efficiency. |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 73 | * The compiler will convert <unsigned>'%'<2^N> into a bit mask. |
| 74 | * Making the Tx ring too large decreases the effectiveness of channel |
| 75 | * bonding and packet priority. |
| 76 | * With BQL support, we can increase TX ring safely. |
| 77 | * There are no ill effects from too-large receive rings. |
| 78 | */ |
| 79 | #define TX_RING_SIZE 64 |
| 80 | #define TX_QUEUE_LEN (TX_RING_SIZE - 6) /* Limit ring entries actually used. */ |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 81 | #define RX_RING_SIZE 64 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | |
| 83 | /* Operational parameters that usually are not changed. */ |
| 84 | |
| 85 | /* Time in jiffies before concluding the transmitter is hung. */ |
| 86 | #define TX_TIMEOUT (2*HZ) |
| 87 | |
| 88 | #define PKT_BUF_SZ 1536 /* Size of each temporary Rx buffer.*/ |
| 89 | |
| 90 | #include <linux/module.h> |
| 91 | #include <linux/moduleparam.h> |
| 92 | #include <linux/kernel.h> |
| 93 | #include <linux/string.h> |
| 94 | #include <linux/timer.h> |
| 95 | #include <linux/errno.h> |
| 96 | #include <linux/ioport.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | #include <linux/interrupt.h> |
| 98 | #include <linux/pci.h> |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 99 | #include <linux/of_address.h> |
| 100 | #include <linux/of_device.h> |
| 101 | #include <linux/of_irq.h> |
| 102 | #include <linux/platform_device.h> |
Domen Puncer | 1e7f0bd | 2005-06-26 18:22:14 -0400 | [diff] [blame] | 103 | #include <linux/dma-mapping.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | #include <linux/netdevice.h> |
| 105 | #include <linux/etherdevice.h> |
| 106 | #include <linux/skbuff.h> |
| 107 | #include <linux/init.h> |
| 108 | #include <linux/delay.h> |
| 109 | #include <linux/mii.h> |
| 110 | #include <linux/ethtool.h> |
| 111 | #include <linux/crc32.h> |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 112 | #include <linux/if_vlan.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | #include <linux/bitops.h> |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 114 | #include <linux/workqueue.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 115 | #include <asm/processor.h> /* Processor type for cache alignment. */ |
| 116 | #include <asm/io.h> |
| 117 | #include <asm/irq.h> |
| 118 | #include <asm/uaccess.h> |
Roger Luethi | e84df48 | 2007-03-06 19:57:37 +0100 | [diff] [blame] | 119 | #include <linux/dmi.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | |
| 121 | /* These identify the driver base version and may not be removed. */ |
Bill Pemberton | 76e239e | 2012-12-03 09:23:48 -0500 | [diff] [blame] | 122 | static const char version[] = |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 123 | "v1.10-LK" DRV_VERSION " " DRV_RELDATE " Written by Donald Becker"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 125 | MODULE_AUTHOR("Donald Becker <becker@scyld.com>"); |
| 126 | MODULE_DESCRIPTION("VIA Rhine PCI Fast Ethernet driver"); |
| 127 | MODULE_LICENSE("GPL"); |
| 128 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | module_param(debug, int, 0); |
| 130 | module_param(rx_copybreak, int, 0); |
Roger Luethi | b933b4d | 2006-08-14 23:00:21 -0700 | [diff] [blame] | 131 | module_param(avoid_D3, bool, 0); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 132 | MODULE_PARM_DESC(debug, "VIA Rhine debug message flags"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 133 | MODULE_PARM_DESC(rx_copybreak, "VIA Rhine copy breakpoint for copy-only-tiny-frames"); |
Roger Luethi | b933b4d | 2006-08-14 23:00:21 -0700 | [diff] [blame] | 134 | MODULE_PARM_DESC(avoid_D3, "Avoid power state D3 (work-around for broken BIOSes)"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 135 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 136 | #define MCAM_SIZE 32 |
| 137 | #define VCAM_SIZE 32 |
| 138 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | /* |
| 140 | Theory of Operation |
| 141 | |
| 142 | I. Board Compatibility |
| 143 | |
| 144 | This driver is designed for the VIA 86c100A Rhine-II PCI Fast Ethernet |
| 145 | controller. |
| 146 | |
| 147 | II. Board-specific settings |
| 148 | |
| 149 | Boards with this chip are functional only in a bus-master PCI slot. |
| 150 | |
| 151 | Many operational settings are loaded from the EEPROM to the Config word at |
| 152 | offset 0x78. For most of these settings, this driver assumes that they are |
| 153 | correct. |
| 154 | If this driver is compiled to use PCI memory space operations the EEPROM |
| 155 | must be configured to enable memory ops. |
| 156 | |
| 157 | III. Driver operation |
| 158 | |
| 159 | IIIa. Ring buffers |
| 160 | |
| 161 | This driver uses two statically allocated fixed-size descriptor lists |
| 162 | formed into rings by a branch from the final descriptor to the beginning of |
| 163 | the list. The ring sizes are set at compile time by RX/TX_RING_SIZE. |
| 164 | |
| 165 | IIIb/c. Transmit/Receive Structure |
| 166 | |
| 167 | This driver attempts to use a zero-copy receive and transmit scheme. |
| 168 | |
| 169 | Alas, all data buffers are required to start on a 32 bit boundary, so |
| 170 | the driver must often copy transmit packets into bounce buffers. |
| 171 | |
| 172 | The driver allocates full frame size skbuffs for the Rx ring buffers at |
| 173 | open() time and passes the skb->data field to the chip as receive data |
| 174 | buffers. When an incoming frame is less than RX_COPYBREAK bytes long, |
| 175 | a fresh skbuff is allocated and the frame is copied to the new skbuff. |
| 176 | When the incoming frame is larger, the skbuff is passed directly up the |
| 177 | protocol stack. Buffers consumed this way are replaced by newly allocated |
| 178 | skbuffs in the last phase of rhine_rx(). |
| 179 | |
| 180 | The RX_COPYBREAK value is chosen to trade-off the memory wasted by |
| 181 | using a full-sized skbuff for small frames vs. the copying costs of larger |
| 182 | frames. New boards are typically used in generously configured machines |
| 183 | and the underfilled buffers have negligible impact compared to the benefit of |
| 184 | a single allocation size, so the default value of zero results in never |
| 185 | copying packets. When copying is done, the cost is usually mitigated by using |
| 186 | a combined copy/checksum routine. Copying also preloads the cache, which is |
| 187 | most useful with small frames. |
| 188 | |
| 189 | Since the VIA chips are only able to transfer data to buffers on 32 bit |
| 190 | boundaries, the IP header at offset 14 in an ethernet frame isn't |
| 191 | longword aligned for further processing. Copying these unaligned buffers |
| 192 | has the beneficial effect of 16-byte aligning the IP header. |
| 193 | |
| 194 | IIId. Synchronization |
| 195 | |
| 196 | The driver runs as two independent, single-threaded flows of control. One |
| 197 | is the send-packet routine, which enforces single-threaded use by the |
Wang Chen | b74ca3a | 2008-12-08 01:14:16 -0800 | [diff] [blame] | 198 | netdev_priv(dev)->lock spinlock. The other thread is the interrupt handler, |
| 199 | which is single threaded by the hardware and interrupt handling software. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | |
| 201 | The send packet thread has partial control over the Tx ring. It locks the |
Wang Chen | b74ca3a | 2008-12-08 01:14:16 -0800 | [diff] [blame] | 202 | netdev_priv(dev)->lock whenever it's queuing a Tx packet. If the next slot in |
| 203 | the ring is not available it stops the transmit queue by |
| 204 | calling netif_stop_queue. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 205 | |
| 206 | The interrupt handler has exclusive control over the Rx ring and records stats |
| 207 | from the Tx ring. After reaping the stats, it marks the Tx queue entry as |
| 208 | empty by incrementing the dirty_tx mark. If at least half of the entries in |
| 209 | the Rx ring are available the transmit queue is woken up if it was stopped. |
| 210 | |
| 211 | IV. Notes |
| 212 | |
| 213 | IVb. References |
| 214 | |
| 215 | Preliminary VT86C100A manual from http://www.via.com.tw/ |
| 216 | http://www.scyld.com/expert/100mbps.html |
| 217 | http://www.scyld.com/expert/NWay.html |
| 218 | ftp://ftp.via.com.tw/public/lan/Products/NIC/VT86C100A/Datasheet/VT86C100A03.pdf |
| 219 | ftp://ftp.via.com.tw/public/lan/Products/NIC/VT6102/Datasheet/VT6102_021.PDF |
| 220 | |
| 221 | |
| 222 | IVc. Errata |
| 223 | |
| 224 | The VT86C100A manual is not reliable information. |
| 225 | The 3043 chip does not handle unaligned transmit or receive buffers, resulting |
| 226 | in significant performance degradation for bounce buffer copies on transmit |
| 227 | and unaligned IP headers on receive. |
| 228 | The chip does not pad to minimum transmit length. |
| 229 | |
| 230 | */ |
| 231 | |
| 232 | |
| 233 | /* This table drives the PCI probe routines. It's mostly boilerplate in all |
| 234 | of the drivers, and will likely be provided by some future kernel. |
| 235 | Note the matching code -- the first table entry matchs all 56** cards but |
| 236 | second only the 1234 card. |
| 237 | */ |
| 238 | |
| 239 | enum rhine_revs { |
| 240 | VT86C100A = 0x00, |
| 241 | VTunknown0 = 0x20, |
| 242 | VT6102 = 0x40, |
| 243 | VT8231 = 0x50, /* Integrated MAC */ |
| 244 | VT8233 = 0x60, /* Integrated MAC */ |
| 245 | VT8235 = 0x74, /* Integrated MAC */ |
| 246 | VT8237 = 0x78, /* Integrated MAC */ |
| 247 | VTunknown1 = 0x7C, |
| 248 | VT6105 = 0x80, |
| 249 | VT6105_B0 = 0x83, |
| 250 | VT6105L = 0x8A, |
| 251 | VT6107 = 0x8C, |
| 252 | VTunknown2 = 0x8E, |
| 253 | VT6105M = 0x90, /* Management adapter */ |
| 254 | }; |
| 255 | |
| 256 | enum rhine_quirks { |
| 257 | rqWOL = 0x0001, /* Wake-On-LAN support */ |
| 258 | rqForceReset = 0x0002, |
| 259 | rq6patterns = 0x0040, /* 6 instead of 4 patterns for WOL */ |
| 260 | rqStatusWBRace = 0x0080, /* Tx Status Writeback Error possible */ |
| 261 | rqRhineI = 0x0100, /* See comment below */ |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 262 | rqIntPHY = 0x0200, /* Integrated PHY */ |
| 263 | rqMgmt = 0x0400, /* Management adapter */ |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 264 | rqNeedEnMMIO = 0x0800, /* Whether the core needs to be |
| 265 | * switched from PIO mode to MMIO |
| 266 | * (only applies to PCI) |
| 267 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | }; |
| 269 | /* |
| 270 | * rqRhineI: VT86C100A (aka Rhine-I) uses different bits to enable |
| 271 | * MMIO as well as for the collision counter and the Tx FIFO underflow |
| 272 | * indicator. In addition, Tx and Rx buffers need to 4 byte aligned. |
| 273 | */ |
| 274 | |
| 275 | /* Beware of PCI posted writes */ |
| 276 | #define IOSYNC do { ioread8(ioaddr + StationAddr); } while (0) |
| 277 | |
Benoit Taine | 9baa3c3 | 2014-08-08 15:56:03 +0200 | [diff] [blame] | 278 | static const struct pci_device_id rhine_pci_tbl[] = { |
Jeff Garzik | 46009c8 | 2006-06-27 09:12:38 -0400 | [diff] [blame] | 279 | { 0x1106, 0x3043, PCI_ANY_ID, PCI_ANY_ID, }, /* VT86C100A */ |
| 280 | { 0x1106, 0x3065, PCI_ANY_ID, PCI_ANY_ID, }, /* VT6102 */ |
| 281 | { 0x1106, 0x3106, PCI_ANY_ID, PCI_ANY_ID, }, /* 6105{,L,LOM} */ |
| 282 | { 0x1106, 0x3053, PCI_ANY_ID, PCI_ANY_ID, }, /* VT6105M */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 283 | { } /* terminate list */ |
| 284 | }; |
| 285 | MODULE_DEVICE_TABLE(pci, rhine_pci_tbl); |
| 286 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 287 | /* OpenFirmware identifiers for platform-bus devices |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 288 | * The .data field is currently only used to store quirks |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 289 | */ |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 290 | static u32 vt8500_quirks = rqWOL | rqForceReset | rq6patterns; |
Fabian Frederick | d2b75a3 | 2015-03-17 19:40:27 +0100 | [diff] [blame] | 291 | static const struct of_device_id rhine_of_tbl[] = { |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 292 | { .compatible = "via,vt8500-rhine", .data = &vt8500_quirks }, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 293 | { } /* terminate list */ |
| 294 | }; |
| 295 | MODULE_DEVICE_TABLE(of, rhine_of_tbl); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 296 | |
| 297 | /* Offsets to the device registers. */ |
| 298 | enum register_offsets { |
| 299 | StationAddr=0x00, RxConfig=0x06, TxConfig=0x07, ChipCmd=0x08, |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 300 | ChipCmd1=0x09, TQWake=0x0A, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 301 | IntrStatus=0x0C, IntrEnable=0x0E, |
| 302 | MulticastFilter0=0x10, MulticastFilter1=0x14, |
| 303 | RxRingPtr=0x18, TxRingPtr=0x1C, GFIFOTest=0x54, |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 304 | MIIPhyAddr=0x6C, MIIStatus=0x6D, PCIBusConfig=0x6E, PCIBusConfig1=0x6F, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 305 | MIICmd=0x70, MIIRegAddr=0x71, MIIData=0x72, MACRegEEcsr=0x74, |
| 306 | ConfigA=0x78, ConfigB=0x79, ConfigC=0x7A, ConfigD=0x7B, |
| 307 | RxMissed=0x7C, RxCRCErrs=0x7E, MiscCmd=0x81, |
| 308 | StickyHW=0x83, IntrStatus2=0x84, |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 309 | CamMask=0x88, CamCon=0x92, CamAddr=0x93, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 310 | WOLcrSet=0xA0, PwcfgSet=0xA1, WOLcgSet=0xA3, WOLcrClr=0xA4, |
| 311 | WOLcrClr1=0xA6, WOLcgClr=0xA7, |
| 312 | PwrcsrSet=0xA8, PwrcsrSet1=0xA9, PwrcsrClr=0xAC, PwrcsrClr1=0xAD, |
| 313 | }; |
| 314 | |
| 315 | /* Bits in ConfigD */ |
| 316 | enum backoff_bits { |
| 317 | BackOptional=0x01, BackModify=0x02, |
| 318 | BackCaptureEffect=0x04, BackRandom=0x08 |
| 319 | }; |
| 320 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 321 | /* Bits in the TxConfig (TCR) register */ |
| 322 | enum tcr_bits { |
| 323 | TCR_PQEN=0x01, |
| 324 | TCR_LB0=0x02, /* loopback[0] */ |
| 325 | TCR_LB1=0x04, /* loopback[1] */ |
| 326 | TCR_OFSET=0x08, |
| 327 | TCR_RTGOPT=0x10, |
| 328 | TCR_RTFT0=0x20, |
| 329 | TCR_RTFT1=0x40, |
| 330 | TCR_RTSF=0x80, |
| 331 | }; |
| 332 | |
| 333 | /* Bits in the CamCon (CAMC) register */ |
| 334 | enum camcon_bits { |
| 335 | CAMC_CAMEN=0x01, |
| 336 | CAMC_VCAMSL=0x02, |
| 337 | CAMC_CAMWR=0x04, |
| 338 | CAMC_CAMRD=0x08, |
| 339 | }; |
| 340 | |
| 341 | /* Bits in the PCIBusConfig1 (BCR1) register */ |
| 342 | enum bcr1_bits { |
| 343 | BCR1_POT0=0x01, |
| 344 | BCR1_POT1=0x02, |
| 345 | BCR1_POT2=0x04, |
| 346 | BCR1_CTFT0=0x08, |
| 347 | BCR1_CTFT1=0x10, |
| 348 | BCR1_CTSF=0x20, |
| 349 | BCR1_TXQNOBK=0x40, /* for VT6105 */ |
| 350 | BCR1_VIDFR=0x80, /* for VT6105 */ |
| 351 | BCR1_MED0=0x40, /* for VT6102 */ |
| 352 | BCR1_MED1=0x80, /* for VT6102 */ |
| 353 | }; |
| 354 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 355 | /* Registers we check that mmio and reg are the same. */ |
| 356 | static const int mmio_verify_registers[] = { |
| 357 | RxConfig, TxConfig, IntrEnable, ConfigA, ConfigB, ConfigC, ConfigD, |
| 358 | 0 |
| 359 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 360 | |
| 361 | /* Bits in the interrupt status/mask registers. */ |
| 362 | enum intr_status_bits { |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 363 | IntrRxDone = 0x0001, |
| 364 | IntrTxDone = 0x0002, |
| 365 | IntrRxErr = 0x0004, |
| 366 | IntrTxError = 0x0008, |
| 367 | IntrRxEmpty = 0x0020, |
| 368 | IntrPCIErr = 0x0040, |
| 369 | IntrStatsMax = 0x0080, |
| 370 | IntrRxEarly = 0x0100, |
| 371 | IntrTxUnderrun = 0x0210, |
| 372 | IntrRxOverflow = 0x0400, |
| 373 | IntrRxDropped = 0x0800, |
| 374 | IntrRxNoBuf = 0x1000, |
| 375 | IntrTxAborted = 0x2000, |
| 376 | IntrLinkChange = 0x4000, |
| 377 | IntrRxWakeUp = 0x8000, |
| 378 | IntrTxDescRace = 0x080000, /* mapped from IntrStatus2 */ |
| 379 | IntrNormalSummary = IntrRxDone | IntrTxDone, |
| 380 | IntrTxErrSummary = IntrTxDescRace | IntrTxAborted | IntrTxError | |
| 381 | IntrTxUnderrun, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 382 | }; |
| 383 | |
| 384 | /* Bits in WOLcrSet/WOLcrClr and PwrcsrSet/PwrcsrClr */ |
| 385 | enum wol_bits { |
| 386 | WOLucast = 0x10, |
| 387 | WOLmagic = 0x20, |
| 388 | WOLbmcast = 0x30, |
| 389 | WOLlnkon = 0x40, |
| 390 | WOLlnkoff = 0x80, |
| 391 | }; |
| 392 | |
| 393 | /* The Rx and Tx buffer descriptors. */ |
| 394 | struct rx_desc { |
Al Viro | 53c03f5 | 2007-08-23 02:33:30 -0400 | [diff] [blame] | 395 | __le32 rx_status; |
| 396 | __le32 desc_length; /* Chain flag, Buffer/frame length */ |
| 397 | __le32 addr; |
| 398 | __le32 next_desc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 399 | }; |
| 400 | struct tx_desc { |
Al Viro | 53c03f5 | 2007-08-23 02:33:30 -0400 | [diff] [blame] | 401 | __le32 tx_status; |
| 402 | __le32 desc_length; /* Chain flag, Tx Config, Frame length */ |
| 403 | __le32 addr; |
| 404 | __le32 next_desc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 405 | }; |
| 406 | |
| 407 | /* Initial value for tx_desc.desc_length, Buffer size goes to bits 0-10 */ |
| 408 | #define TXDESC 0x00e08000 |
| 409 | |
| 410 | enum rx_status_bits { |
| 411 | RxOK=0x8000, RxWholePkt=0x0300, RxErr=0x008F |
| 412 | }; |
| 413 | |
| 414 | /* Bits in *_desc.*_status */ |
| 415 | enum desc_status_bits { |
| 416 | DescOwn=0x80000000 |
| 417 | }; |
| 418 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 419 | /* Bits in *_desc.*_length */ |
| 420 | enum desc_length_bits { |
| 421 | DescTag=0x00010000 |
| 422 | }; |
| 423 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 424 | /* Bits in ChipCmd. */ |
| 425 | enum chip_cmd_bits { |
| 426 | CmdInit=0x01, CmdStart=0x02, CmdStop=0x04, CmdRxOn=0x08, |
| 427 | CmdTxOn=0x10, Cmd1TxDemand=0x20, CmdRxDemand=0x40, |
| 428 | Cmd1EarlyRx=0x01, Cmd1EarlyTx=0x02, Cmd1FDuplex=0x04, |
| 429 | Cmd1NoTxPoll=0x08, Cmd1Reset=0x80, |
| 430 | }; |
| 431 | |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 432 | struct rhine_stats { |
| 433 | u64 packets; |
| 434 | u64 bytes; |
| 435 | struct u64_stats_sync syncp; |
| 436 | }; |
| 437 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 438 | struct rhine_private { |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 439 | /* Bit mask for configured VLAN ids */ |
| 440 | unsigned long active_vlans[BITS_TO_LONGS(VLAN_N_VID)]; |
| 441 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 442 | /* Descriptor rings */ |
| 443 | struct rx_desc *rx_ring; |
| 444 | struct tx_desc *tx_ring; |
| 445 | dma_addr_t rx_ring_dma; |
| 446 | dma_addr_t tx_ring_dma; |
| 447 | |
| 448 | /* The addresses of receive-in-place skbuffs. */ |
| 449 | struct sk_buff *rx_skbuff[RX_RING_SIZE]; |
| 450 | dma_addr_t rx_skbuff_dma[RX_RING_SIZE]; |
| 451 | |
| 452 | /* The saved address of a sent-in-place packet/buffer, for later free(). */ |
| 453 | struct sk_buff *tx_skbuff[TX_RING_SIZE]; |
| 454 | dma_addr_t tx_skbuff_dma[TX_RING_SIZE]; |
| 455 | |
Roger Luethi | 4be5de2 | 2006-04-04 20:49:16 +0200 | [diff] [blame] | 456 | /* Tx bounce buffers (Rhine-I only) */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 457 | unsigned char *tx_buf[TX_RING_SIZE]; |
| 458 | unsigned char *tx_bufs; |
| 459 | dma_addr_t tx_bufs_dma; |
| 460 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 461 | int irq; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 462 | long pioaddr; |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 463 | struct net_device *dev; |
| 464 | struct napi_struct napi; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 465 | spinlock_t lock; |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 466 | struct mutex task_lock; |
| 467 | bool task_enable; |
| 468 | struct work_struct slow_event_task; |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 469 | struct work_struct reset_task; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 471 | u32 msg_enable; |
| 472 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 473 | /* Frequently used values: keep some adjacent for cache effect. */ |
| 474 | u32 quirks; |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 475 | unsigned int cur_rx; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 476 | unsigned int cur_tx, dirty_tx; |
| 477 | unsigned int rx_buf_sz; /* Based on MTU+slack. */ |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 478 | struct rhine_stats rx_stats; |
| 479 | struct rhine_stats tx_stats; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 480 | u8 wolopts; |
| 481 | |
| 482 | u8 tx_thresh, rx_thresh; |
| 483 | |
| 484 | struct mii_if_info mii_if; |
| 485 | void __iomem *base; |
| 486 | }; |
| 487 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 488 | #define BYTE_REG_BITS_ON(x, p) do { iowrite8((ioread8((p))|(x)), (p)); } while (0) |
| 489 | #define WORD_REG_BITS_ON(x, p) do { iowrite16((ioread16((p))|(x)), (p)); } while (0) |
| 490 | #define DWORD_REG_BITS_ON(x, p) do { iowrite32((ioread32((p))|(x)), (p)); } while (0) |
| 491 | |
| 492 | #define BYTE_REG_BITS_IS_ON(x, p) (ioread8((p)) & (x)) |
| 493 | #define WORD_REG_BITS_IS_ON(x, p) (ioread16((p)) & (x)) |
| 494 | #define DWORD_REG_BITS_IS_ON(x, p) (ioread32((p)) & (x)) |
| 495 | |
| 496 | #define BYTE_REG_BITS_OFF(x, p) do { iowrite8(ioread8((p)) & (~(x)), (p)); } while (0) |
| 497 | #define WORD_REG_BITS_OFF(x, p) do { iowrite16(ioread16((p)) & (~(x)), (p)); } while (0) |
| 498 | #define DWORD_REG_BITS_OFF(x, p) do { iowrite32(ioread32((p)) & (~(x)), (p)); } while (0) |
| 499 | |
| 500 | #define BYTE_REG_BITS_SET(x, m, p) do { iowrite8((ioread8((p)) & (~(m)))|(x), (p)); } while (0) |
| 501 | #define WORD_REG_BITS_SET(x, m, p) do { iowrite16((ioread16((p)) & (~(m)))|(x), (p)); } while (0) |
| 502 | #define DWORD_REG_BITS_SET(x, m, p) do { iowrite32((ioread32((p)) & (~(m)))|(x), (p)); } while (0) |
| 503 | |
| 504 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 505 | static int mdio_read(struct net_device *dev, int phy_id, int location); |
| 506 | static void mdio_write(struct net_device *dev, int phy_id, int location, int value); |
| 507 | static int rhine_open(struct net_device *dev); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 508 | static void rhine_reset_task(struct work_struct *work); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 509 | static void rhine_slow_event_task(struct work_struct *work); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 510 | static void rhine_tx_timeout(struct net_device *dev); |
Stephen Hemminger | 61357325 | 2009-08-31 19:50:58 +0000 | [diff] [blame] | 511 | static netdev_tx_t rhine_start_tx(struct sk_buff *skb, |
| 512 | struct net_device *dev); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 513 | static irqreturn_t rhine_interrupt(int irq, void *dev_instance); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 514 | static void rhine_tx(struct net_device *dev); |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 515 | static int rhine_rx(struct net_device *dev, int limit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 516 | static void rhine_set_rx_mode(struct net_device *dev); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 517 | static struct rtnl_link_stats64 *rhine_get_stats64(struct net_device *dev, |
| 518 | struct rtnl_link_stats64 *stats); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 519 | static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd); |
Jeff Garzik | 7282d49 | 2006-09-13 14:30:00 -0400 | [diff] [blame] | 520 | static const struct ethtool_ops netdev_ethtool_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 521 | static int rhine_close(struct net_device *dev); |
Patrick McHardy | 80d5c36 | 2013-04-19 02:04:28 +0000 | [diff] [blame] | 522 | static int rhine_vlan_rx_add_vid(struct net_device *dev, |
| 523 | __be16 proto, u16 vid); |
| 524 | static int rhine_vlan_rx_kill_vid(struct net_device *dev, |
| 525 | __be16 proto, u16 vid); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 526 | static void rhine_restart_tx(struct net_device *dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 527 | |
Andreas Mohr | 3f8c91a | 2012-04-01 12:35:00 +0000 | [diff] [blame] | 528 | static void rhine_wait_bit(struct rhine_private *rp, u8 reg, u8 mask, bool low) |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 529 | { |
| 530 | void __iomem *ioaddr = rp->base; |
| 531 | int i; |
| 532 | |
| 533 | for (i = 0; i < 1024; i++) { |
Andreas Mohr | 3f8c91a | 2012-04-01 12:35:00 +0000 | [diff] [blame] | 534 | bool has_mask_bits = !!(ioread8(ioaddr + reg) & mask); |
| 535 | |
| 536 | if (low ^ has_mask_bits) |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 537 | break; |
| 538 | udelay(10); |
| 539 | } |
| 540 | if (i > 64) { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 541 | netif_dbg(rp, hw, rp->dev, "%s bit wait (%02x/%02x) cycle " |
Andreas Mohr | 3f8c91a | 2012-04-01 12:35:00 +0000 | [diff] [blame] | 542 | "count: %04d\n", low ? "low" : "high", reg, mask, i); |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 543 | } |
| 544 | } |
| 545 | |
| 546 | static void rhine_wait_bit_high(struct rhine_private *rp, u8 reg, u8 mask) |
| 547 | { |
Andreas Mohr | 3f8c91a | 2012-04-01 12:35:00 +0000 | [diff] [blame] | 548 | rhine_wait_bit(rp, reg, mask, false); |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 549 | } |
| 550 | |
| 551 | static void rhine_wait_bit_low(struct rhine_private *rp, u8 reg, u8 mask) |
| 552 | { |
Andreas Mohr | 3f8c91a | 2012-04-01 12:35:00 +0000 | [diff] [blame] | 553 | rhine_wait_bit(rp, reg, mask, true); |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 554 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 555 | |
Francois Romieu | a20a28b | 2011-12-30 14:53:58 +0100 | [diff] [blame] | 556 | static u32 rhine_get_events(struct rhine_private *rp) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 557 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 558 | void __iomem *ioaddr = rp->base; |
| 559 | u32 intr_status; |
| 560 | |
| 561 | intr_status = ioread16(ioaddr + IntrStatus); |
| 562 | /* On Rhine-II, Bit 3 indicates Tx descriptor write-back race. */ |
| 563 | if (rp->quirks & rqStatusWBRace) |
| 564 | intr_status |= ioread8(ioaddr + IntrStatus2) << 16; |
| 565 | return intr_status; |
| 566 | } |
| 567 | |
Francois Romieu | a20a28b | 2011-12-30 14:53:58 +0100 | [diff] [blame] | 568 | static void rhine_ack_events(struct rhine_private *rp, u32 mask) |
| 569 | { |
| 570 | void __iomem *ioaddr = rp->base; |
| 571 | |
| 572 | if (rp->quirks & rqStatusWBRace) |
| 573 | iowrite8(mask >> 16, ioaddr + IntrStatus2); |
| 574 | iowrite16(mask, ioaddr + IntrStatus); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 575 | mmiowb(); |
Francois Romieu | a20a28b | 2011-12-30 14:53:58 +0100 | [diff] [blame] | 576 | } |
| 577 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 578 | /* |
| 579 | * Get power related registers into sane state. |
| 580 | * Notify user about past WOL event. |
| 581 | */ |
| 582 | static void rhine_power_init(struct net_device *dev) |
| 583 | { |
| 584 | struct rhine_private *rp = netdev_priv(dev); |
| 585 | void __iomem *ioaddr = rp->base; |
| 586 | u16 wolstat; |
| 587 | |
| 588 | if (rp->quirks & rqWOL) { |
| 589 | /* Make sure chip is in power state D0 */ |
| 590 | iowrite8(ioread8(ioaddr + StickyHW) & 0xFC, ioaddr + StickyHW); |
| 591 | |
| 592 | /* Disable "force PME-enable" */ |
| 593 | iowrite8(0x80, ioaddr + WOLcgClr); |
| 594 | |
| 595 | /* Clear power-event config bits (WOL) */ |
| 596 | iowrite8(0xFF, ioaddr + WOLcrClr); |
| 597 | /* More recent cards can manage two additional patterns */ |
| 598 | if (rp->quirks & rq6patterns) |
| 599 | iowrite8(0x03, ioaddr + WOLcrClr1); |
| 600 | |
| 601 | /* Save power-event status bits */ |
| 602 | wolstat = ioread8(ioaddr + PwrcsrSet); |
| 603 | if (rp->quirks & rq6patterns) |
| 604 | wolstat |= (ioread8(ioaddr + PwrcsrSet1) & 0x03) << 8; |
| 605 | |
| 606 | /* Clear power-event status bits */ |
| 607 | iowrite8(0xFF, ioaddr + PwrcsrClr); |
| 608 | if (rp->quirks & rq6patterns) |
| 609 | iowrite8(0x03, ioaddr + PwrcsrClr1); |
| 610 | |
| 611 | if (wolstat) { |
| 612 | char *reason; |
| 613 | switch (wolstat) { |
| 614 | case WOLmagic: |
| 615 | reason = "Magic packet"; |
| 616 | break; |
| 617 | case WOLlnkon: |
| 618 | reason = "Link went up"; |
| 619 | break; |
| 620 | case WOLlnkoff: |
| 621 | reason = "Link went down"; |
| 622 | break; |
| 623 | case WOLucast: |
| 624 | reason = "Unicast packet"; |
| 625 | break; |
| 626 | case WOLbmcast: |
| 627 | reason = "Multicast/broadcast packet"; |
| 628 | break; |
| 629 | default: |
| 630 | reason = "Unknown"; |
| 631 | } |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 632 | netdev_info(dev, "Woke system up. Reason: %s\n", |
| 633 | reason); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 634 | } |
| 635 | } |
| 636 | } |
| 637 | |
| 638 | static void rhine_chip_reset(struct net_device *dev) |
| 639 | { |
| 640 | struct rhine_private *rp = netdev_priv(dev); |
| 641 | void __iomem *ioaddr = rp->base; |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 642 | u8 cmd1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 643 | |
| 644 | iowrite8(Cmd1Reset, ioaddr + ChipCmd1); |
| 645 | IOSYNC; |
| 646 | |
| 647 | if (ioread8(ioaddr + ChipCmd1) & Cmd1Reset) { |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 648 | netdev_info(dev, "Reset not complete yet. Trying harder.\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 649 | |
| 650 | /* Force reset */ |
| 651 | if (rp->quirks & rqForceReset) |
| 652 | iowrite8(0x40, ioaddr + MiscCmd); |
| 653 | |
| 654 | /* Reset can take somewhat longer (rare) */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 655 | rhine_wait_bit_low(rp, ChipCmd1, Cmd1Reset); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 656 | } |
| 657 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 658 | cmd1 = ioread8(ioaddr + ChipCmd1); |
| 659 | netif_info(rp, hw, dev, "Reset %s\n", (cmd1 & Cmd1Reset) ? |
| 660 | "failed" : "succeeded"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 661 | } |
| 662 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 663 | static void enable_mmio(long pioaddr, u32 quirks) |
| 664 | { |
| 665 | int n; |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 666 | |
| 667 | if (quirks & rqNeedEnMMIO) { |
| 668 | if (quirks & rqRhineI) { |
| 669 | /* More recent docs say that this bit is reserved */ |
| 670 | n = inb(pioaddr + ConfigA) | 0x20; |
| 671 | outb(n, pioaddr + ConfigA); |
| 672 | } else { |
| 673 | n = inb(pioaddr + ConfigD) | 0x80; |
| 674 | outb(n, pioaddr + ConfigD); |
| 675 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 676 | } |
| 677 | } |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 678 | |
| 679 | static inline int verify_mmio(struct device *hwdev, |
| 680 | long pioaddr, |
| 681 | void __iomem *ioaddr, |
| 682 | u32 quirks) |
| 683 | { |
| 684 | if (quirks & rqNeedEnMMIO) { |
| 685 | int i = 0; |
| 686 | |
| 687 | /* Check that selected MMIO registers match the PIO ones */ |
| 688 | while (mmio_verify_registers[i]) { |
| 689 | int reg = mmio_verify_registers[i++]; |
| 690 | unsigned char a = inb(pioaddr+reg); |
| 691 | unsigned char b = readb(ioaddr+reg); |
| 692 | |
| 693 | if (a != b) { |
| 694 | dev_err(hwdev, |
| 695 | "MMIO do not match PIO [%02x] (%02x != %02x)\n", |
| 696 | reg, a, b); |
| 697 | return -EIO; |
| 698 | } |
| 699 | } |
| 700 | } |
| 701 | return 0; |
| 702 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 | |
| 704 | /* |
| 705 | * Loads bytes 0x00-0x05, 0x6E-0x6F, 0x78-0x7B from EEPROM |
| 706 | * (plus 0x6C for Rhine-I/II) |
| 707 | */ |
Bill Pemberton | 76e239e | 2012-12-03 09:23:48 -0500 | [diff] [blame] | 708 | static void rhine_reload_eeprom(long pioaddr, struct net_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 709 | { |
| 710 | struct rhine_private *rp = netdev_priv(dev); |
| 711 | void __iomem *ioaddr = rp->base; |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 712 | int i; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 713 | |
| 714 | outb(0x20, pioaddr + MACRegEEcsr); |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 715 | for (i = 0; i < 1024; i++) { |
| 716 | if (!(inb(pioaddr + MACRegEEcsr) & 0x20)) |
| 717 | break; |
| 718 | } |
| 719 | if (i > 512) |
| 720 | pr_info("%4d cycles used @ %s:%d\n", i, __func__, __LINE__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 721 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 | /* |
| 723 | * Reloading from EEPROM overwrites ConfigA-D, so we must re-enable |
| 724 | * MMIO. If reloading EEPROM was done first this could be avoided, but |
| 725 | * it is not known if that still works with the "win98-reboot" problem. |
| 726 | */ |
| 727 | enable_mmio(pioaddr, rp->quirks); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 728 | |
| 729 | /* Turn off EEPROM-controlled wake-up (magic packet) */ |
| 730 | if (rp->quirks & rqWOL) |
| 731 | iowrite8(ioread8(ioaddr + ConfigA) & 0xFC, ioaddr + ConfigA); |
| 732 | |
| 733 | } |
| 734 | |
| 735 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 736 | static void rhine_poll(struct net_device *dev) |
| 737 | { |
Francois Romieu | 05d334e | 2012-03-09 15:28:18 +0100 | [diff] [blame] | 738 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 739 | const int irq = rp->irq; |
Francois Romieu | 05d334e | 2012-03-09 15:28:18 +0100 | [diff] [blame] | 740 | |
| 741 | disable_irq(irq); |
| 742 | rhine_interrupt(irq, dev); |
| 743 | enable_irq(irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | } |
| 745 | #endif |
| 746 | |
Francois Romieu | 269f311 | 2011-12-30 14:43:54 +0100 | [diff] [blame] | 747 | static void rhine_kick_tx_threshold(struct rhine_private *rp) |
| 748 | { |
| 749 | if (rp->tx_thresh < 0xe0) { |
| 750 | void __iomem *ioaddr = rp->base; |
| 751 | |
| 752 | rp->tx_thresh += 0x20; |
| 753 | BYTE_REG_BITS_SET(rp->tx_thresh, 0x80, ioaddr + TxConfig); |
| 754 | } |
| 755 | } |
| 756 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 757 | static void rhine_tx_err(struct rhine_private *rp, u32 status) |
| 758 | { |
| 759 | struct net_device *dev = rp->dev; |
| 760 | |
| 761 | if (status & IntrTxAborted) { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 762 | netif_info(rp, tx_err, dev, |
| 763 | "Abort %08x, frame dropped\n", status); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 764 | } |
| 765 | |
| 766 | if (status & IntrTxUnderrun) { |
| 767 | rhine_kick_tx_threshold(rp); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 768 | netif_info(rp, tx_err ,dev, "Transmitter underrun, " |
| 769 | "Tx threshold now %02x\n", rp->tx_thresh); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 770 | } |
| 771 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 772 | if (status & IntrTxDescRace) |
| 773 | netif_info(rp, tx_err, dev, "Tx descriptor write-back race\n"); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 774 | |
| 775 | if ((status & IntrTxError) && |
| 776 | (status & (IntrTxAborted | IntrTxUnderrun | IntrTxDescRace)) == 0) { |
| 777 | rhine_kick_tx_threshold(rp); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 778 | netif_info(rp, tx_err, dev, "Unspecified error. " |
| 779 | "Tx threshold now %02x\n", rp->tx_thresh); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 780 | } |
| 781 | |
| 782 | rhine_restart_tx(dev); |
| 783 | } |
| 784 | |
| 785 | static void rhine_update_rx_crc_and_missed_errord(struct rhine_private *rp) |
| 786 | { |
| 787 | void __iomem *ioaddr = rp->base; |
| 788 | struct net_device_stats *stats = &rp->dev->stats; |
| 789 | |
| 790 | stats->rx_crc_errors += ioread16(ioaddr + RxCRCErrs); |
| 791 | stats->rx_missed_errors += ioread16(ioaddr + RxMissed); |
| 792 | |
| 793 | /* |
| 794 | * Clears the "tally counters" for CRC errors and missed frames(?). |
| 795 | * It has been reported that some chips need a write of 0 to clear |
| 796 | * these, for others the counters are set to 1 when written to and |
| 797 | * instead cleared when read. So we clear them both ways ... |
| 798 | */ |
| 799 | iowrite32(0, ioaddr + RxMissed); |
| 800 | ioread16(ioaddr + RxCRCErrs); |
| 801 | ioread16(ioaddr + RxMissed); |
| 802 | } |
| 803 | |
| 804 | #define RHINE_EVENT_NAPI_RX (IntrRxDone | \ |
| 805 | IntrRxErr | \ |
| 806 | IntrRxEmpty | \ |
| 807 | IntrRxOverflow | \ |
| 808 | IntrRxDropped | \ |
| 809 | IntrRxNoBuf | \ |
| 810 | IntrRxWakeUp) |
| 811 | |
| 812 | #define RHINE_EVENT_NAPI_TX_ERR (IntrTxError | \ |
| 813 | IntrTxAborted | \ |
| 814 | IntrTxUnderrun | \ |
| 815 | IntrTxDescRace) |
| 816 | #define RHINE_EVENT_NAPI_TX (IntrTxDone | RHINE_EVENT_NAPI_TX_ERR) |
| 817 | |
| 818 | #define RHINE_EVENT_NAPI (RHINE_EVENT_NAPI_RX | \ |
| 819 | RHINE_EVENT_NAPI_TX | \ |
| 820 | IntrStatsMax) |
| 821 | #define RHINE_EVENT_SLOW (IntrPCIErr | IntrLinkChange) |
| 822 | #define RHINE_EVENT (RHINE_EVENT_NAPI | RHINE_EVENT_SLOW) |
| 823 | |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 824 | static int rhine_napipoll(struct napi_struct *napi, int budget) |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 825 | { |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 826 | struct rhine_private *rp = container_of(napi, struct rhine_private, napi); |
| 827 | struct net_device *dev = rp->dev; |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 828 | void __iomem *ioaddr = rp->base; |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 829 | u16 enable_mask = RHINE_EVENT & 0xffff; |
| 830 | int work_done = 0; |
| 831 | u32 status; |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 832 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 833 | status = rhine_get_events(rp); |
| 834 | rhine_ack_events(rp, status & ~RHINE_EVENT_SLOW); |
| 835 | |
| 836 | if (status & RHINE_EVENT_NAPI_RX) |
| 837 | work_done += rhine_rx(dev, budget); |
| 838 | |
| 839 | if (status & RHINE_EVENT_NAPI_TX) { |
| 840 | if (status & RHINE_EVENT_NAPI_TX_ERR) { |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 841 | /* Avoid scavenging before Tx engine turned off */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 842 | rhine_wait_bit_low(rp, ChipCmd, CmdTxOn); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 843 | if (ioread8(ioaddr + ChipCmd) & CmdTxOn) |
| 844 | netif_warn(rp, tx_err, dev, "Tx still on\n"); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 845 | } |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 846 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 847 | rhine_tx(dev); |
| 848 | |
| 849 | if (status & RHINE_EVENT_NAPI_TX_ERR) |
| 850 | rhine_tx_err(rp, status); |
| 851 | } |
| 852 | |
| 853 | if (status & IntrStatsMax) { |
| 854 | spin_lock(&rp->lock); |
| 855 | rhine_update_rx_crc_and_missed_errord(rp); |
| 856 | spin_unlock(&rp->lock); |
| 857 | } |
| 858 | |
| 859 | if (status & RHINE_EVENT_SLOW) { |
| 860 | enable_mask &= ~RHINE_EVENT_SLOW; |
| 861 | schedule_work(&rp->slow_event_task); |
| 862 | } |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 863 | |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 864 | if (work_done < budget) { |
Ben Hutchings | 288379f | 2009-01-19 16:43:59 -0800 | [diff] [blame] | 865 | napi_complete(napi); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 866 | iowrite16(enable_mask, ioaddr + IntrEnable); |
| 867 | mmiowb(); |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 868 | } |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 869 | return work_done; |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 870 | } |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 871 | |
Bill Pemberton | 76e239e | 2012-12-03 09:23:48 -0500 | [diff] [blame] | 872 | static void rhine_hw_init(struct net_device *dev, long pioaddr) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 873 | { |
| 874 | struct rhine_private *rp = netdev_priv(dev); |
| 875 | |
| 876 | /* Reset the chip to erase previous misconfiguration. */ |
| 877 | rhine_chip_reset(dev); |
| 878 | |
| 879 | /* Rhine-I needs extra time to recuperate before EEPROM reload */ |
| 880 | if (rp->quirks & rqRhineI) |
| 881 | msleep(5); |
| 882 | |
| 883 | /* Reload EEPROM controlled bytes cleared by soft reset */ |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 884 | if (dev_is_pci(dev->dev.parent)) |
| 885 | rhine_reload_eeprom(pioaddr, dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 886 | } |
| 887 | |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 888 | static const struct net_device_ops rhine_netdev_ops = { |
| 889 | .ndo_open = rhine_open, |
| 890 | .ndo_stop = rhine_close, |
| 891 | .ndo_start_xmit = rhine_start_tx, |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 892 | .ndo_get_stats64 = rhine_get_stats64, |
Jiri Pirko | afc4b13 | 2011-08-16 06:29:01 +0000 | [diff] [blame] | 893 | .ndo_set_rx_mode = rhine_set_rx_mode, |
Ben Hutchings | 635ecaa | 2009-07-09 17:59:01 +0000 | [diff] [blame] | 894 | .ndo_change_mtu = eth_change_mtu, |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 895 | .ndo_validate_addr = eth_validate_addr, |
Stephen Hemminger | fe96aaa | 2009-01-09 11:13:14 +0000 | [diff] [blame] | 896 | .ndo_set_mac_address = eth_mac_addr, |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 897 | .ndo_do_ioctl = netdev_ioctl, |
| 898 | .ndo_tx_timeout = rhine_tx_timeout, |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 899 | .ndo_vlan_rx_add_vid = rhine_vlan_rx_add_vid, |
| 900 | .ndo_vlan_rx_kill_vid = rhine_vlan_rx_kill_vid, |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 901 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 902 | .ndo_poll_controller = rhine_poll, |
| 903 | #endif |
| 904 | }; |
| 905 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 906 | static int rhine_init_one_common(struct device *hwdev, u32 quirks, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 907 | long pioaddr, void __iomem *ioaddr, int irq) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 908 | { |
| 909 | struct net_device *dev; |
| 910 | struct rhine_private *rp; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 911 | int i, rc, phy_id; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 912 | const char *name; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 913 | |
| 914 | /* this should always be supported */ |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 915 | rc = dma_set_mask(hwdev, DMA_BIT_MASK(32)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 916 | if (rc) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 917 | dev_err(hwdev, "32-bit DMA addresses not supported by the card!?\n"); |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 918 | goto err_out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 919 | } |
| 920 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 921 | dev = alloc_etherdev(sizeof(struct rhine_private)); |
| 922 | if (!dev) { |
| 923 | rc = -ENOMEM; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 924 | goto err_out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 925 | } |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 926 | SET_NETDEV_DEV(dev, hwdev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 927 | |
| 928 | rp = netdev_priv(dev); |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 929 | rp->dev = dev; |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 930 | rp->quirks = quirks; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 931 | rp->pioaddr = pioaddr; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 932 | rp->base = ioaddr; |
| 933 | rp->irq = irq; |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 934 | rp->msg_enable = netif_msg_init(debug, RHINE_MSG_DEFAULT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 935 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 936 | phy_id = rp->quirks & rqIntPHY ? 1 : 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 937 | |
John Stultz | 827da44 | 2013-10-07 15:51:58 -0700 | [diff] [blame] | 938 | u64_stats_init(&rp->tx_stats.syncp); |
| 939 | u64_stats_init(&rp->rx_stats.syncp); |
| 940 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 941 | /* Get chip registers into a sane state */ |
| 942 | rhine_power_init(dev); |
| 943 | rhine_hw_init(dev, pioaddr); |
| 944 | |
| 945 | for (i = 0; i < 6; i++) |
| 946 | dev->dev_addr[i] = ioread8(ioaddr + StationAddr + i); |
| 947 | |
Joe Perches | 482e3fe | 2011-04-16 14:15:26 +0000 | [diff] [blame] | 948 | if (!is_valid_ether_addr(dev->dev_addr)) { |
| 949 | /* Report it and use a random ethernet address instead */ |
| 950 | netdev_err(dev, "Invalid MAC address: %pM\n", dev->dev_addr); |
Danny Kukawka | f2cedb6 | 2012-02-15 06:45:39 +0000 | [diff] [blame] | 951 | eth_hw_addr_random(dev); |
Joe Perches | 482e3fe | 2011-04-16 14:15:26 +0000 | [diff] [blame] | 952 | netdev_info(dev, "Using random MAC address: %pM\n", |
| 953 | dev->dev_addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 954 | } |
| 955 | |
| 956 | /* For Rhine-I/II, phy_id is loaded from EEPROM */ |
| 957 | if (!phy_id) |
| 958 | phy_id = ioread8(ioaddr + 0x6C); |
| 959 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 960 | spin_lock_init(&rp->lock); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 961 | mutex_init(&rp->task_lock); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 962 | INIT_WORK(&rp->reset_task, rhine_reset_task); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 963 | INIT_WORK(&rp->slow_event_task, rhine_slow_event_task); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 964 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 965 | rp->mii_if.dev = dev; |
| 966 | rp->mii_if.mdio_read = mdio_read; |
| 967 | rp->mii_if.mdio_write = mdio_write; |
| 968 | rp->mii_if.phy_id_mask = 0x1f; |
| 969 | rp->mii_if.reg_num_mask = 0x1f; |
| 970 | |
| 971 | /* The chip-specific entries in the device structure. */ |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 972 | dev->netdev_ops = &rhine_netdev_ops; |
wangweidong | e76070f | 2014-03-17 15:52:17 +0800 | [diff] [blame] | 973 | dev->ethtool_ops = &netdev_ethtool_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 974 | dev->watchdog_timeo = TX_TIMEOUT; |
Stephen Hemminger | 5d1d07d | 2008-11-21 17:30:11 -0800 | [diff] [blame] | 975 | |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 976 | netif_napi_add(dev, &rp->napi, rhine_napipoll, 64); |
Francois Romieu | 32b0f53 | 2008-07-11 00:30:14 +0200 | [diff] [blame] | 977 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 978 | if (rp->quirks & rqRhineI) |
| 979 | dev->features |= NETIF_F_SG|NETIF_F_HW_CSUM; |
| 980 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 981 | if (rp->quirks & rqMgmt) |
Patrick McHardy | f646968 | 2013-04-19 02:04:27 +0000 | [diff] [blame] | 982 | dev->features |= NETIF_F_HW_VLAN_CTAG_TX | |
| 983 | NETIF_F_HW_VLAN_CTAG_RX | |
| 984 | NETIF_F_HW_VLAN_CTAG_FILTER; |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 985 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 986 | /* dev->name not defined before register_netdev()! */ |
| 987 | rc = register_netdev(dev); |
| 988 | if (rc) |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 989 | goto err_out_free_netdev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 990 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 991 | if (rp->quirks & rqRhineI) |
| 992 | name = "Rhine"; |
| 993 | else if (rp->quirks & rqStatusWBRace) |
| 994 | name = "Rhine II"; |
| 995 | else if (rp->quirks & rqMgmt) |
| 996 | name = "Rhine III (Management Adapter)"; |
| 997 | else |
| 998 | name = "Rhine III"; |
| 999 | |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 1000 | netdev_info(dev, "VIA %s at 0x%lx, %pM, IRQ %d\n", |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1001 | name, (long)ioaddr, dev->dev_addr, rp->irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1002 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1003 | dev_set_drvdata(hwdev, dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1004 | |
| 1005 | { |
| 1006 | u16 mii_cmd; |
| 1007 | int mii_status = mdio_read(dev, phy_id, 1); |
| 1008 | mii_cmd = mdio_read(dev, phy_id, MII_BMCR) & ~BMCR_ISOLATE; |
| 1009 | mdio_write(dev, phy_id, MII_BMCR, mii_cmd); |
| 1010 | if (mii_status != 0xffff && mii_status != 0x0000) { |
| 1011 | rp->mii_if.advertising = mdio_read(dev, phy_id, 4); |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 1012 | netdev_info(dev, |
| 1013 | "MII PHY found at address %d, status 0x%04x advertising %04x Link %04x\n", |
| 1014 | phy_id, |
| 1015 | mii_status, rp->mii_if.advertising, |
| 1016 | mdio_read(dev, phy_id, 5)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1017 | |
| 1018 | /* set IFF_RUNNING */ |
| 1019 | if (mii_status & BMSR_LSTATUS) |
| 1020 | netif_carrier_on(dev); |
| 1021 | else |
| 1022 | netif_carrier_off(dev); |
| 1023 | |
| 1024 | } |
| 1025 | } |
| 1026 | rp->mii_if.phy_id = phy_id; |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1027 | if (avoid_D3) |
| 1028 | netif_info(rp, probe, dev, "No D3 power state at shutdown\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1029 | |
| 1030 | return 0; |
| 1031 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1032 | err_out_free_netdev: |
| 1033 | free_netdev(dev); |
| 1034 | err_out: |
| 1035 | return rc; |
| 1036 | } |
| 1037 | |
| 1038 | static int rhine_init_one_pci(struct pci_dev *pdev, |
| 1039 | const struct pci_device_id *ent) |
| 1040 | { |
| 1041 | struct device *hwdev = &pdev->dev; |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1042 | int rc; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1043 | long pioaddr, memaddr; |
| 1044 | void __iomem *ioaddr; |
| 1045 | int io_size = pdev->revision < VTunknown0 ? 128 : 256; |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1046 | |
| 1047 | /* This driver was written to use PCI memory space. Some early versions |
| 1048 | * of the Rhine may only work correctly with I/O space accesses. |
| 1049 | * TODO: determine for which revisions this is true and assign the flag |
| 1050 | * in code as opposed to this Kconfig option (???) |
| 1051 | */ |
| 1052 | #ifdef CONFIG_VIA_RHINE_MMIO |
| 1053 | u32 quirks = rqNeedEnMMIO; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1054 | #else |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1055 | u32 quirks = 0; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1056 | #endif |
| 1057 | |
| 1058 | /* when built into the kernel, we only print version if device is found */ |
| 1059 | #ifndef MODULE |
| 1060 | pr_info_once("%s\n", version); |
| 1061 | #endif |
| 1062 | |
| 1063 | rc = pci_enable_device(pdev); |
| 1064 | if (rc) |
| 1065 | goto err_out; |
| 1066 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1067 | if (pdev->revision < VTunknown0) { |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1068 | quirks |= rqRhineI; |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1069 | } else if (pdev->revision >= VT6102) { |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1070 | quirks |= rqWOL | rqForceReset; |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1071 | if (pdev->revision < VT6105) { |
| 1072 | quirks |= rqStatusWBRace; |
| 1073 | } else { |
| 1074 | quirks |= rqIntPHY; |
| 1075 | if (pdev->revision >= VT6105_B0) |
| 1076 | quirks |= rq6patterns; |
| 1077 | if (pdev->revision >= VT6105M) |
| 1078 | quirks |= rqMgmt; |
| 1079 | } |
| 1080 | } |
| 1081 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1082 | /* sanity check */ |
| 1083 | if ((pci_resource_len(pdev, 0) < io_size) || |
| 1084 | (pci_resource_len(pdev, 1) < io_size)) { |
| 1085 | rc = -EIO; |
| 1086 | dev_err(hwdev, "Insufficient PCI resources, aborting\n"); |
| 1087 | goto err_out_pci_disable; |
| 1088 | } |
| 1089 | |
| 1090 | pioaddr = pci_resource_start(pdev, 0); |
| 1091 | memaddr = pci_resource_start(pdev, 1); |
| 1092 | |
| 1093 | pci_set_master(pdev); |
| 1094 | |
| 1095 | rc = pci_request_regions(pdev, DRV_NAME); |
| 1096 | if (rc) |
| 1097 | goto err_out_pci_disable; |
| 1098 | |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1099 | ioaddr = pci_iomap(pdev, (quirks & rqNeedEnMMIO ? 1 : 0), io_size); |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1100 | if (!ioaddr) { |
| 1101 | rc = -EIO; |
| 1102 | dev_err(hwdev, |
| 1103 | "ioremap failed for device %s, region 0x%X @ 0x%lX\n", |
| 1104 | dev_name(hwdev), io_size, memaddr); |
| 1105 | goto err_out_free_res; |
| 1106 | } |
| 1107 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1108 | enable_mmio(pioaddr, quirks); |
| 1109 | |
Alexey Charkov | 5b579e2 | 2014-05-03 16:40:53 +0400 | [diff] [blame] | 1110 | rc = verify_mmio(hwdev, pioaddr, ioaddr, quirks); |
| 1111 | if (rc) |
| 1112 | goto err_out_unmap; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1113 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1114 | rc = rhine_init_one_common(&pdev->dev, quirks, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1115 | pioaddr, ioaddr, pdev->irq); |
| 1116 | if (!rc) |
| 1117 | return 0; |
| 1118 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1119 | err_out_unmap: |
| 1120 | pci_iounmap(pdev, ioaddr); |
| 1121 | err_out_free_res: |
| 1122 | pci_release_regions(pdev); |
Roger Luethi | ae99615 | 2014-03-18 18:14:01 +0100 | [diff] [blame] | 1123 | err_out_pci_disable: |
| 1124 | pci_disable_device(pdev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1125 | err_out: |
| 1126 | return rc; |
| 1127 | } |
| 1128 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1129 | static int rhine_init_one_platform(struct platform_device *pdev) |
| 1130 | { |
| 1131 | const struct of_device_id *match; |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1132 | const u32 *quirks; |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1133 | int irq; |
| 1134 | struct resource *res; |
| 1135 | void __iomem *ioaddr; |
| 1136 | |
| 1137 | match = of_match_device(rhine_of_tbl, &pdev->dev); |
| 1138 | if (!match) |
| 1139 | return -EINVAL; |
| 1140 | |
| 1141 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 1142 | ioaddr = devm_ioremap_resource(&pdev->dev, res); |
| 1143 | if (IS_ERR(ioaddr)) |
| 1144 | return PTR_ERR(ioaddr); |
| 1145 | |
| 1146 | irq = irq_of_parse_and_map(pdev->dev.of_node, 0); |
| 1147 | if (!irq) |
| 1148 | return -EINVAL; |
| 1149 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1150 | quirks = match->data; |
| 1151 | if (!quirks) |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1152 | return -EINVAL; |
| 1153 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1154 | return rhine_init_one_common(&pdev->dev, *quirks, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 1155 | (long)ioaddr, ioaddr, irq); |
| 1156 | } |
| 1157 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1158 | static int alloc_ring(struct net_device* dev) |
| 1159 | { |
| 1160 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1161 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1162 | void *ring; |
| 1163 | dma_addr_t ring_dma; |
| 1164 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1165 | ring = dma_alloc_coherent(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1166 | RX_RING_SIZE * sizeof(struct rx_desc) + |
| 1167 | TX_RING_SIZE * sizeof(struct tx_desc), |
| 1168 | &ring_dma, |
| 1169 | GFP_ATOMIC); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1170 | if (!ring) { |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 1171 | netdev_err(dev, "Could not allocate DMA memory\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1172 | return -ENOMEM; |
| 1173 | } |
| 1174 | if (rp->quirks & rqRhineI) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1175 | rp->tx_bufs = dma_alloc_coherent(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1176 | PKT_BUF_SZ * TX_RING_SIZE, |
| 1177 | &rp->tx_bufs_dma, |
| 1178 | GFP_ATOMIC); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1179 | if (rp->tx_bufs == NULL) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1180 | dma_free_coherent(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1181 | RX_RING_SIZE * sizeof(struct rx_desc) + |
| 1182 | TX_RING_SIZE * sizeof(struct tx_desc), |
| 1183 | ring, ring_dma); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1184 | return -ENOMEM; |
| 1185 | } |
| 1186 | } |
| 1187 | |
| 1188 | rp->rx_ring = ring; |
| 1189 | rp->tx_ring = ring + RX_RING_SIZE * sizeof(struct rx_desc); |
| 1190 | rp->rx_ring_dma = ring_dma; |
| 1191 | rp->tx_ring_dma = ring_dma + RX_RING_SIZE * sizeof(struct rx_desc); |
| 1192 | |
| 1193 | return 0; |
| 1194 | } |
| 1195 | |
| 1196 | static void free_ring(struct net_device* dev) |
| 1197 | { |
| 1198 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1199 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1200 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1201 | dma_free_coherent(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1202 | RX_RING_SIZE * sizeof(struct rx_desc) + |
| 1203 | TX_RING_SIZE * sizeof(struct tx_desc), |
| 1204 | rp->rx_ring, rp->rx_ring_dma); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1205 | rp->tx_ring = NULL; |
| 1206 | |
| 1207 | if (rp->tx_bufs) |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1208 | dma_free_coherent(hwdev, PKT_BUF_SZ * TX_RING_SIZE, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1209 | rp->tx_bufs, rp->tx_bufs_dma); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1210 | |
| 1211 | rp->tx_bufs = NULL; |
| 1212 | |
| 1213 | } |
| 1214 | |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1215 | struct rhine_skb_dma { |
| 1216 | struct sk_buff *skb; |
| 1217 | dma_addr_t dma; |
| 1218 | }; |
| 1219 | |
| 1220 | static inline int rhine_skb_dma_init(struct net_device *dev, |
| 1221 | struct rhine_skb_dma *sd) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1222 | { |
| 1223 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1224 | struct device *hwdev = dev->dev.parent; |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1225 | const int size = rp->rx_buf_sz; |
| 1226 | |
| 1227 | sd->skb = netdev_alloc_skb(dev, size); |
| 1228 | if (!sd->skb) |
| 1229 | return -ENOMEM; |
| 1230 | |
| 1231 | sd->dma = dma_map_single(hwdev, sd->skb->data, size, DMA_FROM_DEVICE); |
| 1232 | if (unlikely(dma_mapping_error(hwdev, sd->dma))) { |
| 1233 | netif_err(rp, drv, dev, "Rx DMA mapping failure\n"); |
| 1234 | dev_kfree_skb_any(sd->skb); |
| 1235 | return -EIO; |
| 1236 | } |
| 1237 | |
| 1238 | return 0; |
| 1239 | } |
| 1240 | |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1241 | static void rhine_reset_rbufs(struct rhine_private *rp) |
| 1242 | { |
| 1243 | int i; |
| 1244 | |
| 1245 | rp->cur_rx = 0; |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1246 | |
| 1247 | for (i = 0; i < RX_RING_SIZE; i++) |
| 1248 | rp->rx_ring[i].rx_status = cpu_to_le32(DescOwn); |
| 1249 | } |
| 1250 | |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1251 | static inline void rhine_skb_dma_nic_store(struct rhine_private *rp, |
| 1252 | struct rhine_skb_dma *sd, int entry) |
| 1253 | { |
| 1254 | rp->rx_skbuff_dma[entry] = sd->dma; |
| 1255 | rp->rx_skbuff[entry] = sd->skb; |
| 1256 | |
| 1257 | rp->rx_ring[entry].addr = cpu_to_le32(sd->dma); |
| 1258 | dma_wmb(); |
| 1259 | } |
| 1260 | |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1261 | static void free_rbufs(struct net_device* dev); |
| 1262 | |
| 1263 | static int alloc_rbufs(struct net_device *dev) |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1264 | { |
| 1265 | struct rhine_private *rp = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1266 | dma_addr_t next; |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1267 | int rc, i; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1268 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1269 | rp->rx_buf_sz = (dev->mtu <= 1500 ? PKT_BUF_SZ : dev->mtu + 32); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1270 | next = rp->rx_ring_dma; |
| 1271 | |
| 1272 | /* Init the ring entries */ |
| 1273 | for (i = 0; i < RX_RING_SIZE; i++) { |
| 1274 | rp->rx_ring[i].rx_status = 0; |
| 1275 | rp->rx_ring[i].desc_length = cpu_to_le32(rp->rx_buf_sz); |
| 1276 | next += sizeof(struct rx_desc); |
| 1277 | rp->rx_ring[i].next_desc = cpu_to_le32(next); |
| 1278 | rp->rx_skbuff[i] = NULL; |
| 1279 | } |
| 1280 | /* Mark the last entry as wrapping the ring. */ |
| 1281 | rp->rx_ring[i-1].next_desc = cpu_to_le32(rp->rx_ring_dma); |
| 1282 | |
| 1283 | /* Fill in the Rx buffers. Handle allocation failure gracefully. */ |
| 1284 | for (i = 0; i < RX_RING_SIZE; i++) { |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1285 | struct rhine_skb_dma sd; |
| 1286 | |
| 1287 | rc = rhine_skb_dma_init(dev, &sd); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1288 | if (rc < 0) { |
| 1289 | free_rbufs(dev); |
| 1290 | goto out; |
| 1291 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1292 | |
françois romieu | a21bb8b | 2015-05-01 22:14:39 +0200 | [diff] [blame] | 1293 | rhine_skb_dma_nic_store(rp, &sd, i); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1294 | } |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1295 | |
| 1296 | rhine_reset_rbufs(rp); |
| 1297 | out: |
| 1298 | return rc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1299 | } |
| 1300 | |
| 1301 | static void free_rbufs(struct net_device* dev) |
| 1302 | { |
| 1303 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1304 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1305 | int i; |
| 1306 | |
| 1307 | /* Free all the skbuffs in the Rx queue. */ |
| 1308 | for (i = 0; i < RX_RING_SIZE; i++) { |
| 1309 | rp->rx_ring[i].rx_status = 0; |
| 1310 | rp->rx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */ |
| 1311 | if (rp->rx_skbuff[i]) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1312 | dma_unmap_single(hwdev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1313 | rp->rx_skbuff_dma[i], |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1314 | rp->rx_buf_sz, DMA_FROM_DEVICE); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1315 | dev_kfree_skb(rp->rx_skbuff[i]); |
| 1316 | } |
| 1317 | rp->rx_skbuff[i] = NULL; |
| 1318 | } |
| 1319 | } |
| 1320 | |
| 1321 | static void alloc_tbufs(struct net_device* dev) |
| 1322 | { |
| 1323 | struct rhine_private *rp = netdev_priv(dev); |
| 1324 | dma_addr_t next; |
| 1325 | int i; |
| 1326 | |
| 1327 | rp->dirty_tx = rp->cur_tx = 0; |
| 1328 | next = rp->tx_ring_dma; |
| 1329 | for (i = 0; i < TX_RING_SIZE; i++) { |
| 1330 | rp->tx_skbuff[i] = NULL; |
| 1331 | rp->tx_ring[i].tx_status = 0; |
| 1332 | rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC); |
| 1333 | next += sizeof(struct tx_desc); |
| 1334 | rp->tx_ring[i].next_desc = cpu_to_le32(next); |
Roger Luethi | 4be5de2 | 2006-04-04 20:49:16 +0200 | [diff] [blame] | 1335 | if (rp->quirks & rqRhineI) |
| 1336 | rp->tx_buf[i] = &rp->tx_bufs[i * PKT_BUF_SZ]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1337 | } |
| 1338 | rp->tx_ring[i-1].next_desc = cpu_to_le32(rp->tx_ring_dma); |
| 1339 | |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1340 | netdev_reset_queue(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1341 | } |
| 1342 | |
| 1343 | static void free_tbufs(struct net_device* dev) |
| 1344 | { |
| 1345 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1346 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1347 | int i; |
| 1348 | |
| 1349 | for (i = 0; i < TX_RING_SIZE; i++) { |
| 1350 | rp->tx_ring[i].tx_status = 0; |
| 1351 | rp->tx_ring[i].desc_length = cpu_to_le32(TXDESC); |
| 1352 | rp->tx_ring[i].addr = cpu_to_le32(0xBADF00D0); /* An invalid address. */ |
| 1353 | if (rp->tx_skbuff[i]) { |
| 1354 | if (rp->tx_skbuff_dma[i]) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1355 | dma_unmap_single(hwdev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1356 | rp->tx_skbuff_dma[i], |
| 1357 | rp->tx_skbuff[i]->len, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1358 | DMA_TO_DEVICE); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1359 | } |
| 1360 | dev_kfree_skb(rp->tx_skbuff[i]); |
| 1361 | } |
| 1362 | rp->tx_skbuff[i] = NULL; |
| 1363 | rp->tx_buf[i] = NULL; |
| 1364 | } |
| 1365 | } |
| 1366 | |
| 1367 | static void rhine_check_media(struct net_device *dev, unsigned int init_media) |
| 1368 | { |
| 1369 | struct rhine_private *rp = netdev_priv(dev); |
| 1370 | void __iomem *ioaddr = rp->base; |
| 1371 | |
Ben Hutchings | 5bdc738 | 2015-01-16 17:55:35 +0000 | [diff] [blame] | 1372 | if (!rp->mii_if.force_media) |
| 1373 | mii_check_media(&rp->mii_if, netif_msg_link(rp), init_media); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1374 | |
| 1375 | if (rp->mii_if.full_duplex) |
| 1376 | iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1FDuplex, |
| 1377 | ioaddr + ChipCmd1); |
| 1378 | else |
| 1379 | iowrite8(ioread8(ioaddr + ChipCmd1) & ~Cmd1FDuplex, |
| 1380 | ioaddr + ChipCmd1); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1381 | |
| 1382 | netif_info(rp, link, dev, "force_media %d, carrier %d\n", |
| 1383 | rp->mii_if.force_media, netif_carrier_ok(dev)); |
Roger Luethi | 00b428c | 2006-03-28 20:53:56 +0200 | [diff] [blame] | 1384 | } |
| 1385 | |
| 1386 | /* Called after status of force_media possibly changed */ |
Adrian Bunk | 0761be4 | 2006-04-10 23:22:21 -0700 | [diff] [blame] | 1387 | static void rhine_set_carrier(struct mii_if_info *mii) |
Roger Luethi | 00b428c | 2006-03-28 20:53:56 +0200 | [diff] [blame] | 1388 | { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1389 | struct net_device *dev = mii->dev; |
| 1390 | struct rhine_private *rp = netdev_priv(dev); |
| 1391 | |
Roger Luethi | 00b428c | 2006-03-28 20:53:56 +0200 | [diff] [blame] | 1392 | if (mii->force_media) { |
| 1393 | /* autoneg is off: Link is always assumed to be up */ |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1394 | if (!netif_carrier_ok(dev)) |
| 1395 | netif_carrier_on(dev); |
François Cachereul | 1795843 | 2014-06-12 12:11:25 +0200 | [diff] [blame] | 1396 | } |
| 1397 | |
| 1398 | rhine_check_media(dev, 0); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1399 | |
| 1400 | netif_info(rp, link, dev, "force_media %d, carrier %d\n", |
| 1401 | mii->force_media, netif_carrier_ok(dev)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1402 | } |
| 1403 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1404 | /** |
| 1405 | * rhine_set_cam - set CAM multicast filters |
| 1406 | * @ioaddr: register block of this Rhine |
| 1407 | * @idx: multicast CAM index [0..MCAM_SIZE-1] |
| 1408 | * @addr: multicast address (6 bytes) |
| 1409 | * |
| 1410 | * Load addresses into multicast filters. |
| 1411 | */ |
| 1412 | static void rhine_set_cam(void __iomem *ioaddr, int idx, u8 *addr) |
| 1413 | { |
| 1414 | int i; |
| 1415 | |
| 1416 | iowrite8(CAMC_CAMEN, ioaddr + CamCon); |
| 1417 | wmb(); |
| 1418 | |
| 1419 | /* Paranoid -- idx out of range should never happen */ |
| 1420 | idx &= (MCAM_SIZE - 1); |
| 1421 | |
| 1422 | iowrite8((u8) idx, ioaddr + CamAddr); |
| 1423 | |
| 1424 | for (i = 0; i < 6; i++, addr++) |
| 1425 | iowrite8(*addr, ioaddr + MulticastFilter0 + i); |
| 1426 | udelay(10); |
| 1427 | wmb(); |
| 1428 | |
| 1429 | iowrite8(CAMC_CAMWR | CAMC_CAMEN, ioaddr + CamCon); |
| 1430 | udelay(10); |
| 1431 | |
| 1432 | iowrite8(0, ioaddr + CamCon); |
| 1433 | } |
| 1434 | |
| 1435 | /** |
| 1436 | * rhine_set_vlan_cam - set CAM VLAN filters |
| 1437 | * @ioaddr: register block of this Rhine |
| 1438 | * @idx: VLAN CAM index [0..VCAM_SIZE-1] |
| 1439 | * @addr: VLAN ID (2 bytes) |
| 1440 | * |
| 1441 | * Load addresses into VLAN filters. |
| 1442 | */ |
| 1443 | static void rhine_set_vlan_cam(void __iomem *ioaddr, int idx, u8 *addr) |
| 1444 | { |
| 1445 | iowrite8(CAMC_CAMEN | CAMC_VCAMSL, ioaddr + CamCon); |
| 1446 | wmb(); |
| 1447 | |
| 1448 | /* Paranoid -- idx out of range should never happen */ |
| 1449 | idx &= (VCAM_SIZE - 1); |
| 1450 | |
| 1451 | iowrite8((u8) idx, ioaddr + CamAddr); |
| 1452 | |
| 1453 | iowrite16(*((u16 *) addr), ioaddr + MulticastFilter0 + 6); |
| 1454 | udelay(10); |
| 1455 | wmb(); |
| 1456 | |
| 1457 | iowrite8(CAMC_CAMWR | CAMC_CAMEN, ioaddr + CamCon); |
| 1458 | udelay(10); |
| 1459 | |
| 1460 | iowrite8(0, ioaddr + CamCon); |
| 1461 | } |
| 1462 | |
| 1463 | /** |
| 1464 | * rhine_set_cam_mask - set multicast CAM mask |
| 1465 | * @ioaddr: register block of this Rhine |
| 1466 | * @mask: multicast CAM mask |
| 1467 | * |
| 1468 | * Mask sets multicast filters active/inactive. |
| 1469 | */ |
| 1470 | static void rhine_set_cam_mask(void __iomem *ioaddr, u32 mask) |
| 1471 | { |
| 1472 | iowrite8(CAMC_CAMEN, ioaddr + CamCon); |
| 1473 | wmb(); |
| 1474 | |
| 1475 | /* write mask */ |
| 1476 | iowrite32(mask, ioaddr + CamMask); |
| 1477 | |
| 1478 | /* disable CAMEN */ |
| 1479 | iowrite8(0, ioaddr + CamCon); |
| 1480 | } |
| 1481 | |
| 1482 | /** |
| 1483 | * rhine_set_vlan_cam_mask - set VLAN CAM mask |
| 1484 | * @ioaddr: register block of this Rhine |
| 1485 | * @mask: VLAN CAM mask |
| 1486 | * |
| 1487 | * Mask sets VLAN filters active/inactive. |
| 1488 | */ |
| 1489 | static void rhine_set_vlan_cam_mask(void __iomem *ioaddr, u32 mask) |
| 1490 | { |
| 1491 | iowrite8(CAMC_CAMEN | CAMC_VCAMSL, ioaddr + CamCon); |
| 1492 | wmb(); |
| 1493 | |
| 1494 | /* write mask */ |
| 1495 | iowrite32(mask, ioaddr + CamMask); |
| 1496 | |
| 1497 | /* disable CAMEN */ |
| 1498 | iowrite8(0, ioaddr + CamCon); |
| 1499 | } |
| 1500 | |
| 1501 | /** |
| 1502 | * rhine_init_cam_filter - initialize CAM filters |
| 1503 | * @dev: network device |
| 1504 | * |
| 1505 | * Initialize (disable) hardware VLAN and multicast support on this |
| 1506 | * Rhine. |
| 1507 | */ |
| 1508 | static void rhine_init_cam_filter(struct net_device *dev) |
| 1509 | { |
| 1510 | struct rhine_private *rp = netdev_priv(dev); |
| 1511 | void __iomem *ioaddr = rp->base; |
| 1512 | |
| 1513 | /* Disable all CAMs */ |
| 1514 | rhine_set_vlan_cam_mask(ioaddr, 0); |
| 1515 | rhine_set_cam_mask(ioaddr, 0); |
| 1516 | |
| 1517 | /* disable hardware VLAN support */ |
| 1518 | BYTE_REG_BITS_ON(TCR_PQEN, ioaddr + TxConfig); |
| 1519 | BYTE_REG_BITS_OFF(BCR1_VIDFR, ioaddr + PCIBusConfig1); |
| 1520 | } |
| 1521 | |
| 1522 | /** |
| 1523 | * rhine_update_vcam - update VLAN CAM filters |
| 1524 | * @rp: rhine_private data of this Rhine |
| 1525 | * |
| 1526 | * Update VLAN CAM filters to match configuration change. |
| 1527 | */ |
| 1528 | static void rhine_update_vcam(struct net_device *dev) |
| 1529 | { |
| 1530 | struct rhine_private *rp = netdev_priv(dev); |
| 1531 | void __iomem *ioaddr = rp->base; |
| 1532 | u16 vid; |
| 1533 | u32 vCAMmask = 0; /* 32 vCAMs (6105M and better) */ |
| 1534 | unsigned int i = 0; |
| 1535 | |
| 1536 | for_each_set_bit(vid, rp->active_vlans, VLAN_N_VID) { |
| 1537 | rhine_set_vlan_cam(ioaddr, i, (u8 *)&vid); |
| 1538 | vCAMmask |= 1 << i; |
| 1539 | if (++i >= VCAM_SIZE) |
| 1540 | break; |
| 1541 | } |
| 1542 | rhine_set_vlan_cam_mask(ioaddr, vCAMmask); |
| 1543 | } |
| 1544 | |
Patrick McHardy | 80d5c36 | 2013-04-19 02:04:28 +0000 | [diff] [blame] | 1545 | static int rhine_vlan_rx_add_vid(struct net_device *dev, __be16 proto, u16 vid) |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1546 | { |
| 1547 | struct rhine_private *rp = netdev_priv(dev); |
| 1548 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1549 | spin_lock_bh(&rp->lock); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1550 | set_bit(vid, rp->active_vlans); |
| 1551 | rhine_update_vcam(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1552 | spin_unlock_bh(&rp->lock); |
Jiri Pirko | 8e58613 | 2011-12-08 19:52:37 -0500 | [diff] [blame] | 1553 | return 0; |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1554 | } |
| 1555 | |
Patrick McHardy | 80d5c36 | 2013-04-19 02:04:28 +0000 | [diff] [blame] | 1556 | static int rhine_vlan_rx_kill_vid(struct net_device *dev, __be16 proto, u16 vid) |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1557 | { |
| 1558 | struct rhine_private *rp = netdev_priv(dev); |
| 1559 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1560 | spin_lock_bh(&rp->lock); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1561 | clear_bit(vid, rp->active_vlans); |
| 1562 | rhine_update_vcam(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1563 | spin_unlock_bh(&rp->lock); |
Jiri Pirko | 8e58613 | 2011-12-08 19:52:37 -0500 | [diff] [blame] | 1564 | return 0; |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1565 | } |
| 1566 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1567 | static void init_registers(struct net_device *dev) |
| 1568 | { |
| 1569 | struct rhine_private *rp = netdev_priv(dev); |
| 1570 | void __iomem *ioaddr = rp->base; |
| 1571 | int i; |
| 1572 | |
| 1573 | for (i = 0; i < 6; i++) |
| 1574 | iowrite8(dev->dev_addr[i], ioaddr + StationAddr + i); |
| 1575 | |
| 1576 | /* Initialize other registers. */ |
| 1577 | iowrite16(0x0006, ioaddr + PCIBusConfig); /* Tune configuration??? */ |
| 1578 | /* Configure initial FIFO thresholds. */ |
| 1579 | iowrite8(0x20, ioaddr + TxConfig); |
| 1580 | rp->tx_thresh = 0x20; |
| 1581 | rp->rx_thresh = 0x60; /* Written in rhine_set_rx_mode(). */ |
| 1582 | |
| 1583 | iowrite32(rp->rx_ring_dma, ioaddr + RxRingPtr); |
| 1584 | iowrite32(rp->tx_ring_dma, ioaddr + TxRingPtr); |
| 1585 | |
| 1586 | rhine_set_rx_mode(dev); |
| 1587 | |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 1588 | if (rp->quirks & rqMgmt) |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1589 | rhine_init_cam_filter(dev); |
| 1590 | |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1591 | napi_enable(&rp->napi); |
Stephen Hemminger | ab19766 | 2006-08-14 23:00:18 -0700 | [diff] [blame] | 1592 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1593 | iowrite16(RHINE_EVENT & 0xffff, ioaddr + IntrEnable); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1594 | |
| 1595 | iowrite16(CmdStart | CmdTxOn | CmdRxOn | (Cmd1NoTxPoll << 8), |
| 1596 | ioaddr + ChipCmd); |
| 1597 | rhine_check_media(dev, 1); |
| 1598 | } |
| 1599 | |
| 1600 | /* Enable MII link status auto-polling (required for IntrLinkChange) */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1601 | static void rhine_enable_linkmon(struct rhine_private *rp) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1602 | { |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1603 | void __iomem *ioaddr = rp->base; |
| 1604 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1605 | iowrite8(0, ioaddr + MIICmd); |
| 1606 | iowrite8(MII_BMSR, ioaddr + MIIRegAddr); |
| 1607 | iowrite8(0x80, ioaddr + MIICmd); |
| 1608 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1609 | rhine_wait_bit_high(rp, MIIRegAddr, 0x20); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1610 | |
| 1611 | iowrite8(MII_BMSR | 0x40, ioaddr + MIIRegAddr); |
| 1612 | } |
| 1613 | |
| 1614 | /* Disable MII link status auto-polling (required for MDIO access) */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1615 | static void rhine_disable_linkmon(struct rhine_private *rp) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1616 | { |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1617 | void __iomem *ioaddr = rp->base; |
| 1618 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1619 | iowrite8(0, ioaddr + MIICmd); |
| 1620 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1621 | if (rp->quirks & rqRhineI) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1622 | iowrite8(0x01, ioaddr + MIIRegAddr); // MII_BMSR |
| 1623 | |
John W. Linville | 38bb6b2 | 2006-05-19 10:51:21 -0400 | [diff] [blame] | 1624 | /* Can be called from ISR. Evil. */ |
| 1625 | mdelay(1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1626 | |
| 1627 | /* 0x80 must be set immediately before turning it off */ |
| 1628 | iowrite8(0x80, ioaddr + MIICmd); |
| 1629 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1630 | rhine_wait_bit_high(rp, MIIRegAddr, 0x20); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1631 | |
| 1632 | /* Heh. Now clear 0x80 again. */ |
| 1633 | iowrite8(0, ioaddr + MIICmd); |
| 1634 | } |
| 1635 | else |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1636 | rhine_wait_bit_high(rp, MIIRegAddr, 0x80); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1637 | } |
| 1638 | |
| 1639 | /* Read and write over the MII Management Data I/O (MDIO) interface. */ |
| 1640 | |
| 1641 | static int mdio_read(struct net_device *dev, int phy_id, int regnum) |
| 1642 | { |
| 1643 | struct rhine_private *rp = netdev_priv(dev); |
| 1644 | void __iomem *ioaddr = rp->base; |
| 1645 | int result; |
| 1646 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1647 | rhine_disable_linkmon(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1648 | |
| 1649 | /* rhine_disable_linkmon already cleared MIICmd */ |
| 1650 | iowrite8(phy_id, ioaddr + MIIPhyAddr); |
| 1651 | iowrite8(regnum, ioaddr + MIIRegAddr); |
| 1652 | iowrite8(0x40, ioaddr + MIICmd); /* Trigger read */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1653 | rhine_wait_bit_low(rp, MIICmd, 0x40); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1654 | result = ioread16(ioaddr + MIIData); |
| 1655 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1656 | rhine_enable_linkmon(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1657 | return result; |
| 1658 | } |
| 1659 | |
| 1660 | static void mdio_write(struct net_device *dev, int phy_id, int regnum, int value) |
| 1661 | { |
| 1662 | struct rhine_private *rp = netdev_priv(dev); |
| 1663 | void __iomem *ioaddr = rp->base; |
| 1664 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1665 | rhine_disable_linkmon(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1666 | |
| 1667 | /* rhine_disable_linkmon already cleared MIICmd */ |
| 1668 | iowrite8(phy_id, ioaddr + MIIPhyAddr); |
| 1669 | iowrite8(regnum, ioaddr + MIIRegAddr); |
| 1670 | iowrite16(value, ioaddr + MIIData); |
| 1671 | iowrite8(0x20, ioaddr + MIICmd); /* Trigger write */ |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1672 | rhine_wait_bit_low(rp, MIICmd, 0x20); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1673 | |
Francois Romieu | a384a33 | 2012-01-07 22:19:36 +0100 | [diff] [blame] | 1674 | rhine_enable_linkmon(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1675 | } |
| 1676 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1677 | static void rhine_task_disable(struct rhine_private *rp) |
| 1678 | { |
| 1679 | mutex_lock(&rp->task_lock); |
| 1680 | rp->task_enable = false; |
| 1681 | mutex_unlock(&rp->task_lock); |
| 1682 | |
| 1683 | cancel_work_sync(&rp->slow_event_task); |
| 1684 | cancel_work_sync(&rp->reset_task); |
| 1685 | } |
| 1686 | |
| 1687 | static void rhine_task_enable(struct rhine_private *rp) |
| 1688 | { |
| 1689 | mutex_lock(&rp->task_lock); |
| 1690 | rp->task_enable = true; |
| 1691 | mutex_unlock(&rp->task_lock); |
| 1692 | } |
| 1693 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1694 | static int rhine_open(struct net_device *dev) |
| 1695 | { |
| 1696 | struct rhine_private *rp = netdev_priv(dev); |
| 1697 | void __iomem *ioaddr = rp->base; |
| 1698 | int rc; |
| 1699 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1700 | rc = request_irq(rp->irq, rhine_interrupt, IRQF_SHARED, dev->name, dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1701 | if (rc) |
françois romieu | 4d1fd9c | 2015-05-01 22:14:40 +0200 | [diff] [blame] | 1702 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1703 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1704 | netif_dbg(rp, ifup, dev, "%s() irq %d\n", __func__, rp->irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1705 | |
| 1706 | rc = alloc_ring(dev); |
françois romieu | 4d1fd9c | 2015-05-01 22:14:40 +0200 | [diff] [blame] | 1707 | if (rc < 0) |
| 1708 | goto out_free_irq; |
| 1709 | |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1710 | rc = alloc_rbufs(dev); |
| 1711 | if (rc < 0) |
| 1712 | goto out_free_ring; |
| 1713 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1714 | alloc_tbufs(dev); |
| 1715 | rhine_chip_reset(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1716 | rhine_task_enable(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1717 | init_registers(dev); |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1718 | |
| 1719 | netif_dbg(rp, ifup, dev, "%s() Done - status %04x MII status: %04x\n", |
| 1720 | __func__, ioread16(ioaddr + ChipCmd), |
| 1721 | mdio_read(dev, rp->mii_if.phy_id, MII_BMSR)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1722 | |
| 1723 | netif_start_queue(dev); |
| 1724 | |
françois romieu | 4d1fd9c | 2015-05-01 22:14:40 +0200 | [diff] [blame] | 1725 | out: |
| 1726 | return rc; |
| 1727 | |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1728 | out_free_ring: |
| 1729 | free_ring(dev); |
françois romieu | 4d1fd9c | 2015-05-01 22:14:40 +0200 | [diff] [blame] | 1730 | out_free_irq: |
| 1731 | free_irq(rp->irq, dev); |
| 1732 | goto out; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1733 | } |
| 1734 | |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1735 | static void rhine_reset_task(struct work_struct *work) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1736 | { |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1737 | struct rhine_private *rp = container_of(work, struct rhine_private, |
| 1738 | reset_task); |
| 1739 | struct net_device *dev = rp->dev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1740 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1741 | mutex_lock(&rp->task_lock); |
| 1742 | |
| 1743 | if (!rp->task_enable) |
| 1744 | goto out_unlock; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1745 | |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 1746 | napi_disable(&rp->napi); |
Richard Weinberger | a926592 | 2014-01-14 22:46:36 +0100 | [diff] [blame] | 1747 | netif_tx_disable(dev); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1748 | spin_lock_bh(&rp->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1749 | |
| 1750 | /* clear all descriptors */ |
| 1751 | free_tbufs(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1752 | alloc_tbufs(dev); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 1753 | |
| 1754 | rhine_reset_rbufs(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1755 | |
| 1756 | /* Reinitialize the hardware. */ |
| 1757 | rhine_chip_reset(dev); |
| 1758 | init_registers(dev); |
| 1759 | |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1760 | spin_unlock_bh(&rp->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1761 | |
Eric Dumazet | 1ae5dc3 | 2010-05-10 05:01:31 -0700 | [diff] [blame] | 1762 | dev->trans_start = jiffies; /* prevent tx timeout */ |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1763 | dev->stats.tx_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1764 | netif_wake_queue(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1765 | |
| 1766 | out_unlock: |
| 1767 | mutex_unlock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1768 | } |
| 1769 | |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1770 | static void rhine_tx_timeout(struct net_device *dev) |
| 1771 | { |
| 1772 | struct rhine_private *rp = netdev_priv(dev); |
| 1773 | void __iomem *ioaddr = rp->base; |
| 1774 | |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 1775 | netdev_warn(dev, "Transmit timed out, status %04x, PHY status %04x, resetting...\n", |
| 1776 | ioread16(ioaddr + IntrStatus), |
| 1777 | mdio_read(dev, rp->mii_if.phy_id, MII_BMSR)); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 1778 | |
| 1779 | schedule_work(&rp->reset_task); |
| 1780 | } |
| 1781 | |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1782 | static inline bool rhine_tx_queue_full(struct rhine_private *rp) |
| 1783 | { |
| 1784 | return (rp->cur_tx - rp->dirty_tx) >= TX_QUEUE_LEN; |
| 1785 | } |
| 1786 | |
Stephen Hemminger | 61357325 | 2009-08-31 19:50:58 +0000 | [diff] [blame] | 1787 | static netdev_tx_t rhine_start_tx(struct sk_buff *skb, |
| 1788 | struct net_device *dev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1789 | { |
| 1790 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1791 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1792 | void __iomem *ioaddr = rp->base; |
| 1793 | unsigned entry; |
| 1794 | |
| 1795 | /* Caution: the write order is important here, set the field |
| 1796 | with the "ownership" bits last. */ |
| 1797 | |
| 1798 | /* Calculate the next Tx descriptor entry. */ |
| 1799 | entry = rp->cur_tx % TX_RING_SIZE; |
| 1800 | |
Herbert Xu | 5b057c6 | 2006-06-23 02:06:41 -0700 | [diff] [blame] | 1801 | if (skb_padto(skb, ETH_ZLEN)) |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 1802 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1803 | |
| 1804 | rp->tx_skbuff[entry] = skb; |
| 1805 | |
| 1806 | if ((rp->quirks & rqRhineI) && |
Patrick McHardy | 84fa793 | 2006-08-29 16:44:56 -0700 | [diff] [blame] | 1807 | (((unsigned long)skb->data & 3) || skb_shinfo(skb)->nr_frags != 0 || skb->ip_summed == CHECKSUM_PARTIAL)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1808 | /* Must use alignment buffer. */ |
| 1809 | if (skb->len > PKT_BUF_SZ) { |
| 1810 | /* packet too long, drop it */ |
Eric W. Biederman | 4b3afc6 | 2014-03-15 18:22:47 -0700 | [diff] [blame] | 1811 | dev_kfree_skb_any(skb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1812 | rp->tx_skbuff[entry] = NULL; |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1813 | dev->stats.tx_dropped++; |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 1814 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1815 | } |
Craig Brind | 3e0d167 | 2006-04-27 02:30:46 -0700 | [diff] [blame] | 1816 | |
| 1817 | /* Padding is not copied and so must be redone. */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1818 | skb_copy_and_csum_dev(skb, rp->tx_buf[entry]); |
Craig Brind | 3e0d167 | 2006-04-27 02:30:46 -0700 | [diff] [blame] | 1819 | if (skb->len < ETH_ZLEN) |
| 1820 | memset(rp->tx_buf[entry] + skb->len, 0, |
| 1821 | ETH_ZLEN - skb->len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1822 | rp->tx_skbuff_dma[entry] = 0; |
| 1823 | rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_bufs_dma + |
| 1824 | (rp->tx_buf[entry] - |
| 1825 | rp->tx_bufs)); |
| 1826 | } else { |
| 1827 | rp->tx_skbuff_dma[entry] = |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1828 | dma_map_single(hwdev, skb->data, skb->len, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1829 | DMA_TO_DEVICE); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1830 | if (dma_mapping_error(hwdev, rp->tx_skbuff_dma[entry])) { |
Eric W. Biederman | 4b3afc6 | 2014-03-15 18:22:47 -0700 | [diff] [blame] | 1831 | dev_kfree_skb_any(skb); |
Neil Horman | 9b4fe5f | 2013-07-12 13:35:33 -0400 | [diff] [blame] | 1832 | rp->tx_skbuff_dma[entry] = 0; |
| 1833 | dev->stats.tx_dropped++; |
| 1834 | return NETDEV_TX_OK; |
| 1835 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1836 | rp->tx_ring[entry].addr = cpu_to_le32(rp->tx_skbuff_dma[entry]); |
| 1837 | } |
| 1838 | |
| 1839 | rp->tx_ring[entry].desc_length = |
| 1840 | cpu_to_le32(TXDESC | (skb->len >= ETH_ZLEN ? skb->len : ETH_ZLEN)); |
| 1841 | |
Jiri Pirko | df8a39d | 2015-01-13 17:13:44 +0100 | [diff] [blame] | 1842 | if (unlikely(skb_vlan_tag_present(skb))) { |
| 1843 | u16 vid_pcp = skb_vlan_tag_get(skb); |
Roger Luethi | 207070f | 2013-09-21 14:24:11 +0200 | [diff] [blame] | 1844 | |
| 1845 | /* drop CFI/DEI bit, register needs VID and PCP */ |
| 1846 | vid_pcp = (vid_pcp & VLAN_VID_MASK) | |
| 1847 | ((vid_pcp & VLAN_PRIO_MASK) >> 1); |
| 1848 | rp->tx_ring[entry].tx_status = cpu_to_le32((vid_pcp) << 16); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1849 | /* request tagging */ |
| 1850 | rp->tx_ring[entry].desc_length |= cpu_to_le32(0x020000); |
| 1851 | } |
| 1852 | else |
| 1853 | rp->tx_ring[entry].tx_status = 0; |
| 1854 | |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1855 | netdev_sent_queue(dev, skb->len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1856 | /* lock eth irq */ |
françois romieu | e1efa87 | 2015-05-01 22:14:44 +0200 | [diff] [blame] | 1857 | dma_wmb(); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1858 | rp->tx_ring[entry].tx_status |= cpu_to_le32(DescOwn); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1859 | wmb(); |
| 1860 | |
| 1861 | rp->cur_tx++; |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1862 | /* |
| 1863 | * Nobody wants cur_tx write to rot for ages after the NIC will have |
| 1864 | * seen the transmit request, especially as the transmit completion |
| 1865 | * handler could miss it. |
| 1866 | */ |
| 1867 | smp_wmb(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1868 | |
| 1869 | /* Non-x86 Todo: explicitly flush cache lines here. */ |
| 1870 | |
Jiri Pirko | df8a39d | 2015-01-13 17:13:44 +0100 | [diff] [blame] | 1871 | if (skb_vlan_tag_present(skb)) |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 1872 | /* Tx queues are bits 7-0 (first Tx queue: bit 7) */ |
| 1873 | BYTE_REG_BITS_ON(1 << 7, ioaddr + TQWake); |
| 1874 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1875 | /* Wake the potentially-idle transmit channel */ |
| 1876 | iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand, |
| 1877 | ioaddr + ChipCmd1); |
| 1878 | IOSYNC; |
| 1879 | |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1880 | /* dirty_tx may be pessimistically out-of-sync. See rhine_tx. */ |
| 1881 | if (rhine_tx_queue_full(rp)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1882 | netif_stop_queue(dev); |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1883 | smp_rmb(); |
| 1884 | /* Rejuvenate. */ |
| 1885 | if (!rhine_tx_queue_full(rp)) |
| 1886 | netif_wake_queue(dev); |
| 1887 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1888 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1889 | netif_dbg(rp, tx_queued, dev, "Transmit frame #%d queued in slot %d\n", |
| 1890 | rp->cur_tx - 1, entry); |
| 1891 | |
Patrick McHardy | 6ed1065 | 2009-06-23 06:03:08 +0000 | [diff] [blame] | 1892 | return NETDEV_TX_OK; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1893 | } |
| 1894 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1895 | static void rhine_irq_disable(struct rhine_private *rp) |
| 1896 | { |
| 1897 | iowrite16(0x0000, rp->base + IntrEnable); |
| 1898 | mmiowb(); |
| 1899 | } |
| 1900 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1901 | /* The interrupt handler does all of the Rx thread work and cleans up |
| 1902 | after the Tx thread. */ |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1903 | static irqreturn_t rhine_interrupt(int irq, void *dev_instance) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1904 | { |
| 1905 | struct net_device *dev = dev_instance; |
| 1906 | struct rhine_private *rp = netdev_priv(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1907 | u32 status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1908 | int handled = 0; |
| 1909 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1910 | status = rhine_get_events(rp); |
| 1911 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1912 | netif_dbg(rp, intr, dev, "Interrupt, status %08x\n", status); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1913 | |
| 1914 | if (status & RHINE_EVENT) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1915 | handled = 1; |
| 1916 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1917 | rhine_irq_disable(rp); |
| 1918 | napi_schedule(&rp->napi); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1919 | } |
| 1920 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1921 | if (status & ~(IntrLinkChange | IntrStatsMax | RHINE_EVENT_NAPI)) { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1922 | netif_err(rp, intr, dev, "Something Wicked happened! %08x\n", |
| 1923 | status); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 1924 | } |
| 1925 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1926 | return IRQ_RETVAL(handled); |
| 1927 | } |
| 1928 | |
| 1929 | /* This routine is logically part of the interrupt handler, but isolated |
| 1930 | for clarity. */ |
| 1931 | static void rhine_tx(struct net_device *dev) |
| 1932 | { |
| 1933 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1934 | struct device *hwdev = dev->dev.parent; |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1935 | unsigned int pkts_compl = 0, bytes_compl = 0; |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1936 | unsigned int dirty_tx = rp->dirty_tx; |
| 1937 | unsigned int cur_tx; |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1938 | struct sk_buff *skb; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1939 | |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1940 | /* |
| 1941 | * The race with rhine_start_tx does not matter here as long as the |
| 1942 | * driver enforces a value of cur_tx that was relevant when the |
| 1943 | * packet was scheduled to the network chipset. |
| 1944 | * Executive summary: smp_rmb() balances smp_wmb() in rhine_start_tx. |
| 1945 | */ |
| 1946 | smp_rmb(); |
| 1947 | cur_tx = rp->cur_tx; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1948 | /* find and cleanup dirty tx descriptors */ |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 1949 | while (dirty_tx != cur_tx) { |
| 1950 | unsigned int entry = dirty_tx % TX_RING_SIZE; |
| 1951 | u32 txstatus = le32_to_cpu(rp->tx_ring[entry].tx_status); |
| 1952 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1953 | netif_dbg(rp, tx_done, dev, "Tx scavenge %d status %08x\n", |
| 1954 | entry, txstatus); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1955 | if (txstatus & DescOwn) |
| 1956 | break; |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1957 | skb = rp->tx_skbuff[entry]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1958 | if (txstatus & 0x8000) { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1959 | netif_dbg(rp, tx_done, dev, |
| 1960 | "Transmit error, Tx status %08x\n", txstatus); |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1961 | dev->stats.tx_errors++; |
| 1962 | if (txstatus & 0x0400) |
| 1963 | dev->stats.tx_carrier_errors++; |
| 1964 | if (txstatus & 0x0200) |
| 1965 | dev->stats.tx_window_errors++; |
| 1966 | if (txstatus & 0x0100) |
| 1967 | dev->stats.tx_aborted_errors++; |
| 1968 | if (txstatus & 0x0080) |
| 1969 | dev->stats.tx_heartbeat_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1970 | if (((rp->quirks & rqRhineI) && txstatus & 0x0002) || |
| 1971 | (txstatus & 0x0800) || (txstatus & 0x1000)) { |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1972 | dev->stats.tx_fifo_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1973 | rp->tx_ring[entry].tx_status = cpu_to_le32(DescOwn); |
| 1974 | break; /* Keep the skb - we try again */ |
| 1975 | } |
| 1976 | /* Transmitter restarted in 'abnormal' handler. */ |
| 1977 | } else { |
| 1978 | if (rp->quirks & rqRhineI) |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1979 | dev->stats.collisions += (txstatus >> 3) & 0x0F; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1980 | else |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 1981 | dev->stats.collisions += txstatus & 0x0F; |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 1982 | netif_dbg(rp, tx_done, dev, "collisions: %1.1x:%1.1x\n", |
| 1983 | (txstatus >> 3) & 0xF, txstatus & 0xF); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 1984 | |
| 1985 | u64_stats_update_begin(&rp->tx_stats.syncp); |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1986 | rp->tx_stats.bytes += skb->len; |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 1987 | rp->tx_stats.packets++; |
| 1988 | u64_stats_update_end(&rp->tx_stats.syncp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1989 | } |
| 1990 | /* Free the original skb. */ |
| 1991 | if (rp->tx_skbuff_dma[entry]) { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 1992 | dma_unmap_single(hwdev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1993 | rp->tx_skbuff_dma[entry], |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1994 | skb->len, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 1995 | DMA_TO_DEVICE); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1996 | } |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 1997 | bytes_compl += skb->len; |
| 1998 | pkts_compl++; |
| 1999 | dev_consume_skb_any(skb); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2000 | rp->tx_skbuff[entry] = NULL; |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 2001 | dirty_tx++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2002 | } |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 2003 | |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 2004 | rp->dirty_tx = dirty_tx; |
| 2005 | /* Pity we can't rely on the nearby BQL completion implicit barrier. */ |
| 2006 | smp_wmb(); |
| 2007 | |
Tino Reichardt | 92bf200 | 2015-02-24 10:28:01 -0800 | [diff] [blame] | 2008 | netdev_completed_queue(dev, pkts_compl, bytes_compl); |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 2009 | |
| 2010 | /* cur_tx may be optimistically out-of-sync. See rhine_start_tx. */ |
| 2011 | if (!rhine_tx_queue_full(rp) && netif_queue_stopped(dev)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2012 | netif_wake_queue(dev); |
françois romieu | 3a5a883 | 2015-05-01 22:14:45 +0200 | [diff] [blame^] | 2013 | smp_rmb(); |
| 2014 | /* Rejuvenate. */ |
| 2015 | if (rhine_tx_queue_full(rp)) |
| 2016 | netif_stop_queue(dev); |
| 2017 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2018 | } |
| 2019 | |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2020 | /** |
| 2021 | * rhine_get_vlan_tci - extract TCI from Rx data buffer |
| 2022 | * @skb: pointer to sk_buff |
| 2023 | * @data_size: used data area of the buffer including CRC |
| 2024 | * |
| 2025 | * If hardware VLAN tag extraction is enabled and the chip indicates a 802.1Q |
| 2026 | * packet, the extracted 802.1Q header (2 bytes TPID + 2 bytes TCI) is 4-byte |
| 2027 | * aligned following the CRC. |
| 2028 | */ |
| 2029 | static inline u16 rhine_get_vlan_tci(struct sk_buff *skb, int data_size) |
| 2030 | { |
| 2031 | u8 *trailer = (u8 *)skb->data + ((data_size + 3) & ~3) + 2; |
Harvey Harrison | 4562b2f | 2011-03-28 17:08:59 +0000 | [diff] [blame] | 2032 | return be16_to_cpup((__be16 *)trailer); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2033 | } |
| 2034 | |
françois romieu | 810f19b | 2015-05-01 22:14:43 +0200 | [diff] [blame] | 2035 | static inline void rhine_rx_vlan_tag(struct sk_buff *skb, struct rx_desc *desc, |
| 2036 | int data_size) |
| 2037 | { |
| 2038 | dma_rmb(); |
| 2039 | if (unlikely(desc->desc_length & cpu_to_le32(DescTag))) { |
| 2040 | u16 vlan_tci; |
| 2041 | |
| 2042 | vlan_tci = rhine_get_vlan_tci(skb, data_size); |
| 2043 | __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vlan_tci); |
| 2044 | } |
| 2045 | } |
| 2046 | |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2047 | /* Process up to limit frames from receive ring */ |
| 2048 | static int rhine_rx(struct net_device *dev, int limit) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2049 | { |
| 2050 | struct rhine_private *rp = netdev_priv(dev); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2051 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2052 | int entry = rp->cur_rx % RX_RING_SIZE; |
françois romieu | 62ca1ba | 2015-05-01 22:14:42 +0200 | [diff] [blame] | 2053 | int count; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2054 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2055 | netif_dbg(rp, rx_status, dev, "%s(), entry %d status %08x\n", __func__, |
françois romieu | 62ca1ba | 2015-05-01 22:14:42 +0200 | [diff] [blame] | 2056 | entry, le32_to_cpu(rp->rx_ring[entry].rx_status)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2057 | |
| 2058 | /* If EOP is set on the next entry, it's a new packet. Send it up. */ |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2059 | for (count = 0; count < limit; ++count) { |
françois romieu | 62ca1ba | 2015-05-01 22:14:42 +0200 | [diff] [blame] | 2060 | struct rx_desc *desc = rp->rx_ring + entry; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2061 | u32 desc_status = le32_to_cpu(desc->rx_status); |
| 2062 | int data_size = desc_status >> 16; |
| 2063 | |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2064 | if (desc_status & DescOwn) |
| 2065 | break; |
| 2066 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2067 | netif_dbg(rp, rx_status, dev, "%s() status %08x\n", __func__, |
| 2068 | desc_status); |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2069 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2070 | if ((desc_status & (RxWholePkt | RxErr)) != RxWholePkt) { |
| 2071 | if ((desc_status & RxWholePkt) != RxWholePkt) { |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 2072 | netdev_warn(dev, |
| 2073 | "Oversized Ethernet frame spanned multiple buffers, " |
| 2074 | "entry %#x length %d status %08x!\n", |
| 2075 | entry, data_size, |
| 2076 | desc_status); |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 2077 | dev->stats.rx_length_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2078 | } else if (desc_status & RxErr) { |
| 2079 | /* There was a error. */ |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2080 | netif_dbg(rp, rx_err, dev, |
| 2081 | "%s() Rx error %08x\n", __func__, |
| 2082 | desc_status); |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 2083 | dev->stats.rx_errors++; |
| 2084 | if (desc_status & 0x0030) |
| 2085 | dev->stats.rx_length_errors++; |
| 2086 | if (desc_status & 0x0048) |
| 2087 | dev->stats.rx_fifo_errors++; |
| 2088 | if (desc_status & 0x0004) |
| 2089 | dev->stats.rx_frame_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2090 | if (desc_status & 0x0002) { |
| 2091 | /* this can also be updated outside the interrupt handler */ |
| 2092 | spin_lock(&rp->lock); |
Eric Dumazet | 553e233 | 2009-05-27 10:34:50 +0000 | [diff] [blame] | 2093 | dev->stats.rx_crc_errors++; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2094 | spin_unlock(&rp->lock); |
| 2095 | } |
| 2096 | } |
| 2097 | } else { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2098 | /* Length should omit the CRC */ |
| 2099 | int pkt_len = data_size - 4; |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2100 | struct sk_buff *skb; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2101 | |
| 2102 | /* Check if the packet is long enough to accept without |
| 2103 | copying to a minimally-sized skbuff. */ |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2104 | if (pkt_len < rx_copybreak) { |
Eric Dumazet | 89d71a6 | 2009-10-13 05:34:20 +0000 | [diff] [blame] | 2105 | skb = netdev_alloc_skb_ip_align(dev, pkt_len); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2106 | if (unlikely(!skb)) |
| 2107 | goto drop; |
| 2108 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2109 | dma_sync_single_for_cpu(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 2110 | rp->rx_skbuff_dma[entry], |
| 2111 | rp->rx_buf_sz, |
| 2112 | DMA_FROM_DEVICE); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2113 | |
David S. Miller | 8c7b7fa | 2007-07-10 22:08:12 -0700 | [diff] [blame] | 2114 | skb_copy_to_linear_data(skb, |
David S. Miller | 689be43 | 2005-06-28 15:25:31 -0700 | [diff] [blame] | 2115 | rp->rx_skbuff[entry]->data, |
David S. Miller | 8c7b7fa | 2007-07-10 22:08:12 -0700 | [diff] [blame] | 2116 | pkt_len); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2117 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2118 | dma_sync_single_for_device(hwdev, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 2119 | rp->rx_skbuff_dma[entry], |
| 2120 | rp->rx_buf_sz, |
| 2121 | DMA_FROM_DEVICE); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2122 | } else { |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2123 | struct rhine_skb_dma sd; |
| 2124 | |
| 2125 | if (unlikely(rhine_skb_dma_init(dev, &sd) < 0)) |
| 2126 | goto drop; |
| 2127 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2128 | skb = rp->rx_skbuff[entry]; |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2129 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2130 | dma_unmap_single(hwdev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2131 | rp->rx_skbuff_dma[entry], |
| 2132 | rp->rx_buf_sz, |
Alexey Charkov | 4087c4d | 2014-04-22 19:28:07 +0400 | [diff] [blame] | 2133 | DMA_FROM_DEVICE); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2134 | rhine_skb_dma_nic_store(rp, &sd, entry); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2135 | } |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2136 | |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2137 | skb_put(skb, pkt_len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2138 | skb->protocol = eth_type_trans(skb, dev); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2139 | |
françois romieu | 810f19b | 2015-05-01 22:14:43 +0200 | [diff] [blame] | 2140 | rhine_rx_vlan_tag(skb, desc, data_size); |
| 2141 | |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2142 | netif_receive_skb(skb); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2143 | |
| 2144 | u64_stats_update_begin(&rp->rx_stats.syncp); |
| 2145 | rp->rx_stats.bytes += pkt_len; |
| 2146 | rp->rx_stats.packets++; |
| 2147 | u64_stats_update_end(&rp->rx_stats.syncp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2148 | } |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2149 | give_descriptor_to_nic: |
| 2150 | desc->rx_status = cpu_to_le32(DescOwn); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2151 | entry = (++rp->cur_rx) % RX_RING_SIZE; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2152 | } |
| 2153 | |
Roger Luethi | 633949a | 2006-08-14 23:00:17 -0700 | [diff] [blame] | 2154 | return count; |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2155 | |
| 2156 | drop: |
| 2157 | dev->stats.rx_dropped++; |
| 2158 | goto give_descriptor_to_nic; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2159 | } |
| 2160 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2161 | static void rhine_restart_tx(struct net_device *dev) { |
| 2162 | struct rhine_private *rp = netdev_priv(dev); |
| 2163 | void __iomem *ioaddr = rp->base; |
| 2164 | int entry = rp->dirty_tx % TX_RING_SIZE; |
| 2165 | u32 intr_status; |
| 2166 | |
| 2167 | /* |
Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 2168 | * If new errors occurred, we need to sort them out before doing Tx. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2169 | * In that case the ISR will be back here RSN anyway. |
| 2170 | */ |
Francois Romieu | a20a28b | 2011-12-30 14:53:58 +0100 | [diff] [blame] | 2171 | intr_status = rhine_get_events(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2172 | |
| 2173 | if ((intr_status & IntrTxErrSummary) == 0) { |
| 2174 | |
| 2175 | /* We know better than the chip where it should continue. */ |
| 2176 | iowrite32(rp->tx_ring_dma + entry * sizeof(struct tx_desc), |
| 2177 | ioaddr + TxRingPtr); |
| 2178 | |
| 2179 | iowrite8(ioread8(ioaddr + ChipCmd) | CmdTxOn, |
| 2180 | ioaddr + ChipCmd); |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2181 | |
| 2182 | if (rp->tx_ring[entry].desc_length & cpu_to_le32(0x020000)) |
| 2183 | /* Tx queues are bits 7-0 (first Tx queue: bit 7) */ |
| 2184 | BYTE_REG_BITS_ON(1 << 7, ioaddr + TQWake); |
| 2185 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2186 | iowrite8(ioread8(ioaddr + ChipCmd1) | Cmd1TxDemand, |
| 2187 | ioaddr + ChipCmd1); |
| 2188 | IOSYNC; |
| 2189 | } |
| 2190 | else { |
| 2191 | /* This should never happen */ |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2192 | netif_warn(rp, tx_err, dev, "another error occurred %08x\n", |
| 2193 | intr_status); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2194 | } |
| 2195 | |
| 2196 | } |
| 2197 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2198 | static void rhine_slow_event_task(struct work_struct *work) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2199 | { |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2200 | struct rhine_private *rp = |
| 2201 | container_of(work, struct rhine_private, slow_event_task); |
| 2202 | struct net_device *dev = rp->dev; |
| 2203 | u32 intr_status; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2204 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2205 | mutex_lock(&rp->task_lock); |
| 2206 | |
| 2207 | if (!rp->task_enable) |
| 2208 | goto out_unlock; |
| 2209 | |
| 2210 | intr_status = rhine_get_events(rp); |
| 2211 | rhine_ack_events(rp, intr_status & RHINE_EVENT_SLOW); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2212 | |
| 2213 | if (intr_status & IntrLinkChange) |
John W. Linville | 38bb6b2 | 2006-05-19 10:51:21 -0400 | [diff] [blame] | 2214 | rhine_check_media(dev, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2215 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2216 | if (intr_status & IntrPCIErr) |
| 2217 | netif_warn(rp, hw, dev, "PCI error\n"); |
| 2218 | |
David S. Miller | 559bcac | 2013-01-29 22:58:04 -0500 | [diff] [blame] | 2219 | iowrite16(RHINE_EVENT & 0xffff, rp->base + IntrEnable); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2220 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2221 | out_unlock: |
| 2222 | mutex_unlock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2223 | } |
| 2224 | |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2225 | static struct rtnl_link_stats64 * |
| 2226 | rhine_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2227 | { |
| 2228 | struct rhine_private *rp = netdev_priv(dev); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2229 | unsigned int start; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2230 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2231 | spin_lock_bh(&rp->lock); |
| 2232 | rhine_update_rx_crc_and_missed_errord(rp); |
| 2233 | spin_unlock_bh(&rp->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2234 | |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2235 | netdev_stats_to_stats64(stats, &dev->stats); |
| 2236 | |
| 2237 | do { |
Eric W. Biederman | 57a7744 | 2014-03-13 21:26:42 -0700 | [diff] [blame] | 2238 | start = u64_stats_fetch_begin_irq(&rp->rx_stats.syncp); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2239 | stats->rx_packets = rp->rx_stats.packets; |
| 2240 | stats->rx_bytes = rp->rx_stats.bytes; |
Eric W. Biederman | 57a7744 | 2014-03-13 21:26:42 -0700 | [diff] [blame] | 2241 | } while (u64_stats_fetch_retry_irq(&rp->rx_stats.syncp, start)); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2242 | |
| 2243 | do { |
Eric W. Biederman | 57a7744 | 2014-03-13 21:26:42 -0700 | [diff] [blame] | 2244 | start = u64_stats_fetch_begin_irq(&rp->tx_stats.syncp); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2245 | stats->tx_packets = rp->tx_stats.packets; |
| 2246 | stats->tx_bytes = rp->tx_stats.bytes; |
Eric W. Biederman | 57a7744 | 2014-03-13 21:26:42 -0700 | [diff] [blame] | 2247 | } while (u64_stats_fetch_retry_irq(&rp->tx_stats.syncp, start)); |
Jamie Gloudon | f7b5d1b | 2013-01-23 18:05:04 +0000 | [diff] [blame] | 2248 | |
| 2249 | return stats; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2250 | } |
| 2251 | |
| 2252 | static void rhine_set_rx_mode(struct net_device *dev) |
| 2253 | { |
| 2254 | struct rhine_private *rp = netdev_priv(dev); |
| 2255 | void __iomem *ioaddr = rp->base; |
| 2256 | u32 mc_filter[2]; /* Multicast hash filter */ |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2257 | u8 rx_mode = 0x0C; /* Note: 0x02=accept runt, 0x01=accept errs */ |
| 2258 | struct netdev_hw_addr *ha; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2259 | |
| 2260 | if (dev->flags & IFF_PROMISC) { /* Set promiscuous. */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2261 | rx_mode = 0x1C; |
| 2262 | iowrite32(0xffffffff, ioaddr + MulticastFilter0); |
| 2263 | iowrite32(0xffffffff, ioaddr + MulticastFilter1); |
Jiri Pirko | 4cd24ea | 2010-02-08 04:30:35 +0000 | [diff] [blame] | 2264 | } else if ((netdev_mc_count(dev) > multicast_filter_limit) || |
Joe Perches | 8e95a20 | 2009-12-03 07:58:21 +0000 | [diff] [blame] | 2265 | (dev->flags & IFF_ALLMULTI)) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2266 | /* Too many to match, or accept all multicasts. */ |
| 2267 | iowrite32(0xffffffff, ioaddr + MulticastFilter0); |
| 2268 | iowrite32(0xffffffff, ioaddr + MulticastFilter1); |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 2269 | } else if (rp->quirks & rqMgmt) { |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2270 | int i = 0; |
| 2271 | u32 mCAMmask = 0; /* 32 mCAMs (6105M and better) */ |
| 2272 | netdev_for_each_mc_addr(ha, dev) { |
| 2273 | if (i == MCAM_SIZE) |
| 2274 | break; |
| 2275 | rhine_set_cam(ioaddr, i, ha->addr); |
| 2276 | mCAMmask |= 1 << i; |
| 2277 | i++; |
| 2278 | } |
| 2279 | rhine_set_cam_mask(ioaddr, mCAMmask); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2280 | } else { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2281 | memset(mc_filter, 0, sizeof(mc_filter)); |
Jiri Pirko | 22bedad3 | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 2282 | netdev_for_each_mc_addr(ha, dev) { |
| 2283 | int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2284 | |
| 2285 | mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31); |
| 2286 | } |
| 2287 | iowrite32(mc_filter[0], ioaddr + MulticastFilter0); |
| 2288 | iowrite32(mc_filter[1], ioaddr + MulticastFilter1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2289 | } |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2290 | /* enable/disable VLAN receive filtering */ |
Alexey Charkov | ca8b6e0 | 2014-04-30 22:21:09 +0400 | [diff] [blame] | 2291 | if (rp->quirks & rqMgmt) { |
Roger Luethi | 38f49e8 | 2010-12-06 00:59:40 +0000 | [diff] [blame] | 2292 | if (dev->flags & IFF_PROMISC) |
| 2293 | BYTE_REG_BITS_OFF(BCR1_VIDFR, ioaddr + PCIBusConfig1); |
| 2294 | else |
| 2295 | BYTE_REG_BITS_ON(BCR1_VIDFR, ioaddr + PCIBusConfig1); |
| 2296 | } |
| 2297 | BYTE_REG_BITS_ON(rx_mode, ioaddr + RxConfig); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2298 | } |
| 2299 | |
| 2300 | static void netdev_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info) |
| 2301 | { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2302 | struct device *hwdev = dev->dev.parent; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2303 | |
Rick Jones | 23020ab | 2011-11-09 09:58:07 +0000 | [diff] [blame] | 2304 | strlcpy(info->driver, DRV_NAME, sizeof(info->driver)); |
| 2305 | strlcpy(info->version, DRV_VERSION, sizeof(info->version)); |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2306 | strlcpy(info->bus_info, dev_name(hwdev), sizeof(info->bus_info)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2307 | } |
| 2308 | |
| 2309 | static int netdev_get_settings(struct net_device *dev, struct ethtool_cmd *cmd) |
| 2310 | { |
| 2311 | struct rhine_private *rp = netdev_priv(dev); |
| 2312 | int rc; |
| 2313 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2314 | mutex_lock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2315 | rc = mii_ethtool_gset(&rp->mii_if, cmd); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2316 | mutex_unlock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2317 | |
| 2318 | return rc; |
| 2319 | } |
| 2320 | |
| 2321 | static int netdev_set_settings(struct net_device *dev, struct ethtool_cmd *cmd) |
| 2322 | { |
| 2323 | struct rhine_private *rp = netdev_priv(dev); |
| 2324 | int rc; |
| 2325 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2326 | mutex_lock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2327 | rc = mii_ethtool_sset(&rp->mii_if, cmd); |
Roger Luethi | 00b428c | 2006-03-28 20:53:56 +0200 | [diff] [blame] | 2328 | rhine_set_carrier(&rp->mii_if); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2329 | mutex_unlock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2330 | |
| 2331 | return rc; |
| 2332 | } |
| 2333 | |
| 2334 | static int netdev_nway_reset(struct net_device *dev) |
| 2335 | { |
| 2336 | struct rhine_private *rp = netdev_priv(dev); |
| 2337 | |
| 2338 | return mii_nway_restart(&rp->mii_if); |
| 2339 | } |
| 2340 | |
| 2341 | static u32 netdev_get_link(struct net_device *dev) |
| 2342 | { |
| 2343 | struct rhine_private *rp = netdev_priv(dev); |
| 2344 | |
| 2345 | return mii_link_ok(&rp->mii_if); |
| 2346 | } |
| 2347 | |
| 2348 | static u32 netdev_get_msglevel(struct net_device *dev) |
| 2349 | { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2350 | struct rhine_private *rp = netdev_priv(dev); |
| 2351 | |
| 2352 | return rp->msg_enable; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2353 | } |
| 2354 | |
| 2355 | static void netdev_set_msglevel(struct net_device *dev, u32 value) |
| 2356 | { |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2357 | struct rhine_private *rp = netdev_priv(dev); |
| 2358 | |
| 2359 | rp->msg_enable = value; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2360 | } |
| 2361 | |
| 2362 | static void rhine_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol) |
| 2363 | { |
| 2364 | struct rhine_private *rp = netdev_priv(dev); |
| 2365 | |
| 2366 | if (!(rp->quirks & rqWOL)) |
| 2367 | return; |
| 2368 | |
| 2369 | spin_lock_irq(&rp->lock); |
| 2370 | wol->supported = WAKE_PHY | WAKE_MAGIC | |
| 2371 | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST; /* Untested */ |
| 2372 | wol->wolopts = rp->wolopts; |
| 2373 | spin_unlock_irq(&rp->lock); |
| 2374 | } |
| 2375 | |
| 2376 | static int rhine_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol) |
| 2377 | { |
| 2378 | struct rhine_private *rp = netdev_priv(dev); |
| 2379 | u32 support = WAKE_PHY | WAKE_MAGIC | |
| 2380 | WAKE_UCAST | WAKE_MCAST | WAKE_BCAST; /* Untested */ |
| 2381 | |
| 2382 | if (!(rp->quirks & rqWOL)) |
| 2383 | return -EINVAL; |
| 2384 | |
| 2385 | if (wol->wolopts & ~support) |
| 2386 | return -EINVAL; |
| 2387 | |
| 2388 | spin_lock_irq(&rp->lock); |
| 2389 | rp->wolopts = wol->wolopts; |
| 2390 | spin_unlock_irq(&rp->lock); |
| 2391 | |
| 2392 | return 0; |
| 2393 | } |
| 2394 | |
Jeff Garzik | 7282d49 | 2006-09-13 14:30:00 -0400 | [diff] [blame] | 2395 | static const struct ethtool_ops netdev_ethtool_ops = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2396 | .get_drvinfo = netdev_get_drvinfo, |
| 2397 | .get_settings = netdev_get_settings, |
| 2398 | .set_settings = netdev_set_settings, |
| 2399 | .nway_reset = netdev_nway_reset, |
| 2400 | .get_link = netdev_get_link, |
| 2401 | .get_msglevel = netdev_get_msglevel, |
| 2402 | .set_msglevel = netdev_set_msglevel, |
| 2403 | .get_wol = rhine_get_wol, |
| 2404 | .set_wol = rhine_set_wol, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2405 | }; |
| 2406 | |
| 2407 | static int netdev_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) |
| 2408 | { |
| 2409 | struct rhine_private *rp = netdev_priv(dev); |
| 2410 | int rc; |
| 2411 | |
| 2412 | if (!netif_running(dev)) |
| 2413 | return -EINVAL; |
| 2414 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2415 | mutex_lock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2416 | rc = generic_mii_ioctl(&rp->mii_if, if_mii(rq), cmd, NULL); |
Roger Luethi | 00b428c | 2006-03-28 20:53:56 +0200 | [diff] [blame] | 2417 | rhine_set_carrier(&rp->mii_if); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2418 | mutex_unlock(&rp->task_lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2419 | |
| 2420 | return rc; |
| 2421 | } |
| 2422 | |
| 2423 | static int rhine_close(struct net_device *dev) |
| 2424 | { |
| 2425 | struct rhine_private *rp = netdev_priv(dev); |
| 2426 | void __iomem *ioaddr = rp->base; |
| 2427 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2428 | rhine_task_disable(rp); |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 2429 | napi_disable(&rp->napi); |
Jarek Poplawski | c0d7a02 | 2009-12-23 21:54:29 -0800 | [diff] [blame] | 2430 | netif_stop_queue(dev); |
| 2431 | |
Francois Romieu | fc3e0f8 | 2012-01-07 22:39:37 +0100 | [diff] [blame] | 2432 | netif_dbg(rp, ifdown, dev, "Shutting down ethercard, status was %04x\n", |
| 2433 | ioread16(ioaddr + ChipCmd)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2434 | |
| 2435 | /* Switch to loopback mode to avoid hardware races. */ |
| 2436 | iowrite8(rp->tx_thresh | 0x02, ioaddr + TxConfig); |
| 2437 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2438 | rhine_irq_disable(rp); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2439 | |
| 2440 | /* Stop the chip's Tx and Rx processes. */ |
| 2441 | iowrite16(CmdStop, ioaddr + ChipCmd); |
| 2442 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2443 | free_irq(rp->irq, dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2444 | free_rbufs(dev); |
| 2445 | free_tbufs(dev); |
| 2446 | free_ring(dev); |
| 2447 | |
| 2448 | return 0; |
| 2449 | } |
| 2450 | |
| 2451 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2452 | static void rhine_remove_one_pci(struct pci_dev *pdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2453 | { |
| 2454 | struct net_device *dev = pci_get_drvdata(pdev); |
| 2455 | struct rhine_private *rp = netdev_priv(dev); |
| 2456 | |
| 2457 | unregister_netdev(dev); |
| 2458 | |
| 2459 | pci_iounmap(pdev, rp->base); |
| 2460 | pci_release_regions(pdev); |
| 2461 | |
| 2462 | free_netdev(dev); |
| 2463 | pci_disable_device(pdev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2464 | } |
| 2465 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2466 | static int rhine_remove_one_platform(struct platform_device *pdev) |
| 2467 | { |
| 2468 | struct net_device *dev = platform_get_drvdata(pdev); |
| 2469 | struct rhine_private *rp = netdev_priv(dev); |
| 2470 | |
| 2471 | unregister_netdev(dev); |
| 2472 | |
| 2473 | iounmap(rp->base); |
| 2474 | |
| 2475 | free_netdev(dev); |
| 2476 | |
| 2477 | return 0; |
| 2478 | } |
| 2479 | |
| 2480 | static void rhine_shutdown_pci(struct pci_dev *pdev) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2481 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2482 | struct net_device *dev = pci_get_drvdata(pdev); |
| 2483 | struct rhine_private *rp = netdev_priv(dev); |
| 2484 | void __iomem *ioaddr = rp->base; |
| 2485 | |
| 2486 | if (!(rp->quirks & rqWOL)) |
| 2487 | return; /* Nothing to do for non-WOL adapters */ |
| 2488 | |
| 2489 | rhine_power_init(dev); |
| 2490 | |
| 2491 | /* Make sure we use pattern 0, 1 and not 4, 5 */ |
| 2492 | if (rp->quirks & rq6patterns) |
Laura Garcia | f11cf25 | 2008-02-23 18:56:35 +0100 | [diff] [blame] | 2493 | iowrite8(0x04, ioaddr + WOLcgClr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2494 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2495 | spin_lock(&rp->lock); |
| 2496 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2497 | if (rp->wolopts & WAKE_MAGIC) { |
| 2498 | iowrite8(WOLmagic, ioaddr + WOLcrSet); |
| 2499 | /* |
| 2500 | * Turn EEPROM-controlled wake-up back on -- some hardware may |
| 2501 | * not cooperate otherwise. |
| 2502 | */ |
| 2503 | iowrite8(ioread8(ioaddr + ConfigA) | 0x03, ioaddr + ConfigA); |
| 2504 | } |
| 2505 | |
| 2506 | if (rp->wolopts & (WAKE_BCAST|WAKE_MCAST)) |
| 2507 | iowrite8(WOLbmcast, ioaddr + WOLcgSet); |
| 2508 | |
| 2509 | if (rp->wolopts & WAKE_PHY) |
| 2510 | iowrite8(WOLlnkon | WOLlnkoff, ioaddr + WOLcrSet); |
| 2511 | |
| 2512 | if (rp->wolopts & WAKE_UCAST) |
| 2513 | iowrite8(WOLucast, ioaddr + WOLcrSet); |
| 2514 | |
| 2515 | if (rp->wolopts) { |
| 2516 | /* Enable legacy WOL (for old motherboards) */ |
| 2517 | iowrite8(0x01, ioaddr + PwcfgSet); |
| 2518 | iowrite8(ioread8(ioaddr + StickyHW) | 0x04, ioaddr + StickyHW); |
| 2519 | } |
| 2520 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2521 | spin_unlock(&rp->lock); |
| 2522 | |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2523 | if (system_state == SYSTEM_POWER_OFF && !avoid_D3) { |
Roger Luethi | b933b4d | 2006-08-14 23:00:21 -0700 | [diff] [blame] | 2524 | iowrite8(ioread8(ioaddr + StickyHW) | 0x03, ioaddr + StickyHW); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2525 | |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2526 | pci_wake_from_d3(pdev, true); |
| 2527 | pci_set_power_state(pdev, PCI_D3hot); |
| 2528 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2529 | } |
| 2530 | |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2531 | #ifdef CONFIG_PM_SLEEP |
| 2532 | static int rhine_suspend(struct device *device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2533 | { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2534 | struct net_device *dev = dev_get_drvdata(device); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2535 | struct rhine_private *rp = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2536 | |
| 2537 | if (!netif_running(dev)) |
| 2538 | return 0; |
| 2539 | |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2540 | rhine_task_disable(rp); |
| 2541 | rhine_irq_disable(rp); |
Stephen Hemminger | bea3348 | 2007-10-03 16:41:36 -0700 | [diff] [blame] | 2542 | napi_disable(&rp->napi); |
Francois Romieu | 32b0f53 | 2008-07-11 00:30:14 +0200 | [diff] [blame] | 2543 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2544 | netif_device_detach(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2545 | |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2546 | if (dev_is_pci(device)) |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2547 | rhine_shutdown_pci(to_pci_dev(device)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2548 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2549 | return 0; |
| 2550 | } |
| 2551 | |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2552 | static int rhine_resume(struct device *device) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2553 | { |
Alexey Charkov | f7630d1 | 2014-04-22 19:28:08 +0400 | [diff] [blame] | 2554 | struct net_device *dev = dev_get_drvdata(device); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2555 | struct rhine_private *rp = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2556 | |
| 2557 | if (!netif_running(dev)) |
| 2558 | return 0; |
| 2559 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2560 | enable_mmio(rp->pioaddr, rp->quirks); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2561 | rhine_power_init(dev); |
| 2562 | free_tbufs(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2563 | alloc_tbufs(dev); |
françois romieu | 8709bb2 | 2015-05-01 22:14:41 +0200 | [diff] [blame] | 2564 | rhine_reset_rbufs(rp); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2565 | rhine_task_enable(rp); |
| 2566 | spin_lock_bh(&rp->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2567 | init_registers(dev); |
Francois Romieu | 7ab87ff | 2012-01-06 21:42:26 +0100 | [diff] [blame] | 2568 | spin_unlock_bh(&rp->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2569 | |
| 2570 | netif_device_attach(dev); |
| 2571 | |
| 2572 | return 0; |
| 2573 | } |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2574 | |
| 2575 | static SIMPLE_DEV_PM_OPS(rhine_pm_ops, rhine_suspend, rhine_resume); |
| 2576 | #define RHINE_PM_OPS (&rhine_pm_ops) |
| 2577 | |
| 2578 | #else |
| 2579 | |
| 2580 | #define RHINE_PM_OPS NULL |
| 2581 | |
| 2582 | #endif /* !CONFIG_PM_SLEEP */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2583 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2584 | static struct pci_driver rhine_driver_pci = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2585 | .name = DRV_NAME, |
| 2586 | .id_table = rhine_pci_tbl, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2587 | .probe = rhine_init_one_pci, |
| 2588 | .remove = rhine_remove_one_pci, |
| 2589 | .shutdown = rhine_shutdown_pci, |
Francois Romieu | e92b9b3 | 2012-01-07 22:58:27 +0100 | [diff] [blame] | 2590 | .driver.pm = RHINE_PM_OPS, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2591 | }; |
| 2592 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2593 | static struct platform_driver rhine_driver_platform = { |
| 2594 | .probe = rhine_init_one_platform, |
| 2595 | .remove = rhine_remove_one_platform, |
| 2596 | .driver = { |
| 2597 | .name = DRV_NAME, |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2598 | .of_match_table = rhine_of_tbl, |
| 2599 | .pm = RHINE_PM_OPS, |
| 2600 | } |
| 2601 | }; |
| 2602 | |
Sachin Kamat | 77273ea | 2013-08-07 16:08:16 +0530 | [diff] [blame] | 2603 | static struct dmi_system_id rhine_dmi_table[] __initdata = { |
Roger Luethi | e84df48 | 2007-03-06 19:57:37 +0100 | [diff] [blame] | 2604 | { |
| 2605 | .ident = "EPIA-M", |
| 2606 | .matches = { |
| 2607 | DMI_MATCH(DMI_BIOS_VENDOR, "Award Software International, Inc."), |
| 2608 | DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"), |
| 2609 | }, |
| 2610 | }, |
| 2611 | { |
| 2612 | .ident = "KV7", |
| 2613 | .matches = { |
| 2614 | DMI_MATCH(DMI_BIOS_VENDOR, "Phoenix Technologies, LTD"), |
| 2615 | DMI_MATCH(DMI_BIOS_VERSION, "6.00 PG"), |
| 2616 | }, |
| 2617 | }, |
| 2618 | { NULL } |
| 2619 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2620 | |
| 2621 | static int __init rhine_init(void) |
| 2622 | { |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2623 | int ret_pci, ret_platform; |
| 2624 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2625 | /* when a module, this is printed whether or not devices are found in probe */ |
| 2626 | #ifdef MODULE |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 2627 | pr_info("%s\n", version); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2628 | #endif |
Roger Luethi | e84df48 | 2007-03-06 19:57:37 +0100 | [diff] [blame] | 2629 | if (dmi_check_system(rhine_dmi_table)) { |
| 2630 | /* these BIOSes fail at PXE boot if chip is in D3 */ |
Rusty Russell | eb93992 | 2011-12-19 14:08:01 +0000 | [diff] [blame] | 2631 | avoid_D3 = true; |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 2632 | pr_warn("Broken BIOS detected, avoid_D3 enabled\n"); |
Roger Luethi | e84df48 | 2007-03-06 19:57:37 +0100 | [diff] [blame] | 2633 | } |
| 2634 | else if (avoid_D3) |
Joe Perches | df4511f | 2011-04-16 14:15:25 +0000 | [diff] [blame] | 2635 | pr_info("avoid_D3 set\n"); |
Roger Luethi | e84df48 | 2007-03-06 19:57:37 +0100 | [diff] [blame] | 2636 | |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2637 | ret_pci = pci_register_driver(&rhine_driver_pci); |
| 2638 | ret_platform = platform_driver_register(&rhine_driver_platform); |
| 2639 | if ((ret_pci < 0) && (ret_platform < 0)) |
| 2640 | return ret_pci; |
| 2641 | |
| 2642 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2643 | } |
| 2644 | |
| 2645 | |
| 2646 | static void __exit rhine_cleanup(void) |
| 2647 | { |
Alexey Charkov | 2d28386 | 2014-04-22 19:28:09 +0400 | [diff] [blame] | 2648 | platform_driver_unregister(&rhine_driver_platform); |
| 2649 | pci_unregister_driver(&rhine_driver_pci); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2650 | } |
| 2651 | |
| 2652 | |
| 2653 | module_init(rhine_init); |
| 2654 | module_exit(rhine_cleanup); |