1
2
3
4
5
6
7
8
9#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
10
11#include <linux/interrupt.h>
12#include <linux/module.h>
13#include <linux/kernel.h>
14#include <linux/netdevice.h>
15#include <linux/etherdevice.h>
16#include <linux/ethtool.h>
17#include <linux/cache.h>
18#include <linux/crc32.h>
19#include <linux/mii.h>
20#include <linux/regulator/consumer.h>
21
22#include <linux/spi/spi.h>
23#include <linux/gpio.h>
24#include <linux/of_gpio.h>
25#include <linux/of_net.h>
26
27#include "ks8851.h"
28
29static int msg_enable;
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47struct ks8851_net_spi {
48 struct ks8851_net ks8851;
49 struct mutex lock;
50 struct work_struct tx_work;
51 struct spi_device *spidev;
52 struct spi_message spi_msg1;
53 struct spi_message spi_msg2;
54 struct spi_transfer spi_xfer1;
55 struct spi_transfer spi_xfer2[2];
56};
57
58#define to_ks8851_spi(ks) container_of((ks), struct ks8851_net_spi, ks8851)
59
60
61#define KS_SPIOP_RD 0x00
62#define KS_SPIOP_WR 0x40
63#define KS_SPIOP_RXFIFO 0x80
64#define KS_SPIOP_TXFIFO 0xC0
65
66
67#define BYTE_EN(_x) ((_x) << 2)
68
69
70#define MK_OP(_byteen, _reg) \
71 (BYTE_EN(_byteen) | (_reg) << (8 + 2) | (_reg) >> 6)
72
73
74
75
76
77
78
79
80static void ks8851_lock_spi(struct ks8851_net *ks, unsigned long *flags)
81{
82 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
83
84 mutex_lock(&kss->lock);
85}
86
87
88
89
90
91
92
93
94static void ks8851_unlock_spi(struct ks8851_net *ks, unsigned long *flags)
95{
96 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
97
98 mutex_unlock(&kss->lock);
99}
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116static void ks8851_wrreg16_spi(struct ks8851_net *ks, unsigned int reg,
117 unsigned int val)
118{
119 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
120 struct spi_transfer *xfer = &kss->spi_xfer1;
121 struct spi_message *msg = &kss->spi_msg1;
122 __le16 txb[2];
123 int ret;
124
125 txb[0] = cpu_to_le16(MK_OP(reg & 2 ? 0xC : 0x03, reg) | KS_SPIOP_WR);
126 txb[1] = cpu_to_le16(val);
127
128 xfer->tx_buf = txb;
129 xfer->rx_buf = NULL;
130 xfer->len = 4;
131
132 ret = spi_sync(kss->spidev, msg);
133 if (ret < 0)
134 netdev_err(ks->netdev, "spi_sync() failed\n");
135}
136
137
138
139
140
141
142
143
144
145
146
147static void ks8851_rdreg(struct ks8851_net *ks, unsigned int op,
148 u8 *rxb, unsigned int rxl)
149{
150 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
151 struct spi_transfer *xfer;
152 struct spi_message *msg;
153 __le16 *txb = (__le16 *)ks->txd;
154 u8 *trx = ks->rxd;
155 int ret;
156
157 txb[0] = cpu_to_le16(op | KS_SPIOP_RD);
158
159 if (kss->spidev->master->flags & SPI_MASTER_HALF_DUPLEX) {
160 msg = &kss->spi_msg2;
161 xfer = kss->spi_xfer2;
162
163 xfer->tx_buf = txb;
164 xfer->rx_buf = NULL;
165 xfer->len = 2;
166
167 xfer++;
168 xfer->tx_buf = NULL;
169 xfer->rx_buf = trx;
170 xfer->len = rxl;
171 } else {
172 msg = &kss->spi_msg1;
173 xfer = &kss->spi_xfer1;
174
175 xfer->tx_buf = txb;
176 xfer->rx_buf = trx;
177 xfer->len = rxl + 2;
178 }
179
180 ret = spi_sync(kss->spidev, msg);
181 if (ret < 0)
182 netdev_err(ks->netdev, "read: spi_sync() failed\n");
183 else if (kss->spidev->master->flags & SPI_MASTER_HALF_DUPLEX)
184 memcpy(rxb, trx, rxl);
185 else
186 memcpy(rxb, trx + 2, rxl);
187}
188
189
190
191
192
193
194
195
196static unsigned int ks8851_rdreg16_spi(struct ks8851_net *ks, unsigned int reg)
197{
198 __le16 rx = 0;
199
200 ks8851_rdreg(ks, MK_OP(reg & 2 ? 0xC : 0x3, reg), (u8 *)&rx, 2);
201 return le16_to_cpu(rx);
202}
203
204
205
206
207
208
209
210
211
212
213static void ks8851_rdfifo_spi(struct ks8851_net *ks, u8 *buff, unsigned int len)
214{
215 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
216 struct spi_transfer *xfer = kss->spi_xfer2;
217 struct spi_message *msg = &kss->spi_msg2;
218 u8 txb[1];
219 int ret;
220
221 netif_dbg(ks, rx_status, ks->netdev,
222 "%s: %d@%p\n", __func__, len, buff);
223
224
225 txb[0] = KS_SPIOP_RXFIFO;
226
227 xfer->tx_buf = txb;
228 xfer->rx_buf = NULL;
229 xfer->len = 1;
230
231 xfer++;
232 xfer->rx_buf = buff;
233 xfer->tx_buf = NULL;
234 xfer->len = len;
235
236 ret = spi_sync(kss->spidev, msg);
237 if (ret < 0)
238 netdev_err(ks->netdev, "%s: spi_sync() failed\n", __func__);
239}
240
241
242
243
244
245
246
247
248
249
250
251
252static void ks8851_wrfifo_spi(struct ks8851_net *ks, struct sk_buff *txp,
253 bool irq)
254{
255 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
256 struct spi_transfer *xfer = kss->spi_xfer2;
257 struct spi_message *msg = &kss->spi_msg2;
258 unsigned int fid = 0;
259 int ret;
260
261 netif_dbg(ks, tx_queued, ks->netdev, "%s: skb %p, %d@%p, irq %d\n",
262 __func__, txp, txp->len, txp->data, irq);
263
264 fid = ks->fid++;
265 fid &= TXFR_TXFID_MASK;
266
267 if (irq)
268 fid |= TXFR_TXIC;
269
270
271 ks->txh.txb[1] = KS_SPIOP_TXFIFO;
272 ks->txh.txw[1] = cpu_to_le16(fid);
273 ks->txh.txw[2] = cpu_to_le16(txp->len);
274
275 xfer->tx_buf = &ks->txh.txb[1];
276 xfer->rx_buf = NULL;
277 xfer->len = 5;
278
279 xfer++;
280 xfer->tx_buf = txp->data;
281 xfer->rx_buf = NULL;
282 xfer->len = ALIGN(txp->len, 4);
283
284 ret = spi_sync(kss->spidev, msg);
285 if (ret < 0)
286 netdev_err(ks->netdev, "%s: spi_sync() failed\n", __func__);
287}
288
289
290
291
292
293
294static void ks8851_rx_skb_spi(struct ks8851_net *ks, struct sk_buff *skb)
295{
296 netif_rx_ni(skb);
297}
298
299
300
301
302
303
304
305
306static void ks8851_tx_work(struct work_struct *work)
307{
308 struct ks8851_net_spi *kss;
309 struct ks8851_net *ks;
310 unsigned long flags;
311 struct sk_buff *txb;
312 bool last;
313
314 kss = container_of(work, struct ks8851_net_spi, tx_work);
315 ks = &kss->ks8851;
316 last = skb_queue_empty(&ks->txq);
317
318 ks8851_lock_spi(ks, &flags);
319
320 while (!last) {
321 txb = skb_dequeue(&ks->txq);
322 last = skb_queue_empty(&ks->txq);
323
324 if (txb) {
325 ks8851_wrreg16_spi(ks, KS_RXQCR,
326 ks->rc_rxqcr | RXQCR_SDA);
327 ks8851_wrfifo_spi(ks, txb, last);
328 ks8851_wrreg16_spi(ks, KS_RXQCR, ks->rc_rxqcr);
329 ks8851_wrreg16_spi(ks, KS_TXQCR, TXQCR_METFE);
330
331 ks8851_done_tx(ks, txb);
332 }
333 }
334
335 ks8851_unlock_spi(ks, &flags);
336}
337
338
339
340
341
342static void ks8851_flush_tx_work_spi(struct ks8851_net *ks)
343{
344 struct ks8851_net_spi *kss = to_ks8851_spi(ks);
345
346 flush_work(&kss->tx_work);
347}
348
349
350
351
352
353
354
355
356static unsigned int calc_txlen(unsigned int len)
357{
358 return ALIGN(len + 4, 4);
359}
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374static netdev_tx_t ks8851_start_xmit_spi(struct sk_buff *skb,
375 struct net_device *dev)
376{
377 unsigned int needed = calc_txlen(skb->len);
378 struct ks8851_net *ks = netdev_priv(dev);
379 netdev_tx_t ret = NETDEV_TX_OK;
380 struct ks8851_net_spi *kss;
381
382 kss = to_ks8851_spi(ks);
383
384 netif_dbg(ks, tx_queued, ks->netdev,
385 "%s: skb %p, %d@%p\n", __func__, skb, skb->len, skb->data);
386
387 spin_lock(&ks->statelock);
388
389 if (needed > ks->tx_space) {
390 netif_stop_queue(dev);
391 ret = NETDEV_TX_BUSY;
392 } else {
393 ks->tx_space -= needed;
394 skb_queue_tail(&ks->txq, skb);
395 }
396
397 spin_unlock(&ks->statelock);
398 schedule_work(&kss->tx_work);
399
400 return ret;
401}
402
403static int ks8851_probe_spi(struct spi_device *spi)
404{
405 struct device *dev = &spi->dev;
406 struct ks8851_net_spi *kss;
407 struct net_device *netdev;
408 struct ks8851_net *ks;
409
410 netdev = devm_alloc_etherdev(dev, sizeof(struct ks8851_net_spi));
411 if (!netdev)
412 return -ENOMEM;
413
414 spi->bits_per_word = 8;
415
416 ks = netdev_priv(netdev);
417
418 ks->lock = ks8851_lock_spi;
419 ks->unlock = ks8851_unlock_spi;
420 ks->rdreg16 = ks8851_rdreg16_spi;
421 ks->wrreg16 = ks8851_wrreg16_spi;
422 ks->rdfifo = ks8851_rdfifo_spi;
423 ks->wrfifo = ks8851_wrfifo_spi;
424 ks->start_xmit = ks8851_start_xmit_spi;
425 ks->rx_skb = ks8851_rx_skb_spi;
426 ks->flush_tx_work = ks8851_flush_tx_work_spi;
427
428#define STD_IRQ (IRQ_LCI | \
429 IRQ_TXI | \
430 IRQ_RXI | \
431 IRQ_SPIBEI | \
432 IRQ_TXPSI | \
433 IRQ_RXPSI)
434 ks->rc_ier = STD_IRQ;
435
436 kss = to_ks8851_spi(ks);
437
438 kss->spidev = spi;
439 mutex_init(&kss->lock);
440 INIT_WORK(&kss->tx_work, ks8851_tx_work);
441
442
443 spi_message_init(&kss->spi_msg1);
444 spi_message_add_tail(&kss->spi_xfer1, &kss->spi_msg1);
445
446 spi_message_init(&kss->spi_msg2);
447 spi_message_add_tail(&kss->spi_xfer2[0], &kss->spi_msg2);
448 spi_message_add_tail(&kss->spi_xfer2[1], &kss->spi_msg2);
449
450 netdev->irq = spi->irq;
451
452 return ks8851_probe_common(netdev, dev, msg_enable);
453}
454
455static int ks8851_remove_spi(struct spi_device *spi)
456{
457 return ks8851_remove_common(&spi->dev);
458}
459
460static const struct of_device_id ks8851_match_table[] = {
461 { .compatible = "micrel,ks8851" },
462 { }
463};
464MODULE_DEVICE_TABLE(of, ks8851_match_table);
465
466static struct spi_driver ks8851_driver = {
467 .driver = {
468 .name = "ks8851",
469 .of_match_table = ks8851_match_table,
470 .pm = &ks8851_pm_ops,
471 },
472 .probe = ks8851_probe_spi,
473 .remove = ks8851_remove_spi,
474};
475module_spi_driver(ks8851_driver);
476
477MODULE_DESCRIPTION("KS8851 Network driver");
478MODULE_AUTHOR("Ben Dooks <ben@simtec.co.uk>");
479MODULE_LICENSE("GPL");
480
481module_param_named(message, msg_enable, int, 0);
482MODULE_PARM_DESC(message, "Message verbosity level (0=none, 31=all)");
483MODULE_ALIAS("spi:ks8851");
484