]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/net/plip.c
projects / mirror_ubuntu-artful-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
net: use NETDEV_TX_OK instead of 0 in ndo_start_xmit() functions
[mirror_ubuntu-artful-kernel.git] / drivers / net / plip.c
CommitLineData
1da177e4
LT		 1/* $Id: plip.c,v 1.3.6.2 1997/04/16 15:07:56 phil Exp $ */
2/* PLIP: A parallel port "network" driver for Linux. */
3/* This driver is for parallel port with 5-bit cable (LapLink (R) cable). */
4/*
5 * Authors: Donald Becker <becker@scyld.com>
6 * Tommy Thorn <thorn@daimi.aau.dk>
7 * Tanabe Hiroyasu <hiro@sanpo.t.u-tokyo.ac.jp>
8 * Alan Cox <gw4pts@gw4pts.ampr.org>
9 * Peter Bauer <100136.3530@compuserve.com>
10 * Niibe Yutaka <gniibe@mri.co.jp>
11 * Nimrod Zimerman <zimerman@mailandnews.com>
12 *
13 * Enhancements:
14 * Modularization and ifreq/ifmap support by Alan Cox.
15 * Rewritten by Niibe Yutaka.
16 * parport-sharing awareness code by Philip Blundell.
17 * SMP locking by Niibe Yutaka.
18 * Support for parallel ports with no IRQ (poll mode),
6aa20a22 19 * Modifications to use the parallel port API
1da177e4
LT		 20 * by Nimrod Zimerman.
21 *
22 * Fixes:
23 * Niibe Yutaka
24 * - Module initialization.
25 * - MTU fix.
26 * - Make sure other end is OK, before sending a packet.
27 * - Fix immediate timer problem.
28 *
29 * Al Viro
30 * - Changed {enable,disable}_irq handling to make it work
31 * with new ("stack") semantics.
32 *
33 * This program is free software; you can redistribute it and/or
34 * modify it under the terms of the GNU General Public License
35 * as published by the Free Software Foundation; either version
36 * 2 of the License, or (at your option) any later version.
37 */
38
39/*
40 * Original version and the name 'PLIP' from Donald Becker <becker@scyld.com>
41 * inspired by Russ Nelson's parallel port packet driver.
42 *
43 * NOTE:
44 * Tanabe Hiroyasu had changed the protocol, and it was in Linux v1.0.
45 * Because of the necessity to communicate to DOS machines with the
46 * Crynwr packet driver, Peter Bauer changed the protocol again
47 * back to original protocol.
48 *
49 * This version follows original PLIP protocol.
50 * So, this PLIP can't communicate the PLIP of Linux v1.0.
51 */
52
53/*
54 * To use with DOS box, please do (Turn on ARP switch):
55 * # ifconfig plip[0-2] arp
56 */
57static const char version[] = "NET3 PLIP version 2.4-parport gniibe@mri.co.jp\n";
58
59/*
60 Sources:
61 Ideas and protocols came from Russ Nelson's <nelson@crynwr.com>
62 "parallel.asm" parallel port packet driver.
63
64 The "Crynwr" parallel port standard specifies the following protocol:
65 Trigger by sending nibble '0x8' (this causes interrupt on other end)
66 count-low octet
67 count-high octet
68 ... data octets
69 checksum octet
70 Each octet is sent as <wait for rx. '0x1?'> <send 0x10+(octet&0x0F)>
71 <wait for rx. '0x0?'> <send 0x00+((octet>>4)&0x0F)>
72
73 The packet is encapsulated as if it were ethernet.
74
75 The cable used is a de facto standard parallel null cable -- sold as
76 a "LapLink" cable by various places. You'll need a 12-conductor cable to
77 make one yourself. The wiring is:
78 SLCTIN 17 - 17
79 GROUND 25 - 25
80 D0->ERROR 2 - 15 15 - 2
81 D1->SLCT 3 - 13 13 - 3
82 D2->PAPOUT 4 - 12 12 - 4
83 D3->ACK 5 - 10 10 - 5
84 D4->BUSY 6 - 11 11 - 6
85 Do not connect the other pins. They are
86 D5,D6,D7 are 7,8,9
87 STROBE is 1, FEED is 14, INIT is 16
88 extra grounds are 18,19,20,21,22,23,24
89*/
90
91#include <linux/module.h>
92#include <linux/kernel.h>
93#include <linux/types.h>
94#include <linux/fcntl.h>
95#include <linux/interrupt.h>
96#include <linux/string.h>
97#include <linux/if_ether.h>
98#include <linux/in.h>
99#include <linux/errno.h>
100#include <linux/delay.h>
1da177e4
LT		 101#include <linux/init.h>
102#include <linux/netdevice.h>
103#include <linux/etherdevice.h>
104#include <linux/inetdevice.h>
105#include <linux/skbuff.h>
106#include <linux/if_plip.h>
107#include <linux/workqueue.h>
1da177e4 108#include <linux/spinlock.h>
01f31ac8 109#include <linux/completion.h>
1da177e4
LT		 110#include <linux/parport.h>
111#include <linux/bitops.h>
112
113#include <net/neighbour.h>
114
115#include <asm/system.h>
116#include <asm/irq.h>
117#include <asm/byteorder.h>
1da177e4
LT		 118
119/* Maximum number of devices to support. */
120#define PLIP_MAX 8
121
122/* Use 0 for production, 1 for verification, >2 for debug */
123#ifndef NET_DEBUG
124#define NET_DEBUG 1
125#endif
f71e1309 126static const unsigned int net_debug = NET_DEBUG;
1da177e4
LT		 127
128#define ENABLE(irq) if (irq != -1) enable_irq(irq)
129#define DISABLE(irq) if (irq != -1) disable_irq(irq)
130
131/* In micro second */
132#define PLIP_DELAY_UNIT 1
133
134/* Connection time out = PLIP_TRIGGER_WAIT * PLIP_DELAY_UNIT usec */
135#define PLIP_TRIGGER_WAIT 500
136
137/* Nibble time out = PLIP_NIBBLE_WAIT * PLIP_DELAY_UNIT usec */
138#define PLIP_NIBBLE_WAIT 3000
139
140/* Bottom halves */
c4028958
DH		 141static void plip_kick_bh(struct work_struct *work);
142static void plip_bh(struct work_struct *work);
143static void plip_timer_bh(struct work_struct *work);
1da177e4
LT		 144
145/* Interrupt handler */
5712cb3d 146static void plip_interrupt(void *dev_id);
1da177e4
LT		 147
148/* Functions for DEV methods */
149static int plip_tx_packet(struct sk_buff *skb, struct net_device *dev);
150static int plip_hard_header(struct sk_buff *skb, struct net_device *dev,
3b04ddde
SH		 151 unsigned short type, const void *daddr,
152 const void *saddr, unsigned len);
153static int plip_hard_header_cache(const struct neighbour *neigh,
1da177e4
LT		 154 struct hh_cache *hh);
155static int plip_open(struct net_device *dev);
156static int plip_close(struct net_device *dev);
1da177e4
LT		 157static int plip_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd);
158static int plip_preempt(void *handle);
159static void plip_wakeup(void *handle);
77933d72 160
1da177e4
LT		 161enum plip_connection_state {
162 PLIP_CN_NONE=0,
163 PLIP_CN_RECEIVE,
164 PLIP_CN_SEND,
165 PLIP_CN_CLOSING,
166 PLIP_CN_ERROR
167};
168
169enum plip_packet_state {
170 PLIP_PK_DONE=0,
171 PLIP_PK_TRIGGER,
172 PLIP_PK_LENGTH_LSB,
173 PLIP_PK_LENGTH_MSB,
174 PLIP_PK_DATA,
175 PLIP_PK_CHECKSUM
176};
177
178enum plip_nibble_state {
179 PLIP_NB_BEGIN,
180 PLIP_NB_1,
181 PLIP_NB_2,
182};
183
184struct plip_local {
185 enum plip_packet_state state;
186 enum plip_nibble_state nibble;
187 union {
188 struct {
189#if defined(__LITTLE_ENDIAN)
190 unsigned char lsb;
191 unsigned char msb;
192#elif defined(__BIG_ENDIAN)
193 unsigned char msb;
194 unsigned char lsb;
195#else
196#error "Please fix the endianness defines in <asm/byteorder.h>"
197#endif
198 } b;
199 unsigned short h;
200 } length;
201 unsigned short byte;
202 unsigned char checksum;
203 unsigned char data;
204 struct sk_buff *skb;
205};
206
207struct net_local {
c4028958 208 struct net_device *dev;
1da177e4 209 struct work_struct immediate;
c4028958
DH		 210 struct delayed_work deferred;
211 struct delayed_work timer;
1da177e4
LT		 212 struct plip_local snd_data;
213 struct plip_local rcv_data;
214 struct pardevice *pardev;
215 unsigned long trigger;
216 unsigned long nibble;
217 enum plip_connection_state connection;
218 unsigned short timeout_count;
219 int is_deferred;
220 int port_owner;
221 int should_relinquish;
1da177e4
LT		 222 spinlock_t lock;
223 atomic_t kill_timer;
01f31ac8 224 struct completion killed_timer_cmp;
1da177e4 225};
77933d72
JJ		 226
227static inline void enable_parport_interrupts (struct net_device *dev)
1da177e4
LT		 228{
229 if (dev->irq != -1)
230 {
231 struct parport *port =
4cf1653a 232 ((struct net_local *)netdev_priv(dev))->pardev->port;
1da177e4
LT		 233 port->ops->enable_irq (port);
234 }
235}
236
77933d72 237static inline void disable_parport_interrupts (struct net_device *dev)
1da177e4
LT		 238{
239 if (dev->irq != -1)
240 {
241 struct parport *port =
4cf1653a 242 ((struct net_local *)netdev_priv(dev))->pardev->port;
1da177e4
LT		 243 port->ops->disable_irq (port);
244 }
245}
246
77933d72 247static inline void write_data (struct net_device *dev, unsigned char data)
1da177e4
LT		 248{
249 struct parport *port =
4cf1653a 250 ((struct net_local *)netdev_priv(dev))->pardev->port;
1da177e4
LT		 251
252 port->ops->write_data (port, data);
253}
254
77933d72 255static inline unsigned char read_status (struct net_device *dev)
1da177e4
LT		 256{
257 struct parport *port =
4cf1653a 258 ((struct net_local *)netdev_priv(dev))->pardev->port;
1da177e4
LT		 259
260 return port->ops->read_status (port);
261}
77933d72 262
3b04ddde
SH		 263static const struct header_ops plip_header_ops = {
264 .create = plip_hard_header,
265 .cache = plip_hard_header_cache,
266};
267
ed8cf436
SH		 268static const struct net_device_ops plip_netdev_ops = {
269 .ndo_open = plip_open,
270 .ndo_stop = plip_close,
271 .ndo_start_xmit = plip_tx_packet,
272 .ndo_do_ioctl = plip_ioctl,
273};
274
1da177e4
LT		 275/* Entry point of PLIP driver.
276 Probe the hardware, and register/initialize the driver.
277
278 PLIP is rather weird, because of the way it interacts with the parport
279 system. It is _not_ initialised from Space.c. Instead, plip_init()
280 is called, and that function makes up a "struct net_device" for each port, and
281 then calls us here.
282
283 */
284static void
285plip_init_netdev(struct net_device *dev)
286{
287 struct net_local *nl = netdev_priv(dev);
288
289 /* Then, override parts of it */
1da177e4
LT		 290 dev->tx_queue_len = 10;
291 dev->flags = IFF_POINTOPOINT|IFF_NOARP;
292 memset(dev->dev_addr, 0xfc, ETH_ALEN);
293
ed8cf436 294 dev->netdev_ops = &plip_netdev_ops;
3b04ddde 295 dev->header_ops = &plip_header_ops;
1da177e4
LT		 296
297
298 nl->port_owner = 0;
299
300 /* Initialize constants */
301 nl->trigger = PLIP_TRIGGER_WAIT;
302 nl->nibble = PLIP_NIBBLE_WAIT;
303
304 /* Initialize task queue structures */
c4028958
DH		 305 INIT_WORK(&nl->immediate, plip_bh);
306 INIT_DELAYED_WORK(&nl->deferred, plip_kick_bh);
1da177e4
LT		 307
308 if (dev->irq == -1)
c4028958 309 INIT_DELAYED_WORK(&nl->timer, plip_timer_bh);
1da177e4
LT		 310
311 spin_lock_init(&nl->lock);
312}
77933d72 313
1da177e4
LT		 314/* Bottom half handler for the delayed request.
315 This routine is kicked by do_timer().
316 Request `plip_bh' to be invoked. */
317static void
c4028958 318plip_kick_bh(struct work_struct *work)
1da177e4 319{
c4028958
DH		 320 struct net_local *nl =
321 container_of(work, struct net_local, deferred.work);
1da177e4
LT		 322
323 if (nl->is_deferred)
324 schedule_work(&nl->immediate);
325}
326
327/* Forward declarations of internal routines */
328static int plip_none(struct net_device *, struct net_local *,
329 struct plip_local *, struct plip_local *);
330static int plip_receive_packet(struct net_device *, struct net_local *,
331 struct plip_local *, struct plip_local *);
332static int plip_send_packet(struct net_device *, struct net_local *,
333 struct plip_local *, struct plip_local *);
334static int plip_connection_close(struct net_device *, struct net_local *,
335 struct plip_local *, struct plip_local *);
336static int plip_error(struct net_device *, struct net_local *,
337 struct plip_local *, struct plip_local *);
338static int plip_bh_timeout_error(struct net_device *dev, struct net_local *nl,
339 struct plip_local *snd,
340 struct plip_local *rcv,
341 int error);
342
343#define OK 0
344#define TIMEOUT 1
345#define ERROR 2
346#define HS_TIMEOUT 3
347
348typedef int (*plip_func)(struct net_device *dev, struct net_local *nl,
349 struct plip_local *snd, struct plip_local *rcv);
350
f71e1309 351static const plip_func connection_state_table[] =
1da177e4
LT		 352{
353 plip_none,
354 plip_receive_packet,
355 plip_send_packet,
356 plip_connection_close,
357 plip_error
358};
359
360/* Bottom half handler of PLIP. */
361static void
c4028958 362plip_bh(struct work_struct *work)
1da177e4 363{
c4028958 364 struct net_local *nl = container_of(work, struct net_local, immediate);
1da177e4
LT		 365 struct plip_local *snd = &nl->snd_data;
366 struct plip_local *rcv = &nl->rcv_data;
367 plip_func f;
368 int r;
369
370 nl->is_deferred = 0;
371 f = connection_state_table[nl->connection];
c4028958
DH		 372 if ((r = (*f)(nl->dev, nl, snd, rcv)) != OK
373 && (r = plip_bh_timeout_error(nl->dev, nl, snd, rcv, r)) != OK) {
1da177e4
LT		 374 nl->is_deferred = 1;
375 schedule_delayed_work(&nl->deferred, 1);
376 }
377}
378
379static void
c4028958 380plip_timer_bh(struct work_struct *work)
1da177e4 381{
c4028958
DH		 382 struct net_local *nl =
383 container_of(work, struct net_local, timer.work);
6aa20a22 384
1da177e4 385 if (!(atomic_read (&nl->kill_timer))) {
5712cb3d 386 plip_interrupt (nl->dev);
1da177e4
LT		 387
388 schedule_delayed_work(&nl->timer, 1);
389 }
390 else {
01f31ac8 391 complete(&nl->killed_timer_cmp);
1da177e4
LT		 392 }
393}
394
395static int
396plip_bh_timeout_error(struct net_device *dev, struct net_local *nl,
397 struct plip_local *snd, struct plip_local *rcv,
398 int error)
399{
400 unsigned char c0;
401 /*
402 * This is tricky. If we got here from the beginning of send (either
403 * with ERROR or HS_TIMEOUT) we have IRQ enabled. Otherwise it's
404 * already disabled. With the old variant of {enable,disable}_irq()
405 * extra disable_irq() was a no-op. Now it became mortal - it's
406 * unbalanced and thus we'll never re-enable IRQ (until rmmod plip,
407 * that is). So we have to treat HS_TIMEOUT and ERROR from send
408 * in a special way.
409 */
410
411 spin_lock_irq(&nl->lock);
412 if (nl->connection == PLIP_CN_SEND) {
413
414 if (error != ERROR) { /* Timeout */
415 nl->timeout_count++;
416 if ((error == HS_TIMEOUT
417 && nl->timeout_count <= 10)
418 || nl->timeout_count <= 3) {
419 spin_unlock_irq(&nl->lock);
420 /* Try again later */
421 return TIMEOUT;
422 }
423 c0 = read_status(dev);
424 printk(KERN_WARNING "%s: transmit timeout(%d,%02x)\n",
425 dev->name, snd->state, c0);
426 } else
427 error = HS_TIMEOUT;
09f75cd7
JG		 428 dev->stats.tx_errors++;
429 dev->stats.tx_aborted_errors++;
1da177e4
LT		 430 } else if (nl->connection == PLIP_CN_RECEIVE) {
431 if (rcv->state == PLIP_PK_TRIGGER) {
432 /* Transmission was interrupted. */
433 spin_unlock_irq(&nl->lock);
434 return OK;
435 }
436 if (error != ERROR) { /* Timeout */
437 if (++nl->timeout_count <= 3) {
438 spin_unlock_irq(&nl->lock);
439 /* Try again later */
440 return TIMEOUT;
441 }
442 c0 = read_status(dev);
443 printk(KERN_WARNING "%s: receive timeout(%d,%02x)\n",
444 dev->name, rcv->state, c0);
445 }
09f75cd7 446 dev->stats.rx_dropped++;
1da177e4
LT		 447 }
448 rcv->state = PLIP_PK_DONE;
449 if (rcv->skb) {
450 kfree_skb(rcv->skb);
451 rcv->skb = NULL;
452 }
453 snd->state = PLIP_PK_DONE;
454 if (snd->skb) {
455 dev_kfree_skb(snd->skb);
456 snd->skb = NULL;
457 }
458 spin_unlock_irq(&nl->lock);
459 if (error == HS_TIMEOUT) {
460 DISABLE(dev->irq);
461 synchronize_irq(dev->irq);
462 }
463 disable_parport_interrupts (dev);
464 netif_stop_queue (dev);
465 nl->connection = PLIP_CN_ERROR;
466 write_data (dev, 0x00);
467
468 return TIMEOUT;
469}
77933d72 470
1da177e4
LT		 471static int
472plip_none(struct net_device *dev, struct net_local *nl,
473 struct plip_local *snd, struct plip_local *rcv)
474{
475 return OK;
476}
477
478/* PLIP_RECEIVE --- receive a byte(two nibbles)
479 Returns OK on success, TIMEOUT on timeout */
77933d72 480static inline int
1da177e4
LT		 481plip_receive(unsigned short nibble_timeout, struct net_device *dev,
482 enum plip_nibble_state *ns_p, unsigned char *data_p)
483{
484 unsigned char c0, c1;
485 unsigned int cx;
486
487 switch (*ns_p) {
488 case PLIP_NB_BEGIN:
489 cx = nibble_timeout;
490 while (1) {
491 c0 = read_status(dev);
492 udelay(PLIP_DELAY_UNIT);
493 if ((c0 & 0x80) == 0) {
494 c1 = read_status(dev);
495 if (c0 == c1)
496 break;
497 }
498 if (--cx == 0)
499 return TIMEOUT;
500 }
501 *data_p = (c0 >> 3) & 0x0f;
502 write_data (dev, 0x10); /* send ACK */
503 *ns_p = PLIP_NB_1;
504
505 case PLIP_NB_1:
506 cx = nibble_timeout;
507 while (1) {
508 c0 = read_status(dev);
509 udelay(PLIP_DELAY_UNIT);
510 if (c0 & 0x80) {
511 c1 = read_status(dev);
512 if (c0 == c1)
513 break;
514 }
515 if (--cx == 0)
516 return TIMEOUT;
517 }
518 *data_p |= (c0 << 1) & 0xf0;
519 write_data (dev, 0x00); /* send ACK */
520 *ns_p = PLIP_NB_BEGIN;
521 case PLIP_NB_2:
522 break;
523 }
524 return OK;
525}
526
527/*
6aa20a22 528 * Determine the packet's protocol ID. The rule here is that we
1da177e4
LT		 529 * assume 802.3 if the type field is short enough to be a length.
530 * This is normal practice and works for any 'now in use' protocol.
531 *
532 * PLIP is ethernet ish but the daddr might not be valid if unicast.
533 * PLIP fortunately has no bus architecture (its Point-to-point).
534 *
535 * We can't fix the daddr thing as that quirk (more bug) is embedded
536 * in far too many old systems not all even running Linux.
537 */
6aa20a22 538
ab611487 539static __be16 plip_type_trans(struct sk_buff *skb, struct net_device *dev)
1da177e4
LT		 540{
541 struct ethhdr *eth;
542 unsigned char *rawp;
6aa20a22 543
98e399f8 544 skb_reset_mac_header(skb);
1da177e4
LT		 545 skb_pull(skb,dev->hard_header_len);
546 eth = eth_hdr(skb);
6aa20a22 547
1da177e4
LT		 548 if(*eth->h_dest&1)
549 {
550 if(memcmp(eth->h_dest,dev->broadcast, ETH_ALEN)==0)
551 skb->pkt_type=PACKET_BROADCAST;
552 else
553 skb->pkt_type=PACKET_MULTICAST;
554 }
6aa20a22 555
1da177e4
LT		 556 /*
557 * This ALLMULTI check should be redundant by 1.4
558 * so don't forget to remove it.
559 */
6aa20a22 560
1da177e4
LT		 561 if (ntohs(eth->h_proto) >= 1536)
562 return eth->h_proto;
6aa20a22 563
1da177e4 564 rawp = skb->data;
6aa20a22 565
1da177e4
LT		 566 /*
567 * This is a magic hack to spot IPX packets. Older Novell breaks
568 * the protocol design and runs IPX over 802.3 without an 802.2 LLC
569 * layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This
570 * won't work for fault tolerant netware but does for the rest.
571 */
572 if (*(unsigned short *)rawp == 0xFFFF)
573 return htons(ETH_P_802_3);
6aa20a22 574
1da177e4
LT		 575 /*
576 * Real 802.2 LLC
577 */
578 return htons(ETH_P_802_2);
579}
580
1da177e4
LT		 581/* PLIP_RECEIVE_PACKET --- receive a packet */
582static int
583plip_receive_packet(struct net_device *dev, struct net_local *nl,
584 struct plip_local *snd, struct plip_local *rcv)
585{
586 unsigned short nibble_timeout = nl->nibble;
587 unsigned char *lbuf;
588
589 switch (rcv->state) {
590 case PLIP_PK_TRIGGER:
591 DISABLE(dev->irq);
592 /* Don't need to synchronize irq, as we can safely ignore it */
593 disable_parport_interrupts (dev);
594 write_data (dev, 0x01); /* send ACK */
595 if (net_debug > 2)
596 printk(KERN_DEBUG "%s: receive start\n", dev->name);
597 rcv->state = PLIP_PK_LENGTH_LSB;
598 rcv->nibble = PLIP_NB_BEGIN;
599
600 case PLIP_PK_LENGTH_LSB:
601 if (snd->state != PLIP_PK_DONE) {
602 if (plip_receive(nl->trigger, dev,
603 &rcv->nibble, &rcv->length.b.lsb)) {
604 /* collision, here dev->tbusy == 1 */
605 rcv->state = PLIP_PK_DONE;
606 nl->is_deferred = 1;
607 nl->connection = PLIP_CN_SEND;
608 schedule_delayed_work(&nl->deferred, 1);
609 enable_parport_interrupts (dev);
610 ENABLE(dev->irq);
611 return OK;
612 }
613 } else {
614 if (plip_receive(nibble_timeout, dev,
615 &rcv->nibble, &rcv->length.b.lsb))
616 return TIMEOUT;
617 }
618 rcv->state = PLIP_PK_LENGTH_MSB;
619
620 case PLIP_PK_LENGTH_MSB:
621 if (plip_receive(nibble_timeout, dev,
622 &rcv->nibble, &rcv->length.b.msb))
623 return TIMEOUT;
624 if (rcv->length.h > dev->mtu + dev->hard_header_len
625 || rcv->length.h < 8) {
626 printk(KERN_WARNING "%s: bogus packet size %d.\n", dev->name, rcv->length.h);
627 return ERROR;
628 }
629 /* Malloc up new buffer. */
630 rcv->skb = dev_alloc_skb(rcv->length.h + 2);
631 if (rcv->skb == NULL) {
632 printk(KERN_ERR "%s: Memory squeeze.\n", dev->name);
633 return ERROR;
634 }
635 skb_reserve(rcv->skb, 2); /* Align IP on 16 byte boundaries */
636 skb_put(rcv->skb,rcv->length.h);
637 rcv->skb->dev = dev;
638 rcv->state = PLIP_PK_DATA;
639 rcv->byte = 0;
640 rcv->checksum = 0;
641
642 case PLIP_PK_DATA:
643 lbuf = rcv->skb->data;
e4c3c13c 644 do {
1da177e4
LT		 645 if (plip_receive(nibble_timeout, dev,
646 &rcv->nibble, &lbuf[rcv->byte]))
647 return TIMEOUT;
e4c3c13c
HE		 648 } while (++rcv->byte < rcv->length.h);
649 do {
1da177e4 650 rcv->checksum += lbuf[--rcv->byte];
e4c3c13c 651 } while (rcv->byte);
1da177e4
LT		 652 rcv->state = PLIP_PK_CHECKSUM;
653
654 case PLIP_PK_CHECKSUM:
655 if (plip_receive(nibble_timeout, dev,
656 &rcv->nibble, &rcv->data))
657 return TIMEOUT;
658 if (rcv->data != rcv->checksum) {
09f75cd7 659 dev->stats.rx_crc_errors++;
1da177e4
LT		 660 if (net_debug)
661 printk(KERN_DEBUG "%s: checksum error\n", dev->name);
662 return ERROR;
663 }
664 rcv->state = PLIP_PK_DONE;
665
666 case PLIP_PK_DONE:
667 /* Inform the upper layer for the arrival of a packet. */
668 rcv->skb->protocol=plip_type_trans(rcv->skb, dev);
f6ce5cca 669 netif_rx_ni(rcv->skb);
09f75cd7
JG		 670 dev->stats.rx_bytes += rcv->length.h;
671 dev->stats.rx_packets++;
1da177e4
LT		 672 rcv->skb = NULL;
673 if (net_debug > 2)
674 printk(KERN_DEBUG "%s: receive end\n", dev->name);
675
676 /* Close the connection. */
677 write_data (dev, 0x00);
678 spin_lock_irq(&nl->lock);
679 if (snd->state != PLIP_PK_DONE) {
680 nl->connection = PLIP_CN_SEND;
681 spin_unlock_irq(&nl->lock);
682 schedule_work(&nl->immediate);
683 enable_parport_interrupts (dev);
684 ENABLE(dev->irq);
685 return OK;
686 } else {
687 nl->connection = PLIP_CN_NONE;
688 spin_unlock_irq(&nl->lock);
689 enable_parport_interrupts (dev);
690 ENABLE(dev->irq);
691 return OK;
692 }
693 }
694 return OK;
695}
696
697/* PLIP_SEND --- send a byte (two nibbles)
698 Returns OK on success, TIMEOUT when timeout */
77933d72 699static inline int
1da177e4
LT		 700plip_send(unsigned short nibble_timeout, struct net_device *dev,
701 enum plip_nibble_state *ns_p, unsigned char data)
702{
703 unsigned char c0;
704 unsigned int cx;
705
706 switch (*ns_p) {
707 case PLIP_NB_BEGIN:
708 write_data (dev, data & 0x0f);
709 *ns_p = PLIP_NB_1;
710
711 case PLIP_NB_1:
712 write_data (dev, 0x10 | (data & 0x0f));
713 cx = nibble_timeout;
714 while (1) {
715 c0 = read_status(dev);
716 if ((c0 & 0x80) == 0)
717 break;
718 if (--cx == 0)
719 return TIMEOUT;
720 udelay(PLIP_DELAY_UNIT);
721 }
722 write_data (dev, 0x10 | (data >> 4));
723 *ns_p = PLIP_NB_2;
724
725 case PLIP_NB_2:
726 write_data (dev, (data >> 4));
727 cx = nibble_timeout;
728 while (1) {
729 c0 = read_status(dev);
730 if (c0 & 0x80)
731 break;
732 if (--cx == 0)
733 return TIMEOUT;
734 udelay(PLIP_DELAY_UNIT);
735 }
736 *ns_p = PLIP_NB_BEGIN;
737 return OK;
738 }
739 return OK;
740}
741
742/* PLIP_SEND_PACKET --- send a packet */
743static int
744plip_send_packet(struct net_device *dev, struct net_local *nl,
745 struct plip_local *snd, struct plip_local *rcv)
746{
747 unsigned short nibble_timeout = nl->nibble;
748 unsigned char *lbuf;
749 unsigned char c0;
750 unsigned int cx;
751
752 if (snd->skb == NULL || (lbuf = snd->skb->data) == NULL) {
753 printk(KERN_DEBUG "%s: send skb lost\n", dev->name);
754 snd->state = PLIP_PK_DONE;
755 snd->skb = NULL;
756 return ERROR;
757 }
758
759 switch (snd->state) {
760 case PLIP_PK_TRIGGER:
761 if ((read_status(dev) & 0xf8) != 0x80)
762 return HS_TIMEOUT;
763
764 /* Trigger remote rx interrupt. */
765 write_data (dev, 0x08);
766 cx = nl->trigger;
767 while (1) {
768 udelay(PLIP_DELAY_UNIT);
769 spin_lock_irq(&nl->lock);
770 if (nl->connection == PLIP_CN_RECEIVE) {
771 spin_unlock_irq(&nl->lock);
772 /* Interrupted. */
09f75cd7 773 dev->stats.collisions++;
1da177e4
LT		 774 return OK;
775 }
776 c0 = read_status(dev);
777 if (c0 & 0x08) {
778 spin_unlock_irq(&nl->lock);
779 DISABLE(dev->irq);
780 synchronize_irq(dev->irq);
781 if (nl->connection == PLIP_CN_RECEIVE) {
782 /* Interrupted.
783 We don't need to enable irq,
784 as it is soon disabled. */
785 /* Yes, we do. New variant of
786 {enable,disable}_irq *counts*
787 them. -- AV */
788 ENABLE(dev->irq);
09f75cd7 789 dev->stats.collisions++;
1da177e4
LT		 790 return OK;
791 }
792 disable_parport_interrupts (dev);
793 if (net_debug > 2)
794 printk(KERN_DEBUG "%s: send start\n", dev->name);
795 snd->state = PLIP_PK_LENGTH_LSB;
796 snd->nibble = PLIP_NB_BEGIN;
797 nl->timeout_count = 0;
798 break;
799 }
800 spin_unlock_irq(&nl->lock);
801 if (--cx == 0) {
802 write_data (dev, 0x00);
803 return HS_TIMEOUT;
804 }
805 }
806
807 case PLIP_PK_LENGTH_LSB:
808 if (plip_send(nibble_timeout, dev,
809 &snd->nibble, snd->length.b.lsb))
810 return TIMEOUT;
811 snd->state = PLIP_PK_LENGTH_MSB;
812
813 case PLIP_PK_LENGTH_MSB:
814 if (plip_send(nibble_timeout, dev,
815 &snd->nibble, snd->length.b.msb))
816 return TIMEOUT;
817 snd->state = PLIP_PK_DATA;
818 snd->byte = 0;
819 snd->checksum = 0;
820
821 case PLIP_PK_DATA:
e4c3c13c 822 do {
1da177e4
LT		 823 if (plip_send(nibble_timeout, dev,
824 &snd->nibble, lbuf[snd->byte]))
825 return TIMEOUT;
e4c3c13c
HE		 826 } while (++snd->byte < snd->length.h);
827 do {
1da177e4 828 snd->checksum += lbuf[--snd->byte];
e4c3c13c 829 } while (snd->byte);
1da177e4
LT		 830 snd->state = PLIP_PK_CHECKSUM;
831
832 case PLIP_PK_CHECKSUM:
833 if (plip_send(nibble_timeout, dev,
834 &snd->nibble, snd->checksum))
835 return TIMEOUT;
836
09f75cd7 837 dev->stats.tx_bytes += snd->skb->len;
1da177e4 838 dev_kfree_skb(snd->skb);
09f75cd7 839 dev->stats.tx_packets++;
1da177e4
LT		 840 snd->state = PLIP_PK_DONE;
841
842 case PLIP_PK_DONE:
843 /* Close the connection */
844 write_data (dev, 0x00);
845 snd->skb = NULL;
846 if (net_debug > 2)
847 printk(KERN_DEBUG "%s: send end\n", dev->name);
848 nl->connection = PLIP_CN_CLOSING;
849 nl->is_deferred = 1;
850 schedule_delayed_work(&nl->deferred, 1);
851 enable_parport_interrupts (dev);
852 ENABLE(dev->irq);
853 return OK;
854 }
855 return OK;
856}
857
858static int
859plip_connection_close(struct net_device *dev, struct net_local *nl,
860 struct plip_local *snd, struct plip_local *rcv)
861{
862 spin_lock_irq(&nl->lock);
863 if (nl->connection == PLIP_CN_CLOSING) {
864 nl->connection = PLIP_CN_NONE;
865 netif_wake_queue (dev);
866 }
867 spin_unlock_irq(&nl->lock);
868 if (nl->should_relinquish) {
869 nl->should_relinquish = nl->port_owner = 0;
870 parport_release(nl->pardev);
871 }
872 return OK;
873}
874
875/* PLIP_ERROR --- wait till other end settled */
876static int
877plip_error(struct net_device *dev, struct net_local *nl,
878 struct plip_local *snd, struct plip_local *rcv)
879{
880 unsigned char status;
881
882 status = read_status(dev);
883 if ((status & 0xf8) == 0x80) {
884 if (net_debug > 2)
885 printk(KERN_DEBUG "%s: reset interface.\n", dev->name);
886 nl->connection = PLIP_CN_NONE;
887 nl->should_relinquish = 0;
888 netif_start_queue (dev);
889 enable_parport_interrupts (dev);
890 ENABLE(dev->irq);
891 netif_wake_queue (dev);
892 } else {
893 nl->is_deferred = 1;
894 schedule_delayed_work(&nl->deferred, 1);
895 }
896
897 return OK;
898}
77933d72 899
1da177e4
LT		 900/* Handle the parallel port interrupts. */
901static void
5712cb3d 902plip_interrupt(void *dev_id)
1da177e4
LT		 903{
904 struct net_device *dev = dev_id;
905 struct net_local *nl;
906 struct plip_local *rcv;
907 unsigned char c0;
cabce28e 908 unsigned long flags;
1da177e4 909
1da177e4
LT		 910 nl = netdev_priv(dev);
911 rcv = &nl->rcv_data;
912
cabce28e 913 spin_lock_irqsave (&nl->lock, flags);
1da177e4
LT		 914
915 c0 = read_status(dev);
916 if ((c0 & 0xf8) != 0xc0) {
917 if ((dev->irq != -1) && (net_debug > 1))
918 printk(KERN_DEBUG "%s: spurious interrupt\n", dev->name);
cabce28e 919 spin_unlock_irqrestore (&nl->lock, flags);
1da177e4
LT		 920 return;
921 }
922
923 if (net_debug > 3)
924 printk(KERN_DEBUG "%s: interrupt.\n", dev->name);
925
926 switch (nl->connection) {
927 case PLIP_CN_CLOSING:
928 netif_wake_queue (dev);
929 case PLIP_CN_NONE:
930 case PLIP_CN_SEND:
931 rcv->state = PLIP_PK_TRIGGER;
932 nl->connection = PLIP_CN_RECEIVE;
933 nl->timeout_count = 0;
934 schedule_work(&nl->immediate);
935 break;
936
937 case PLIP_CN_RECEIVE:
938 /* May occur because there is race condition
939 around test and set of dev->interrupt.
940 Ignore this interrupt. */
941 break;
942
943 case PLIP_CN_ERROR:
944 printk(KERN_ERR "%s: receive interrupt in error state\n", dev->name);
945 break;
946 }
947
cabce28e 948 spin_unlock_irqrestore(&nl->lock, flags);
1da177e4 949}
77933d72 950
1da177e4
LT		 951static int
952plip_tx_packet(struct sk_buff *skb, struct net_device *dev)
953{
954 struct net_local *nl = netdev_priv(dev);
955 struct plip_local *snd = &nl->snd_data;
956
957 if (netif_queue_stopped(dev))
5b548140 958 return NETDEV_TX_BUSY;
1da177e4
LT		 959
960 /* We may need to grab the bus */
961 if (!nl->port_owner) {
962 if (parport_claim(nl->pardev))
5b548140 963 return NETDEV_TX_BUSY;
1da177e4
LT		 964 nl->port_owner = 1;
965 }
966
967 netif_stop_queue (dev);
6aa20a22 968
1da177e4
LT		 969 if (skb->len > dev->mtu + dev->hard_header_len) {
970 printk(KERN_WARNING "%s: packet too big, %d.\n", dev->name, (int)skb->len);
971 netif_start_queue (dev);
5b548140 972 return NETDEV_TX_BUSY;
1da177e4
LT		 973 }
974
975 if (net_debug > 2)
976 printk(KERN_DEBUG "%s: send request\n", dev->name);
977
978 spin_lock_irq(&nl->lock);
979 dev->trans_start = jiffies;
980 snd->skb = skb;
981 snd->length.h = skb->len;
982 snd->state = PLIP_PK_TRIGGER;
983 if (nl->connection == PLIP_CN_NONE) {
984 nl->connection = PLIP_CN_SEND;
985 nl->timeout_count = 0;
986 }
987 schedule_work(&nl->immediate);
988 spin_unlock_irq(&nl->lock);
6aa20a22 989
6ed10654 990 return NETDEV_TX_OK;
1da177e4
LT		 991}
992
993static void
3b04ddde 994plip_rewrite_address(const struct net_device *dev, struct ethhdr *eth)
1da177e4 995{
3b04ddde 996 const struct in_device *in_dev = dev->ip_ptr;
1da177e4 997
3b04ddde 998 if (in_dev) {
1da177e4 999 /* Any address will do - we take the first */
3b04ddde
SH		 1000 const struct in_ifaddr *ifa = in_dev->ifa_list;
1001 if (ifa) {
1da177e4
LT		 1002 memcpy(eth->h_source, dev->dev_addr, 6);
1003 memset(eth->h_dest, 0xfc, 2);
1004 memcpy(eth->h_dest+2, &ifa->ifa_address, 4);
1005 }
1006 }
1007}
1008
1009static int
1010plip_hard_header(struct sk_buff *skb, struct net_device *dev,
3b04ddde
SH		 1011 unsigned short type, const void *daddr,
1012 const void *saddr, unsigned len)
1da177e4 1013{
1da177e4
LT		 1014 int ret;
1015
3b04ddde
SH		 1016 ret = eth_header(skb, dev, type, daddr, saddr, len);
1017 if (ret >= 0)
1da177e4
LT		 1018 plip_rewrite_address (dev, (struct ethhdr *)skb->data);
1019
1020 return ret;
1021}
1022
dac499f9
HE		 1023static int plip_hard_header_cache(const struct neighbour *neigh,
1024 struct hh_cache *hh)
1da177e4 1025{
1da177e4 1026 int ret;
6aa20a22 1027
3b04ddde
SH		 1028 ret = eth_header_cache(neigh, hh);
1029 if (ret == 0) {
1da177e4
LT		 1030 struct ethhdr *eth;
1031
1032 eth = (struct ethhdr*)(((u8*)hh->hh_data) +
1033 HH_DATA_OFF(sizeof(*eth)));
1034 plip_rewrite_address (neigh->dev, eth);
1035 }
6aa20a22 1036
1da177e4 1037 return ret;
6aa20a22 1038}
1da177e4
LT		 1039
1040/* Open/initialize the board. This is called (in the current kernel)
1041 sometime after booting when the 'ifconfig' program is run.
1042
1043 This routine gets exclusive access to the parallel port by allocating
1044 its IRQ line.
1045 */
1046static int
1047plip_open(struct net_device *dev)
1048{
1049 struct net_local *nl = netdev_priv(dev);
1050 struct in_device *in_dev;
1051
1052 /* Grab the port */
1053 if (!nl->port_owner) {
1054 if (parport_claim(nl->pardev)) return -EAGAIN;
1055 nl->port_owner = 1;
1056 }
1057
1058 nl->should_relinquish = 0;
1059
1060 /* Clear the data port. */
1061 write_data (dev, 0x00);
1062
1063 /* Enable rx interrupt. */
1064 enable_parport_interrupts (dev);
1065 if (dev->irq == -1)
1066 {
1067 atomic_set (&nl->kill_timer, 0);
1068 schedule_delayed_work(&nl->timer, 1);
1069 }
1070
1071 /* Initialize the state machine. */
1072 nl->rcv_data.state = nl->snd_data.state = PLIP_PK_DONE;
1073 nl->rcv_data.skb = nl->snd_data.skb = NULL;
1074 nl->connection = PLIP_CN_NONE;
1075 nl->is_deferred = 0;
1076
1077 /* Fill in the MAC-level header.
1078 We used to abuse dev->broadcast to store the point-to-point
1079 MAC address, but we no longer do it. Instead, we fetch the
1080 interface address whenever it is needed, which is cheap enough
1081 because we use the hh_cache. Actually, abusing dev->broadcast
1082 didn't work, because when using plip_open the point-to-point
1083 address isn't yet known.
1084 PLIP doesn't have a real MAC address, but we need it to be
1085 DOS compatible, and to properly support taps (otherwise,
1086 when the device address isn't identical to the address of a
1087 received frame, the kernel incorrectly drops it). */
1088
1089 if ((in_dev=dev->ip_ptr) != NULL) {
1090 /* Any address will do - we take the first. We already
1091 have the first two bytes filled with 0xfc, from
1092 plip_init_dev(). */
1093 struct in_ifaddr *ifa=in_dev->ifa_list;
1094 if (ifa != NULL) {
1095 memcpy(dev->dev_addr+2, &ifa->ifa_local, 4);
1096 }
1097 }
1098
1099 netif_start_queue (dev);
1100
1101 return 0;
1102}
1103
1104/* The inverse routine to plip_open (). */
1105static int
1106plip_close(struct net_device *dev)
1107{
1108 struct net_local *nl = netdev_priv(dev);
1109 struct plip_local *snd = &nl->snd_data;
1110 struct plip_local *rcv = &nl->rcv_data;
1111
1112 netif_stop_queue (dev);
1113 DISABLE(dev->irq);
1114 synchronize_irq(dev->irq);
1115
1116 if (dev->irq == -1)
1117 {
01f31ac8 1118 init_completion(&nl->killed_timer_cmp);
1da177e4 1119 atomic_set (&nl->kill_timer, 1);
01f31ac8 1120 wait_for_completion(&nl->killed_timer_cmp);
1da177e4
LT		 1121 }
1122
1123#ifdef NOTDEF
1124 outb(0x00, PAR_DATA(dev));
1125#endif
1126 nl->is_deferred = 0;
1127 nl->connection = PLIP_CN_NONE;
1128 if (nl->port_owner) {
1129 parport_release(nl->pardev);
1130 nl->port_owner = 0;
1131 }
1132
1133 snd->state = PLIP_PK_DONE;
1134 if (snd->skb) {
1135 dev_kfree_skb(snd->skb);
1136 snd->skb = NULL;
1137 }
1138 rcv->state = PLIP_PK_DONE;
1139 if (rcv->skb) {
1140 kfree_skb(rcv->skb);
1141 rcv->skb = NULL;
1142 }
1143
1144#ifdef NOTDEF
1145 /* Reset. */
1146 outb(0x00, PAR_CONTROL(dev));
1147#endif
1148 return 0;
1149}
1150
1151static int
1152plip_preempt(void *handle)
1153{
1154 struct net_device *dev = (struct net_device *)handle;
1155 struct net_local *nl = netdev_priv(dev);
1156
1157 /* Stand our ground if a datagram is on the wire */
1158 if (nl->connection != PLIP_CN_NONE) {
1159 nl->should_relinquish = 1;
1160 return 1;
1161 }
1162
1163 nl->port_owner = 0; /* Remember that we released the bus */
1164 return 0;
1165}
1166
1167static void
1168plip_wakeup(void *handle)
1169{
1170 struct net_device *dev = (struct net_device *)handle;
1171 struct net_local *nl = netdev_priv(dev);
1172
1173 if (nl->port_owner) {
1174 /* Why are we being woken up? */
1175 printk(KERN_DEBUG "%s: why am I being woken up?\n", dev->name);
1176 if (!parport_claim(nl->pardev))
1177 /* bus_owner is already set (but why?) */
1178 printk(KERN_DEBUG "%s: I'm broken.\n", dev->name);
1179 else
1180 return;
1181 }
6aa20a22 1182
1da177e4
LT		 1183 if (!(dev->flags & IFF_UP))
1184 /* Don't need the port when the interface is down */
1185 return;
1186
1187 if (!parport_claim(nl->pardev)) {
1188 nl->port_owner = 1;
1189 /* Clear the data port. */
1190 write_data (dev, 0x00);
1191 }
1192
1193 return;
1194}
1195
1da177e4
LT		 1196static int
1197plip_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
1198{
1199 struct net_local *nl = netdev_priv(dev);
1200 struct plipconf *pc = (struct plipconf *) &rq->ifr_ifru;
1201
1202 if (cmd != SIOCDEVPLIP)
1203 return -EOPNOTSUPP;
1204
1205 switch(pc->pcmd) {
1206 case PLIP_GET_TIMEOUT:
1207 pc->trigger = nl->trigger;
1208 pc->nibble = nl->nibble;
1209 break;
1210 case PLIP_SET_TIMEOUT:
1211 if(!capable(CAP_NET_ADMIN))
1212 return -EPERM;
1213 nl->trigger = pc->trigger;
1214 nl->nibble = pc->nibble;
1215 break;
1216 default:
1217 return -EOPNOTSUPP;
1218 }
1219 return 0;
1220}
77933d72 1221
1da177e4
LT		 1222static int parport[PLIP_MAX] = { [0 ... PLIP_MAX-1] = -1 };
1223static int timid;
1224
1225module_param_array(parport, int, NULL, 0);
1226module_param(timid, int, 0);
1227MODULE_PARM_DESC(parport, "List of parport device numbers to use by plip");
1228
1229static struct net_device *dev_plip[PLIP_MAX] = { NULL, };
1230
1231static inline int
1232plip_searchfor(int list[], int a)
1233{
1234 int i;
1235 for (i = 0; i < PLIP_MAX && list[i] != -1; i++) {
1236 if (list[i] == a) return 1;
1237 }
1238 return 0;
1239}
1240
1241/* plip_attach() is called (by the parport code) when a port is
1242 * available to use. */
1243static void plip_attach (struct parport *port)
1244{
1245 static int unit;
1246 struct net_device *dev;
1247 struct net_local *nl;
1248 char name[IFNAMSIZ];
1249
6aa20a22 1250 if ((parport[0] == -1 && (!timid || !port->devices)) ||
1da177e4
LT		 1251 plip_searchfor(parport, port->number)) {
1252 if (unit == PLIP_MAX) {
1253 printk(KERN_ERR "plip: too many devices\n");
1254 return;
1255 }
1256
1257 sprintf(name, "plip%d", unit);
1258 dev = alloc_etherdev(sizeof(struct net_local));
1259 if (!dev) {
1260 printk(KERN_ERR "plip: memory squeeze\n");
1261 return;
1262 }
6aa20a22 1263
1da177e4
LT		 1264 strcpy(dev->name, name);
1265
1da177e4
LT		 1266 dev->irq = port->irq;
1267 dev->base_addr = port->base;
1268 if (port->irq == -1) {
1269 printk(KERN_INFO "plip: %s has no IRQ. Using IRQ-less mode,"
1270 "which is fairly inefficient!\n", port->name);
1271 }
1272
1273 nl = netdev_priv(dev);
c4028958 1274 nl->dev = dev;
cdb32706 1275 nl->pardev = parport_register_device(port, dev->name, plip_preempt,
6aa20a22 1276 plip_wakeup, plip_interrupt,
1da177e4
LT		 1277 0, dev);
1278
1279 if (!nl->pardev) {
1280 printk(KERN_ERR "%s: parport_register failed\n", name);
1281 goto err_free_dev;
1282 return;
1283 }
1284
1285 plip_init_netdev(dev);
1286
1287 if (register_netdev(dev)) {
1288 printk(KERN_ERR "%s: network register failed\n", name);
1289 goto err_parport_unregister;
1290 }
1291
1292 printk(KERN_INFO "%s", version);
1293 if (dev->irq != -1)
1294 printk(KERN_INFO "%s: Parallel port at %#3lx, "
1295 "using IRQ %d.\n",
1296 dev->name, dev->base_addr, dev->irq);
1297 else
1298 printk(KERN_INFO "%s: Parallel port at %#3lx, "
1299 "not using IRQ.\n",
1300 dev->name, dev->base_addr);
1301 dev_plip[unit++] = dev;
1302 }
1303 return;
1304
1305err_parport_unregister:
1306 parport_unregister_device(nl->pardev);
1307err_free_dev:
1308 free_netdev(dev);
1309 return;
1310}
1311
1312/* plip_detach() is called (by the parport code) when a port is
1313 * no longer available to use. */
1314static void plip_detach (struct parport *port)
1315{
1316 /* Nothing to do */
1317}
1318
1319static struct parport_driver plip_driver = {
1320 .name = "plip",
1321 .attach = plip_attach,
1322 .detach = plip_detach
1323};
1324
1325static void __exit plip_cleanup_module (void)
1326{
1327 struct net_device *dev;
1328 int i;
1329
1330 parport_unregister_driver (&plip_driver);
1331
1332 for (i=0; i < PLIP_MAX; i++) {
1333 if ((dev = dev_plip[i])) {
1334 struct net_local *nl = netdev_priv(dev);
1335 unregister_netdev(dev);
1336 if (nl->port_owner)
1337 parport_release(nl->pardev);
1338 parport_unregister_device(nl->pardev);
1339 free_netdev(dev);
1340 dev_plip[i] = NULL;
1341 }
1342 }
1343}
1344
1345#ifndef MODULE
1346
1347static int parport_ptr;
1348
1349static int __init plip_setup(char *str)
1350{
1351 int ints[4];
1352
1353 str = get_options(str, ARRAY_SIZE(ints), ints);
1354
1355 /* Ugh. */
1356 if (!strncmp(str, "parport", 7)) {
1357 int n = simple_strtoul(str+7, NULL, 10);
1358 if (parport_ptr < PLIP_MAX)
1359 parport[parport_ptr++] = n;
1360 else
1361 printk(KERN_INFO "plip: too many ports, %s ignored.\n",
1362 str);
1363 } else if (!strcmp(str, "timid")) {
1364 timid = 1;
1365 } else {
1366 if (ints[0] == 0 || ints[1] == 0) {
1367 /* disable driver on "plip=" or "plip=0" */
1368 parport[0] = -2;
1369 } else {
6aa20a22 1370 printk(KERN_WARNING "warning: 'plip=0x%x' ignored\n",
1da177e4
LT		 1371 ints[1]);
1372 }
1373 }
1374 return 1;
1375}
1376
1377__setup("plip=", plip_setup);
1378
1379#endif /* !MODULE */
1380
1381static int __init plip_init (void)
1382{
1383 if (parport[0] == -2)
1384 return 0;
1385
1386 if (parport[0] != -1 && timid) {
1387 printk(KERN_WARNING "plip: warning, ignoring `timid' since specific ports given.\n");
1388 timid = 0;
1389 }
1390
1391 if (parport_register_driver (&plip_driver)) {
1392 printk (KERN_WARNING "plip: couldn't register driver\n");
1393 return 1;
1394 }
1395
1396 return 0;
1397}
1398
1399module_init(plip_init);
1400module_exit(plip_cleanup_module);
1401MODULE_LICENSE("GPL");
Ubuntu Artful kernel mirror