Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2002 Wolfgang Grandegger, wg@denx.de. |
| 4 | * |
| 5 | * This driver for AMD PCnet network controllers is derived from the |
| 6 | * Linux driver pcnet32.c written 1996-1999 by Thomas Bogendoerfer. |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 7 | */ |
| 8 | |
| 9 | #include <common.h> |
Simon Glass | 1eb69ae | 2019-11-14 12:57:39 -0700 | [diff] [blame] | 10 | #include <cpu_func.h> |
Simon Glass | f7ae49f | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 11 | #include <log.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 12 | #include <malloc.h> |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 13 | #include <memalign.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 14 | #include <net.h> |
Ben Warren | e309053 | 2008-08-31 10:08:43 -0700 | [diff] [blame] | 15 | #include <netdev.h> |
Simon Glass | 90526e9 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 16 | #include <asm/cache.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 17 | #include <asm/io.h> |
| 18 | #include <pci.h> |
Simon Glass | c05ed00 | 2020-05-10 11:40:11 -0600 | [diff] [blame] | 19 | #include <linux/delay.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 20 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 21 | #define PCNET_DEBUG_LEVEL 0 /* 0=off, 1=init, 2=rx/tx */ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 22 | |
Wolfgang Denk | 138b608 | 2011-11-05 05:12:58 +0000 | [diff] [blame] | 23 | #define PCNET_DEBUG1(fmt,args...) \ |
| 24 | debug_cond(PCNET_DEBUG_LEVEL > 0, fmt ,##args) |
| 25 | #define PCNET_DEBUG2(fmt,args...) \ |
| 26 | debug_cond(PCNET_DEBUG_LEVEL > 1, fmt ,##args) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 27 | |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 28 | /* |
| 29 | * Set the number of Tx and Rx buffers, using Log_2(# buffers). |
| 30 | * Reasonable default values are 4 Tx buffers, and 16 Rx buffers. |
| 31 | * That translates to 2 (4 == 2^^2) and 4 (16 == 2^^4). |
| 32 | */ |
| 33 | #define PCNET_LOG_TX_BUFFERS 0 |
| 34 | #define PCNET_LOG_RX_BUFFERS 2 |
| 35 | |
| 36 | #define TX_RING_SIZE (1 << (PCNET_LOG_TX_BUFFERS)) |
| 37 | #define TX_RING_LEN_BITS ((PCNET_LOG_TX_BUFFERS) << 12) |
| 38 | |
| 39 | #define RX_RING_SIZE (1 << (PCNET_LOG_RX_BUFFERS)) |
| 40 | #define RX_RING_LEN_BITS ((PCNET_LOG_RX_BUFFERS) << 4) |
| 41 | |
| 42 | #define PKT_BUF_SZ 1544 |
| 43 | |
| 44 | /* The PCNET Rx and Tx ring descriptors. */ |
| 45 | struct pcnet_rx_head { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 46 | u32 base; |
| 47 | s16 buf_length; |
| 48 | s16 status; |
| 49 | u32 msg_length; |
| 50 | u32 reserved; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 51 | }; |
| 52 | |
| 53 | struct pcnet_tx_head { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 54 | u32 base; |
| 55 | s16 length; |
| 56 | s16 status; |
| 57 | u32 misc; |
| 58 | u32 reserved; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 59 | }; |
| 60 | |
| 61 | /* The PCNET 32-Bit initialization block, described in databook. */ |
| 62 | struct pcnet_init_block { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 63 | u16 mode; |
| 64 | u16 tlen_rlen; |
| 65 | u8 phys_addr[6]; |
| 66 | u16 reserved; |
| 67 | u32 filter[2]; |
| 68 | /* Receive and transmit ring base, along with extra bits. */ |
| 69 | u32 rx_ring; |
| 70 | u32 tx_ring; |
| 71 | u32 reserved2; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 72 | }; |
| 73 | |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 74 | struct pcnet_uncached_priv { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 75 | struct pcnet_rx_head rx_ring[RX_RING_SIZE]; |
| 76 | struct pcnet_tx_head tx_ring[TX_RING_SIZE]; |
| 77 | struct pcnet_init_block init_block; |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 78 | } __aligned(ARCH_DMA_MINALIGN); |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 79 | |
Marek Vasut | 97d5c14 | 2020-05-17 15:10:41 +0200 | [diff] [blame] | 80 | struct pcnet_priv { |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 81 | struct pcnet_uncached_priv ucp; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 82 | /* Receive Buffer space */ |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 83 | unsigned char rx_buf[RX_RING_SIZE][PKT_BUF_SZ + 4]; |
| 84 | struct pcnet_uncached_priv *uc; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 85 | int cur_rx; |
| 86 | int cur_tx; |
Marek Vasut | 97d5c14 | 2020-05-17 15:10:41 +0200 | [diff] [blame] | 87 | }; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 88 | |
Marek Vasut | 97d5c14 | 2020-05-17 15:10:41 +0200 | [diff] [blame] | 89 | static struct pcnet_priv *lp; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 90 | |
| 91 | /* Offsets from base I/O address for WIO mode */ |
| 92 | #define PCNET_RDP 0x10 |
| 93 | #define PCNET_RAP 0x12 |
| 94 | #define PCNET_RESET 0x14 |
| 95 | #define PCNET_BDP 0x16 |
| 96 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 97 | static u16 pcnet_read_csr(struct eth_device *dev, int index) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 98 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 99 | void __iomem *base = (void __iomem *)dev->iobase; |
| 100 | |
| 101 | writew(index, base + PCNET_RAP); |
| 102 | return readw(base + PCNET_RDP); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 103 | } |
| 104 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 105 | static void pcnet_write_csr(struct eth_device *dev, int index, u16 val) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 106 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 107 | void __iomem *base = (void __iomem *)dev->iobase; |
| 108 | |
| 109 | writew(index, base + PCNET_RAP); |
| 110 | writew(val, base + PCNET_RDP); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 111 | } |
| 112 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 113 | static u16 pcnet_read_bcr(struct eth_device *dev, int index) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 114 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 115 | void __iomem *base = (void __iomem *)dev->iobase; |
| 116 | |
| 117 | writew(index, base + PCNET_RAP); |
| 118 | return readw(base + PCNET_BDP); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 119 | } |
| 120 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 121 | static void pcnet_write_bcr(struct eth_device *dev, int index, u16 val) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 122 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 123 | void __iomem *base = (void __iomem *)dev->iobase; |
| 124 | |
| 125 | writew(index, base + PCNET_RAP); |
| 126 | writew(val, base + PCNET_BDP); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 127 | } |
| 128 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 129 | static void pcnet_reset(struct eth_device *dev) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 130 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 131 | void __iomem *base = (void __iomem *)dev->iobase; |
| 132 | |
| 133 | readw(base + PCNET_RESET); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 134 | } |
| 135 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 136 | static int pcnet_check(struct eth_device *dev) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 137 | { |
Daniel Schwierzeck | 8510580 | 2020-05-03 19:43:32 +0200 | [diff] [blame] | 138 | void __iomem *base = (void __iomem *)dev->iobase; |
| 139 | |
| 140 | writew(88, base + PCNET_RAP); |
| 141 | return readw(base + PCNET_RAP) == 88; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 142 | } |
| 143 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 144 | static int pcnet_init (struct eth_device *dev, bd_t * bis); |
Joe Hershberger | f92a151 | 2012-05-22 18:09:56 +0000 | [diff] [blame] | 145 | static int pcnet_send(struct eth_device *dev, void *packet, int length); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 146 | static int pcnet_recv (struct eth_device *dev); |
| 147 | static void pcnet_halt (struct eth_device *dev); |
| 148 | static int pcnet_probe (struct eth_device *dev, bd_t * bis, int dev_num); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 149 | |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 150 | static inline pci_addr_t pcnet_virt_to_mem(const struct eth_device *dev, |
Paul Burton | 4677d66 | 2016-05-26 14:49:34 +0100 | [diff] [blame] | 151 | void *addr) |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 152 | { |
Paul Burton | 442d2e0 | 2016-05-26 14:49:35 +0100 | [diff] [blame] | 153 | pci_dev_t devbusfn = (pci_dev_t)(unsigned long)dev->priv; |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 154 | void *virt_addr = addr; |
| 155 | |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 156 | return pci_virt_to_mem(devbusfn, virt_addr); |
| 157 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 158 | |
| 159 | static struct pci_device_id supported[] = { |
Marek Vasut | e4797c3 | 2020-05-17 17:33:17 +0200 | [diff] [blame] | 160 | { PCI_DEVICE(PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_LANCE) }, |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 161 | {} |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 162 | }; |
| 163 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 164 | static int pcnet_probe(struct eth_device *dev, bd_t *bis, int dev_nr) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 165 | { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 166 | int chip_version; |
| 167 | char *chipname; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 168 | int i; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 169 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 170 | /* Reset the PCnet controller */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 171 | pcnet_reset(dev); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 172 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 173 | /* Check if register access is working */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 174 | if (pcnet_read_csr(dev, 0) != 4 || !pcnet_check(dev)) { |
| 175 | printf("%s: CSR register access check failed\n", dev->name); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 176 | return -1; |
| 177 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 178 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 179 | /* Identify the chip */ |
| 180 | chip_version = |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 181 | pcnet_read_csr(dev, 88) | (pcnet_read_csr(dev, 89) << 16); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 182 | if ((chip_version & 0xfff) != 0x003) |
| 183 | return -1; |
| 184 | chip_version = (chip_version >> 12) & 0xffff; |
| 185 | switch (chip_version) { |
| 186 | case 0x2621: |
| 187 | chipname = "PCnet/PCI II 79C970A"; /* PCI */ |
| 188 | break; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 189 | case 0x2625: |
| 190 | chipname = "PCnet/FAST III 79C973"; /* PCI */ |
| 191 | break; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 192 | case 0x2627: |
| 193 | chipname = "PCnet/FAST III 79C975"; /* PCI */ |
| 194 | break; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 195 | default: |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 196 | printf("%s: PCnet version %#x not supported\n", |
| 197 | dev->name, chip_version); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 198 | return -1; |
| 199 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 200 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 201 | PCNET_DEBUG1("AMD %s\n", chipname); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 202 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 203 | /* |
| 204 | * In most chips, after a chip reset, the ethernet address is read from |
| 205 | * the station address PROM at the base address and programmed into the |
| 206 | * "Physical Address Registers" CSR12-14. |
| 207 | */ |
| 208 | for (i = 0; i < 3; i++) { |
| 209 | unsigned int val; |
| 210 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 211 | val = pcnet_read_csr(dev, i + 12) & 0x0ffff; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 212 | /* There may be endianness issues here. */ |
| 213 | dev->enetaddr[2 * i] = val & 0x0ff; |
| 214 | dev->enetaddr[2 * i + 1] = (val >> 8) & 0x0ff; |
| 215 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 216 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 217 | return 0; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 218 | } |
| 219 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 220 | static int pcnet_init(struct eth_device *dev, bd_t *bis) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 221 | { |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 222 | struct pcnet_uncached_priv *uc; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 223 | int i, val; |
Paul Burton | 442d2e0 | 2016-05-26 14:49:35 +0100 | [diff] [blame] | 224 | unsigned long addr; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 225 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 226 | PCNET_DEBUG1("%s: pcnet_init...\n", dev->name); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 227 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 228 | /* Switch pcnet to 32bit mode */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 229 | pcnet_write_bcr(dev, 20, 2); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 230 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 231 | /* Set/reset autoselect bit */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 232 | val = pcnet_read_bcr(dev, 2) & ~2; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 233 | val |= 2; |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 234 | pcnet_write_bcr(dev, 2, val); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 235 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 236 | /* Enable auto negotiate, setup, disable fd */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 237 | val = pcnet_read_bcr(dev, 32) & ~0x98; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 238 | val |= 0x20; |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 239 | pcnet_write_bcr(dev, 32, val); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 240 | |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 241 | /* |
Paul Burton | 62715a2 | 2013-11-08 11:18:46 +0000 | [diff] [blame] | 242 | * Enable NOUFLO on supported controllers, with the transmit |
| 243 | * start point set to the full packet. This will cause entire |
| 244 | * packets to be buffered by the ethernet controller before |
| 245 | * transmission, eliminating underflows which are common on |
| 246 | * slower devices. Controllers which do not support NOUFLO will |
| 247 | * simply be left with a larger transmit FIFO threshold. |
| 248 | */ |
| 249 | val = pcnet_read_bcr(dev, 18); |
| 250 | val |= 1 << 11; |
| 251 | pcnet_write_bcr(dev, 18, val); |
| 252 | val = pcnet_read_csr(dev, 80); |
| 253 | val |= 0x3 << 10; |
| 254 | pcnet_write_csr(dev, 80, val); |
| 255 | |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 256 | uc = lp->uc; |
| 257 | |
| 258 | uc->init_block.mode = cpu_to_le16(0x0000); |
| 259 | uc->init_block.filter[0] = 0x00000000; |
| 260 | uc->init_block.filter[1] = 0x00000000; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 261 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 262 | /* |
| 263 | * Initialize the Rx ring. |
| 264 | */ |
| 265 | lp->cur_rx = 0; |
| 266 | for (i = 0; i < RX_RING_SIZE; i++) { |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 267 | addr = pcnet_virt_to_mem(dev, lp->rx_buf[i]); |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 268 | uc->rx_ring[i].base = cpu_to_le32(addr); |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 269 | uc->rx_ring[i].buf_length = cpu_to_le16(-PKT_BUF_SZ); |
| 270 | uc->rx_ring[i].status = cpu_to_le16(0x8000); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 271 | PCNET_DEBUG1 |
| 272 | ("Rx%d: base=0x%x buf_length=0x%hx status=0x%hx\n", i, |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 273 | uc->rx_ring[i].base, uc->rx_ring[i].buf_length, |
| 274 | uc->rx_ring[i].status); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 275 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 276 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 277 | /* |
| 278 | * Initialize the Tx ring. The Tx buffer address is filled in as |
| 279 | * needed, but we do need to clear the upper ownership bit. |
| 280 | */ |
| 281 | lp->cur_tx = 0; |
| 282 | for (i = 0; i < TX_RING_SIZE; i++) { |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 283 | uc->tx_ring[i].base = 0; |
| 284 | uc->tx_ring[i].status = 0; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 285 | } |
| 286 | |
| 287 | /* |
| 288 | * Setup Init Block. |
| 289 | */ |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 290 | PCNET_DEBUG1("Init block at 0x%p: MAC", &lp->uc->init_block); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 291 | |
| 292 | for (i = 0; i < 6; i++) { |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 293 | lp->uc->init_block.phys_addr[i] = dev->enetaddr[i]; |
| 294 | PCNET_DEBUG1(" %02x", lp->uc->init_block.phys_addr[i]); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 295 | } |
| 296 | |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 297 | uc->init_block.tlen_rlen = cpu_to_le16(TX_RING_LEN_BITS | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 298 | RX_RING_LEN_BITS); |
Paul Burton | 4677d66 | 2016-05-26 14:49:34 +0100 | [diff] [blame] | 299 | addr = pcnet_virt_to_mem(dev, uc->rx_ring); |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 300 | uc->init_block.rx_ring = cpu_to_le32(addr); |
Paul Burton | 4677d66 | 2016-05-26 14:49:34 +0100 | [diff] [blame] | 301 | addr = pcnet_virt_to_mem(dev, uc->tx_ring); |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 302 | uc->init_block.tx_ring = cpu_to_le32(addr); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 303 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 304 | PCNET_DEBUG1("\ntlen_rlen=0x%x rx_ring=0x%x tx_ring=0x%x\n", |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 305 | uc->init_block.tlen_rlen, |
| 306 | uc->init_block.rx_ring, uc->init_block.tx_ring); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 307 | |
| 308 | /* |
| 309 | * Tell the controller where the Init Block is located. |
| 310 | */ |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 311 | barrier(); |
Paul Burton | 4677d66 | 2016-05-26 14:49:34 +0100 | [diff] [blame] | 312 | addr = pcnet_virt_to_mem(dev, &lp->uc->init_block); |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 313 | pcnet_write_csr(dev, 1, addr & 0xffff); |
| 314 | pcnet_write_csr(dev, 2, (addr >> 16) & 0xffff); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 315 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 316 | pcnet_write_csr(dev, 4, 0x0915); |
| 317 | pcnet_write_csr(dev, 0, 0x0001); /* start */ |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 318 | |
| 319 | /* Wait for Init Done bit */ |
| 320 | for (i = 10000; i > 0; i--) { |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 321 | if (pcnet_read_csr(dev, 0) & 0x0100) |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 322 | break; |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 323 | udelay(10); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 324 | } |
| 325 | if (i <= 0) { |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 326 | printf("%s: TIMEOUT: controller init failed\n", dev->name); |
| 327 | pcnet_reset(dev); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 328 | return -1; |
| 329 | } |
| 330 | |
| 331 | /* |
| 332 | * Finally start network controller operation. |
| 333 | */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 334 | pcnet_write_csr(dev, 0, 0x0002); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 335 | |
| 336 | return 0; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 337 | } |
| 338 | |
Joe Hershberger | f92a151 | 2012-05-22 18:09:56 +0000 | [diff] [blame] | 339 | static int pcnet_send(struct eth_device *dev, void *packet, int pkt_len) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 340 | { |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 341 | int i, status; |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 342 | u32 addr; |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 343 | struct pcnet_tx_head *entry = &lp->uc->tx_ring[lp->cur_tx]; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 344 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 345 | PCNET_DEBUG2("Tx%d: %d bytes from 0x%p ", lp->cur_tx, pkt_len, |
| 346 | packet); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 347 | |
Paul Burton | f3ac866 | 2013-11-08 11:18:45 +0000 | [diff] [blame] | 348 | flush_dcache_range((unsigned long)packet, |
| 349 | (unsigned long)packet + pkt_len); |
| 350 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 351 | /* Wait for completion by testing the OWN bit */ |
| 352 | for (i = 1000; i > 0; i--) { |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 353 | status = readw(&entry->status); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 354 | if ((status & 0x8000) == 0) |
| 355 | break; |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 356 | udelay(100); |
| 357 | PCNET_DEBUG2("."); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 358 | } |
| 359 | if (i <= 0) { |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 360 | printf("%s: TIMEOUT: Tx%d failed (status = 0x%x)\n", |
| 361 | dev->name, lp->cur_tx, status); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 362 | pkt_len = 0; |
| 363 | goto failure; |
| 364 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 365 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 366 | /* |
| 367 | * Setup Tx ring. Caution: the write order is important here, |
| 368 | * set the status with the "ownership" bits last. |
| 369 | */ |
Paul Burton | 4677d66 | 2016-05-26 14:49:34 +0100 | [diff] [blame] | 370 | addr = pcnet_virt_to_mem(dev, packet); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 371 | writew(-pkt_len, &entry->length); |
| 372 | writel(0, &entry->misc); |
Daniel Schwierzeck | df50b3b | 2016-01-12 21:48:24 +0100 | [diff] [blame] | 373 | writel(addr, &entry->base); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 374 | writew(0x8300, &entry->status); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 375 | |
| 376 | /* Trigger an immediate send poll. */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 377 | pcnet_write_csr(dev, 0, 0x0008); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 378 | |
| 379 | failure: |
| 380 | if (++lp->cur_tx >= TX_RING_SIZE) |
| 381 | lp->cur_tx = 0; |
| 382 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 383 | PCNET_DEBUG2("done\n"); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 384 | return pkt_len; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 385 | } |
| 386 | |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 387 | static int pcnet_recv (struct eth_device *dev) |
| 388 | { |
| 389 | struct pcnet_rx_head *entry; |
Paul Burton | a354ddc | 2014-04-07 16:41:47 +0100 | [diff] [blame] | 390 | unsigned char *buf; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 391 | int pkt_len = 0; |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 392 | u16 status, err_status; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 393 | |
| 394 | while (1) { |
Paul Burton | f1ae382 | 2014-04-07 16:41:46 +0100 | [diff] [blame] | 395 | entry = &lp->uc->rx_ring[lp->cur_rx]; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 396 | /* |
| 397 | * If we own the next entry, it's a new packet. Send it up. |
| 398 | */ |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 399 | status = readw(&entry->status); |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 400 | if ((status & 0x8000) != 0) |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 401 | break; |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 402 | err_status = status >> 8; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 403 | |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 404 | if (err_status != 0x03) { /* There was an error. */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 405 | printf("%s: Rx%d", dev->name, lp->cur_rx); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 406 | PCNET_DEBUG1(" (status=0x%x)", err_status); |
| 407 | if (err_status & 0x20) |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 408 | printf(" Frame"); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 409 | if (err_status & 0x10) |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 410 | printf(" Overflow"); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 411 | if (err_status & 0x08) |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 412 | printf(" CRC"); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 413 | if (err_status & 0x04) |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 414 | printf(" Fifo"); |
| 415 | printf(" Error\n"); |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 416 | status &= 0x03ff; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 417 | |
| 418 | } else { |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 419 | pkt_len = (readl(&entry->msg_length) & 0xfff) - 4; |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 420 | if (pkt_len < 60) { |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 421 | printf("%s: Rx%d: invalid packet length %d\n", |
| 422 | dev->name, lp->cur_rx, pkt_len); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 423 | } else { |
Marek Vasut | 1c38c36 | 2020-05-17 16:16:45 +0200 | [diff] [blame] | 424 | buf = lp->rx_buf[lp->cur_rx]; |
Paul Burton | a354ddc | 2014-04-07 16:41:47 +0100 | [diff] [blame] | 425 | invalidate_dcache_range((unsigned long)buf, |
| 426 | (unsigned long)buf + pkt_len); |
Joe Hershberger | 1fd92db | 2015-04-08 01:41:06 -0500 | [diff] [blame] | 427 | net_process_received_packet(buf, pkt_len); |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 428 | PCNET_DEBUG2("Rx%d: %d bytes from 0x%p\n", |
Paul Burton | a354ddc | 2014-04-07 16:41:47 +0100 | [diff] [blame] | 429 | lp->cur_rx, pkt_len, buf); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 430 | } |
| 431 | } |
Paul Burton | 6fb49e4 | 2014-04-07 16:41:48 +0100 | [diff] [blame] | 432 | |
| 433 | status |= 0x8000; |
| 434 | writew(status, &entry->status); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 435 | |
| 436 | if (++lp->cur_rx >= RX_RING_SIZE) |
| 437 | lp->cur_rx = 0; |
| 438 | } |
| 439 | return pkt_len; |
| 440 | } |
| 441 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 442 | static void pcnet_halt(struct eth_device *dev) |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 443 | { |
| 444 | int i; |
| 445 | |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 446 | PCNET_DEBUG1("%s: pcnet_halt...\n", dev->name); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 447 | |
| 448 | /* Reset the PCnet controller */ |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 449 | pcnet_reset(dev); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 450 | |
| 451 | /* Wait for Stop bit */ |
| 452 | for (i = 1000; i > 0; i--) { |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 453 | if (pcnet_read_csr(dev, 0) & 0x4) |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 454 | break; |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 455 | udelay(10); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 456 | } |
Paul Burton | 6011dab | 2013-11-08 11:18:43 +0000 | [diff] [blame] | 457 | if (i <= 0) |
| 458 | printf("%s: TIMEOUT: controller reset failed\n", dev->name); |
Wolfgang Denk | 11ea26f | 2008-04-24 23:44:26 +0200 | [diff] [blame] | 459 | } |
Marek Vasut | 69e08bd | 2020-05-17 16:31:41 +0200 | [diff] [blame^] | 460 | |
| 461 | int pcnet_initialize(bd_t *bis) |
| 462 | { |
| 463 | pci_dev_t devbusfn; |
| 464 | struct eth_device *dev; |
| 465 | u16 command, status; |
| 466 | int dev_nr = 0; |
| 467 | u32 bar; |
| 468 | |
| 469 | PCNET_DEBUG1("\npcnet_initialize...\n"); |
| 470 | |
| 471 | for (dev_nr = 0; ; dev_nr++) { |
| 472 | /* |
| 473 | * Find the PCnet PCI device(s). |
| 474 | */ |
| 475 | devbusfn = pci_find_devices(supported, dev_nr); |
| 476 | if (devbusfn < 0) |
| 477 | break; |
| 478 | |
| 479 | /* |
| 480 | * Allocate and pre-fill the device structure. |
| 481 | */ |
| 482 | dev = calloc(1, sizeof(*dev)); |
| 483 | if (!dev) { |
| 484 | printf("pcnet: Can not allocate memory\n"); |
| 485 | break; |
| 486 | } |
| 487 | |
| 488 | /* |
| 489 | * We only maintain one structure because the drivers will |
| 490 | * never be used concurrently. In 32bit mode the RX and TX |
| 491 | * ring entries must be aligned on 16-byte boundaries. |
| 492 | */ |
| 493 | if (!lp) { |
| 494 | lp = malloc_cache_aligned(sizeof(*lp)); |
| 495 | lp->uc = map_physmem((phys_addr_t)&lp->ucp, |
| 496 | sizeof(lp->ucp), MAP_NOCACHE); |
| 497 | flush_dcache_range((unsigned long)lp, |
| 498 | (unsigned long)lp + sizeof(*lp)); |
| 499 | } |
| 500 | |
| 501 | dev->priv = (void *)(unsigned long)devbusfn; |
| 502 | sprintf(dev->name, "pcnet#%d", dev_nr); |
| 503 | |
| 504 | /* |
| 505 | * Setup the PCI device. |
| 506 | */ |
| 507 | pci_read_config_dword(devbusfn, PCI_BASE_ADDRESS_1, &bar); |
| 508 | dev->iobase = pci_mem_to_phys(devbusfn, bar); |
| 509 | dev->iobase &= ~0xf; |
| 510 | |
| 511 | PCNET_DEBUG1("%s: devbusfn=0x%x iobase=0x%lx: ", |
| 512 | dev->name, devbusfn, (unsigned long)dev->iobase); |
| 513 | |
| 514 | command = PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER; |
| 515 | pci_write_config_word(devbusfn, PCI_COMMAND, command); |
| 516 | pci_read_config_word(devbusfn, PCI_COMMAND, &status); |
| 517 | if ((status & command) != command) { |
| 518 | printf("%s: Couldn't enable IO access or Bus Mastering\n", |
| 519 | dev->name); |
| 520 | free(dev); |
| 521 | continue; |
| 522 | } |
| 523 | |
| 524 | pci_write_config_byte(devbusfn, PCI_LATENCY_TIMER, 0x40); |
| 525 | |
| 526 | /* |
| 527 | * Probe the PCnet chip. |
| 528 | */ |
| 529 | if (pcnet_probe(dev, bis, dev_nr) < 0) { |
| 530 | free(dev); |
| 531 | continue; |
| 532 | } |
| 533 | |
| 534 | /* |
| 535 | * Setup device structure and register the driver. |
| 536 | */ |
| 537 | dev->init = pcnet_init; |
| 538 | dev->halt = pcnet_halt; |
| 539 | dev->send = pcnet_send; |
| 540 | dev->recv = pcnet_recv; |
| 541 | |
| 542 | eth_register(dev); |
| 543 | } |
| 544 | |
| 545 | udelay(10 * 1000); |
| 546 | |
| 547 | return dev_nr; |
| 548 | } |