Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* cs89x0.c: A Crystal Semiconductor (Now Cirrus Logic) CS89[02]0 |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 2 | * driver for linux. |
| 3 | * Written 1996 by Russell Nelson, with reference to skeleton.c |
| 4 | * written 1993-1994 by Donald Becker. |
| 5 | * |
| 6 | * This software may be used and distributed according to the terms |
| 7 | * of the GNU General Public License, incorporated herein by reference. |
| 8 | * |
| 9 | * The author may be reached at nelson@crynwr.com, Crynwr |
| 10 | * Software, 521 Pleasant Valley Rd., Potsdam, NY 13676 |
| 11 | * |
| 12 | * Other contributors: |
| 13 | * Mike Cruse : mcruse@cti-ltd.com |
| 14 | * Russ Nelson |
| 15 | * Melody Lee : ethernet@crystal.cirrus.com |
| 16 | * Alan Cox |
| 17 | * Andrew Morton |
| 18 | * Oskar Schirmer : oskar@scara.com |
| 19 | * Deepak Saxena : dsaxena@plexity.net |
| 20 | * Dmitry Pervushin : dpervushin@ru.mvista.com |
| 21 | * Deepak Saxena : dsaxena@plexity.net |
| 22 | * Domenico Andreoli : cavokz@gmail.com |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 23 | */ |
| 24 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | |
| 26 | /* |
| 27 | * Set this to zero to disable DMA code |
| 28 | * |
| 29 | * Note that even if DMA is turned off we still support the 'dma' and 'use_dma' |
| 30 | * module options so we don't break any startup scripts. |
| 31 | */ |
Lennert Buytenhek | 91e1c46 | 2006-01-11 12:17:34 -0800 | [diff] [blame] | 32 | #ifndef CONFIG_ISA_DMA_API |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | #define ALLOW_DMA 0 |
| 34 | #else |
| 35 | #define ALLOW_DMA 1 |
| 36 | #endif |
| 37 | |
| 38 | /* |
| 39 | * Set this to zero to remove all the debug statements via |
| 40 | * dead code elimination |
| 41 | */ |
| 42 | #define DEBUGGING 1 |
| 43 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 44 | /* Sources: |
| 45 | * Crynwr packet driver epktisa. |
| 46 | * Crystal Semiconductor data sheets. |
| 47 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 49 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
| 50 | |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 51 | #include <linux/module.h> |
| 52 | #include <linux/printk.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | #include <linux/errno.h> |
| 54 | #include <linux/netdevice.h> |
| 55 | #include <linux/etherdevice.h> |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 56 | #include <linux/platform_device.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | #include <linux/kernel.h> |
| 58 | #include <linux/types.h> |
| 59 | #include <linux/fcntl.h> |
| 60 | #include <linux/interrupt.h> |
| 61 | #include <linux/ioport.h> |
| 62 | #include <linux/in.h> |
| 63 | #include <linux/skbuff.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | #include <linux/spinlock.h> |
| 65 | #include <linux/string.h> |
| 66 | #include <linux/init.h> |
| 67 | #include <linux/bitops.h> |
| 68 | #include <linux/delay.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 69 | #include <linux/gfp.h> |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 70 | #include <linux/io.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 71 | |
Al Viro | 7625d48 | 2005-09-26 05:25:59 +0100 | [diff] [blame] | 72 | #include <asm/irq.h> |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 73 | #include <linux/atomic.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 | #if ALLOW_DMA |
| 75 | #include <asm/dma.h> |
| 76 | #endif |
| 77 | |
| 78 | #include "cs89x0.h" |
| 79 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 80 | #define cs89_dbg(val, level, fmt, ...) \ |
| 81 | do { \ |
| 82 | if (val <= net_debug) \ |
| 83 | pr_##level(fmt, ##__VA_ARGS__); \ |
| 84 | } while (0) |
| 85 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 86 | static char version[] __initdata = |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 87 | "v2.4.3-pre1 Russell Nelson <nelson@crynwr.com>, Andrew Morton"; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | |
| 89 | #define DRV_NAME "cs89x0" |
| 90 | |
| 91 | /* First, a few definitions that the brave might change. |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 92 | * A zero-terminated list of I/O addresses to be probed. Some special flags.. |
| 93 | * Addr & 1 = Read back the address port, look for signature and reset |
| 94 | * the page window before probing |
| 95 | * Addr & 3 = Reset the page window and probe |
| 96 | * The CLPS eval board has the Cirrus chip at 0x80090300, in ARM IO space, |
| 97 | * but it is possible that a Cirrus board could be plugged into the ISA |
| 98 | * slots. |
| 99 | */ |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 100 | /* The cs8900 has 4 IRQ pins, software selectable. cs8900_irq_map maps |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 101 | * them to system IRQ numbers. This mapping is card specific and is set to |
| 102 | * the configuration of the Cirrus Eval board for this chip. |
| 103 | */ |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 104 | #ifndef CONFIG_CS89x0_PLATFORM |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 105 | static unsigned int netcard_portlist[] __used __initdata = { |
| 106 | 0x300, 0x320, 0x340, 0x360, 0x200, 0x220, 0x240, |
| 107 | 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0, 0 |
| 108 | }; |
| 109 | static unsigned int cs8900_irq_map[] = { |
| 110 | 10, 11, 12, 5 |
| 111 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 | #endif |
| 113 | |
| 114 | #if DEBUGGING |
| 115 | static unsigned int net_debug = DEBUGGING; |
| 116 | #else |
| 117 | #define net_debug 0 /* gcc will remove all the debug code for us */ |
| 118 | #endif |
| 119 | |
| 120 | /* The number of low I/O ports used by the ethercard. */ |
| 121 | #define NETCARD_IO_EXTENT 16 |
| 122 | |
| 123 | /* we allow the user to override various values normally set in the EEPROM */ |
| 124 | #define FORCE_RJ45 0x0001 /* pick one of these three */ |
| 125 | #define FORCE_AUI 0x0002 |
| 126 | #define FORCE_BNC 0x0004 |
| 127 | |
| 128 | #define FORCE_AUTO 0x0010 /* pick one of these three */ |
| 129 | #define FORCE_HALF 0x0020 |
| 130 | #define FORCE_FULL 0x0030 |
| 131 | |
| 132 | /* Information that need to be kept for each board. */ |
| 133 | struct net_local { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | int chip_type; /* one of: CS8900, CS8920, CS8920M */ |
| 135 | char chip_revision; /* revision letter of the chip ('A'...) */ |
| 136 | int send_cmd; /* the proper send command: TX_NOW, TX_AFTER_381, or TX_AFTER_ALL */ |
| 137 | int auto_neg_cnf; /* auto-negotiation word from EEPROM */ |
| 138 | int adapter_cnf; /* adapter configuration from EEPROM */ |
| 139 | int isa_config; /* ISA configuration from EEPROM */ |
| 140 | int irq_map; /* IRQ map from EEPROM */ |
| 141 | int rx_mode; /* what mode are we in? 0, RX_MULTCAST_ACCEPT, or RX_ALL_ACCEPT */ |
| 142 | int curr_rx_cfg; /* a copy of PP_RxCFG */ |
| 143 | int linectl; /* either 0 or LOW_RX_SQUELCH, depending on configuration. */ |
| 144 | int send_underrun; /* keep track of how many underruns in a row we get */ |
| 145 | int force; /* force various values; see FORCE* above. */ |
| 146 | spinlock_t lock; |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 147 | void __iomem *virt_addr;/* CS89x0 virtual address. */ |
| 148 | unsigned long size; /* Length of CS89x0 memory region. */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 149 | #if ALLOW_DMA |
| 150 | int use_dma; /* Flag: we're using dma */ |
| 151 | int dma; /* DMA channel */ |
| 152 | int dmasize; /* 16 or 64 */ |
| 153 | unsigned char *dma_buff; /* points to the beginning of the buffer */ |
| 154 | unsigned char *end_dma_buff; /* points to the end of the buffer */ |
| 155 | unsigned char *rx_dma_ptr; /* points to the next packet */ |
| 156 | #endif |
| 157 | }; |
| 158 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 159 | /* Example routines you must write ;->. */ |
| 160 | #define tx_done(dev) 1 |
| 161 | |
| 162 | /* |
| 163 | * Permit 'cs89x0_dma=N' in the kernel boot environment |
| 164 | */ |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 165 | #if !defined(MODULE) |
| 166 | #if ALLOW_DMA |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 167 | static int g_cs89x0_dma; |
| 168 | |
| 169 | static int __init dma_fn(char *str) |
| 170 | { |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 171 | g_cs89x0_dma = simple_strtol(str, NULL, 0); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 172 | return 1; |
| 173 | } |
| 174 | |
| 175 | __setup("cs89x0_dma=", dma_fn); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 176 | #endif /* ALLOW_DMA */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 177 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | static int g_cs89x0_media__force; |
| 179 | |
| 180 | static int __init media_fn(char *str) |
| 181 | { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 182 | if (!strcmp(str, "rj45")) |
| 183 | g_cs89x0_media__force = FORCE_RJ45; |
| 184 | else if (!strcmp(str, "aui")) |
| 185 | g_cs89x0_media__force = FORCE_AUI; |
| 186 | else if (!strcmp(str, "bnc")) |
| 187 | g_cs89x0_media__force = FORCE_BNC; |
| 188 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 | return 1; |
| 190 | } |
| 191 | |
| 192 | __setup("cs89x0_media=", media_fn); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 193 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 195 | static void readwords(struct net_local *lp, int portno, void *buf, int length) |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 196 | { |
| 197 | u8 *buf8 = (u8 *)buf; |
| 198 | |
| 199 | do { |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 200 | u16 tmp16; |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 201 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 202 | tmp16 = ioread16(lp->virt_addr + portno); |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 203 | *buf8++ = (u8)tmp16; |
| 204 | *buf8++ = (u8)(tmp16 >> 8); |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 205 | } while (--length); |
| 206 | } |
| 207 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 208 | static void writewords(struct net_local *lp, int portno, void *buf, int length) |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 209 | { |
| 210 | u8 *buf8 = (u8 *)buf; |
| 211 | |
| 212 | do { |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 213 | u16 tmp16; |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 214 | |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 215 | tmp16 = *buf8++; |
| 216 | tmp16 |= (*buf8++) << 8; |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 217 | iowrite16(tmp16, lp->virt_addr + portno); |
Lennert Buytenhek | 084f746 | 2006-01-08 01:01:12 -0800 | [diff] [blame] | 218 | } while (--length); |
| 219 | } |
| 220 | |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 221 | static u16 |
| 222 | readreg(struct net_device *dev, u16 regno) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | { |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 224 | struct net_local *lp = netdev_priv(dev); |
| 225 | |
| 226 | iowrite16(regno, lp->virt_addr + ADD_PORT); |
| 227 | return ioread16(lp->virt_addr + DATA_PORT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 228 | } |
| 229 | |
| 230 | static void |
Lennert Buytenhek | a07f0db | 2006-01-14 13:21:17 -0800 | [diff] [blame] | 231 | writereg(struct net_device *dev, u16 regno, u16 value) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | { |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 233 | struct net_local *lp = netdev_priv(dev); |
| 234 | |
| 235 | iowrite16(regno, lp->virt_addr + ADD_PORT); |
| 236 | iowrite16(value, lp->virt_addr + DATA_PORT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 237 | } |
| 238 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 239 | static int __init |
| 240 | wait_eeprom_ready(struct net_device *dev) |
| 241 | { |
| 242 | int timeout = jiffies; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 243 | /* check to see if the EEPROM is ready, |
| 244 | * a timeout is used just in case EEPROM is ready when |
| 245 | * SI_BUSY in the PP_SelfST is clear |
| 246 | */ |
| 247 | while (readreg(dev, PP_SelfST) & SI_BUSY) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 248 | if (jiffies - timeout >= 40) |
| 249 | return -1; |
| 250 | return 0; |
| 251 | } |
| 252 | |
| 253 | static int __init |
| 254 | get_eeprom_data(struct net_device *dev, int off, int len, int *buffer) |
| 255 | { |
| 256 | int i; |
| 257 | |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 258 | cs89_dbg(3, info, "EEPROM data from %x for %x:", off, len); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 259 | for (i = 0; i < len; i++) { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 260 | if (wait_eeprom_ready(dev) < 0) |
| 261 | return -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | /* Now send the EEPROM read command and EEPROM location to read */ |
| 263 | writereg(dev, PP_EECMD, (off + i) | EEPROM_READ_CMD); |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 264 | if (wait_eeprom_ready(dev) < 0) |
| 265 | return -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 266 | buffer[i] = readreg(dev, PP_EEData); |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 267 | cs89_dbg(3, cont, " %04x", buffer[i]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 268 | } |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 269 | cs89_dbg(3, cont, "\n"); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 270 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 271 | } |
| 272 | |
| 273 | static int __init |
| 274 | get_eeprom_cksum(int off, int len, int *buffer) |
| 275 | { |
| 276 | int i, cksum; |
| 277 | |
| 278 | cksum = 0; |
| 279 | for (i = 0; i < len; i++) |
| 280 | cksum += buffer[i]; |
| 281 | cksum &= 0xffff; |
| 282 | if (cksum == 0) |
| 283 | return 0; |
| 284 | return -1; |
| 285 | } |
| 286 | |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 287 | static void |
| 288 | write_irq(struct net_device *dev, int chip_type, int irq) |
| 289 | { |
| 290 | int i; |
| 291 | |
| 292 | if (chip_type == CS8900) { |
| 293 | #ifndef CONFIG_CS89x0_PLATFORM |
| 294 | /* Search the mapping table for the corresponding IRQ pin. */ |
| 295 | for (i = 0; i != ARRAY_SIZE(cs8900_irq_map); i++) |
| 296 | if (cs8900_irq_map[i] == irq) |
| 297 | break; |
| 298 | /* Not found */ |
| 299 | if (i == ARRAY_SIZE(cs8900_irq_map)) |
| 300 | i = 3; |
| 301 | #else |
| 302 | /* INTRQ0 pin is used for interrupt generation. */ |
| 303 | i = 0; |
| 304 | #endif |
| 305 | writereg(dev, PP_CS8900_ISAINT, i); |
| 306 | } else { |
| 307 | writereg(dev, PP_CS8920_ISAINT, irq); |
| 308 | } |
| 309 | } |
| 310 | |
| 311 | static void |
| 312 | count_rx_errors(int status, struct net_device *dev) |
| 313 | { |
| 314 | dev->stats.rx_errors++; |
| 315 | if (status & RX_RUNT) |
| 316 | dev->stats.rx_length_errors++; |
| 317 | if (status & RX_EXTRA_DATA) |
| 318 | dev->stats.rx_length_errors++; |
| 319 | if ((status & RX_CRC_ERROR) && !(status & (RX_EXTRA_DATA | RX_RUNT))) |
| 320 | /* per str 172 */ |
| 321 | dev->stats.rx_crc_errors++; |
| 322 | if (status & RX_DRIBBLE) |
| 323 | dev->stats.rx_frame_errors++; |
| 324 | } |
| 325 | |
| 326 | /********************************* |
| 327 | * This page contains DMA routines |
| 328 | *********************************/ |
| 329 | |
| 330 | #if ALLOW_DMA |
| 331 | |
| 332 | #define dma_page_eq(ptr1, ptr2) ((long)(ptr1) >> 17 == (long)(ptr2) >> 17) |
| 333 | |
| 334 | static void |
| 335 | get_dma_channel(struct net_device *dev) |
| 336 | { |
| 337 | struct net_local *lp = netdev_priv(dev); |
| 338 | |
| 339 | if (lp->dma) { |
| 340 | dev->dma = lp->dma; |
| 341 | lp->isa_config |= ISA_RxDMA; |
| 342 | } else { |
| 343 | if ((lp->isa_config & ANY_ISA_DMA) == 0) |
| 344 | return; |
| 345 | dev->dma = lp->isa_config & DMA_NO_MASK; |
| 346 | if (lp->chip_type == CS8900) |
| 347 | dev->dma += 5; |
| 348 | if (dev->dma < 5 || dev->dma > 7) { |
| 349 | lp->isa_config &= ~ANY_ISA_DMA; |
| 350 | return; |
| 351 | } |
| 352 | } |
| 353 | } |
| 354 | |
| 355 | static void |
| 356 | write_dma(struct net_device *dev, int chip_type, int dma) |
| 357 | { |
| 358 | struct net_local *lp = netdev_priv(dev); |
| 359 | if ((lp->isa_config & ANY_ISA_DMA) == 0) |
| 360 | return; |
| 361 | if (chip_type == CS8900) |
| 362 | writereg(dev, PP_CS8900_ISADMA, dma - 5); |
| 363 | else |
| 364 | writereg(dev, PP_CS8920_ISADMA, dma); |
| 365 | } |
| 366 | |
| 367 | static void |
| 368 | set_dma_cfg(struct net_device *dev) |
| 369 | { |
| 370 | struct net_local *lp = netdev_priv(dev); |
| 371 | |
| 372 | if (lp->use_dma) { |
| 373 | if ((lp->isa_config & ANY_ISA_DMA) == 0) { |
| 374 | cs89_dbg(3, err, "set_dma_cfg(): no DMA\n"); |
| 375 | return; |
| 376 | } |
| 377 | if (lp->isa_config & ISA_RxDMA) { |
| 378 | lp->curr_rx_cfg |= RX_DMA_ONLY; |
| 379 | cs89_dbg(3, info, "set_dma_cfg(): RX_DMA_ONLY\n"); |
| 380 | } else { |
| 381 | lp->curr_rx_cfg |= AUTO_RX_DMA; /* not that we support it... */ |
| 382 | cs89_dbg(3, info, "set_dma_cfg(): AUTO_RX_DMA\n"); |
| 383 | } |
| 384 | } |
| 385 | } |
| 386 | |
| 387 | static int |
| 388 | dma_bufcfg(struct net_device *dev) |
| 389 | { |
| 390 | struct net_local *lp = netdev_priv(dev); |
| 391 | if (lp->use_dma) |
| 392 | return (lp->isa_config & ANY_ISA_DMA) ? RX_DMA_ENBL : 0; |
| 393 | else |
| 394 | return 0; |
| 395 | } |
| 396 | |
| 397 | static int |
| 398 | dma_busctl(struct net_device *dev) |
| 399 | { |
| 400 | int retval = 0; |
| 401 | struct net_local *lp = netdev_priv(dev); |
| 402 | if (lp->use_dma) { |
| 403 | if (lp->isa_config & ANY_ISA_DMA) |
| 404 | retval |= RESET_RX_DMA; /* Reset the DMA pointer */ |
| 405 | if (lp->isa_config & DMA_BURST) |
| 406 | retval |= DMA_BURST_MODE; /* Does ISA config specify DMA burst ? */ |
| 407 | if (lp->dmasize == 64) |
| 408 | retval |= RX_DMA_SIZE_64K; /* did they ask for 64K? */ |
| 409 | retval |= MEMORY_ON; /* we need memory enabled to use DMA. */ |
| 410 | } |
| 411 | return retval; |
| 412 | } |
| 413 | |
| 414 | static void |
| 415 | dma_rx(struct net_device *dev) |
| 416 | { |
| 417 | struct net_local *lp = netdev_priv(dev); |
| 418 | struct sk_buff *skb; |
| 419 | int status, length; |
| 420 | unsigned char *bp = lp->rx_dma_ptr; |
| 421 | |
| 422 | status = bp[0] + (bp[1] << 8); |
| 423 | length = bp[2] + (bp[3] << 8); |
| 424 | bp += 4; |
| 425 | |
| 426 | cs89_dbg(5, debug, "%s: receiving DMA packet at %lx, status %x, length %x\n", |
| 427 | dev->name, (unsigned long)bp, status, length); |
| 428 | |
| 429 | if ((status & RX_OK) == 0) { |
| 430 | count_rx_errors(status, dev); |
| 431 | goto skip_this_frame; |
| 432 | } |
| 433 | |
| 434 | /* Malloc up new buffer. */ |
| 435 | skb = netdev_alloc_skb(dev, length + 2); |
| 436 | if (skb == NULL) { |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 437 | dev->stats.rx_dropped++; |
| 438 | |
| 439 | /* AKPM: advance bp to the next frame */ |
| 440 | skip_this_frame: |
| 441 | bp += (length + 3) & ~3; |
| 442 | if (bp >= lp->end_dma_buff) |
| 443 | bp -= lp->dmasize * 1024; |
| 444 | lp->rx_dma_ptr = bp; |
| 445 | return; |
| 446 | } |
| 447 | skb_reserve(skb, 2); /* longword align L3 header */ |
| 448 | |
| 449 | if (bp + length > lp->end_dma_buff) { |
| 450 | int semi_cnt = lp->end_dma_buff - bp; |
| 451 | memcpy(skb_put(skb, semi_cnt), bp, semi_cnt); |
| 452 | memcpy(skb_put(skb, length - semi_cnt), lp->dma_buff, |
| 453 | length - semi_cnt); |
| 454 | } else { |
| 455 | memcpy(skb_put(skb, length), bp, length); |
| 456 | } |
| 457 | bp += (length + 3) & ~3; |
| 458 | if (bp >= lp->end_dma_buff) |
| 459 | bp -= lp->dmasize*1024; |
| 460 | lp->rx_dma_ptr = bp; |
| 461 | |
| 462 | cs89_dbg(3, info, "%s: received %d byte DMA packet of type %x\n", |
| 463 | dev->name, length, |
| 464 | ((skb->data[ETH_ALEN + ETH_ALEN] << 8) | |
| 465 | skb->data[ETH_ALEN + ETH_ALEN + 1])); |
| 466 | |
| 467 | skb->protocol = eth_type_trans(skb, dev); |
| 468 | netif_rx(skb); |
| 469 | dev->stats.rx_packets++; |
| 470 | dev->stats.rx_bytes += length; |
| 471 | } |
| 472 | |
| 473 | static void release_dma_buff(struct net_local *lp) |
| 474 | { |
| 475 | if (lp->dma_buff) { |
| 476 | free_pages((unsigned long)(lp->dma_buff), |
| 477 | get_order(lp->dmasize * 1024)); |
| 478 | lp->dma_buff = NULL; |
| 479 | } |
| 480 | } |
| 481 | |
| 482 | #endif /* ALLOW_DMA */ |
| 483 | |
| 484 | static void |
| 485 | control_dc_dc(struct net_device *dev, int on_not_off) |
| 486 | { |
| 487 | struct net_local *lp = netdev_priv(dev); |
| 488 | unsigned int selfcontrol; |
| 489 | int timenow = jiffies; |
| 490 | /* control the DC to DC convertor in the SelfControl register. |
| 491 | * Note: This is hooked up to a general purpose pin, might not |
| 492 | * always be a DC to DC convertor. |
| 493 | */ |
| 494 | |
| 495 | selfcontrol = HCB1_ENBL; /* Enable the HCB1 bit as an output */ |
| 496 | if (((lp->adapter_cnf & A_CNF_DC_DC_POLARITY) != 0) ^ on_not_off) |
| 497 | selfcontrol |= HCB1; |
| 498 | else |
| 499 | selfcontrol &= ~HCB1; |
| 500 | writereg(dev, PP_SelfCTL, selfcontrol); |
| 501 | |
| 502 | /* Wait for the DC/DC converter to power up - 500ms */ |
| 503 | while (jiffies - timenow < HZ) |
| 504 | ; |
| 505 | } |
| 506 | |
| 507 | /* send a test packet - return true if carrier bits are ok */ |
| 508 | static int |
| 509 | send_test_pkt(struct net_device *dev) |
| 510 | { |
| 511 | struct net_local *lp = netdev_priv(dev); |
| 512 | char test_packet[] = { |
| 513 | 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, |
| 514 | 0, 46, /* A 46 in network order */ |
| 515 | 0, 0, /* DSAP=0 & SSAP=0 fields */ |
| 516 | 0xf3, 0 /* Control (Test Req + P bit set) */ |
| 517 | }; |
| 518 | long timenow = jiffies; |
| 519 | |
| 520 | writereg(dev, PP_LineCTL, readreg(dev, PP_LineCTL) | SERIAL_TX_ON); |
| 521 | |
| 522 | memcpy(test_packet, dev->dev_addr, ETH_ALEN); |
| 523 | memcpy(test_packet + ETH_ALEN, dev->dev_addr, ETH_ALEN); |
| 524 | |
| 525 | iowrite16(TX_AFTER_ALL, lp->virt_addr + TX_CMD_PORT); |
| 526 | iowrite16(ETH_ZLEN, lp->virt_addr + TX_LEN_PORT); |
| 527 | |
| 528 | /* Test to see if the chip has allocated memory for the packet */ |
| 529 | while (jiffies - timenow < 5) |
| 530 | if (readreg(dev, PP_BusST) & READY_FOR_TX_NOW) |
| 531 | break; |
| 532 | if (jiffies - timenow >= 5) |
| 533 | return 0; /* this shouldn't happen */ |
| 534 | |
| 535 | /* Write the contents of the packet */ |
| 536 | writewords(lp, TX_FRAME_PORT, test_packet, (ETH_ZLEN + 1) >> 1); |
| 537 | |
| 538 | cs89_dbg(1, debug, "Sending test packet "); |
| 539 | /* wait a couple of jiffies for packet to be received */ |
| 540 | for (timenow = jiffies; jiffies - timenow < 3;) |
| 541 | ; |
| 542 | if ((readreg(dev, PP_TxEvent) & TX_SEND_OK_BITS) == TX_OK) { |
| 543 | cs89_dbg(1, cont, "succeeded\n"); |
| 544 | return 1; |
| 545 | } |
| 546 | cs89_dbg(1, cont, "failed\n"); |
| 547 | return 0; |
| 548 | } |
| 549 | |
| 550 | #define DETECTED_NONE 0 |
| 551 | #define DETECTED_RJ45H 1 |
| 552 | #define DETECTED_RJ45F 2 |
| 553 | #define DETECTED_AUI 3 |
| 554 | #define DETECTED_BNC 4 |
| 555 | |
| 556 | static int |
| 557 | detect_tp(struct net_device *dev) |
| 558 | { |
| 559 | struct net_local *lp = netdev_priv(dev); |
| 560 | int timenow = jiffies; |
| 561 | int fdx; |
| 562 | |
| 563 | cs89_dbg(1, debug, "%s: Attempting TP\n", dev->name); |
| 564 | |
| 565 | /* If connected to another full duplex capable 10-Base-T card |
| 566 | * the link pulses seem to be lost when the auto detect bit in |
| 567 | * the LineCTL is set. To overcome this the auto detect bit will |
| 568 | * be cleared whilst testing the 10-Base-T interface. This would |
| 569 | * not be necessary for the sparrow chip but is simpler to do it |
| 570 | * anyway. |
| 571 | */ |
| 572 | writereg(dev, PP_LineCTL, lp->linectl & ~AUI_ONLY); |
| 573 | control_dc_dc(dev, 0); |
| 574 | |
| 575 | /* Delay for the hardware to work out if the TP cable is present |
| 576 | * - 150ms |
| 577 | */ |
| 578 | for (timenow = jiffies; jiffies - timenow < 15;) |
| 579 | ; |
| 580 | if ((readreg(dev, PP_LineST) & LINK_OK) == 0) |
| 581 | return DETECTED_NONE; |
| 582 | |
| 583 | if (lp->chip_type == CS8900) { |
| 584 | switch (lp->force & 0xf0) { |
| 585 | #if 0 |
| 586 | case FORCE_AUTO: |
| 587 | pr_info("%s: cs8900 doesn't autonegotiate\n", |
| 588 | dev->name); |
| 589 | return DETECTED_NONE; |
| 590 | #endif |
| 591 | /* CS8900 doesn't support AUTO, change to HALF*/ |
| 592 | case FORCE_AUTO: |
| 593 | lp->force &= ~FORCE_AUTO; |
| 594 | lp->force |= FORCE_HALF; |
| 595 | break; |
| 596 | case FORCE_HALF: |
| 597 | break; |
| 598 | case FORCE_FULL: |
| 599 | writereg(dev, PP_TestCTL, |
| 600 | readreg(dev, PP_TestCTL) | FDX_8900); |
| 601 | break; |
| 602 | } |
| 603 | fdx = readreg(dev, PP_TestCTL) & FDX_8900; |
| 604 | } else { |
| 605 | switch (lp->force & 0xf0) { |
| 606 | case FORCE_AUTO: |
| 607 | lp->auto_neg_cnf = AUTO_NEG_ENABLE; |
| 608 | break; |
| 609 | case FORCE_HALF: |
| 610 | lp->auto_neg_cnf = 0; |
| 611 | break; |
| 612 | case FORCE_FULL: |
| 613 | lp->auto_neg_cnf = RE_NEG_NOW | ALLOW_FDX; |
| 614 | break; |
| 615 | } |
| 616 | |
| 617 | writereg(dev, PP_AutoNegCTL, lp->auto_neg_cnf & AUTO_NEG_MASK); |
| 618 | |
| 619 | if ((lp->auto_neg_cnf & AUTO_NEG_BITS) == AUTO_NEG_ENABLE) { |
| 620 | pr_info("%s: negotiating duplex...\n", dev->name); |
| 621 | while (readreg(dev, PP_AutoNegST) & AUTO_NEG_BUSY) { |
| 622 | if (jiffies - timenow > 4000) { |
| 623 | pr_err("**** Full / half duplex auto-negotiation timed out ****\n"); |
| 624 | break; |
| 625 | } |
| 626 | } |
| 627 | } |
| 628 | fdx = readreg(dev, PP_AutoNegST) & FDX_ACTIVE; |
| 629 | } |
| 630 | if (fdx) |
| 631 | return DETECTED_RJ45F; |
| 632 | else |
| 633 | return DETECTED_RJ45H; |
| 634 | } |
| 635 | |
| 636 | static int |
| 637 | detect_bnc(struct net_device *dev) |
| 638 | { |
| 639 | struct net_local *lp = netdev_priv(dev); |
| 640 | |
| 641 | cs89_dbg(1, debug, "%s: Attempting BNC\n", dev->name); |
| 642 | control_dc_dc(dev, 1); |
| 643 | |
| 644 | writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY); |
| 645 | |
| 646 | if (send_test_pkt(dev)) |
| 647 | return DETECTED_BNC; |
| 648 | else |
| 649 | return DETECTED_NONE; |
| 650 | } |
| 651 | |
| 652 | static int |
| 653 | detect_aui(struct net_device *dev) |
| 654 | { |
| 655 | struct net_local *lp = netdev_priv(dev); |
| 656 | |
| 657 | cs89_dbg(1, debug, "%s: Attempting AUI\n", dev->name); |
| 658 | control_dc_dc(dev, 0); |
| 659 | |
| 660 | writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY); |
| 661 | |
| 662 | if (send_test_pkt(dev)) |
| 663 | return DETECTED_AUI; |
| 664 | else |
| 665 | return DETECTED_NONE; |
| 666 | } |
| 667 | |
| 668 | /* We have a good packet(s), get it/them out of the buffers. */ |
| 669 | static void |
| 670 | net_rx(struct net_device *dev) |
| 671 | { |
| 672 | struct net_local *lp = netdev_priv(dev); |
| 673 | struct sk_buff *skb; |
| 674 | int status, length; |
| 675 | |
| 676 | status = ioread16(lp->virt_addr + RX_FRAME_PORT); |
| 677 | length = ioread16(lp->virt_addr + RX_FRAME_PORT); |
| 678 | |
| 679 | if ((status & RX_OK) == 0) { |
| 680 | count_rx_errors(status, dev); |
| 681 | return; |
| 682 | } |
| 683 | |
| 684 | /* Malloc up new buffer. */ |
| 685 | skb = netdev_alloc_skb(dev, length + 2); |
| 686 | if (skb == NULL) { |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 687 | dev->stats.rx_dropped++; |
| 688 | return; |
| 689 | } |
| 690 | skb_reserve(skb, 2); /* longword align L3 header */ |
| 691 | |
| 692 | readwords(lp, RX_FRAME_PORT, skb_put(skb, length), length >> 1); |
| 693 | if (length & 1) |
| 694 | skb->data[length-1] = ioread16(lp->virt_addr + RX_FRAME_PORT); |
| 695 | |
| 696 | cs89_dbg(3, debug, "%s: received %d byte packet of type %x\n", |
| 697 | dev->name, length, |
| 698 | (skb->data[ETH_ALEN + ETH_ALEN] << 8) | |
| 699 | skb->data[ETH_ALEN + ETH_ALEN + 1]); |
| 700 | |
| 701 | skb->protocol = eth_type_trans(skb, dev); |
| 702 | netif_rx(skb); |
| 703 | dev->stats.rx_packets++; |
| 704 | dev->stats.rx_bytes += length; |
| 705 | } |
| 706 | |
| 707 | /* The typical workload of the driver: |
| 708 | * Handle the network interface interrupts. |
| 709 | */ |
| 710 | |
| 711 | static irqreturn_t net_interrupt(int irq, void *dev_id) |
| 712 | { |
| 713 | struct net_device *dev = dev_id; |
| 714 | struct net_local *lp; |
| 715 | int status; |
| 716 | int handled = 0; |
| 717 | |
| 718 | lp = netdev_priv(dev); |
| 719 | |
| 720 | /* we MUST read all the events out of the ISQ, otherwise we'll never |
| 721 | * get interrupted again. As a consequence, we can't have any limit |
| 722 | * on the number of times we loop in the interrupt handler. The |
| 723 | * hardware guarantees that eventually we'll run out of events. Of |
| 724 | * course, if you're on a slow machine, and packets are arriving |
| 725 | * faster than you can read them off, you're screwed. Hasta la |
| 726 | * vista, baby! |
| 727 | */ |
| 728 | while ((status = ioread16(lp->virt_addr + ISQ_PORT))) { |
| 729 | cs89_dbg(4, debug, "%s: event=%04x\n", dev->name, status); |
| 730 | handled = 1; |
| 731 | switch (status & ISQ_EVENT_MASK) { |
| 732 | case ISQ_RECEIVER_EVENT: |
| 733 | /* Got a packet(s). */ |
| 734 | net_rx(dev); |
| 735 | break; |
| 736 | case ISQ_TRANSMITTER_EVENT: |
| 737 | dev->stats.tx_packets++; |
| 738 | netif_wake_queue(dev); /* Inform upper layers. */ |
| 739 | if ((status & (TX_OK | |
| 740 | TX_LOST_CRS | |
| 741 | TX_SQE_ERROR | |
| 742 | TX_LATE_COL | |
| 743 | TX_16_COL)) != TX_OK) { |
| 744 | if ((status & TX_OK) == 0) |
| 745 | dev->stats.tx_errors++; |
| 746 | if (status & TX_LOST_CRS) |
| 747 | dev->stats.tx_carrier_errors++; |
| 748 | if (status & TX_SQE_ERROR) |
| 749 | dev->stats.tx_heartbeat_errors++; |
| 750 | if (status & TX_LATE_COL) |
| 751 | dev->stats.tx_window_errors++; |
| 752 | if (status & TX_16_COL) |
| 753 | dev->stats.tx_aborted_errors++; |
| 754 | } |
| 755 | break; |
| 756 | case ISQ_BUFFER_EVENT: |
| 757 | if (status & READY_FOR_TX) { |
| 758 | /* we tried to transmit a packet earlier, |
| 759 | * but inexplicably ran out of buffers. |
| 760 | * That shouldn't happen since we only ever |
| 761 | * load one packet. Shrug. Do the right |
| 762 | * thing anyway. |
| 763 | */ |
| 764 | netif_wake_queue(dev); /* Inform upper layers. */ |
| 765 | } |
| 766 | if (status & TX_UNDERRUN) { |
| 767 | cs89_dbg(0, err, "%s: transmit underrun\n", |
| 768 | dev->name); |
| 769 | lp->send_underrun++; |
| 770 | if (lp->send_underrun == 3) |
| 771 | lp->send_cmd = TX_AFTER_381; |
| 772 | else if (lp->send_underrun == 6) |
| 773 | lp->send_cmd = TX_AFTER_ALL; |
| 774 | /* transmit cycle is done, although |
| 775 | * frame wasn't transmitted - this |
| 776 | * avoids having to wait for the upper |
| 777 | * layers to timeout on us, in the |
| 778 | * event of a tx underrun |
| 779 | */ |
| 780 | netif_wake_queue(dev); /* Inform upper layers. */ |
| 781 | } |
| 782 | #if ALLOW_DMA |
| 783 | if (lp->use_dma && (status & RX_DMA)) { |
| 784 | int count = readreg(dev, PP_DmaFrameCnt); |
| 785 | while (count) { |
| 786 | cs89_dbg(5, debug, |
| 787 | "%s: receiving %d DMA frames\n", |
| 788 | dev->name, count); |
| 789 | if (count > 1) |
| 790 | cs89_dbg(2, debug, |
| 791 | "%s: receiving %d DMA frames\n", |
| 792 | dev->name, count); |
| 793 | dma_rx(dev); |
| 794 | if (--count == 0) |
| 795 | count = readreg(dev, PP_DmaFrameCnt); |
| 796 | if (count > 0) |
| 797 | cs89_dbg(2, debug, |
| 798 | "%s: continuing with %d DMA frames\n", |
| 799 | dev->name, count); |
| 800 | } |
| 801 | } |
| 802 | #endif |
| 803 | break; |
| 804 | case ISQ_RX_MISS_EVENT: |
| 805 | dev->stats.rx_missed_errors += (status >> 6); |
| 806 | break; |
| 807 | case ISQ_TX_COL_EVENT: |
| 808 | dev->stats.collisions += (status >> 6); |
| 809 | break; |
| 810 | } |
| 811 | } |
| 812 | return IRQ_RETVAL(handled); |
| 813 | } |
| 814 | |
| 815 | /* Open/initialize the board. This is called (in the current kernel) |
| 816 | sometime after booting when the 'ifconfig' program is run. |
| 817 | |
| 818 | This routine should set everything up anew at each open, even |
| 819 | registers that "should" only need to be set once at boot, so that |
| 820 | there is non-reboot way to recover if something goes wrong. |
| 821 | */ |
| 822 | |
| 823 | /* AKPM: do we need to do any locking here? */ |
| 824 | |
| 825 | static int |
| 826 | net_open(struct net_device *dev) |
| 827 | { |
| 828 | struct net_local *lp = netdev_priv(dev); |
| 829 | int result = 0; |
| 830 | int i; |
| 831 | int ret; |
| 832 | |
| 833 | if (dev->irq < 2) { |
| 834 | /* Allow interrupts to be generated by the chip */ |
| 835 | /* Cirrus' release had this: */ |
| 836 | #if 0 |
| 837 | writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL) | ENABLE_IRQ); |
| 838 | #endif |
| 839 | /* And 2.3.47 had this: */ |
| 840 | writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON); |
| 841 | |
| 842 | for (i = 2; i < CS8920_NO_INTS; i++) { |
| 843 | if ((1 << i) & lp->irq_map) { |
| 844 | if (request_irq(i, net_interrupt, 0, dev->name, |
| 845 | dev) == 0) { |
| 846 | dev->irq = i; |
| 847 | write_irq(dev, lp->chip_type, i); |
| 848 | /* writereg(dev, PP_BufCFG, GENERATE_SW_INTERRUPT); */ |
| 849 | break; |
| 850 | } |
| 851 | } |
| 852 | } |
| 853 | |
| 854 | if (i >= CS8920_NO_INTS) { |
| 855 | writereg(dev, PP_BusCTL, 0); /* disable interrupts. */ |
| 856 | pr_err("can't get an interrupt\n"); |
| 857 | ret = -EAGAIN; |
| 858 | goto bad_out; |
| 859 | } |
| 860 | } else { |
Paul Bolle | c23343c | 2013-03-29 00:51:30 +0000 | [diff] [blame^] | 861 | #if !defined(CONFIG_CS89x0_PLATFORM) |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 862 | if (((1 << dev->irq) & lp->irq_map) == 0) { |
| 863 | pr_err("%s: IRQ %d is not in our map of allowable IRQs, which is %x\n", |
| 864 | dev->name, dev->irq, lp->irq_map); |
| 865 | ret = -EAGAIN; |
| 866 | goto bad_out; |
| 867 | } |
| 868 | #endif |
| 869 | /* FIXME: Cirrus' release had this: */ |
| 870 | writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL)|ENABLE_IRQ); |
| 871 | /* And 2.3.47 had this: */ |
| 872 | #if 0 |
| 873 | writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON); |
| 874 | #endif |
| 875 | write_irq(dev, lp->chip_type, dev->irq); |
| 876 | ret = request_irq(dev->irq, net_interrupt, 0, dev->name, dev); |
| 877 | if (ret) { |
| 878 | pr_err("request_irq(%d) failed\n", dev->irq); |
| 879 | goto bad_out; |
| 880 | } |
| 881 | } |
| 882 | |
| 883 | #if ALLOW_DMA |
| 884 | if (lp->use_dma && (lp->isa_config & ANY_ISA_DMA)) { |
| 885 | unsigned long flags; |
| 886 | lp->dma_buff = (unsigned char *)__get_dma_pages(GFP_KERNEL, |
| 887 | get_order(lp->dmasize * 1024)); |
| 888 | if (!lp->dma_buff) { |
| 889 | pr_err("%s: cannot get %dK memory for DMA\n", |
| 890 | dev->name, lp->dmasize); |
| 891 | goto release_irq; |
| 892 | } |
| 893 | cs89_dbg(1, debug, "%s: dma %lx %lx\n", |
| 894 | dev->name, |
| 895 | (unsigned long)lp->dma_buff, |
| 896 | (unsigned long)isa_virt_to_bus(lp->dma_buff)); |
| 897 | if ((unsigned long)lp->dma_buff >= MAX_DMA_ADDRESS || |
| 898 | !dma_page_eq(lp->dma_buff, |
| 899 | lp->dma_buff + lp->dmasize * 1024 - 1)) { |
| 900 | pr_err("%s: not usable as DMA buffer\n", dev->name); |
| 901 | goto release_irq; |
| 902 | } |
| 903 | memset(lp->dma_buff, 0, lp->dmasize * 1024); /* Why? */ |
| 904 | if (request_dma(dev->dma, dev->name)) { |
| 905 | pr_err("%s: cannot get dma channel %d\n", |
| 906 | dev->name, dev->dma); |
| 907 | goto release_irq; |
| 908 | } |
| 909 | write_dma(dev, lp->chip_type, dev->dma); |
| 910 | lp->rx_dma_ptr = lp->dma_buff; |
| 911 | lp->end_dma_buff = lp->dma_buff + lp->dmasize * 1024; |
| 912 | spin_lock_irqsave(&lp->lock, flags); |
| 913 | disable_dma(dev->dma); |
| 914 | clear_dma_ff(dev->dma); |
| 915 | set_dma_mode(dev->dma, DMA_RX_MODE); /* auto_init as well */ |
| 916 | set_dma_addr(dev->dma, isa_virt_to_bus(lp->dma_buff)); |
| 917 | set_dma_count(dev->dma, lp->dmasize * 1024); |
| 918 | enable_dma(dev->dma); |
| 919 | spin_unlock_irqrestore(&lp->lock, flags); |
| 920 | } |
| 921 | #endif /* ALLOW_DMA */ |
| 922 | |
| 923 | /* set the Ethernet address */ |
| 924 | for (i = 0; i < ETH_ALEN / 2; i++) |
| 925 | writereg(dev, PP_IA + i * 2, |
| 926 | (dev->dev_addr[i * 2] | |
| 927 | (dev->dev_addr[i * 2 + 1] << 8))); |
| 928 | |
| 929 | /* while we're testing the interface, leave interrupts disabled */ |
| 930 | writereg(dev, PP_BusCTL, MEMORY_ON); |
| 931 | |
| 932 | /* Set the LineCTL quintuplet based on adapter configuration read from EEPROM */ |
| 933 | if ((lp->adapter_cnf & A_CNF_EXTND_10B_2) && |
| 934 | (lp->adapter_cnf & A_CNF_LOW_RX_SQUELCH)) |
| 935 | lp->linectl = LOW_RX_SQUELCH; |
| 936 | else |
| 937 | lp->linectl = 0; |
| 938 | |
| 939 | /* check to make sure that they have the "right" hardware available */ |
| 940 | switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) { |
| 941 | case A_CNF_MEDIA_10B_T: |
| 942 | result = lp->adapter_cnf & A_CNF_10B_T; |
| 943 | break; |
| 944 | case A_CNF_MEDIA_AUI: |
| 945 | result = lp->adapter_cnf & A_CNF_AUI; |
| 946 | break; |
| 947 | case A_CNF_MEDIA_10B_2: |
| 948 | result = lp->adapter_cnf & A_CNF_10B_2; |
| 949 | break; |
| 950 | default: |
| 951 | result = lp->adapter_cnf & (A_CNF_10B_T | |
| 952 | A_CNF_AUI | |
| 953 | A_CNF_10B_2); |
| 954 | } |
| 955 | if (!result) { |
| 956 | pr_err("%s: EEPROM is configured for unavailable media\n", |
| 957 | dev->name); |
| 958 | release_dma: |
| 959 | #if ALLOW_DMA |
| 960 | free_dma(dev->dma); |
| 961 | release_irq: |
| 962 | release_dma_buff(lp); |
| 963 | #endif |
| 964 | writereg(dev, PP_LineCTL, |
| 965 | readreg(dev, PP_LineCTL) & ~(SERIAL_TX_ON | SERIAL_RX_ON)); |
| 966 | free_irq(dev->irq, dev); |
| 967 | ret = -EAGAIN; |
| 968 | goto bad_out; |
| 969 | } |
| 970 | |
| 971 | /* set the hardware to the configured choice */ |
| 972 | switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) { |
| 973 | case A_CNF_MEDIA_10B_T: |
| 974 | result = detect_tp(dev); |
| 975 | if (result == DETECTED_NONE) { |
| 976 | pr_warn("%s: 10Base-T (RJ-45) has no cable\n", |
| 977 | dev->name); |
| 978 | if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ |
| 979 | result = DETECTED_RJ45H; /* Yes! I don't care if I see a link pulse */ |
| 980 | } |
| 981 | break; |
| 982 | case A_CNF_MEDIA_AUI: |
| 983 | result = detect_aui(dev); |
| 984 | if (result == DETECTED_NONE) { |
| 985 | pr_warn("%s: 10Base-5 (AUI) has no cable\n", dev->name); |
| 986 | if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ |
| 987 | result = DETECTED_AUI; /* Yes! I don't care if I see a carrrier */ |
| 988 | } |
| 989 | break; |
| 990 | case A_CNF_MEDIA_10B_2: |
| 991 | result = detect_bnc(dev); |
| 992 | if (result == DETECTED_NONE) { |
| 993 | pr_warn("%s: 10Base-2 (BNC) has no cable\n", dev->name); |
| 994 | if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ |
| 995 | result = DETECTED_BNC; /* Yes! I don't care if I can xmit a packet */ |
| 996 | } |
| 997 | break; |
| 998 | case A_CNF_MEDIA_AUTO: |
| 999 | writereg(dev, PP_LineCTL, lp->linectl | AUTO_AUI_10BASET); |
| 1000 | if (lp->adapter_cnf & A_CNF_10B_T) { |
| 1001 | result = detect_tp(dev); |
| 1002 | if (result != DETECTED_NONE) |
| 1003 | break; |
| 1004 | } |
| 1005 | if (lp->adapter_cnf & A_CNF_AUI) { |
| 1006 | result = detect_aui(dev); |
| 1007 | if (result != DETECTED_NONE) |
| 1008 | break; |
| 1009 | } |
| 1010 | if (lp->adapter_cnf & A_CNF_10B_2) { |
| 1011 | result = detect_bnc(dev); |
| 1012 | if (result != DETECTED_NONE) |
| 1013 | break; |
| 1014 | } |
| 1015 | pr_err("%s: no media detected\n", dev->name); |
| 1016 | goto release_dma; |
| 1017 | } |
| 1018 | switch (result) { |
| 1019 | case DETECTED_NONE: |
| 1020 | pr_err("%s: no network cable attached to configured media\n", |
| 1021 | dev->name); |
| 1022 | goto release_dma; |
| 1023 | case DETECTED_RJ45H: |
| 1024 | pr_info("%s: using half-duplex 10Base-T (RJ-45)\n", dev->name); |
| 1025 | break; |
| 1026 | case DETECTED_RJ45F: |
| 1027 | pr_info("%s: using full-duplex 10Base-T (RJ-45)\n", dev->name); |
| 1028 | break; |
| 1029 | case DETECTED_AUI: |
| 1030 | pr_info("%s: using 10Base-5 (AUI)\n", dev->name); |
| 1031 | break; |
| 1032 | case DETECTED_BNC: |
| 1033 | pr_info("%s: using 10Base-2 (BNC)\n", dev->name); |
| 1034 | break; |
| 1035 | } |
| 1036 | |
| 1037 | /* Turn on both receive and transmit operations */ |
| 1038 | writereg(dev, PP_LineCTL, |
| 1039 | readreg(dev, PP_LineCTL) | SERIAL_RX_ON | SERIAL_TX_ON); |
| 1040 | |
| 1041 | /* Receive only error free packets addressed to this card */ |
| 1042 | lp->rx_mode = 0; |
| 1043 | writereg(dev, PP_RxCTL, DEF_RX_ACCEPT); |
| 1044 | |
| 1045 | lp->curr_rx_cfg = RX_OK_ENBL | RX_CRC_ERROR_ENBL; |
| 1046 | |
| 1047 | if (lp->isa_config & STREAM_TRANSFER) |
| 1048 | lp->curr_rx_cfg |= RX_STREAM_ENBL; |
| 1049 | #if ALLOW_DMA |
| 1050 | set_dma_cfg(dev); |
| 1051 | #endif |
| 1052 | writereg(dev, PP_RxCFG, lp->curr_rx_cfg); |
| 1053 | |
| 1054 | writereg(dev, PP_TxCFG, (TX_LOST_CRS_ENBL | |
| 1055 | TX_SQE_ERROR_ENBL | |
| 1056 | TX_OK_ENBL | |
| 1057 | TX_LATE_COL_ENBL | |
| 1058 | TX_JBR_ENBL | |
| 1059 | TX_ANY_COL_ENBL | |
| 1060 | TX_16_COL_ENBL)); |
| 1061 | |
| 1062 | writereg(dev, PP_BufCFG, (READY_FOR_TX_ENBL | |
| 1063 | RX_MISS_COUNT_OVRFLOW_ENBL | |
| 1064 | #if ALLOW_DMA |
| 1065 | dma_bufcfg(dev) | |
| 1066 | #endif |
| 1067 | TX_COL_COUNT_OVRFLOW_ENBL | |
| 1068 | TX_UNDERRUN_ENBL)); |
| 1069 | |
| 1070 | /* now that we've got our act together, enable everything */ |
| 1071 | writereg(dev, PP_BusCTL, (ENABLE_IRQ |
| 1072 | | (dev->mem_start ? MEMORY_ON : 0) /* turn memory on */ |
| 1073 | #if ALLOW_DMA |
| 1074 | | dma_busctl(dev) |
| 1075 | #endif |
| 1076 | )); |
| 1077 | netif_start_queue(dev); |
| 1078 | cs89_dbg(1, debug, "net_open() succeeded\n"); |
| 1079 | return 0; |
| 1080 | bad_out: |
| 1081 | return ret; |
| 1082 | } |
| 1083 | |
| 1084 | /* The inverse routine to net_open(). */ |
| 1085 | static int |
| 1086 | net_close(struct net_device *dev) |
| 1087 | { |
| 1088 | #if ALLOW_DMA |
| 1089 | struct net_local *lp = netdev_priv(dev); |
| 1090 | #endif |
| 1091 | |
| 1092 | netif_stop_queue(dev); |
| 1093 | |
| 1094 | writereg(dev, PP_RxCFG, 0); |
| 1095 | writereg(dev, PP_TxCFG, 0); |
| 1096 | writereg(dev, PP_BufCFG, 0); |
| 1097 | writereg(dev, PP_BusCTL, 0); |
| 1098 | |
| 1099 | free_irq(dev->irq, dev); |
| 1100 | |
| 1101 | #if ALLOW_DMA |
| 1102 | if (lp->use_dma && lp->dma) { |
| 1103 | free_dma(dev->dma); |
| 1104 | release_dma_buff(lp); |
| 1105 | } |
| 1106 | #endif |
| 1107 | |
| 1108 | /* Update the statistics here. */ |
| 1109 | return 0; |
| 1110 | } |
| 1111 | |
| 1112 | /* Get the current statistics. |
| 1113 | * This may be called with the card open or closed. |
| 1114 | */ |
| 1115 | static struct net_device_stats * |
| 1116 | net_get_stats(struct net_device *dev) |
| 1117 | { |
| 1118 | struct net_local *lp = netdev_priv(dev); |
| 1119 | unsigned long flags; |
| 1120 | |
| 1121 | spin_lock_irqsave(&lp->lock, flags); |
| 1122 | /* Update the statistics from the device registers. */ |
| 1123 | dev->stats.rx_missed_errors += (readreg(dev, PP_RxMiss) >> 6); |
| 1124 | dev->stats.collisions += (readreg(dev, PP_TxCol) >> 6); |
| 1125 | spin_unlock_irqrestore(&lp->lock, flags); |
| 1126 | |
| 1127 | return &dev->stats; |
| 1128 | } |
| 1129 | |
| 1130 | static void net_timeout(struct net_device *dev) |
| 1131 | { |
| 1132 | /* If we get here, some higher level has decided we are broken. |
| 1133 | There should really be a "kick me" function call instead. */ |
| 1134 | cs89_dbg(0, err, "%s: transmit timed out, %s?\n", |
| 1135 | dev->name, |
| 1136 | tx_done(dev) ? "IRQ conflict" : "network cable problem"); |
| 1137 | /* Try to restart the adaptor. */ |
| 1138 | netif_wake_queue(dev); |
| 1139 | } |
| 1140 | |
| 1141 | static netdev_tx_t net_send_packet(struct sk_buff *skb, struct net_device *dev) |
| 1142 | { |
| 1143 | struct net_local *lp = netdev_priv(dev); |
| 1144 | unsigned long flags; |
| 1145 | |
| 1146 | cs89_dbg(3, debug, "%s: sent %d byte packet of type %x\n", |
| 1147 | dev->name, skb->len, |
| 1148 | ((skb->data[ETH_ALEN + ETH_ALEN] << 8) | |
| 1149 | skb->data[ETH_ALEN + ETH_ALEN + 1])); |
| 1150 | |
| 1151 | /* keep the upload from being interrupted, since we |
| 1152 | * ask the chip to start transmitting before the |
| 1153 | * whole packet has been completely uploaded. |
| 1154 | */ |
| 1155 | |
| 1156 | spin_lock_irqsave(&lp->lock, flags); |
| 1157 | netif_stop_queue(dev); |
| 1158 | |
| 1159 | /* initiate a transmit sequence */ |
| 1160 | iowrite16(lp->send_cmd, lp->virt_addr + TX_CMD_PORT); |
| 1161 | iowrite16(skb->len, lp->virt_addr + TX_LEN_PORT); |
| 1162 | |
| 1163 | /* Test to see if the chip has allocated memory for the packet */ |
| 1164 | if ((readreg(dev, PP_BusST) & READY_FOR_TX_NOW) == 0) { |
| 1165 | /* Gasp! It hasn't. But that shouldn't happen since |
| 1166 | * we're waiting for TxOk, so return 1 and requeue this packet. |
| 1167 | */ |
| 1168 | |
| 1169 | spin_unlock_irqrestore(&lp->lock, flags); |
| 1170 | cs89_dbg(0, err, "Tx buffer not free!\n"); |
| 1171 | return NETDEV_TX_BUSY; |
| 1172 | } |
| 1173 | /* Write the contents of the packet */ |
| 1174 | writewords(lp, TX_FRAME_PORT, skb->data, (skb->len + 1) >> 1); |
| 1175 | spin_unlock_irqrestore(&lp->lock, flags); |
| 1176 | dev->stats.tx_bytes += skb->len; |
| 1177 | dev_kfree_skb(skb); |
| 1178 | |
| 1179 | /* We DO NOT call netif_wake_queue() here. |
| 1180 | * We also DO NOT call netif_start_queue(). |
| 1181 | * |
| 1182 | * Either of these would cause another bottom half run through |
| 1183 | * net_send_packet() before this packet has fully gone out. |
| 1184 | * That causes us to hit the "Gasp!" above and the send is rescheduled. |
| 1185 | * it runs like a dog. We just return and wait for the Tx completion |
| 1186 | * interrupt handler to restart the netdevice layer |
| 1187 | */ |
| 1188 | |
| 1189 | return NETDEV_TX_OK; |
| 1190 | } |
| 1191 | |
| 1192 | static void set_multicast_list(struct net_device *dev) |
| 1193 | { |
| 1194 | struct net_local *lp = netdev_priv(dev); |
| 1195 | unsigned long flags; |
Jaccon Bastiaansen | b72c200 | 2012-08-27 11:53:51 +0000 | [diff] [blame] | 1196 | u16 cfg; |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1197 | |
| 1198 | spin_lock_irqsave(&lp->lock, flags); |
| 1199 | if (dev->flags & IFF_PROMISC) |
| 1200 | lp->rx_mode = RX_ALL_ACCEPT; |
| 1201 | else if ((dev->flags & IFF_ALLMULTI) || !netdev_mc_empty(dev)) |
| 1202 | /* The multicast-accept list is initialized to accept-all, |
| 1203 | * and we rely on higher-level filtering for now. |
| 1204 | */ |
| 1205 | lp->rx_mode = RX_MULTCAST_ACCEPT; |
| 1206 | else |
| 1207 | lp->rx_mode = 0; |
| 1208 | |
| 1209 | writereg(dev, PP_RxCTL, DEF_RX_ACCEPT | lp->rx_mode); |
| 1210 | |
| 1211 | /* in promiscuous mode, we accept errored packets, |
| 1212 | * so we have to enable interrupts on them also |
| 1213 | */ |
Jaccon Bastiaansen | b72c200 | 2012-08-27 11:53:51 +0000 | [diff] [blame] | 1214 | cfg = lp->curr_rx_cfg; |
| 1215 | if (lp->rx_mode == RX_ALL_ACCEPT) |
| 1216 | cfg |= RX_CRC_ERROR_ENBL | RX_RUNT_ENBL | RX_EXTRA_DATA_ENBL; |
| 1217 | writereg(dev, PP_RxCFG, cfg); |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1218 | spin_unlock_irqrestore(&lp->lock, flags); |
| 1219 | } |
| 1220 | |
| 1221 | static int set_mac_address(struct net_device *dev, void *p) |
| 1222 | { |
| 1223 | int i; |
| 1224 | struct sockaddr *addr = p; |
| 1225 | |
| 1226 | if (netif_running(dev)) |
| 1227 | return -EBUSY; |
| 1228 | |
| 1229 | memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); |
| 1230 | |
| 1231 | cs89_dbg(0, debug, "%s: Setting MAC address to %pM\n", |
| 1232 | dev->name, dev->dev_addr); |
| 1233 | |
| 1234 | /* set the Ethernet address */ |
| 1235 | for (i = 0; i < ETH_ALEN / 2; i++) |
| 1236 | writereg(dev, PP_IA + i * 2, |
| 1237 | (dev->dev_addr[i * 2] | |
| 1238 | (dev->dev_addr[i * 2 + 1] << 8))); |
| 1239 | |
| 1240 | return 0; |
| 1241 | } |
| 1242 | |
Deepak Saxena | 6f51916 | 2005-09-09 13:02:07 -0700 | [diff] [blame] | 1243 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 1244 | /* |
| 1245 | * Polling receive - used by netconsole and other diagnostic tools |
| 1246 | * to allow network i/o with interrupts disabled. |
| 1247 | */ |
| 1248 | static void net_poll_controller(struct net_device *dev) |
| 1249 | { |
| 1250 | disable_irq(dev->irq); |
David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1251 | net_interrupt(dev->irq, dev); |
Deepak Saxena | 6f51916 | 2005-09-09 13:02:07 -0700 | [diff] [blame] | 1252 | enable_irq(dev->irq); |
| 1253 | } |
| 1254 | #endif |
| 1255 | |
Stephen Hemminger | 15d23e7 | 2009-03-26 15:11:43 +0000 | [diff] [blame] | 1256 | static const struct net_device_ops net_ops = { |
| 1257 | .ndo_open = net_open, |
| 1258 | .ndo_stop = net_close, |
| 1259 | .ndo_tx_timeout = net_timeout, |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1260 | .ndo_start_xmit = net_send_packet, |
Stephen Hemminger | 15d23e7 | 2009-03-26 15:11:43 +0000 | [diff] [blame] | 1261 | .ndo_get_stats = net_get_stats, |
Jiri Pirko | afc4b13 | 2011-08-16 06:29:01 +0000 | [diff] [blame] | 1262 | .ndo_set_rx_mode = set_multicast_list, |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1263 | .ndo_set_mac_address = set_mac_address, |
Stephen Hemminger | 15d23e7 | 2009-03-26 15:11:43 +0000 | [diff] [blame] | 1264 | #ifdef CONFIG_NET_POLL_CONTROLLER |
| 1265 | .ndo_poll_controller = net_poll_controller, |
| 1266 | #endif |
| 1267 | .ndo_change_mtu = eth_change_mtu, |
| 1268 | .ndo_validate_addr = eth_validate_addr, |
| 1269 | }; |
| 1270 | |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1271 | static void __init reset_chip(struct net_device *dev) |
| 1272 | { |
| 1273 | #if !defined(CONFIG_MACH_MX31ADS) |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1274 | struct net_local *lp = netdev_priv(dev); |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1275 | int reset_start_time; |
| 1276 | |
| 1277 | writereg(dev, PP_SelfCTL, readreg(dev, PP_SelfCTL) | POWER_ON_RESET); |
| 1278 | |
| 1279 | /* wait 30 ms */ |
| 1280 | msleep(30); |
| 1281 | |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1282 | if (lp->chip_type != CS8900) { |
| 1283 | /* Hardware problem requires PNP registers to be reconfigured after a reset */ |
| 1284 | iowrite16(PP_CS8920_ISAINT, lp->virt_addr + ADD_PORT); |
| 1285 | iowrite8(dev->irq, lp->virt_addr + DATA_PORT); |
| 1286 | iowrite8(0, lp->virt_addr + DATA_PORT + 1); |
| 1287 | |
| 1288 | iowrite16(PP_CS8920_ISAMemB, lp->virt_addr + ADD_PORT); |
| 1289 | iowrite8((dev->mem_start >> 16) & 0xff, |
| 1290 | lp->virt_addr + DATA_PORT); |
| 1291 | iowrite8((dev->mem_start >> 8) & 0xff, |
| 1292 | lp->virt_addr + DATA_PORT + 1); |
| 1293 | } |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1294 | |
| 1295 | /* Wait until the chip is reset */ |
| 1296 | reset_start_time = jiffies; |
| 1297 | while ((readreg(dev, PP_SelfST) & INIT_DONE) == 0 && |
| 1298 | jiffies - reset_start_time < 2) |
| 1299 | ; |
| 1300 | #endif /* !CONFIG_MACH_MX31ADS */ |
| 1301 | } |
| 1302 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1303 | /* This is the real probe routine. |
| 1304 | * Linux has a history of friendly device probes on the ISA bus. |
| 1305 | * A good device probes avoids doing writes, and |
| 1306 | * verifies that the correct device exists and functions. |
| 1307 | * Return 0 on success. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1308 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1309 | static int __init |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1310 | cs89x0_probe1(struct net_device *dev, void __iomem *ioaddr, int modular) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1311 | { |
| 1312 | struct net_local *lp = netdev_priv(dev); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1313 | int i; |
Denis Vlasenko | 01bdc03 | 2005-07-31 22:34:50 -0700 | [diff] [blame] | 1314 | int tmp; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1315 | unsigned rev_type = 0; |
| 1316 | int eeprom_buff[CHKSUM_LEN]; |
| 1317 | int retval; |
| 1318 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1319 | /* Initialize the device structure. */ |
| 1320 | if (!modular) { |
| 1321 | memset(lp, 0, sizeof(*lp)); |
| 1322 | spin_lock_init(&lp->lock); |
| 1323 | #ifndef MODULE |
| 1324 | #if ALLOW_DMA |
| 1325 | if (g_cs89x0_dma) { |
| 1326 | lp->use_dma = 1; |
| 1327 | lp->dma = g_cs89x0_dma; |
| 1328 | lp->dmasize = 16; /* Could make this an option... */ |
| 1329 | } |
| 1330 | #endif |
| 1331 | lp->force = g_cs89x0_media__force; |
| 1332 | #endif |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1333 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1334 | |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1335 | pr_debug("PP_addr at %p[%x]: 0x%x\n", |
| 1336 | ioaddr, ADD_PORT, ioread16(ioaddr + ADD_PORT)); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1337 | iowrite16(PP_ChipID, ioaddr + ADD_PORT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1338 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1339 | tmp = ioread16(ioaddr + DATA_PORT); |
Denis Vlasenko | 01bdc03 | 2005-07-31 22:34:50 -0700 | [diff] [blame] | 1340 | if (tmp != CHIP_EISA_ID_SIG) { |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1341 | pr_debug("%s: incorrect signature at %p[%x]: 0x%x!=" |
| 1342 | CHIP_EISA_ID_SIG_STR "\n", |
| 1343 | dev->name, ioaddr, DATA_PORT, tmp); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1344 | retval = -ENODEV; |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1345 | goto out1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1346 | } |
| 1347 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1348 | lp->virt_addr = ioaddr; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1349 | |
| 1350 | /* get the chip type */ |
| 1351 | rev_type = readreg(dev, PRODUCT_ID_ADD); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1352 | lp->chip_type = rev_type & ~REVISON_BITS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1353 | lp->chip_revision = ((rev_type & REVISON_BITS) >> 8) + 'A'; |
| 1354 | |
Joe Perches | 6fba180 | 2012-05-18 12:56:31 +0000 | [diff] [blame] | 1355 | /* Check the chip type and revision in order to set the correct |
| 1356 | * send command. CS8920 revision C and CS8900 revision F can use |
| 1357 | * the faster send. |
| 1358 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1359 | lp->send_cmd = TX_AFTER_381; |
| 1360 | if (lp->chip_type == CS8900 && lp->chip_revision >= 'F') |
| 1361 | lp->send_cmd = TX_NOW; |
| 1362 | if (lp->chip_type != CS8900 && lp->chip_revision >= 'C') |
| 1363 | lp->send_cmd = TX_NOW; |
| 1364 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1365 | pr_info_once("%s\n", version); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1366 | |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1367 | pr_info("%s: cs89%c0%s rev %c found at %p ", |
| 1368 | dev->name, |
| 1369 | lp->chip_type == CS8900 ? '0' : '2', |
| 1370 | lp->chip_type == CS8920M ? "M" : "", |
| 1371 | lp->chip_revision, |
| 1372 | lp->virt_addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1373 | |
| 1374 | reset_chip(dev); |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1375 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1376 | /* Here we read the current configuration of the chip. |
| 1377 | * If there is no Extended EEPROM then the idea is to not disturb |
| 1378 | * the chip configuration, it should have been correctly setup by |
| 1379 | * automatic EEPROM read on reset. So, if the chip says it read |
| 1380 | * the EEPROM the driver will always do *something* instead of |
| 1381 | * complain that adapter_cnf is 0. |
| 1382 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1383 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1384 | if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) == |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1385 | (EEPROM_OK | EEPROM_PRESENT)) { |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1386 | /* Load the MAC. */ |
| 1387 | for (i = 0; i < ETH_ALEN / 2; i++) { |
| 1388 | unsigned int Addr; |
| 1389 | Addr = readreg(dev, PP_IA + i * 2); |
| 1390 | dev->dev_addr[i * 2] = Addr & 0xFF; |
| 1391 | dev->dev_addr[i * 2 + 1] = Addr >> 8; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1392 | } |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1393 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1394 | /* Load the Adapter Configuration. |
| 1395 | * Note: Barring any more specific information from some |
| 1396 | * other source (ie EEPROM+Schematics), we would not know |
| 1397 | * how to operate a 10Base2 interface on the AUI port. |
| 1398 | * However, since we do read the status of HCB1 and use |
| 1399 | * settings that always result in calls to control_dc_dc(dev,0) |
| 1400 | * a BNC interface should work if the enable pin |
| 1401 | * (dc/dc converter) is on HCB1. |
| 1402 | * It will be called AUI however. |
| 1403 | */ |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1404 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1405 | lp->adapter_cnf = 0; |
| 1406 | i = readreg(dev, PP_LineCTL); |
| 1407 | /* Preserve the setting of the HCB1 pin. */ |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1408 | if ((i & (HCB1 | HCB1_ENBL)) == (HCB1 | HCB1_ENBL)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1409 | lp->adapter_cnf |= A_CNF_DC_DC_POLARITY; |
| 1410 | /* Save the sqelch bit */ |
| 1411 | if ((i & LOW_RX_SQUELCH) == LOW_RX_SQUELCH) |
| 1412 | lp->adapter_cnf |= A_CNF_EXTND_10B_2 | A_CNF_LOW_RX_SQUELCH; |
| 1413 | /* Check if the card is in 10Base-t only mode */ |
| 1414 | if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == 0) |
| 1415 | lp->adapter_cnf |= A_CNF_10B_T | A_CNF_MEDIA_10B_T; |
| 1416 | /* Check if the card is in AUI only mode */ |
| 1417 | if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUI_ONLY) |
| 1418 | lp->adapter_cnf |= A_CNF_AUI | A_CNF_MEDIA_AUI; |
| 1419 | /* Check if the card is in Auto mode. */ |
| 1420 | if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUTO_AUI_10BASET) |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1421 | lp->adapter_cnf |= A_CNF_AUI | A_CNF_10B_T | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1422 | A_CNF_MEDIA_AUI | A_CNF_MEDIA_10B_T | A_CNF_MEDIA_AUTO; |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1423 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1424 | cs89_dbg(1, info, "%s: PP_LineCTL=0x%x, adapter_cnf=0x%x\n", |
| 1425 | dev->name, i, lp->adapter_cnf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1426 | |
| 1427 | /* IRQ. Other chips already probe, see below. */ |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1428 | if (lp->chip_type == CS8900) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1429 | lp->isa_config = readreg(dev, PP_CS8900_ISAINT) & INT_NO_MASK; |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1430 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1431 | pr_cont("[Cirrus EEPROM] "); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1432 | } |
| 1433 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1434 | pr_cont("\n"); |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1435 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1436 | /* First check to see if an EEPROM is attached. */ |
Christoph Egger | ef3cf9f | 2010-07-14 13:40:36 -0700 | [diff] [blame] | 1437 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1438 | if ((readreg(dev, PP_SelfST) & EEPROM_PRESENT) == 0) |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1439 | pr_warn("No EEPROM, relying on command line....\n"); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1440 | else if (get_eeprom_data(dev, START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) { |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1441 | pr_warn("EEPROM read failed, relying on command line\n"); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1442 | } else if (get_eeprom_cksum(START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1443 | /* Check if the chip was able to read its own configuration starting |
| 1444 | at 0 in the EEPROM*/ |
| 1445 | if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) != |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1446 | (EEPROM_OK | EEPROM_PRESENT)) |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1447 | pr_warn("Extended EEPROM checksum bad and no Cirrus EEPROM, relying on command line\n"); |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1448 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1449 | } else { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1450 | /* This reads an extended EEPROM that is not documented |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1451 | * in the CS8900 datasheet. |
| 1452 | */ |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1453 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1454 | /* get transmission control word but keep the autonegotiation bits */ |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1455 | if (!lp->auto_neg_cnf) |
| 1456 | lp->auto_neg_cnf = eeprom_buff[AUTO_NEG_CNF_OFFSET / 2]; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1457 | /* Store adapter configuration */ |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1458 | if (!lp->adapter_cnf) |
| 1459 | lp->adapter_cnf = eeprom_buff[ADAPTER_CNF_OFFSET / 2]; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1460 | /* Store ISA configuration */ |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1461 | lp->isa_config = eeprom_buff[ISA_CNF_OFFSET / 2]; |
| 1462 | dev->mem_start = eeprom_buff[PACKET_PAGE_OFFSET / 2] << 8; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1463 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1464 | /* eeprom_buff has 32-bit ints, so we can't just memcpy it */ |
| 1465 | /* store the initial memory base address */ |
| 1466 | for (i = 0; i < ETH_ALEN / 2; i++) { |
| 1467 | dev->dev_addr[i * 2] = eeprom_buff[i]; |
| 1468 | dev->dev_addr[i * 2 + 1] = eeprom_buff[i] >> 8; |
| 1469 | } |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1470 | cs89_dbg(1, debug, "%s: new adapter_cnf: 0x%x\n", |
| 1471 | dev->name, lp->adapter_cnf); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1472 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1473 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1474 | /* allow them to force multiple transceivers. If they force multiple, autosense */ |
| 1475 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1476 | int count = 0; |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1477 | if (lp->force & FORCE_RJ45) { |
| 1478 | lp->adapter_cnf |= A_CNF_10B_T; |
| 1479 | count++; |
| 1480 | } |
| 1481 | if (lp->force & FORCE_AUI) { |
| 1482 | lp->adapter_cnf |= A_CNF_AUI; |
| 1483 | count++; |
| 1484 | } |
| 1485 | if (lp->force & FORCE_BNC) { |
| 1486 | lp->adapter_cnf |= A_CNF_10B_2; |
| 1487 | count++; |
| 1488 | } |
| 1489 | if (count > 1) |
| 1490 | lp->adapter_cnf |= A_CNF_MEDIA_AUTO; |
| 1491 | else if (lp->force & FORCE_RJ45) |
| 1492 | lp->adapter_cnf |= A_CNF_MEDIA_10B_T; |
| 1493 | else if (lp->force & FORCE_AUI) |
| 1494 | lp->adapter_cnf |= A_CNF_MEDIA_AUI; |
| 1495 | else if (lp->force & FORCE_BNC) |
| 1496 | lp->adapter_cnf |= A_CNF_MEDIA_10B_2; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1497 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1498 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1499 | cs89_dbg(1, debug, "%s: after force 0x%x, adapter_cnf=0x%x\n", |
| 1500 | dev->name, lp->force, lp->adapter_cnf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1501 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1502 | /* FIXME: We don't let you set dc-dc polarity or low RX squelch from the command line: add it here */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1503 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1504 | /* FIXME: We don't let you set the IMM bit from the command line: add it to lp->auto_neg_cnf here */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1505 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1506 | /* FIXME: we don't set the Ethernet address on the command line. Use |
| 1507 | * ifconfig IFACE hw ether AABBCCDDEEFF |
| 1508 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1509 | |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1510 | pr_info("media %s%s%s", |
| 1511 | (lp->adapter_cnf & A_CNF_10B_T) ? "RJ-45," : "", |
| 1512 | (lp->adapter_cnf & A_CNF_AUI) ? "AUI," : "", |
| 1513 | (lp->adapter_cnf & A_CNF_10B_2) ? "BNC," : ""); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1514 | |
| 1515 | lp->irq_map = 0xffff; |
| 1516 | |
| 1517 | /* If this is a CS8900 then no pnp soft */ |
| 1518 | if (lp->chip_type != CS8900 && |
| 1519 | /* Check if the ISA IRQ has been set */ |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1520 | (i = readreg(dev, PP_CS8920_ISAINT) & 0xff, |
| 1521 | (i != 0 && i < CS8920_NO_INTS))) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1522 | if (!dev->irq) |
| 1523 | dev->irq = i; |
| 1524 | } else { |
| 1525 | i = lp->isa_config & INT_NO_MASK; |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1526 | #ifndef CONFIG_CS89x0_PLATFORM |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1527 | if (lp->chip_type == CS8900) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1528 | /* Translate the IRQ using the IRQ mapping table. */ |
Denis Cheng | ff8ac60 | 2007-09-02 18:30:18 +0800 | [diff] [blame] | 1529 | if (i >= ARRAY_SIZE(cs8900_irq_map)) |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1530 | pr_err("invalid ISA interrupt number %d\n", i); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1531 | else |
| 1532 | i = cs8900_irq_map[i]; |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1533 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1534 | lp->irq_map = CS8900_IRQ_MAP; /* fixed IRQ map for CS8900 */ |
| 1535 | } else { |
| 1536 | int irq_map_buff[IRQ_MAP_LEN/2]; |
| 1537 | |
| 1538 | if (get_eeprom_data(dev, IRQ_MAP_EEPROM_DATA, |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1539 | IRQ_MAP_LEN / 2, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1540 | irq_map_buff) >= 0) { |
| 1541 | if ((irq_map_buff[0] & 0xff) == PNP_IRQ_FRMT) |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1542 | lp->irq_map = ((irq_map_buff[0] >> 8) | |
| 1543 | (irq_map_buff[1] << 8)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1544 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1545 | } |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1546 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1547 | if (!dev->irq) |
| 1548 | dev->irq = i; |
| 1549 | } |
| 1550 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1551 | pr_cont(" IRQ %d", dev->irq); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1552 | |
| 1553 | #if ALLOW_DMA |
| 1554 | if (lp->use_dma) { |
| 1555 | get_dma_channel(dev); |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1556 | pr_cont(", DMA %d", dev->dma); |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1557 | } else |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1558 | #endif |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1559 | pr_cont(", programmed I/O"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1560 | |
| 1561 | /* print the ethernet address. */ |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1562 | pr_cont(", MAC %pM\n", dev->dev_addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1563 | |
Stephen Hemminger | 15d23e7 | 2009-03-26 15:11:43 +0000 | [diff] [blame] | 1564 | dev->netdev_ops = &net_ops; |
| 1565 | dev->watchdog_timeo = HZ; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1566 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1567 | cs89_dbg(0, info, "cs89x0_probe1() successful\n"); |
| b1fc550 | 2005-05-12 20:11:55 -0400 | [diff] [blame] | 1568 | |
| 1569 | retval = register_netdev(dev); |
| 1570 | if (retval) |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1571 | goto out2; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1572 | return 0; |
| 1573 | out2: |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1574 | iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1575 | out1: |
| 1576 | return retval; |
| 1577 | } |
| 1578 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1579 | #ifndef CONFIG_CS89x0_PLATFORM |
| 1580 | /* |
| 1581 | * This function converts the I/O port addres used by the cs89x0_probe() and |
| 1582 | * init_module() functions to the I/O memory address used by the |
| 1583 | * cs89x0_probe1() function. |
| 1584 | */ |
| 1585 | static int __init |
| 1586 | cs89x0_ioport_probe(struct net_device *dev, unsigned long ioport, int modular) |
| 1587 | { |
| 1588 | struct net_local *lp = netdev_priv(dev); |
| 1589 | int ret; |
| 1590 | void __iomem *io_mem; |
| 1591 | |
| 1592 | if (!lp) |
| 1593 | return -ENOMEM; |
| 1594 | |
| 1595 | dev->base_addr = ioport; |
| 1596 | |
| 1597 | if (!request_region(ioport, NETCARD_IO_EXTENT, DRV_NAME)) { |
| 1598 | ret = -EBUSY; |
| 1599 | goto out; |
| 1600 | } |
| 1601 | |
| 1602 | io_mem = ioport_map(ioport & ~3, NETCARD_IO_EXTENT); |
| 1603 | if (!io_mem) { |
| 1604 | ret = -ENOMEM; |
| 1605 | goto release; |
| 1606 | } |
| 1607 | |
| 1608 | /* if they give us an odd I/O address, then do ONE write to |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1609 | * the address port, to get it back to address zero, where we |
| 1610 | * expect to find the EISA signature word. An IO with a base of 0x3 |
| 1611 | * will skip the test for the ADD_PORT. |
| 1612 | */ |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1613 | if (ioport & 1) { |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1614 | cs89_dbg(1, info, "%s: odd ioaddr 0x%lx\n", dev->name, ioport); |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1615 | if ((ioport & 2) != 2) { |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1616 | if ((ioread16(io_mem + ADD_PORT) & ADD_MASK) != |
| 1617 | ADD_SIG) { |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1618 | pr_err("%s: bad signature 0x%x\n", |
| 1619 | dev->name, ioread16(io_mem + ADD_PORT)); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1620 | ret = -ENODEV; |
| 1621 | goto unmap; |
| 1622 | } |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1623 | } |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1624 | } |
| 1625 | |
| 1626 | ret = cs89x0_probe1(dev, io_mem, modular); |
| 1627 | if (!ret) |
| 1628 | goto out; |
| 1629 | unmap: |
| 1630 | ioport_unmap(io_mem); |
| 1631 | release: |
| 1632 | release_region(ioport, NETCARD_IO_EXTENT); |
| 1633 | out: |
| 1634 | return ret; |
| 1635 | } |
| 1636 | |
| 1637 | #ifndef MODULE |
| 1638 | /* Check for a network adaptor of this type, and return '0' iff one exists. |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1639 | * If dev->base_addr == 0, probe all likely locations. |
| 1640 | * If dev->base_addr == 1, always return failure. |
| 1641 | * If dev->base_addr == 2, allocate space for the device and return success |
| 1642 | * (detachable devices only). |
| 1643 | * Return 0 on success. |
| 1644 | */ |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1645 | |
| 1646 | struct net_device * __init cs89x0_probe(int unit) |
| 1647 | { |
| 1648 | struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); |
| 1649 | unsigned *port; |
| 1650 | int err = 0; |
| 1651 | int irq; |
| 1652 | int io; |
| 1653 | |
| 1654 | if (!dev) |
| 1655 | return ERR_PTR(-ENODEV); |
| 1656 | |
| 1657 | sprintf(dev->name, "eth%d", unit); |
| 1658 | netdev_boot_setup_check(dev); |
| 1659 | io = dev->base_addr; |
| 1660 | irq = dev->irq; |
| 1661 | |
Joe Perches | 808e9a7 | 2012-05-18 12:56:30 +0000 | [diff] [blame] | 1662 | cs89_dbg(0, info, "cs89x0_probe(0x%x)\n", io); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1663 | |
| 1664 | if (io > 0x1ff) { /* Check a single specified location. */ |
| 1665 | err = cs89x0_ioport_probe(dev, io, 0); |
| 1666 | } else if (io != 0) { /* Don't probe at all. */ |
| 1667 | err = -ENXIO; |
| 1668 | } else { |
| 1669 | for (port = netcard_portlist; *port; port++) { |
| 1670 | if (cs89x0_ioport_probe(dev, *port, 0) == 0) |
| 1671 | break; |
| 1672 | dev->irq = irq; |
| 1673 | } |
| 1674 | if (!*port) |
| 1675 | err = -ENODEV; |
| 1676 | } |
| 1677 | if (err) |
| 1678 | goto out; |
| 1679 | return dev; |
| 1680 | out: |
| 1681 | free_netdev(dev); |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1682 | pr_warn("no cs8900 or cs8920 detected. Be sure to disable PnP with SETUP\n"); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1683 | return ERR_PTR(err); |
| 1684 | } |
| 1685 | #endif |
| 1686 | #endif |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1687 | |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1688 | #if defined(MODULE) && !defined(CONFIG_CS89x0_PLATFORM) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1689 | |
| 1690 | static struct net_device *dev_cs89x0; |
| 1691 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1692 | /* Support the 'debug' module parm even if we're compiled for non-debug to |
Jeff Garzik | 6aa20a2 | 2006-09-13 13:24:59 -0400 | [diff] [blame] | 1693 | * avoid breaking someone's startup scripts |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1694 | */ |
| 1695 | |
| 1696 | static int io; |
| 1697 | static int irq; |
| 1698 | static int debug; |
| 1699 | static char media[8]; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1700 | static int duplex = -1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1701 | |
| 1702 | static int use_dma; /* These generate unused var warnings if ALLOW_DMA = 0 */ |
| 1703 | static int dma; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1704 | static int dmasize = 16; /* or 64 */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1705 | |
| 1706 | module_param(io, int, 0); |
| 1707 | module_param(irq, int, 0); |
| 1708 | module_param(debug, int, 0); |
| 1709 | module_param_string(media, media, sizeof(media), 0); |
| 1710 | module_param(duplex, int, 0); |
| 1711 | module_param(dma , int, 0); |
| 1712 | module_param(dmasize , int, 0); |
| 1713 | module_param(use_dma , int, 0); |
| 1714 | MODULE_PARM_DESC(io, "cs89x0 I/O base address"); |
| 1715 | MODULE_PARM_DESC(irq, "cs89x0 IRQ number"); |
| 1716 | #if DEBUGGING |
| 1717 | MODULE_PARM_DESC(debug, "cs89x0 debug level (0-6)"); |
| 1718 | #else |
| 1719 | MODULE_PARM_DESC(debug, "(ignored)"); |
| 1720 | #endif |
| 1721 | MODULE_PARM_DESC(media, "Set cs89x0 adapter(s) media type(s) (rj45,bnc,aui)"); |
| 1722 | /* No other value than -1 for duplex seems to be currently interpreted */ |
| 1723 | MODULE_PARM_DESC(duplex, "(ignored)"); |
| 1724 | #if ALLOW_DMA |
| 1725 | MODULE_PARM_DESC(dma , "cs89x0 ISA DMA channel; ignored if use_dma=0"); |
| 1726 | MODULE_PARM_DESC(dmasize , "cs89x0 DMA size in kB (16,64); ignored if use_dma=0"); |
| 1727 | MODULE_PARM_DESC(use_dma , "cs89x0 using DMA (0-1)"); |
| 1728 | #else |
| 1729 | MODULE_PARM_DESC(dma , "(ignored)"); |
| 1730 | MODULE_PARM_DESC(dmasize , "(ignored)"); |
| 1731 | MODULE_PARM_DESC(use_dma , "(ignored)"); |
| 1732 | #endif |
| 1733 | |
Francois Cami | e1f8e87 | 2008-10-15 22:01:59 -0700 | [diff] [blame] | 1734 | MODULE_AUTHOR("Mike Cruse, Russwll Nelson <nelson@crynwr.com>, Andrew Morton"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1735 | MODULE_LICENSE("GPL"); |
| 1736 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1737 | /* |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1738 | * media=t - specify media type |
| 1739 | * or media=2 |
| 1740 | * or media=aui |
| 1741 | * or medai=auto |
| 1742 | * duplex=0 - specify forced half/full/autonegotiate duplex |
| 1743 | * debug=# - debug level |
| 1744 | * |
| 1745 | * Default Chip Configuration: |
| 1746 | * DMA Burst = enabled |
| 1747 | * IOCHRDY Enabled = enabled |
| 1748 | * UseSA = enabled |
| 1749 | * CS8900 defaults to half-duplex if not specified on command-line |
| 1750 | * CS8920 defaults to autoneg if not specified on command-line |
| 1751 | * Use reset defaults for other config parameters |
| 1752 | * |
| 1753 | * Assumptions: |
| 1754 | * media type specified is supported (circuitry is present) |
| 1755 | * if memory address is > 1MB, then required mem decode hw is present |
| 1756 | * if 10B-2, then agent other than driver will enable DC/DC converter |
| 1757 | * (hw or software util) |
| 1758 | */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1759 | |
Andrew Morton | e26c129 | 2006-08-14 22:59:59 -0700 | [diff] [blame] | 1760 | int __init init_module(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1761 | { |
| 1762 | struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); |
| 1763 | struct net_local *lp; |
| 1764 | int ret = 0; |
| 1765 | |
| 1766 | #if DEBUGGING |
| 1767 | net_debug = debug; |
| 1768 | #else |
| 1769 | debug = 0; |
| 1770 | #endif |
| 1771 | if (!dev) |
| 1772 | return -ENOMEM; |
| 1773 | |
| 1774 | dev->irq = irq; |
| 1775 | dev->base_addr = io; |
| 1776 | lp = netdev_priv(dev); |
| 1777 | |
| 1778 | #if ALLOW_DMA |
| 1779 | if (use_dma) { |
| 1780 | lp->use_dma = use_dma; |
| 1781 | lp->dma = dma; |
| 1782 | lp->dmasize = dmasize; |
| 1783 | } |
| 1784 | #endif |
| 1785 | |
| 1786 | spin_lock_init(&lp->lock); |
| 1787 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1788 | /* boy, they'd better get these right */ |
| 1789 | if (!strcmp(media, "rj45")) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1790 | lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T; |
| 1791 | else if (!strcmp(media, "aui")) |
| 1792 | lp->adapter_cnf = A_CNF_MEDIA_AUI | A_CNF_AUI; |
| 1793 | else if (!strcmp(media, "bnc")) |
| 1794 | lp->adapter_cnf = A_CNF_MEDIA_10B_2 | A_CNF_10B_2; |
| 1795 | else |
| 1796 | lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T; |
| 1797 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1798 | if (duplex == -1) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1799 | lp->auto_neg_cnf = AUTO_NEG_ENABLE; |
| 1800 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1801 | if (io == 0) { |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1802 | pr_err("Module autoprobing not allowed\n"); |
| 1803 | pr_err("Append io=0xNNN\n"); |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1804 | ret = -EPERM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1805 | goto out; |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1806 | } else if (io <= 0x1ff) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1807 | ret = -ENXIO; |
| 1808 | goto out; |
| 1809 | } |
| 1810 | |
| 1811 | #if ALLOW_DMA |
| 1812 | if (use_dma && dmasize != 16 && dmasize != 64) { |
Joe Perches | dd92b9a | 2012-05-18 12:56:28 +0000 | [diff] [blame] | 1813 | pr_err("dma size must be either 16K or 64K, not %dK\n", |
| 1814 | dmasize); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1815 | ret = -EPERM; |
| 1816 | goto out; |
| 1817 | } |
| 1818 | #endif |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1819 | ret = cs89x0_ioport_probe(dev, io, 1); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1820 | if (ret) |
| 1821 | goto out; |
| 1822 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1823 | dev_cs89x0 = dev; |
| 1824 | return 0; |
| 1825 | out: |
| 1826 | free_netdev(dev); |
| 1827 | return ret; |
| 1828 | } |
| 1829 | |
Al Viro | afc8eb4 | 2006-06-14 18:50:53 -0400 | [diff] [blame] | 1830 | void __exit |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1831 | cleanup_module(void) |
| 1832 | { |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1833 | struct net_local *lp = netdev_priv(dev_cs89x0); |
| 1834 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1835 | unregister_netdev(dev_cs89x0); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1836 | iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT); |
| 1837 | ioport_unmap(lp->virt_addr); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1838 | release_region(dev_cs89x0->base_addr, NETCARD_IO_EXTENT); |
| 1839 | free_netdev(dev_cs89x0); |
| 1840 | } |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1841 | #endif /* MODULE && !CONFIG_CS89x0_PLATFORM */ |
| 1842 | |
| 1843 | #ifdef CONFIG_CS89x0_PLATFORM |
| 1844 | static int __init cs89x0_platform_probe(struct platform_device *pdev) |
| 1845 | { |
| 1846 | struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); |
| 1847 | struct net_local *lp; |
| 1848 | struct resource *mem_res; |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1849 | void __iomem *virt_addr; |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1850 | int err; |
| 1851 | |
| 1852 | if (!dev) |
| 1853 | return -ENOMEM; |
| 1854 | |
| 1855 | lp = netdev_priv(dev); |
| 1856 | |
| 1857 | mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| 1858 | dev->irq = platform_get_irq(pdev, 0); |
| 1859 | if (mem_res == NULL || dev->irq <= 0) { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1860 | dev_warn(&dev->dev, "memory/interrupt resource missing\n"); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1861 | err = -ENXIO; |
| 1862 | goto free; |
| 1863 | } |
| 1864 | |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1865 | lp->size = resource_size(mem_res); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1866 | if (!request_mem_region(mem_res->start, lp->size, DRV_NAME)) { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1867 | dev_warn(&dev->dev, "request_mem_region() failed\n"); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1868 | err = -EBUSY; |
| 1869 | goto free; |
| 1870 | } |
| 1871 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1872 | virt_addr = ioremap(mem_res->start, lp->size); |
| 1873 | if (!virt_addr) { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1874 | dev_warn(&dev->dev, "ioremap() failed\n"); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1875 | err = -ENOMEM; |
| 1876 | goto release; |
| 1877 | } |
| 1878 | |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1879 | err = cs89x0_probe1(dev, virt_addr, 0); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1880 | if (err) { |
Joe Perches | ca034bc | 2012-05-18 12:56:29 +0000 | [diff] [blame] | 1881 | dev_warn(&dev->dev, "no cs8900 or cs8920 detected\n"); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1882 | goto unmap; |
| 1883 | } |
| 1884 | |
| 1885 | platform_set_drvdata(pdev, dev); |
| 1886 | return 0; |
| 1887 | |
| 1888 | unmap: |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1889 | iounmap(virt_addr); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1890 | release: |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1891 | release_mem_region(mem_res->start, lp->size); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1892 | free: |
| 1893 | free_netdev(dev); |
| 1894 | return err; |
| 1895 | } |
| 1896 | |
| 1897 | static int cs89x0_platform_remove(struct platform_device *pdev) |
| 1898 | { |
| 1899 | struct net_device *dev = platform_get_drvdata(pdev); |
| 1900 | struct net_local *lp = netdev_priv(dev); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1901 | struct resource *mem_res; |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1902 | |
Joe Perches | 204a38a | 2012-05-18 12:56:27 +0000 | [diff] [blame] | 1903 | /* This platform_get_resource() call will not return NULL, because |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1904 | * the same call in cs89x0_platform_probe() has returned a non NULL |
| 1905 | * value. |
| 1906 | */ |
| 1907 | mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1908 | unregister_netdev(dev); |
| 1909 | iounmap(lp->virt_addr); |
Jaccon Bastiaansen | 09dcd60 | 2012-05-17 07:11:42 +0000 | [diff] [blame] | 1910 | release_mem_region(mem_res->start, lp->size); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1911 | free_netdev(dev); |
| 1912 | return 0; |
| 1913 | } |
| 1914 | |
| 1915 | static struct platform_driver cs89x0_driver = { |
| 1916 | .driver = { |
| 1917 | .name = DRV_NAME, |
| 1918 | .owner = THIS_MODULE, |
| 1919 | }, |
| 1920 | .remove = cs89x0_platform_remove, |
| 1921 | }; |
| 1922 | |
Jingoo Han | fae4f3c | 2013-03-04 16:43:50 +0000 | [diff] [blame] | 1923 | module_platform_driver_probe(cs89x0_driver, cs89x0_platform_probe); |
Jaccon Bastiaansen | e9460a9 | 2012-01-26 21:46:15 +0100 | [diff] [blame] | 1924 | |
| 1925 | #endif /* CONFIG_CS89x0_PLATFORM */ |