GNU Linux-libre 4.14.251-gnu1
[releases.git] / drivers / net / ethernet / micrel / ks8851.c
1 /* drivers/net/ethernet/micrel/ks8851.c
2  *
3  * Copyright 2009 Simtec Electronics
4  *      http://www.simtec.co.uk/
5  *      Ben Dooks <ben@simtec.co.uk>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11
12 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
13
14 #define DEBUG
15
16 #include <linux/interrupt.h>
17 #include <linux/module.h>
18 #include <linux/kernel.h>
19 #include <linux/netdevice.h>
20 #include <linux/etherdevice.h>
21 #include <linux/ethtool.h>
22 #include <linux/cache.h>
23 #include <linux/crc32.h>
24 #include <linux/mii.h>
25 #include <linux/eeprom_93cx6.h>
26 #include <linux/regulator/consumer.h>
27
28 #include <linux/spi/spi.h>
29 #include <linux/gpio.h>
30 #include <linux/of_gpio.h>
31
32 #include "ks8851.h"
33
34 /**
35  * struct ks8851_rxctrl - KS8851 driver rx control
36  * @mchash: Multicast hash-table data.
37  * @rxcr1: KS_RXCR1 register setting
38  * @rxcr2: KS_RXCR2 register setting
39  *
40  * Representation of the settings needs to control the receive filtering
41  * such as the multicast hash-filter and the receive register settings. This
42  * is used to make the job of working out if the receive settings change and
43  * then issuing the new settings to the worker that will send the necessary
44  * commands.
45  */
46 struct ks8851_rxctrl {
47         u16     mchash[4];
48         u16     rxcr1;
49         u16     rxcr2;
50 };
51
52 /**
53  * union ks8851_tx_hdr - tx header data
54  * @txb: The header as bytes
55  * @txw: The header as 16bit, little-endian words
56  *
57  * A dual representation of the tx header data to allow
58  * access to individual bytes, and to allow 16bit accesses
59  * with 16bit alignment.
60  */
61 union ks8851_tx_hdr {
62         u8      txb[6];
63         __le16  txw[3];
64 };
65
66 /**
67  * struct ks8851_net - KS8851 driver private data
68  * @netdev: The network device we're bound to
69  * @spidev: The spi device we're bound to.
70  * @lock: Lock to ensure that the device is not accessed when busy.
71  * @statelock: Lock on this structure for tx list.
72  * @mii: The MII state information for the mii calls.
73  * @rxctrl: RX settings for @rxctrl_work.
74  * @tx_work: Work queue for tx packets
75  * @rxctrl_work: Work queue for updating RX mode and multicast lists
76  * @txq: Queue of packets for transmission.
77  * @spi_msg1: pre-setup SPI transfer with one message, @spi_xfer1.
78  * @spi_msg2: pre-setup SPI transfer with two messages, @spi_xfer2.
79  * @txh: Space for generating packet TX header in DMA-able data
80  * @rxd: Space for receiving SPI data, in DMA-able space.
81  * @txd: Space for transmitting SPI data, in DMA-able space.
82  * @msg_enable: The message flags controlling driver output (see ethtool).
83  * @fid: Incrementing frame id tag.
84  * @rc_ier: Cached copy of KS_IER.
85  * @rc_ccr: Cached copy of KS_CCR.
86  * @rc_rxqcr: Cached copy of KS_RXQCR.
87  * @eeprom: 93CX6 EEPROM state for accessing on-board EEPROM.
88  * @vdd_reg:    Optional regulator supplying the chip
89  * @vdd_io: Optional digital power supply for IO
90  * @gpio: Optional reset_n gpio
91  *
92  * The @lock ensures that the chip is protected when certain operations are
93  * in progress. When the read or write packet transfer is in progress, most
94  * of the chip registers are not ccessible until the transfer is finished and
95  * the DMA has been de-asserted.
96  *
97  * The @statelock is used to protect information in the structure which may
98  * need to be accessed via several sources, such as the network driver layer
99  * or one of the work queues.
100  *
101  * We align the buffers we may use for rx/tx to ensure that if the SPI driver
102  * wants to DMA map them, it will not have any problems with data the driver
103  * modifies.
104  */
105 struct ks8851_net {
106         struct net_device       *netdev;
107         struct spi_device       *spidev;
108         struct mutex            lock;
109         spinlock_t              statelock;
110
111         union ks8851_tx_hdr     txh ____cacheline_aligned;
112         u8                      rxd[8];
113         u8                      txd[8];
114
115         u32                     msg_enable ____cacheline_aligned;
116         u16                     tx_space;
117         u8                      fid;
118
119         u16                     rc_ier;
120         u16                     rc_rxqcr;
121         u16                     rc_ccr;
122
123         struct mii_if_info      mii;
124         struct ks8851_rxctrl    rxctrl;
125
126         struct work_struct      tx_work;
127         struct work_struct      rxctrl_work;
128
129         struct sk_buff_head     txq;
130
131         struct spi_message      spi_msg1;
132         struct spi_message      spi_msg2;
133         struct spi_transfer     spi_xfer1;
134         struct spi_transfer     spi_xfer2[2];
135
136         struct eeprom_93cx6     eeprom;
137         struct regulator        *vdd_reg;
138         struct regulator        *vdd_io;
139         int                     gpio;
140 };
141
142 static int msg_enable;
143
144 /* shift for byte-enable data */
145 #define BYTE_EN(_x)     ((_x) << 2)
146
147 /* turn register number and byte-enable mask into data for start of packet */
148 #define MK_OP(_byteen, _reg) (BYTE_EN(_byteen) | (_reg)  << (8+2) | (_reg) >> 6)
149
150 /* SPI register read/write calls.
151  *
152  * All these calls issue SPI transactions to access the chip's registers. They
153  * all require that the necessary lock is held to prevent accesses when the
154  * chip is busy transferring packet data (RX/TX FIFO accesses).
155  */
156
157 /**
158  * ks8851_wrreg16 - write 16bit register value to chip
159  * @ks: The chip state
160  * @reg: The register address
161  * @val: The value to write
162  *
163  * Issue a write to put the value @val into the register specified in @reg.
164  */
165 static void ks8851_wrreg16(struct ks8851_net *ks, unsigned reg, unsigned val)
166 {
167         struct spi_transfer *xfer = &ks->spi_xfer1;
168         struct spi_message *msg = &ks->spi_msg1;
169         __le16 txb[2];
170         int ret;
171
172         txb[0] = cpu_to_le16(MK_OP(reg & 2 ? 0xC : 0x03, reg) | KS_SPIOP_WR);
173         txb[1] = cpu_to_le16(val);
174
175         xfer->tx_buf = txb;
176         xfer->rx_buf = NULL;
177         xfer->len = 4;
178
179         ret = spi_sync(ks->spidev, msg);
180         if (ret < 0)
181                 netdev_err(ks->netdev, "spi_sync() failed\n");
182 }
183
184 /**
185  * ks8851_wrreg8 - write 8bit register value to chip
186  * @ks: The chip state
187  * @reg: The register address
188  * @val: The value to write
189  *
190  * Issue a write to put the value @val into the register specified in @reg.
191  */
192 static void ks8851_wrreg8(struct ks8851_net *ks, unsigned reg, unsigned val)
193 {
194         struct spi_transfer *xfer = &ks->spi_xfer1;
195         struct spi_message *msg = &ks->spi_msg1;
196         __le16 txb[2];
197         int ret;
198         int bit;
199
200         bit = 1 << (reg & 3);
201
202         txb[0] = cpu_to_le16(MK_OP(bit, reg) | KS_SPIOP_WR);
203         txb[1] = val;
204
205         xfer->tx_buf = txb;
206         xfer->rx_buf = NULL;
207         xfer->len = 3;
208
209         ret = spi_sync(ks->spidev, msg);
210         if (ret < 0)
211                 netdev_err(ks->netdev, "spi_sync() failed\n");
212 }
213
214 /**
215  * ks8851_rdreg - issue read register command and return the data
216  * @ks: The device state
217  * @op: The register address and byte enables in message format.
218  * @rxb: The RX buffer to return the result into
219  * @rxl: The length of data expected.
220  *
221  * This is the low level read call that issues the necessary spi message(s)
222  * to read data from the register specified in @op.
223  */
224 static void ks8851_rdreg(struct ks8851_net *ks, unsigned op,
225                          u8 *rxb, unsigned rxl)
226 {
227         struct spi_transfer *xfer;
228         struct spi_message *msg;
229         __le16 *txb = (__le16 *)ks->txd;
230         u8 *trx = ks->rxd;
231         int ret;
232
233         txb[0] = cpu_to_le16(op | KS_SPIOP_RD);
234
235         if (ks->spidev->master->flags & SPI_MASTER_HALF_DUPLEX) {
236                 msg = &ks->spi_msg2;
237                 xfer = ks->spi_xfer2;
238
239                 xfer->tx_buf = txb;
240                 xfer->rx_buf = NULL;
241                 xfer->len = 2;
242
243                 xfer++;
244                 xfer->tx_buf = NULL;
245                 xfer->rx_buf = trx;
246                 xfer->len = rxl;
247         } else {
248                 msg = &ks->spi_msg1;
249                 xfer = &ks->spi_xfer1;
250
251                 xfer->tx_buf = txb;
252                 xfer->rx_buf = trx;
253                 xfer->len = rxl + 2;
254         }
255
256         ret = spi_sync(ks->spidev, msg);
257         if (ret < 0)
258                 netdev_err(ks->netdev, "read: spi_sync() failed\n");
259         else if (ks->spidev->master->flags & SPI_MASTER_HALF_DUPLEX)
260                 memcpy(rxb, trx, rxl);
261         else
262                 memcpy(rxb, trx + 2, rxl);
263 }
264
265 /**
266  * ks8851_rdreg8 - read 8 bit register from device
267  * @ks: The chip information
268  * @reg: The register address
269  *
270  * Read a 8bit register from the chip, returning the result
271 */
272 static unsigned ks8851_rdreg8(struct ks8851_net *ks, unsigned reg)
273 {
274         u8 rxb[1];
275
276         ks8851_rdreg(ks, MK_OP(1 << (reg & 3), reg), rxb, 1);
277         return rxb[0];
278 }
279
280 /**
281  * ks8851_rdreg16 - read 16 bit register from device
282  * @ks: The chip information
283  * @reg: The register address
284  *
285  * Read a 16bit register from the chip, returning the result
286 */
287 static unsigned ks8851_rdreg16(struct ks8851_net *ks, unsigned reg)
288 {
289         __le16 rx = 0;
290
291         ks8851_rdreg(ks, MK_OP(reg & 2 ? 0xC : 0x3, reg), (u8 *)&rx, 2);
292         return le16_to_cpu(rx);
293 }
294
295 /**
296  * ks8851_rdreg32 - read 32 bit register from device
297  * @ks: The chip information
298  * @reg: The register address
299  *
300  * Read a 32bit register from the chip.
301  *
302  * Note, this read requires the address be aligned to 4 bytes.
303 */
304 static unsigned ks8851_rdreg32(struct ks8851_net *ks, unsigned reg)
305 {
306         __le32 rx = 0;
307
308         WARN_ON(reg & 3);
309
310         ks8851_rdreg(ks, MK_OP(0xf, reg), (u8 *)&rx, 4);
311         return le32_to_cpu(rx);
312 }
313
314 /**
315  * ks8851_soft_reset - issue one of the soft reset to the device
316  * @ks: The device state.
317  * @op: The bit(s) to set in the GRR
318  *
319  * Issue the relevant soft-reset command to the device's GRR register
320  * specified by @op.
321  *
322  * Note, the delays are in there as a caution to ensure that the reset
323  * has time to take effect and then complete. Since the datasheet does
324  * not currently specify the exact sequence, we have chosen something
325  * that seems to work with our device.
326  */
327 static void ks8851_soft_reset(struct ks8851_net *ks, unsigned op)
328 {
329         ks8851_wrreg16(ks, KS_GRR, op);
330         mdelay(1);      /* wait a short time to effect reset */
331         ks8851_wrreg16(ks, KS_GRR, 0);
332         mdelay(1);      /* wait for condition to clear */
333 }
334
335 /**
336  * ks8851_set_powermode - set power mode of the device
337  * @ks: The device state
338  * @pwrmode: The power mode value to write to KS_PMECR.
339  *
340  * Change the power mode of the chip.
341  */
342 static void ks8851_set_powermode(struct ks8851_net *ks, unsigned pwrmode)
343 {
344         unsigned pmecr;
345
346         netif_dbg(ks, hw, ks->netdev, "setting power mode %d\n", pwrmode);
347
348         pmecr = ks8851_rdreg16(ks, KS_PMECR);
349         pmecr &= ~PMECR_PM_MASK;
350         pmecr |= pwrmode;
351
352         ks8851_wrreg16(ks, KS_PMECR, pmecr);
353 }
354
355 /**
356  * ks8851_write_mac_addr - write mac address to device registers
357  * @dev: The network device
358  *
359  * Update the KS8851 MAC address registers from the address in @dev.
360  *
361  * This call assumes that the chip is not running, so there is no need to
362  * shutdown the RXQ process whilst setting this.
363 */
364 static int ks8851_write_mac_addr(struct net_device *dev)
365 {
366         struct ks8851_net *ks = netdev_priv(dev);
367         int i;
368
369         mutex_lock(&ks->lock);
370
371         /*
372          * Wake up chip in case it was powered off when stopped; otherwise,
373          * the first write to the MAC address does not take effect.
374          */
375         ks8851_set_powermode(ks, PMECR_PM_NORMAL);
376         for (i = 0; i < ETH_ALEN; i++)
377                 ks8851_wrreg8(ks, KS_MAR(i), dev->dev_addr[i]);
378         if (!netif_running(dev))
379                 ks8851_set_powermode(ks, PMECR_PM_SOFTDOWN);
380
381         mutex_unlock(&ks->lock);
382
383         return 0;
384 }
385
386 /**
387  * ks8851_read_mac_addr - read mac address from device registers
388  * @dev: The network device
389  *
390  * Update our copy of the KS8851 MAC address from the registers of @dev.
391 */
392 static void ks8851_read_mac_addr(struct net_device *dev)
393 {
394         struct ks8851_net *ks = netdev_priv(dev);
395         int i;
396
397         mutex_lock(&ks->lock);
398
399         for (i = 0; i < ETH_ALEN; i++)
400                 dev->dev_addr[i] = ks8851_rdreg8(ks, KS_MAR(i));
401
402         mutex_unlock(&ks->lock);
403 }
404
405 /**
406  * ks8851_init_mac - initialise the mac address
407  * @ks: The device structure
408  *
409  * Get or create the initial mac address for the device and then set that
410  * into the station address register. If there is an EEPROM present, then
411  * we try that. If no valid mac address is found we use eth_random_addr()
412  * to create a new one.
413  */
414 static void ks8851_init_mac(struct ks8851_net *ks)
415 {
416         struct net_device *dev = ks->netdev;
417
418         /* first, try reading what we've got already */
419         if (ks->rc_ccr & CCR_EEPROM) {
420                 ks8851_read_mac_addr(dev);
421                 if (is_valid_ether_addr(dev->dev_addr))
422                         return;
423
424                 netdev_err(ks->netdev, "invalid mac address read %pM\n",
425                                 dev->dev_addr);
426         }
427
428         eth_hw_addr_random(dev);
429         ks8851_write_mac_addr(dev);
430 }
431
432 /**
433  * ks8851_rdfifo - read data from the receive fifo
434  * @ks: The device state.
435  * @buff: The buffer address
436  * @len: The length of the data to read
437  *
438  * Issue an RXQ FIFO read command and read the @len amount of data from
439  * the FIFO into the buffer specified by @buff.
440  */
441 static void ks8851_rdfifo(struct ks8851_net *ks, u8 *buff, unsigned len)
442 {
443         struct spi_transfer *xfer = ks->spi_xfer2;
444         struct spi_message *msg = &ks->spi_msg2;
445         u8 txb[1];
446         int ret;
447
448         netif_dbg(ks, rx_status, ks->netdev,
449                   "%s: %d@%p\n", __func__, len, buff);
450
451         /* set the operation we're issuing */
452         txb[0] = KS_SPIOP_RXFIFO;
453
454         xfer->tx_buf = txb;
455         xfer->rx_buf = NULL;
456         xfer->len = 1;
457
458         xfer++;
459         xfer->rx_buf = buff;
460         xfer->tx_buf = NULL;
461         xfer->len = len;
462
463         ret = spi_sync(ks->spidev, msg);
464         if (ret < 0)
465                 netdev_err(ks->netdev, "%s: spi_sync() failed\n", __func__);
466 }
467
468 /**
469  * ks8851_dbg_dumpkkt - dump initial packet contents to debug
470  * @ks: The device state
471  * @rxpkt: The data for the received packet
472  *
473  * Dump the initial data from the packet to dev_dbg().
474 */
475 static void ks8851_dbg_dumpkkt(struct ks8851_net *ks, u8 *rxpkt)
476 {
477         netdev_dbg(ks->netdev,
478                    "pkt %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x\n",
479                    rxpkt[4], rxpkt[5], rxpkt[6], rxpkt[7],
480                    rxpkt[8], rxpkt[9], rxpkt[10], rxpkt[11],
481                    rxpkt[12], rxpkt[13], rxpkt[14], rxpkt[15]);
482 }
483
484 /**
485  * ks8851_rx_pkts - receive packets from the host
486  * @ks: The device information.
487  *
488  * This is called from the IRQ work queue when the system detects that there
489  * are packets in the receive queue. Find out how many packets there are and
490  * read them from the FIFO.
491  */
492 static void ks8851_rx_pkts(struct ks8851_net *ks)
493 {
494         struct sk_buff *skb;
495         unsigned rxfc;
496         unsigned rxlen;
497         unsigned rxstat;
498         u32 rxh;
499         u8 *rxpkt;
500
501         rxfc = ks8851_rdreg8(ks, KS_RXFC);
502
503         netif_dbg(ks, rx_status, ks->netdev,
504                   "%s: %d packets\n", __func__, rxfc);
505
506         /* Currently we're issuing a read per packet, but we could possibly
507          * improve the code by issuing a single read, getting the receive
508          * header, allocating the packet and then reading the packet data
509          * out in one go.
510          *
511          * This form of operation would require us to hold the SPI bus'
512          * chipselect low during the entie transaction to avoid any
513          * reset to the data stream coming from the chip.
514          */
515
516         for (; rxfc != 0; rxfc--) {
517                 rxh = ks8851_rdreg32(ks, KS_RXFHSR);
518                 rxstat = rxh & 0xffff;
519                 rxlen = (rxh >> 16) & 0xfff;
520
521                 netif_dbg(ks, rx_status, ks->netdev,
522                           "rx: stat 0x%04x, len 0x%04x\n", rxstat, rxlen);
523
524                 /* the length of the packet includes the 32bit CRC */
525
526                 /* set dma read address */
527                 ks8851_wrreg16(ks, KS_RXFDPR, RXFDPR_RXFPAI | 0x00);
528
529                 /* start DMA access */
530                 ks8851_wrreg16(ks, KS_RXQCR, ks->rc_rxqcr | RXQCR_SDA);
531
532                 if (rxlen > 4) {
533                         unsigned int rxalign;
534
535                         rxlen -= 4;
536                         rxalign = ALIGN(rxlen, 4);
537                         skb = netdev_alloc_skb_ip_align(ks->netdev, rxalign);
538                         if (skb) {
539
540                                 /* 4 bytes of status header + 4 bytes of
541                                  * garbage: we put them before ethernet
542                                  * header, so that they are copied,
543                                  * but ignored.
544                                  */
545
546                                 rxpkt = skb_put(skb, rxlen) - 8;
547
548                                 ks8851_rdfifo(ks, rxpkt, rxalign + 8);
549
550                                 if (netif_msg_pktdata(ks))
551                                         ks8851_dbg_dumpkkt(ks, rxpkt);
552
553                                 skb->protocol = eth_type_trans(skb, ks->netdev);
554                                 netif_rx_ni(skb);
555
556                                 ks->netdev->stats.rx_packets++;
557                                 ks->netdev->stats.rx_bytes += rxlen;
558                         }
559                 }
560
561                 /* end DMA access and dequeue packet */
562                 ks8851_wrreg16(ks, KS_RXQCR, ks->rc_rxqcr | RXQCR_RRXEF);
563         }
564 }
565
566 /**
567  * ks8851_irq - IRQ handler for dealing with interrupt requests
568  * @irq: IRQ number
569  * @_ks: cookie
570  *
571  * This handler is invoked when the IRQ line asserts to find out what happened.
572  * As we cannot allow ourselves to sleep in HARDIRQ context, this handler runs
573  * in thread context.
574  *
575  * Read the interrupt status, work out what needs to be done and then clear
576  * any of the interrupts that are not needed.
577  */
578 static irqreturn_t ks8851_irq(int irq, void *_ks)
579 {
580         struct ks8851_net *ks = _ks;
581         unsigned status;
582         unsigned handled = 0;
583
584         mutex_lock(&ks->lock);
585
586         status = ks8851_rdreg16(ks, KS_ISR);
587
588         netif_dbg(ks, intr, ks->netdev,
589                   "%s: status 0x%04x\n", __func__, status);
590
591         if (status & IRQ_LCI)
592                 handled |= IRQ_LCI;
593
594         if (status & IRQ_LDI) {
595                 u16 pmecr = ks8851_rdreg16(ks, KS_PMECR);
596                 pmecr &= ~PMECR_WKEVT_MASK;
597                 ks8851_wrreg16(ks, KS_PMECR, pmecr | PMECR_WKEVT_LINK);
598
599                 handled |= IRQ_LDI;
600         }
601
602         if (status & IRQ_RXPSI)
603                 handled |= IRQ_RXPSI;
604
605         if (status & IRQ_TXI) {
606                 handled |= IRQ_TXI;
607
608                 /* no lock here, tx queue should have been stopped */
609
610                 /* update our idea of how much tx space is available to the
611                  * system */
612                 ks->tx_space = ks8851_rdreg16(ks, KS_TXMIR);
613
614                 netif_dbg(ks, intr, ks->netdev,
615                           "%s: txspace %d\n", __func__, ks->tx_space);
616         }
617
618         if (status & IRQ_RXI)
619                 handled |= IRQ_RXI;
620
621         if (status & IRQ_SPIBEI) {
622                 dev_err(&ks->spidev->dev, "%s: spi bus error\n", __func__);
623                 handled |= IRQ_SPIBEI;
624         }
625
626         ks8851_wrreg16(ks, KS_ISR, handled);
627
628         if (status & IRQ_RXI) {
629                 /* the datasheet says to disable the rx interrupt during
630                  * packet read-out, however we're masking the interrupt
631                  * from the device so do not bother masking just the RX
632                  * from the device. */
633
634                 ks8851_rx_pkts(ks);
635         }
636
637         /* if something stopped the rx process, probably due to wanting
638          * to change the rx settings, then do something about restarting
639          * it. */
640         if (status & IRQ_RXPSI) {
641                 struct ks8851_rxctrl *rxc = &ks->rxctrl;
642
643                 /* update the multicast hash table */
644                 ks8851_wrreg16(ks, KS_MAHTR0, rxc->mchash[0]);
645                 ks8851_wrreg16(ks, KS_MAHTR1, rxc->mchash[1]);
646                 ks8851_wrreg16(ks, KS_MAHTR2, rxc->mchash[2]);
647                 ks8851_wrreg16(ks, KS_MAHTR3, rxc->mchash[3]);
648
649                 ks8851_wrreg16(ks, KS_RXCR2, rxc->rxcr2);
650                 ks8851_wrreg16(ks, KS_RXCR1, rxc->rxcr1);
651         }
652
653         mutex_unlock(&ks->lock);
654
655         if (status & IRQ_LCI)
656                 mii_check_link(&ks->mii);
657
658         if (status & IRQ_TXI)
659                 netif_wake_queue(ks->netdev);
660
661         return IRQ_HANDLED;
662 }
663
664 /**
665  * calc_txlen - calculate size of message to send packet
666  * @len: Length of data
667  *
668  * Returns the size of the TXFIFO message needed to send
669  * this packet.
670  */
671 static inline unsigned calc_txlen(unsigned len)
672 {
673         return ALIGN(len + 4, 4);
674 }
675
676 /**
677  * ks8851_wrpkt - write packet to TX FIFO
678  * @ks: The device state.
679  * @txp: The sk_buff to transmit.
680  * @irq: IRQ on completion of the packet.
681  *
682  * Send the @txp to the chip. This means creating the relevant packet header
683  * specifying the length of the packet and the other information the chip
684  * needs, such as IRQ on completion. Send the header and the packet data to
685  * the device.
686  */
687 static void ks8851_wrpkt(struct ks8851_net *ks, struct sk_buff *txp, bool irq)
688 {
689         struct spi_transfer *xfer = ks->spi_xfer2;
690         struct spi_message *msg = &ks->spi_msg2;
691         unsigned fid = 0;
692         int ret;
693
694         netif_dbg(ks, tx_queued, ks->netdev, "%s: skb %p, %d@%p, irq %d\n",
695                   __func__, txp, txp->len, txp->data, irq);
696
697         fid = ks->fid++;
698         fid &= TXFR_TXFID_MASK;
699
700         if (irq)
701                 fid |= TXFR_TXIC;       /* irq on completion */
702
703         /* start header at txb[1] to align txw entries */
704         ks->txh.txb[1] = KS_SPIOP_TXFIFO;
705         ks->txh.txw[1] = cpu_to_le16(fid);
706         ks->txh.txw[2] = cpu_to_le16(txp->len);
707
708         xfer->tx_buf = &ks->txh.txb[1];
709         xfer->rx_buf = NULL;
710         xfer->len = 5;
711
712         xfer++;
713         xfer->tx_buf = txp->data;
714         xfer->rx_buf = NULL;
715         xfer->len = ALIGN(txp->len, 4);
716
717         ret = spi_sync(ks->spidev, msg);
718         if (ret < 0)
719                 netdev_err(ks->netdev, "%s: spi_sync() failed\n", __func__);
720 }
721
722 /**
723  * ks8851_done_tx - update and then free skbuff after transmitting
724  * @ks: The device state
725  * @txb: The buffer transmitted
726  */
727 static void ks8851_done_tx(struct ks8851_net *ks, struct sk_buff *txb)
728 {
729         struct net_device *dev = ks->netdev;
730
731         dev->stats.tx_bytes += txb->len;
732         dev->stats.tx_packets++;
733
734         dev_kfree_skb(txb);
735 }
736
737 /**
738  * ks8851_tx_work - process tx packet(s)
739  * @work: The work strucutre what was scheduled.
740  *
741  * This is called when a number of packets have been scheduled for
742  * transmission and need to be sent to the device.
743  */
744 static void ks8851_tx_work(struct work_struct *work)
745 {
746         struct ks8851_net *ks = container_of(work, struct ks8851_net, tx_work);
747         struct sk_buff *txb;
748         bool last = skb_queue_empty(&ks->txq);
749
750         mutex_lock(&ks->lock);
751
752         while (!last) {
753                 txb = skb_dequeue(&ks->txq);
754                 last = skb_queue_empty(&ks->txq);
755
756                 if (txb != NULL) {
757                         ks8851_wrreg16(ks, KS_RXQCR, ks->rc_rxqcr | RXQCR_SDA);
758                         ks8851_wrpkt(ks, txb, last);
759                         ks8851_wrreg16(ks, KS_RXQCR, ks->rc_rxqcr);
760                         ks8851_wrreg16(ks, KS_TXQCR, TXQCR_METFE);
761
762                         ks8851_done_tx(ks, txb);
763                 }
764         }
765
766         mutex_unlock(&ks->lock);
767 }
768
769 /**
770  * ks8851_net_open - open network device
771  * @dev: The network device being opened.
772  *
773  * Called when the network device is marked active, such as a user executing
774  * 'ifconfig up' on the device.
775  */
776 static int ks8851_net_open(struct net_device *dev)
777 {
778         struct ks8851_net *ks = netdev_priv(dev);
779         int ret;
780
781         ret = request_threaded_irq(dev->irq, NULL, ks8851_irq,
782                                    IRQF_TRIGGER_LOW | IRQF_ONESHOT,
783                                    dev->name, ks);
784         if (ret < 0) {
785                 netdev_err(dev, "failed to get irq\n");
786                 return ret;
787         }
788
789         /* lock the card, even if we may not actually be doing anything
790          * else at the moment */
791         mutex_lock(&ks->lock);
792
793         netif_dbg(ks, ifup, ks->netdev, "opening\n");
794
795         /* bring chip out of any power saving mode it was in */
796         ks8851_set_powermode(ks, PMECR_PM_NORMAL);
797
798         /* issue a soft reset to the RX/TX QMU to put it into a known
799          * state. */
800         ks8851_soft_reset(ks, GRR_QMU);
801
802         /* setup transmission parameters */
803
804         ks8851_wrreg16(ks, KS_TXCR, (TXCR_TXE | /* enable transmit process */
805                                      TXCR_TXPE | /* pad to min length */
806                                      TXCR_TXCRC | /* add CRC */
807                                      TXCR_TXFCE)); /* enable flow control */
808
809         /* auto-increment tx data, reset tx pointer */
810         ks8851_wrreg16(ks, KS_TXFDPR, TXFDPR_TXFPAI);
811
812         /* setup receiver control */
813
814         ks8851_wrreg16(ks, KS_RXCR1, (RXCR1_RXPAFMA | /*  from mac filter */
815                                       RXCR1_RXFCE | /* enable flow control */
816                                       RXCR1_RXBE | /* broadcast enable */
817                                       RXCR1_RXUE | /* unicast enable */
818                                       RXCR1_RXE)); /* enable rx block */
819
820         /* transfer entire frames out in one go */
821         ks8851_wrreg16(ks, KS_RXCR2, RXCR2_SRDBL_FRAME);
822
823         /* set receive counter timeouts */
824         ks8851_wrreg16(ks, KS_RXDTTR, 1000); /* 1ms after first frame to IRQ */
825         ks8851_wrreg16(ks, KS_RXDBCTR, 4096); /* >4Kbytes in buffer to IRQ */
826         ks8851_wrreg16(ks, KS_RXFCTR, 10);  /* 10 frames to IRQ */
827
828         ks->rc_rxqcr = (RXQCR_RXFCTE |  /* IRQ on frame count exceeded */
829                         RXQCR_RXDBCTE | /* IRQ on byte count exceeded */
830                         RXQCR_RXDTTE);  /* IRQ on time exceeded */
831
832         ks8851_wrreg16(ks, KS_RXQCR, ks->rc_rxqcr);
833
834         /* clear then enable interrupts */
835
836 #define STD_IRQ (IRQ_LCI |      /* Link Change */       \
837                  IRQ_TXI |      /* TX done */           \
838                  IRQ_RXI |      /* RX done */           \
839                  IRQ_SPIBEI |   /* SPI bus error */     \
840                  IRQ_TXPSI |    /* TX process stop */   \
841                  IRQ_RXPSI)     /* RX process stop */
842
843         ks->rc_ier = STD_IRQ;
844         ks8851_wrreg16(ks, KS_ISR, STD_IRQ);
845         ks8851_wrreg16(ks, KS_IER, STD_IRQ);
846
847         netif_start_queue(ks->netdev);
848
849         netif_dbg(ks, ifup, ks->netdev, "network device up\n");
850
851         mutex_unlock(&ks->lock);
852         mii_check_link(&ks->mii);
853         return 0;
854 }
855
856 /**
857  * ks8851_net_stop - close network device
858  * @dev: The device being closed.
859  *
860  * Called to close down a network device which has been active. Cancell any
861  * work, shutdown the RX and TX process and then place the chip into a low
862  * power state whilst it is not being used.
863  */
864 static int ks8851_net_stop(struct net_device *dev)
865 {
866         struct ks8851_net *ks = netdev_priv(dev);
867
868         netif_info(ks, ifdown, dev, "shutting down\n");
869
870         netif_stop_queue(dev);
871
872         mutex_lock(&ks->lock);
873         /* turn off the IRQs and ack any outstanding */
874         ks8851_wrreg16(ks, KS_IER, 0x0000);
875         ks8851_wrreg16(ks, KS_ISR, 0xffff);
876         mutex_unlock(&ks->lock);
877
878         /* stop any outstanding work */
879         flush_work(&ks->tx_work);
880         flush_work(&ks->rxctrl_work);
881
882         mutex_lock(&ks->lock);
883         /* shutdown RX process */
884         ks8851_wrreg16(ks, KS_RXCR1, 0x0000);
885
886         /* shutdown TX process */
887         ks8851_wrreg16(ks, KS_TXCR, 0x0000);
888
889         /* set powermode to soft power down to save power */
890         ks8851_set_powermode(ks, PMECR_PM_SOFTDOWN);
891         mutex_unlock(&ks->lock);
892
893         /* ensure any queued tx buffers are dumped */
894         while (!skb_queue_empty(&ks->txq)) {
895                 struct sk_buff *txb = skb_dequeue(&ks->txq);
896
897                 netif_dbg(ks, ifdown, ks->netdev,
898                           "%s: freeing txb %p\n", __func__, txb);
899
900                 dev_kfree_skb(txb);
901         }
902
903         free_irq(dev->irq, ks);
904
905         return 0;
906 }
907
908 /**
909  * ks8851_start_xmit - transmit packet
910  * @skb: The buffer to transmit
911  * @dev: The device used to transmit the packet.
912  *
913  * Called by the network layer to transmit the @skb. Queue the packet for
914  * the device and schedule the necessary work to transmit the packet when
915  * it is free.
916  *
917  * We do this to firstly avoid sleeping with the network device locked,
918  * and secondly so we can round up more than one packet to transmit which
919  * means we can try and avoid generating too many transmit done interrupts.
920  */
921 static netdev_tx_t ks8851_start_xmit(struct sk_buff *skb,
922                                      struct net_device *dev)
923 {
924         struct ks8851_net *ks = netdev_priv(dev);
925         unsigned needed = calc_txlen(skb->len);
926         netdev_tx_t ret = NETDEV_TX_OK;
927
928         netif_dbg(ks, tx_queued, ks->netdev,
929                   "%s: skb %p, %d@%p\n", __func__, skb, skb->len, skb->data);
930
931         spin_lock(&ks->statelock);
932
933         if (needed > ks->tx_space) {
934                 netif_stop_queue(dev);
935                 ret = NETDEV_TX_BUSY;
936         } else {
937                 ks->tx_space -= needed;
938                 skb_queue_tail(&ks->txq, skb);
939         }
940
941         spin_unlock(&ks->statelock);
942         schedule_work(&ks->tx_work);
943
944         return ret;
945 }
946
947 /**
948  * ks8851_rxctrl_work - work handler to change rx mode
949  * @work: The work structure this belongs to.
950  *
951  * Lock the device and issue the necessary changes to the receive mode from
952  * the network device layer. This is done so that we can do this without
953  * having to sleep whilst holding the network device lock.
954  *
955  * Since the recommendation from Micrel is that the RXQ is shutdown whilst the
956  * receive parameters are programmed, we issue a write to disable the RXQ and
957  * then wait for the interrupt handler to be triggered once the RXQ shutdown is
958  * complete. The interrupt handler then writes the new values into the chip.
959  */
960 static void ks8851_rxctrl_work(struct work_struct *work)
961 {
962         struct ks8851_net *ks = container_of(work, struct ks8851_net, rxctrl_work);
963
964         mutex_lock(&ks->lock);
965
966         /* need to shutdown RXQ before modifying filter parameters */
967         ks8851_wrreg16(ks, KS_RXCR1, 0x00);
968
969         mutex_unlock(&ks->lock);
970 }
971
972 static void ks8851_set_rx_mode(struct net_device *dev)
973 {
974         struct ks8851_net *ks = netdev_priv(dev);
975         struct ks8851_rxctrl rxctrl;
976
977         memset(&rxctrl, 0, sizeof(rxctrl));
978
979         if (dev->flags & IFF_PROMISC) {
980                 /* interface to receive everything */
981
982                 rxctrl.rxcr1 = RXCR1_RXAE | RXCR1_RXINVF;
983         } else if (dev->flags & IFF_ALLMULTI) {
984                 /* accept all multicast packets */
985
986                 rxctrl.rxcr1 = (RXCR1_RXME | RXCR1_RXAE |
987                                 RXCR1_RXPAFMA | RXCR1_RXMAFMA);
988         } else if (dev->flags & IFF_MULTICAST && !netdev_mc_empty(dev)) {
989                 struct netdev_hw_addr *ha;
990                 u32 crc;
991
992                 /* accept some multicast */
993
994                 netdev_for_each_mc_addr(ha, dev) {
995                         crc = ether_crc(ETH_ALEN, ha->addr);
996                         crc >>= (32 - 6);  /* get top six bits */
997
998                         rxctrl.mchash[crc >> 4] |= (1 << (crc & 0xf));
999                 }
1000
1001                 rxctrl.rxcr1 = RXCR1_RXME | RXCR1_RXPAFMA;
1002         } else {
1003                 /* just accept broadcast / unicast */
1004                 rxctrl.rxcr1 = RXCR1_RXPAFMA;
1005         }
1006
1007         rxctrl.rxcr1 |= (RXCR1_RXUE | /* unicast enable */
1008                          RXCR1_RXBE | /* broadcast enable */
1009                          RXCR1_RXE | /* RX process enable */
1010                          RXCR1_RXFCE); /* enable flow control */
1011
1012         rxctrl.rxcr2 |= RXCR2_SRDBL_FRAME;
1013
1014         /* schedule work to do the actual set of the data if needed */
1015
1016         spin_lock(&ks->statelock);
1017
1018         if (memcmp(&rxctrl, &ks->rxctrl, sizeof(rxctrl)) != 0) {
1019                 memcpy(&ks->rxctrl, &rxctrl, sizeof(ks->rxctrl));
1020                 schedule_work(&ks->rxctrl_work);
1021         }
1022
1023         spin_unlock(&ks->statelock);
1024 }
1025
1026 static int ks8851_set_mac_address(struct net_device *dev, void *addr)
1027 {
1028         struct sockaddr *sa = addr;
1029
1030         if (netif_running(dev))
1031                 return -EBUSY;
1032
1033         if (!is_valid_ether_addr(sa->sa_data))
1034                 return -EADDRNOTAVAIL;
1035
1036         memcpy(dev->dev_addr, sa->sa_data, ETH_ALEN);
1037         return ks8851_write_mac_addr(dev);
1038 }
1039
1040 static int ks8851_net_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
1041 {
1042         struct ks8851_net *ks = netdev_priv(dev);
1043
1044         if (!netif_running(dev))
1045                 return -EINVAL;
1046
1047         return generic_mii_ioctl(&ks->mii, if_mii(req), cmd, NULL);
1048 }
1049
1050 static const struct net_device_ops ks8851_netdev_ops = {
1051         .ndo_open               = ks8851_net_open,
1052         .ndo_stop               = ks8851_net_stop,
1053         .ndo_do_ioctl           = ks8851_net_ioctl,
1054         .ndo_start_xmit         = ks8851_start_xmit,
1055         .ndo_set_mac_address    = ks8851_set_mac_address,
1056         .ndo_set_rx_mode        = ks8851_set_rx_mode,
1057         .ndo_validate_addr      = eth_validate_addr,
1058 };
1059
1060 /* ethtool support */
1061
1062 static void ks8851_get_drvinfo(struct net_device *dev,
1063                                struct ethtool_drvinfo *di)
1064 {
1065         strlcpy(di->driver, "KS8851", sizeof(di->driver));
1066         strlcpy(di->version, "1.00", sizeof(di->version));
1067         strlcpy(di->bus_info, dev_name(dev->dev.parent), sizeof(di->bus_info));
1068 }
1069
1070 static u32 ks8851_get_msglevel(struct net_device *dev)
1071 {
1072         struct ks8851_net *ks = netdev_priv(dev);
1073         return ks->msg_enable;
1074 }
1075
1076 static void ks8851_set_msglevel(struct net_device *dev, u32 to)
1077 {
1078         struct ks8851_net *ks = netdev_priv(dev);
1079         ks->msg_enable = to;
1080 }
1081
1082 static int ks8851_get_link_ksettings(struct net_device *dev,
1083                                      struct ethtool_link_ksettings *cmd)
1084 {
1085         struct ks8851_net *ks = netdev_priv(dev);
1086
1087         mii_ethtool_get_link_ksettings(&ks->mii, cmd);
1088
1089         return 0;
1090 }
1091
1092 static int ks8851_set_link_ksettings(struct net_device *dev,
1093                                      const struct ethtool_link_ksettings *cmd)
1094 {
1095         struct ks8851_net *ks = netdev_priv(dev);
1096         return mii_ethtool_set_link_ksettings(&ks->mii, cmd);
1097 }
1098
1099 static u32 ks8851_get_link(struct net_device *dev)
1100 {
1101         struct ks8851_net *ks = netdev_priv(dev);
1102         return mii_link_ok(&ks->mii);
1103 }
1104
1105 static int ks8851_nway_reset(struct net_device *dev)
1106 {
1107         struct ks8851_net *ks = netdev_priv(dev);
1108         return mii_nway_restart(&ks->mii);
1109 }
1110
1111 /* EEPROM support */
1112
1113 static void ks8851_eeprom_regread(struct eeprom_93cx6 *ee)
1114 {
1115         struct ks8851_net *ks = ee->data;
1116         unsigned val;
1117
1118         val = ks8851_rdreg16(ks, KS_EEPCR);
1119
1120         ee->reg_data_out = (val & EEPCR_EESB) ? 1 : 0;
1121         ee->reg_data_clock = (val & EEPCR_EESCK) ? 1 : 0;
1122         ee->reg_chip_select = (val & EEPCR_EECS) ? 1 : 0;
1123 }
1124
1125 static void ks8851_eeprom_regwrite(struct eeprom_93cx6 *ee)
1126 {
1127         struct ks8851_net *ks = ee->data;
1128         unsigned val = EEPCR_EESA;      /* default - eeprom access on */
1129
1130         if (ee->drive_data)
1131                 val |= EEPCR_EESRWA;
1132         if (ee->reg_data_in)
1133                 val |= EEPCR_EEDO;
1134         if (ee->reg_data_clock)
1135                 val |= EEPCR_EESCK;
1136         if (ee->reg_chip_select)
1137                 val |= EEPCR_EECS;
1138
1139         ks8851_wrreg16(ks, KS_EEPCR, val);
1140 }
1141
1142 /**
1143  * ks8851_eeprom_claim - claim device EEPROM and activate the interface
1144  * @ks: The network device state.
1145  *
1146  * Check for the presence of an EEPROM, and then activate software access
1147  * to the device.
1148  */
1149 static int ks8851_eeprom_claim(struct ks8851_net *ks)
1150 {
1151         if (!(ks->rc_ccr & CCR_EEPROM))
1152                 return -ENOENT;
1153
1154         mutex_lock(&ks->lock);
1155
1156         /* start with clock low, cs high */
1157         ks8851_wrreg16(ks, KS_EEPCR, EEPCR_EESA | EEPCR_EECS);
1158         return 0;
1159 }
1160
1161 /**
1162  * ks8851_eeprom_release - release the EEPROM interface
1163  * @ks: The device state
1164  *
1165  * Release the software access to the device EEPROM
1166  */
1167 static void ks8851_eeprom_release(struct ks8851_net *ks)
1168 {
1169         unsigned val = ks8851_rdreg16(ks, KS_EEPCR);
1170
1171         ks8851_wrreg16(ks, KS_EEPCR, val & ~EEPCR_EESA);
1172         mutex_unlock(&ks->lock);
1173 }
1174
1175 #define KS_EEPROM_MAGIC (0x00008851)
1176
1177 static int ks8851_set_eeprom(struct net_device *dev,
1178                              struct ethtool_eeprom *ee, u8 *data)
1179 {
1180         struct ks8851_net *ks = netdev_priv(dev);
1181         int offset = ee->offset;
1182         int len = ee->len;
1183         u16 tmp;
1184
1185         /* currently only support byte writing */
1186         if (len != 1)
1187                 return -EINVAL;
1188
1189         if (ee->magic != KS_EEPROM_MAGIC)
1190                 return -EINVAL;
1191
1192         if (ks8851_eeprom_claim(ks))
1193                 return -ENOENT;
1194
1195         eeprom_93cx6_wren(&ks->eeprom, true);
1196
1197         /* ethtool currently only supports writing bytes, which means
1198          * we have to read/modify/write our 16bit EEPROMs */
1199
1200         eeprom_93cx6_read(&ks->eeprom, offset/2, &tmp);
1201
1202         if (offset & 1) {
1203                 tmp &= 0xff;
1204                 tmp |= *data << 8;
1205         } else {
1206                 tmp &= 0xff00;
1207                 tmp |= *data;
1208         }
1209
1210         eeprom_93cx6_write(&ks->eeprom, offset/2, tmp);
1211         eeprom_93cx6_wren(&ks->eeprom, false);
1212
1213         ks8851_eeprom_release(ks);
1214
1215         return 0;
1216 }
1217
1218 static int ks8851_get_eeprom(struct net_device *dev,
1219                              struct ethtool_eeprom *ee, u8 *data)
1220 {
1221         struct ks8851_net *ks = netdev_priv(dev);
1222         int offset = ee->offset;
1223         int len = ee->len;
1224
1225         /* must be 2 byte aligned */
1226         if (len & 1 || offset & 1)
1227                 return -EINVAL;
1228
1229         if (ks8851_eeprom_claim(ks))
1230                 return -ENOENT;
1231
1232         ee->magic = KS_EEPROM_MAGIC;
1233
1234         eeprom_93cx6_multiread(&ks->eeprom, offset/2, (__le16 *)data, len/2);
1235         ks8851_eeprom_release(ks);
1236
1237         return 0;
1238 }
1239
1240 static int ks8851_get_eeprom_len(struct net_device *dev)
1241 {
1242         struct ks8851_net *ks = netdev_priv(dev);
1243
1244         /* currently, we assume it is an 93C46 attached, so return 128 */
1245         return ks->rc_ccr & CCR_EEPROM ? 128 : 0;
1246 }
1247
1248 static const struct ethtool_ops ks8851_ethtool_ops = {
1249         .get_drvinfo    = ks8851_get_drvinfo,
1250         .get_msglevel   = ks8851_get_msglevel,
1251         .set_msglevel   = ks8851_set_msglevel,
1252         .get_link       = ks8851_get_link,
1253         .nway_reset     = ks8851_nway_reset,
1254         .get_eeprom_len = ks8851_get_eeprom_len,
1255         .get_eeprom     = ks8851_get_eeprom,
1256         .set_eeprom     = ks8851_set_eeprom,
1257         .get_link_ksettings = ks8851_get_link_ksettings,
1258         .set_link_ksettings = ks8851_set_link_ksettings,
1259 };
1260
1261 /* MII interface controls */
1262
1263 /**
1264  * ks8851_phy_reg - convert MII register into a KS8851 register
1265  * @reg: MII register number.
1266  *
1267  * Return the KS8851 register number for the corresponding MII PHY register
1268  * if possible. Return zero if the MII register has no direct mapping to the
1269  * KS8851 register set.
1270  */
1271 static int ks8851_phy_reg(int reg)
1272 {
1273         switch (reg) {
1274         case MII_BMCR:
1275                 return KS_P1MBCR;
1276         case MII_BMSR:
1277                 return KS_P1MBSR;
1278         case MII_PHYSID1:
1279                 return KS_PHY1ILR;
1280         case MII_PHYSID2:
1281                 return KS_PHY1IHR;
1282         case MII_ADVERTISE:
1283                 return KS_P1ANAR;
1284         case MII_LPA:
1285                 return KS_P1ANLPR;
1286         }
1287
1288         return 0x0;
1289 }
1290
1291 /**
1292  * ks8851_phy_read - MII interface PHY register read.
1293  * @dev: The network device the PHY is on.
1294  * @phy_addr: Address of PHY (ignored as we only have one)
1295  * @reg: The register to read.
1296  *
1297  * This call reads data from the PHY register specified in @reg. Since the
1298  * device does not support all the MII registers, the non-existent values
1299  * are always returned as zero.
1300  *
1301  * We return zero for unsupported registers as the MII code does not check
1302  * the value returned for any error status, and simply returns it to the
1303  * caller. The mii-tool that the driver was tested with takes any -ve error
1304  * as real PHY capabilities, thus displaying incorrect data to the user.
1305  */
1306 static int ks8851_phy_read(struct net_device *dev, int phy_addr, int reg)
1307 {
1308         struct ks8851_net *ks = netdev_priv(dev);
1309         int ksreg;
1310         int result;
1311
1312         ksreg = ks8851_phy_reg(reg);
1313         if (!ksreg)
1314                 return 0x0;     /* no error return allowed, so use zero */
1315
1316         mutex_lock(&ks->lock);
1317         result = ks8851_rdreg16(ks, ksreg);
1318         mutex_unlock(&ks->lock);
1319
1320         return result;
1321 }
1322
1323 static void ks8851_phy_write(struct net_device *dev,
1324                              int phy, int reg, int value)
1325 {
1326         struct ks8851_net *ks = netdev_priv(dev);
1327         int ksreg;
1328
1329         ksreg = ks8851_phy_reg(reg);
1330         if (ksreg) {
1331                 mutex_lock(&ks->lock);
1332                 ks8851_wrreg16(ks, ksreg, value);
1333                 mutex_unlock(&ks->lock);
1334         }
1335 }
1336
1337 /**
1338  * ks8851_read_selftest - read the selftest memory info.
1339  * @ks: The device state
1340  *
1341  * Read and check the TX/RX memory selftest information.
1342  */
1343 static int ks8851_read_selftest(struct ks8851_net *ks)
1344 {
1345         unsigned both_done = MBIR_TXMBF | MBIR_RXMBF;
1346         int ret = 0;
1347         unsigned rd;
1348
1349         rd = ks8851_rdreg16(ks, KS_MBIR);
1350
1351         if ((rd & both_done) != both_done) {
1352                 netdev_warn(ks->netdev, "Memory selftest not finished\n");
1353                 return 0;
1354         }
1355
1356         if (rd & MBIR_TXMBFA) {
1357                 netdev_err(ks->netdev, "TX memory selftest fail\n");
1358                 ret |= 1;
1359         }
1360
1361         if (rd & MBIR_RXMBFA) {
1362                 netdev_err(ks->netdev, "RX memory selftest fail\n");
1363                 ret |= 2;
1364         }
1365
1366         return 0;
1367 }
1368
1369 /* driver bus management functions */
1370
1371 #ifdef CONFIG_PM_SLEEP
1372
1373 static int ks8851_suspend(struct device *dev)
1374 {
1375         struct ks8851_net *ks = dev_get_drvdata(dev);
1376         struct net_device *netdev = ks->netdev;
1377
1378         if (netif_running(netdev)) {
1379                 netif_device_detach(netdev);
1380                 ks8851_net_stop(netdev);
1381         }
1382
1383         return 0;
1384 }
1385
1386 static int ks8851_resume(struct device *dev)
1387 {
1388         struct ks8851_net *ks = dev_get_drvdata(dev);
1389         struct net_device *netdev = ks->netdev;
1390
1391         if (netif_running(netdev)) {
1392                 ks8851_net_open(netdev);
1393                 netif_device_attach(netdev);
1394         }
1395
1396         return 0;
1397 }
1398 #endif
1399
1400 static SIMPLE_DEV_PM_OPS(ks8851_pm_ops, ks8851_suspend, ks8851_resume);
1401
1402 static int ks8851_probe(struct spi_device *spi)
1403 {
1404         struct net_device *ndev;
1405         struct ks8851_net *ks;
1406         int ret;
1407         unsigned cider;
1408         int gpio;
1409
1410         ndev = alloc_etherdev(sizeof(struct ks8851_net));
1411         if (!ndev)
1412                 return -ENOMEM;
1413
1414         spi->bits_per_word = 8;
1415
1416         ks = netdev_priv(ndev);
1417
1418         ks->netdev = ndev;
1419         ks->spidev = spi;
1420         ks->tx_space = 6144;
1421
1422         gpio = of_get_named_gpio_flags(spi->dev.of_node, "reset-gpios",
1423                                        0, NULL);
1424         if (gpio == -EPROBE_DEFER) {
1425                 ret = gpio;
1426                 goto err_gpio;
1427         }
1428
1429         ks->gpio = gpio;
1430         if (gpio_is_valid(gpio)) {
1431                 ret = devm_gpio_request_one(&spi->dev, gpio,
1432                                             GPIOF_OUT_INIT_LOW, "ks8851_rst_n");
1433                 if (ret) {
1434                         dev_err(&spi->dev, "reset gpio request failed\n");
1435                         goto err_gpio;
1436                 }
1437         }
1438
1439         ks->vdd_io = devm_regulator_get(&spi->dev, "vdd-io");
1440         if (IS_ERR(ks->vdd_io)) {
1441                 ret = PTR_ERR(ks->vdd_io);
1442                 goto err_reg_io;
1443         }
1444
1445         ret = regulator_enable(ks->vdd_io);
1446         if (ret) {
1447                 dev_err(&spi->dev, "regulator vdd_io enable fail: %d\n",
1448                         ret);
1449                 goto err_reg_io;
1450         }
1451
1452         ks->vdd_reg = devm_regulator_get(&spi->dev, "vdd");
1453         if (IS_ERR(ks->vdd_reg)) {
1454                 ret = PTR_ERR(ks->vdd_reg);
1455                 goto err_reg;
1456         }
1457
1458         ret = regulator_enable(ks->vdd_reg);
1459         if (ret) {
1460                 dev_err(&spi->dev, "regulator vdd enable fail: %d\n",
1461                         ret);
1462                 goto err_reg;
1463         }
1464
1465         if (gpio_is_valid(gpio)) {
1466                 usleep_range(10000, 11000);
1467                 gpio_set_value(gpio, 1);
1468         }
1469
1470         mutex_init(&ks->lock);
1471         spin_lock_init(&ks->statelock);
1472
1473         INIT_WORK(&ks->tx_work, ks8851_tx_work);
1474         INIT_WORK(&ks->rxctrl_work, ks8851_rxctrl_work);
1475
1476         /* initialise pre-made spi transfer messages */
1477
1478         spi_message_init(&ks->spi_msg1);
1479         spi_message_add_tail(&ks->spi_xfer1, &ks->spi_msg1);
1480
1481         spi_message_init(&ks->spi_msg2);
1482         spi_message_add_tail(&ks->spi_xfer2[0], &ks->spi_msg2);
1483         spi_message_add_tail(&ks->spi_xfer2[1], &ks->spi_msg2);
1484
1485         /* setup EEPROM state */
1486
1487         ks->eeprom.data = ks;
1488         ks->eeprom.width = PCI_EEPROM_WIDTH_93C46;
1489         ks->eeprom.register_read = ks8851_eeprom_regread;
1490         ks->eeprom.register_write = ks8851_eeprom_regwrite;
1491
1492         /* setup mii state */
1493         ks->mii.dev             = ndev;
1494         ks->mii.phy_id          = 1,
1495         ks->mii.phy_id_mask     = 1;
1496         ks->mii.reg_num_mask    = 0xf;
1497         ks->mii.mdio_read       = ks8851_phy_read;
1498         ks->mii.mdio_write      = ks8851_phy_write;
1499
1500         dev_info(&spi->dev, "message enable is %d\n", msg_enable);
1501
1502         /* set the default message enable */
1503         ks->msg_enable = netif_msg_init(msg_enable, (NETIF_MSG_DRV |
1504                                                      NETIF_MSG_PROBE |
1505                                                      NETIF_MSG_LINK));
1506
1507         skb_queue_head_init(&ks->txq);
1508
1509         ndev->ethtool_ops = &ks8851_ethtool_ops;
1510         SET_NETDEV_DEV(ndev, &spi->dev);
1511
1512         spi_set_drvdata(spi, ks);
1513
1514         netif_carrier_off(ks->netdev);
1515         ndev->if_port = IF_PORT_100BASET;
1516         ndev->netdev_ops = &ks8851_netdev_ops;
1517         ndev->irq = spi->irq;
1518
1519         /* issue a global soft reset to reset the device. */
1520         ks8851_soft_reset(ks, GRR_GSR);
1521
1522         /* simple check for a valid chip being connected to the bus */
1523         cider = ks8851_rdreg16(ks, KS_CIDER);
1524         if ((cider & ~CIDER_REV_MASK) != CIDER_ID) {
1525                 dev_err(&spi->dev, "failed to read device ID\n");
1526                 ret = -ENODEV;
1527                 goto err_id;
1528         }
1529
1530         /* cache the contents of the CCR register for EEPROM, etc. */
1531         ks->rc_ccr = ks8851_rdreg16(ks, KS_CCR);
1532
1533         ks8851_read_selftest(ks);
1534         ks8851_init_mac(ks);
1535
1536         ret = register_netdev(ndev);
1537         if (ret) {
1538                 dev_err(&spi->dev, "failed to register network device\n");
1539                 goto err_netdev;
1540         }
1541
1542         netdev_info(ndev, "revision %d, MAC %pM, IRQ %d, %s EEPROM\n",
1543                     CIDER_REV_GET(cider), ndev->dev_addr, ndev->irq,
1544                     ks->rc_ccr & CCR_EEPROM ? "has" : "no");
1545
1546         return 0;
1547
1548 err_netdev:
1549 err_id:
1550         if (gpio_is_valid(gpio))
1551                 gpio_set_value(gpio, 0);
1552         regulator_disable(ks->vdd_reg);
1553 err_reg:
1554         regulator_disable(ks->vdd_io);
1555 err_reg_io:
1556 err_gpio:
1557         free_netdev(ndev);
1558         return ret;
1559 }
1560
1561 static int ks8851_remove(struct spi_device *spi)
1562 {
1563         struct ks8851_net *priv = spi_get_drvdata(spi);
1564
1565         if (netif_msg_drv(priv))
1566                 dev_info(&spi->dev, "remove\n");
1567
1568         unregister_netdev(priv->netdev);
1569         if (gpio_is_valid(priv->gpio))
1570                 gpio_set_value(priv->gpio, 0);
1571         regulator_disable(priv->vdd_reg);
1572         regulator_disable(priv->vdd_io);
1573         free_netdev(priv->netdev);
1574
1575         return 0;
1576 }
1577
1578 static const struct of_device_id ks8851_match_table[] = {
1579         { .compatible = "micrel,ks8851" },
1580         { }
1581 };
1582 MODULE_DEVICE_TABLE(of, ks8851_match_table);
1583
1584 static struct spi_driver ks8851_driver = {
1585         .driver = {
1586                 .name = "ks8851",
1587                 .of_match_table = ks8851_match_table,
1588                 .pm = &ks8851_pm_ops,
1589         },
1590         .probe = ks8851_probe,
1591         .remove = ks8851_remove,
1592 };
1593 module_spi_driver(ks8851_driver);
1594
1595 MODULE_DESCRIPTION("KS8851 Network driver");
1596 MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
1597 MODULE_LICENSE("GPL");
1598
1599 module_param_named(message, msg_enable, int, 0);
1600 MODULE_PARM_DESC(message, "Message verbosity level (0=none, 31=all)");
1601 MODULE_ALIAS("spi:ks8851");