2 * An implementation of the Acorn Econet and AUN protocols.
3 * Philip Blundell <philb@gnu.org>
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version
8 * 2 of the License, or (at your option) any later version.
12 #include <linux/config.h>
13 #include <linux/module.h>
15 #include <linux/types.h>
16 #include <linux/kernel.h>
17 #include <linux/sched.h>
18 #include <linux/string.h>
20 #include <linux/socket.h>
21 #include <linux/sockios.h>
23 #include <linux/errno.h>
24 #include <linux/interrupt.h>
25 #include <linux/if_ether.h>
26 #include <linux/netdevice.h>
27 #include <linux/inetdevice.h>
28 #include <linux/route.h>
29 #include <linux/inet.h>
30 #include <linux/etherdevice.h>
31 #include <linux/if_arp.h>
32 #include <linux/wireless.h>
33 #include <linux/skbuff.h>
34 #include <linux/udp.h>
36 #include <net/inet_common.h>
37 #include <linux/stat.h>
38 #include <linux/init.h>
39 #include <linux/if_ec.h>
42 #include <linux/spinlock.h>
43 #include <linux/rcupdate.h>
44 #include <linux/bitops.h>
45 #include <linux/mutex.h>
47 #include <asm/uaccess.h>
48 #include <asm/system.h>
50 static const struct proto_ops econet_ops;
51 static struct hlist_head econet_sklist;
52 static DEFINE_RWLOCK(econet_lock);
53 static DEFINE_MUTEX(econet_mutex);
55 /* Since there are only 256 possible network numbers (or fewer, depends
56 how you count) it makes sense to use a simple lookup table. */
57 static struct net_device *net2dev_map[256];
59 #define EC_PORT_IP 0xd2
61 #ifdef CONFIG_ECONET_AUNUDP
62 static DEFINE_SPINLOCK(aun_queue_lock);
63 static struct socket *udpsock;
64 #define AUN_PORT 0x8000
69 unsigned char code; /* AUN magic protocol byte */
76 static unsigned long aun_seq;
78 /* Queue of packets waiting to be transmitted. */
79 static struct sk_buff_head aun_queue;
80 static struct timer_list ab_cleanup_timer;
82 #endif /* CONFIG_ECONET_AUNUDP */
84 /* Per-packet information */
87 struct sockaddr_ec sec;
88 unsigned long cookie; /* Supplied by user. */
89 #ifdef CONFIG_ECONET_AUNUDP
91 unsigned long seq; /* Sequencing */
92 unsigned long timeout; /* Timeout */
93 unsigned long start; /* jiffies */
95 #ifdef CONFIG_ECONET_NATIVE
96 void (*sent)(struct sk_buff *, int result);
100 static void econet_remove_socket(struct hlist_head *list, struct sock *sk)
102 write_lock_bh(&econet_lock);
103 sk_del_node_init(sk);
104 write_unlock_bh(&econet_lock);
107 static void econet_insert_socket(struct hlist_head *list, struct sock *sk)
109 write_lock_bh(&econet_lock);
110 sk_add_node(sk, list);
111 write_unlock_bh(&econet_lock);
115 * Pull a packet from our receive queue and hand it to the user.
116 * If necessary we block.
119 static int econet_recvmsg(struct kiocb *iocb, struct socket *sock,
120 struct msghdr *msg, size_t len, int flags)
122 struct sock *sk = sock->sk;
127 msg->msg_namelen = sizeof(struct sockaddr_ec);
129 mutex_lock(&econet_mutex);
132 * Call the generic datagram receiver. This handles all sorts
133 * of horrible races and re-entrancy so we can forget about it
134 * in the protocol layers.
136 * Now it will return ENETDOWN, if device have just gone down,
137 * but then it will block.
140 skb=skb_recv_datagram(sk,flags,flags&MSG_DONTWAIT,&err);
143 * An error occurred so return it. Because skb_recv_datagram()
144 * handles the blocking we don't see and worry about blocking
152 * You lose any data beyond the buffer you gave. If it worries a
153 * user program they can ask the device for its MTU anyway.
160 msg->msg_flags|=MSG_TRUNC;
163 /* We can't use skb_copy_datagram here */
164 err = memcpy_toiovec(msg->msg_iov, skb->data, copied);
167 skb_get_timestamp(skb, &sk->sk_stamp);
170 memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
173 * Free or return the buffer as appropriate. Again this
174 * hides all the races and re-entrancy issues from us.
179 skb_free_datagram(sk, skb);
181 mutex_unlock(&econet_mutex);
186 * Bind an Econet socket.
189 static int econet_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
191 struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
193 struct econet_sock *eo;
199 if (addr_len < sizeof(struct sockaddr_ec) ||
200 sec->sec_family != AF_ECONET)
203 mutex_lock(&econet_mutex);
209 eo->port = sec->port;
210 eo->station = sec->addr.station;
211 eo->net = sec->addr.net;
213 mutex_unlock(&econet_mutex);
218 #if defined(CONFIG_ECONET_AUNUDP) || defined(CONFIG_ECONET_NATIVE)
220 * Queue a transmit result for the user to be told about.
223 static void tx_result(struct sock *sk, unsigned long cookie, int result)
225 struct sk_buff *skb = alloc_skb(0, GFP_ATOMIC);
227 struct sockaddr_ec *sec;
231 printk(KERN_DEBUG "ec: memory squeeze, transmit result dropped.\n");
235 eb = (struct ec_cb *)&skb->cb;
236 sec = (struct sockaddr_ec *)&eb->sec;
237 memset(sec, 0, sizeof(struct sockaddr_ec));
238 sec->cookie = cookie;
239 sec->type = ECTYPE_TRANSMIT_STATUS | result;
240 sec->sec_family = AF_ECONET;
242 if (sock_queue_rcv_skb(sk, skb) < 0)
247 #ifdef CONFIG_ECONET_NATIVE
249 * Called by the Econet hardware driver when a packet transmit
250 * has completed. Tell the user.
253 static void ec_tx_done(struct sk_buff *skb, int result)
255 struct ec_cb *eb = (struct ec_cb *)&skb->cb;
256 tx_result(skb->sk, eb->cookie, result);
261 * Send a packet. We have to work out which device it's going out on
262 * and hence whether to use real Econet or the UDP emulation.
265 static int econet_sendmsg(struct kiocb *iocb, struct socket *sock,
266 struct msghdr *msg, size_t len)
268 struct sock *sk = sock->sk;
269 struct sockaddr_ec *saddr=(struct sockaddr_ec *)msg->msg_name;
270 struct net_device *dev;
273 unsigned char port, cb;
274 #if defined(CONFIG_ECONET_AUNUDP) || defined(CONFIG_ECONET_NATIVE)
278 #ifdef CONFIG_ECONET_AUNUDP
279 struct msghdr udpmsg;
280 struct iovec iov[msg->msg_iovlen+1];
282 struct sockaddr_in udpdest;
283 __kernel_size_t size;
292 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_CMSG_COMPAT))
296 * Get and verify the address.
299 mutex_lock(&econet_mutex);
302 struct econet_sock *eo = ec_sk(sk);
304 addr.station = eo->station;
309 if (msg->msg_namelen < sizeof(struct sockaddr_ec)) {
310 mutex_unlock(&econet_mutex);
313 addr.station = saddr->addr.station;
314 addr.net = saddr->addr.net;
319 /* Look for a device with the right network number. */
320 dev = net2dev_map[addr.net];
322 /* If not directly reachable, use some default */
324 dev = net2dev_map[0];
325 /* No interfaces at all? */
327 mutex_unlock(&econet_mutex);
332 if (len + 15 > dev->mtu) {
333 mutex_unlock(&econet_mutex);
337 if (dev->type == ARPHRD_ECONET) {
338 /* Real hardware Econet. We're not worthy etc. */
339 #ifdef CONFIG_ECONET_NATIVE
340 unsigned short proto = 0;
344 skb = sock_alloc_send_skb(sk, len+LL_RESERVED_SPACE(dev),
345 msg->msg_flags & MSG_DONTWAIT, &err);
349 skb_reserve(skb, LL_RESERVED_SPACE(dev));
350 skb->nh.raw = skb->data;
352 eb = (struct ec_cb *)&skb->cb;
354 /* BUG: saddr may be NULL */
355 eb->cookie = saddr->cookie;
357 eb->sent = ec_tx_done;
359 if (dev->hard_header) {
361 struct ec_framehdr *fh;
363 res = dev->hard_header(skb, dev, ntohs(proto),
365 /* Poke in our control byte and
366 port number. Hack, hack. */
367 fh = (struct ec_framehdr *)(skb->data);
370 if (sock->type != SOCK_DGRAM) {
371 skb->tail = skb->data;
377 /* Copy the data. Returns -EFAULT on error */
378 err = memcpy_fromiovec(skb_put(skb,len), msg->msg_iov, len);
379 skb->protocol = proto;
381 skb->priority = sk->sk_priority;
386 if (!(dev->flags & IFF_UP))
395 mutex_unlock(&econet_mutex);
406 mutex_unlock(&econet_mutex);
411 #ifdef CONFIG_ECONET_AUNUDP
412 /* AUN virtual Econet. */
414 if (udpsock == NULL) {
415 mutex_unlock(&econet_mutex);
416 return -ENETDOWN; /* No socket - can't send */
419 /* Make up a UDP datagram and hand it off to some higher intellect. */
421 memset(&udpdest, 0, sizeof(udpdest));
422 udpdest.sin_family = AF_INET;
423 udpdest.sin_port = htons(AUN_PORT);
425 /* At the moment we use the stupid Acorn scheme of Econet address
426 y.x maps to IP a.b.c.x. This should be replaced with something
427 more flexible and more aware of subnet masks. */
429 struct in_device *idev;
430 unsigned long network = 0;
433 idev = __in_dev_get_rcu(dev);
436 network = ntohl(idev->ifa_list->ifa_address) &
437 0xffffff00; /* !!! */
440 udpdest.sin_addr.s_addr = htonl(network | addr.station);
445 ah.code = 2; /* magic */
448 /* tack our header on the front of the iovec */
449 size = sizeof(struct aunhdr);
451 * XXX: that is b0rken. We can't mix userland and kernel pointers
452 * in iovec, since on a lot of platforms copy_from_user() will
453 * *not* work with the kernel and userland ones at the same time,
454 * regardless of what we do with set_fs(). And we are talking about
455 * econet-over-ethernet here, so "it's only ARM anyway" doesn't
456 * apply. Any suggestions on fixing that code? -- AV
458 iov[0].iov_base = (void *)&ah;
459 iov[0].iov_len = size;
460 for (i = 0; i < msg->msg_iovlen; i++) {
461 void __user *base = msg->msg_iov[i].iov_base;
462 size_t len = msg->msg_iov[i].iov_len;
463 /* Check it now since we switch to KERNEL_DS later. */
464 if (!access_ok(VERIFY_READ, base, len)) {
465 mutex_unlock(&econet_mutex);
468 iov[i+1].iov_base = base;
469 iov[i+1].iov_len = len;
473 /* Get a skbuff (no data, just holds our cb information) */
474 if ((skb = sock_alloc_send_skb(sk, 0,
475 msg->msg_flags & MSG_DONTWAIT,
477 mutex_unlock(&econet_mutex);
481 eb = (struct ec_cb *)&skb->cb;
483 eb->cookie = saddr->cookie;
484 eb->timeout = (5*HZ);
487 eb->seq = (aun_seq++);
490 skb_queue_tail(&aun_queue, skb);
492 udpmsg.msg_name = (void *)&udpdest;
493 udpmsg.msg_namelen = sizeof(udpdest);
494 udpmsg.msg_iov = &iov[0];
495 udpmsg.msg_iovlen = msg->msg_iovlen + 1;
496 udpmsg.msg_control = NULL;
497 udpmsg.msg_controllen = 0;
500 oldfs = get_fs(); set_fs(KERNEL_DS); /* More privs :-) */
501 err = sock_sendmsg(udpsock, &udpmsg, size);
506 mutex_unlock(&econet_mutex);
512 * Look up the address of a socket.
515 static int econet_getname(struct socket *sock, struct sockaddr *uaddr,
516 int *uaddr_len, int peer)
519 struct econet_sock *eo;
520 struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
525 mutex_lock(&econet_mutex);
530 sec->sec_family = AF_ECONET;
531 sec->port = eo->port;
532 sec->addr.station = eo->station;
533 sec->addr.net = eo->net;
535 mutex_unlock(&econet_mutex);
537 *uaddr_len = sizeof(*sec);
541 static void econet_destroy_timer(unsigned long data)
543 struct sock *sk=(struct sock *)data;
545 if (!atomic_read(&sk->sk_wmem_alloc) &&
546 !atomic_read(&sk->sk_rmem_alloc)) {
551 sk->sk_timer.expires = jiffies + 10 * HZ;
552 add_timer(&sk->sk_timer);
553 printk(KERN_DEBUG "econet socket destroy delayed\n");
557 * Close an econet socket.
560 static int econet_release(struct socket *sock)
564 mutex_lock(&econet_mutex);
570 econet_remove_socket(&econet_sklist, sk);
573 * Now the socket is dead. No more input will appear.
576 sk->sk_state_change(sk); /* It is useless. Just for sanity. */
579 sk->sk_socket = NULL;
580 sock_set_flag(sk, SOCK_DEAD);
584 skb_queue_purge(&sk->sk_receive_queue);
586 if (atomic_read(&sk->sk_rmem_alloc) ||
587 atomic_read(&sk->sk_wmem_alloc)) {
588 sk->sk_timer.data = (unsigned long)sk;
589 sk->sk_timer.expires = jiffies + HZ;
590 sk->sk_timer.function = econet_destroy_timer;
591 add_timer(&sk->sk_timer);
599 mutex_unlock(&econet_mutex);
603 static struct proto econet_proto = {
605 .owner = THIS_MODULE,
606 .obj_size = sizeof(struct econet_sock),
610 * Create an Econet socket
613 static int econet_create(struct socket *sock, int protocol)
616 struct econet_sock *eo;
619 /* Econet only provides datagram services. */
620 if (sock->type != SOCK_DGRAM)
621 return -ESOCKTNOSUPPORT;
623 sock->state = SS_UNCONNECTED;
626 sk = sk_alloc(PF_ECONET, GFP_KERNEL, &econet_proto, 1);
631 sock->ops = &econet_ops;
632 sock_init_data(sock, sk);
635 sock_reset_flag(sk, SOCK_ZAPPED);
636 sk->sk_family = PF_ECONET;
639 econet_insert_socket(&econet_sklist, sk);
646 * Handle Econet specific ioctls
649 static int ec_dev_ioctl(struct socket *sock, unsigned int cmd, void __user *arg)
652 struct ec_device *edev;
653 struct net_device *dev;
654 struct sockaddr_ec *sec;
658 * Fetch the caller's info block into kernel space
661 if (copy_from_user(&ifr, arg, sizeof(struct ifreq)))
664 if ((dev = dev_get_by_name(ifr.ifr_name)) == NULL)
667 sec = (struct sockaddr_ec *)&ifr.ifr_addr;
669 mutex_lock(&econet_mutex);
676 /* Magic up a new one. */
677 edev = kmalloc(sizeof(struct ec_device), GFP_KERNEL);
682 memset(edev, 0, sizeof(struct ec_device));
685 net2dev_map[edev->net] = NULL;
686 edev->station = sec->addr.station;
687 edev->net = sec->addr.net;
688 net2dev_map[sec->addr.net] = dev;
690 net2dev_map[0] = dev;
699 memset(sec, 0, sizeof(struct sockaddr_ec));
700 sec->addr.station = edev->station;
701 sec->addr.net = edev->net;
702 sec->sec_family = AF_ECONET;
704 if (copy_to_user(arg, &ifr, sizeof(struct ifreq)))
713 mutex_unlock(&econet_mutex);
721 * Handle generic ioctls
724 static int econet_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
726 struct sock *sk = sock->sk;
727 void __user *argp = (void __user *)arg;
731 return sock_get_timestamp(sk, argp);
735 return ec_dev_ioctl(sock, cmd, argp);
745 static struct net_proto_family econet_family_ops = {
747 .create = econet_create,
748 .owner = THIS_MODULE,
751 static const struct proto_ops econet_ops = {
753 .owner = THIS_MODULE,
754 .release = econet_release,
756 .connect = sock_no_connect,
757 .socketpair = sock_no_socketpair,
758 .accept = sock_no_accept,
759 .getname = econet_getname,
760 .poll = datagram_poll,
761 .ioctl = econet_ioctl,
762 .listen = sock_no_listen,
763 .shutdown = sock_no_shutdown,
764 .setsockopt = sock_no_setsockopt,
765 .getsockopt = sock_no_getsockopt,
766 .sendmsg = econet_sendmsg,
767 .recvmsg = econet_recvmsg,
768 .mmap = sock_no_mmap,
769 .sendpage = sock_no_sendpage,
772 #if defined(CONFIG_ECONET_AUNUDP) || defined(CONFIG_ECONET_NATIVE)
774 * Find the listening socket, if any, for the given data.
777 static struct sock *ec_listening_socket(unsigned char port, unsigned char
778 station, unsigned char net)
781 struct hlist_node *node;
783 sk_for_each(sk, node, &econet_sklist) {
784 struct econet_sock *opt = ec_sk(sk);
785 if ((opt->port == port || opt->port == 0) &&
786 (opt->station == station || opt->station == 0) &&
787 (opt->net == net || opt->net == 0))
796 * Queue a received packet for a socket.
799 static int ec_queue_packet(struct sock *sk, struct sk_buff *skb,
800 unsigned char stn, unsigned char net,
801 unsigned char cb, unsigned char port)
803 struct ec_cb *eb = (struct ec_cb *)&skb->cb;
804 struct sockaddr_ec *sec = (struct sockaddr_ec *)&eb->sec;
806 memset(sec, 0, sizeof(struct sockaddr_ec));
807 sec->sec_family = AF_ECONET;
808 sec->type = ECTYPE_PACKET_RECEIVED;
812 sec->addr.station = stn;
814 return sock_queue_rcv_skb(sk, skb);
818 #ifdef CONFIG_ECONET_AUNUDP
820 * Send an AUN protocol response.
823 static void aun_send_response(__u32 addr, unsigned long seq, int code, int cb)
825 struct sockaddr_in sin = {
826 .sin_family = AF_INET,
827 .sin_port = htons(AUN_PORT),
828 .sin_addr = {.s_addr = addr}
830 struct aunhdr ah = {.code = code, .cb = cb, .handle = seq};
831 struct kvec iov = {.iov_base = (void *)&ah, .iov_len = sizeof(ah)};
832 struct msghdr udpmsg;
834 udpmsg.msg_name = (void *)&sin;
835 udpmsg.msg_namelen = sizeof(sin);
836 udpmsg.msg_control = NULL;
837 udpmsg.msg_controllen = 0;
840 kernel_sendmsg(udpsock, &udpmsg, &iov, 1, sizeof(ah));
845 * Handle incoming AUN packets. Work out if anybody wants them,
846 * and send positive or negative acknowledgements as appropriate.
849 static void aun_incoming(struct sk_buff *skb, struct aunhdr *ah, size_t len)
851 struct iphdr *ip = skb->nh.iph;
852 unsigned char stn = ntohl(ip->saddr) & 0xff;
854 struct sk_buff *newskb;
855 struct ec_device *edev = skb->dev->ec_ptr;
860 if ((sk = ec_listening_socket(ah->port, stn, edev->net)) == NULL)
861 goto bad; /* Nobody wants it */
863 newskb = alloc_skb((len - sizeof(struct aunhdr) + 15) & ~15,
867 printk(KERN_DEBUG "AUN: memory squeeze, dropping packet.\n");
868 /* Send nack and hope sender tries again */
872 memcpy(skb_put(newskb, len - sizeof(struct aunhdr)), (void *)(ah+1),
873 len - sizeof(struct aunhdr));
875 if (ec_queue_packet(sk, newskb, stn, edev->net, ah->cb, ah->port))
877 /* Socket is bankrupt. */
882 aun_send_response(ip->saddr, ah->handle, 3, 0);
886 aun_send_response(ip->saddr, ah->handle, 4, 0);
890 * Handle incoming AUN transmit acknowledgements. If the sequence
891 * number matches something in our backlog then kill it and tell
892 * the user. If the remote took too long to reply then we may have
893 * dropped the packet already.
896 static void aun_tx_ack(unsigned long seq, int result)
902 spin_lock_irqsave(&aun_queue_lock, flags);
903 skb = skb_peek(&aun_queue);
904 while (skb && skb != (struct sk_buff *)&aun_queue)
906 struct sk_buff *newskb = skb->next;
907 eb = (struct ec_cb *)&skb->cb;
913 spin_unlock_irqrestore(&aun_queue_lock, flags);
914 printk(KERN_DEBUG "AUN: unknown sequence %ld\n", seq);
918 tx_result(skb->sk, eb->cookie, result);
919 skb_unlink(skb, &aun_queue);
920 spin_unlock_irqrestore(&aun_queue_lock, flags);
925 * Deal with received AUN frames - sort out what type of thing it is
926 * and hand it to the right function.
929 static void aun_data_available(struct sock *sk, int slen)
938 while ((skb = skb_recv_datagram(sk, 0, 1, &err)) == NULL) {
939 if (err == -EAGAIN) {
940 printk(KERN_ERR "AUN: no data available?!");
943 printk(KERN_DEBUG "AUN: recvfrom() error %d\n", -err);
946 data = skb->h.raw + sizeof(struct udphdr);
947 ah = (struct aunhdr *)data;
948 len = skb->len - sizeof(struct udphdr);
954 aun_incoming(skb, ah, len);
957 aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_OK);
960 aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_NOT_LISTENING);
963 /* This isn't quite right yet. */
965 aun_send_response(ip->saddr, ah->handle, 6, ah->cb);
969 printk(KERN_DEBUG "unknown AUN packet (type %d)\n", data[0]);
972 skb_free_datagram(sk, skb);
976 * Called by the timer to manage the AUN transmit queue. If a packet
977 * was sent to a dead or nonexistent host then we will never get an
978 * acknowledgement back. After a few seconds we need to spot this and
982 static void ab_cleanup(unsigned long h)
987 spin_lock_irqsave(&aun_queue_lock, flags);
988 skb = skb_peek(&aun_queue);
989 while (skb && skb != (struct sk_buff *)&aun_queue)
991 struct sk_buff *newskb = skb->next;
992 struct ec_cb *eb = (struct ec_cb *)&skb->cb;
993 if ((jiffies - eb->start) > eb->timeout)
995 tx_result(skb->sk, eb->cookie,
996 ECTYPE_TRANSMIT_NOT_PRESENT);
997 skb_unlink(skb, &aun_queue);
1002 spin_unlock_irqrestore(&aun_queue_lock, flags);
1004 mod_timer(&ab_cleanup_timer, jiffies + (HZ*2));
1007 static int __init aun_udp_initialise(void)
1010 struct sockaddr_in sin;
1012 skb_queue_head_init(&aun_queue);
1013 spin_lock_init(&aun_queue_lock);
1014 init_timer(&ab_cleanup_timer);
1015 ab_cleanup_timer.expires = jiffies + (HZ*2);
1016 ab_cleanup_timer.function = ab_cleanup;
1017 add_timer(&ab_cleanup_timer);
1019 memset(&sin, 0, sizeof(sin));
1020 sin.sin_port = htons(AUN_PORT);
1022 /* We can count ourselves lucky Acorn machines are too dim to
1024 if ((error = sock_create_kern(PF_INET, SOCK_DGRAM, 0, &udpsock)) < 0)
1026 printk("AUN: socket error %d\n", -error);
1030 udpsock->sk->sk_reuse = 1;
1031 udpsock->sk->sk_allocation = GFP_ATOMIC; /* we're going to call it
1034 error = udpsock->ops->bind(udpsock, (struct sockaddr *)&sin,
1038 printk("AUN: bind error %d\n", -error);
1042 udpsock->sk->sk_data_ready = aun_data_available;
1047 sock_release(udpsock);
1053 #ifdef CONFIG_ECONET_NATIVE
1056 * Receive an Econet frame from a device.
1059 static int econet_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *pt, struct net_device *orig_dev)
1061 struct ec_framehdr *hdr;
1063 struct ec_device *edev = dev->ec_ptr;
1065 if (skb->pkt_type == PACKET_OTHERHOST)
1071 if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL)
1074 if (!pskb_may_pull(skb, sizeof(struct ec_framehdr)))
1077 hdr = (struct ec_framehdr *) skb->data;
1079 /* First check for encapsulated IP */
1080 if (hdr->port == EC_PORT_IP) {
1081 skb->protocol = htons(ETH_P_IP);
1082 skb_pull(skb, sizeof(struct ec_framehdr));
1087 sk = ec_listening_socket(hdr->port, hdr->src_stn, hdr->src_net);
1091 if (ec_queue_packet(sk, skb, edev->net, hdr->src_stn, hdr->cb,
1102 static struct packet_type econet_packet_type = {
1103 .type = __constant_htons(ETH_P_ECONET),
1107 static void econet_hw_initialise(void)
1109 dev_add_pack(&econet_packet_type);
1114 static int econet_notifier(struct notifier_block *this, unsigned long msg, void *data)
1116 struct net_device *dev = (struct net_device *)data;
1117 struct ec_device *edev;
1120 case NETDEV_UNREGISTER:
1121 /* A device has gone down - kill any data we hold for it. */
1125 if (net2dev_map[0] == dev)
1126 net2dev_map[0] = NULL;
1127 net2dev_map[edev->net] = NULL;
1137 static struct notifier_block econet_netdev_notifier = {
1138 .notifier_call =econet_notifier,
1141 static void __exit econet_proto_exit(void)
1143 #ifdef CONFIG_ECONET_AUNUDP
1144 del_timer(&ab_cleanup_timer);
1146 sock_release(udpsock);
1148 unregister_netdevice_notifier(&econet_netdev_notifier);
1149 sock_unregister(econet_family_ops.family);
1150 proto_unregister(&econet_proto);
1153 static int __init econet_proto_init(void)
1155 int err = proto_register(&econet_proto, 0);
1159 sock_register(&econet_family_ops);
1160 #ifdef CONFIG_ECONET_AUNUDP
1161 spin_lock_init(&aun_queue_lock);
1162 aun_udp_initialise();
1164 #ifdef CONFIG_ECONET_NATIVE
1165 econet_hw_initialise();
1167 register_netdevice_notifier(&econet_netdev_notifier);
1172 module_init(econet_proto_init);
1173 module_exit(econet_proto_exit);
1175 MODULE_LICENSE("GPL");
1176 MODULE_ALIAS_NETPROTO(PF_ECONET);