/*
|
/*
|
* An implementation of the Acorn Econet and AUN protocols.
|
* An implementation of the Acorn Econet and AUN protocols.
|
* Philip Blundell <philb@gnu.org>
|
* Philip Blundell <philb@gnu.org>
|
*
|
*
|
* This program is free software; you can redistribute it and/or
|
* This program is free software; you can redistribute it and/or
|
* modify it under the terms of the GNU General Public License
|
* modify it under the terms of the GNU General Public License
|
* as published by the Free Software Foundation; either version
|
* as published by the Free Software Foundation; either version
|
* 2 of the License, or (at your option) any later version.
|
* 2 of the License, or (at your option) any later version.
|
*
|
*
|
*/
|
*/
|
|
|
#include <linux/config.h>
|
#include <linux/config.h>
|
#include <linux/module.h>
|
#include <linux/module.h>
|
|
|
#include <linux/types.h>
|
#include <linux/types.h>
|
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
#include <linux/sched.h>
|
#include <linux/sched.h>
|
#include <linux/string.h>
|
#include <linux/string.h>
|
#include <linux/mm.h>
|
#include <linux/mm.h>
|
#include <linux/socket.h>
|
#include <linux/socket.h>
|
#include <linux/sockios.h>
|
#include <linux/sockios.h>
|
#include <linux/in.h>
|
#include <linux/in.h>
|
#include <linux/errno.h>
|
#include <linux/errno.h>
|
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
#include <linux/if_ether.h>
|
#include <linux/if_ether.h>
|
#include <linux/netdevice.h>
|
#include <linux/netdevice.h>
|
#include <linux/inetdevice.h>
|
#include <linux/inetdevice.h>
|
#include <linux/route.h>
|
#include <linux/route.h>
|
#include <linux/inet.h>
|
#include <linux/inet.h>
|
#include <linux/etherdevice.h>
|
#include <linux/etherdevice.h>
|
#include <linux/if_arp.h>
|
#include <linux/if_arp.h>
|
#include <linux/wireless.h>
|
#include <linux/wireless.h>
|
#include <linux/skbuff.h>
|
#include <linux/skbuff.h>
|
#include <net/sock.h>
|
#include <net/sock.h>
|
#include <net/inet_common.h>
|
#include <net/inet_common.h>
|
#include <linux/stat.h>
|
#include <linux/stat.h>
|
#include <linux/init.h>
|
#include <linux/init.h>
|
#include <linux/if_ec.h>
|
#include <linux/if_ec.h>
|
#include <net/udp.h>
|
#include <net/udp.h>
|
#include <net/ip.h>
|
#include <net/ip.h>
|
#include <linux/spinlock.h>
|
#include <linux/spinlock.h>
|
|
|
#include <asm/uaccess.h>
|
#include <asm/uaccess.h>
|
#include <asm/system.h>
|
#include <asm/system.h>
|
#include <asm/bitops.h>
|
#include <asm/bitops.h>
|
|
|
static struct proto_ops econet_ops;
|
static struct proto_ops econet_ops;
|
static struct sock *econet_sklist;
|
static struct sock *econet_sklist;
|
|
|
/* Since there are only 256 possible network numbers (or fewer, depends
|
/* Since there are only 256 possible network numbers (or fewer, depends
|
how you count) it makes sense to use a simple lookup table. */
|
how you count) it makes sense to use a simple lookup table. */
|
static struct net_device *net2dev_map[256];
|
static struct net_device *net2dev_map[256];
|
|
|
#define EC_PORT_IP 0xd2
|
#define EC_PORT_IP 0xd2
|
|
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
static spinlock_t aun_queue_lock;
|
static spinlock_t aun_queue_lock;
|
static struct socket *udpsock;
|
static struct socket *udpsock;
|
#define AUN_PORT 0x8000
|
#define AUN_PORT 0x8000
|
|
|
|
|
struct aunhdr
|
struct aunhdr
|
{
|
{
|
unsigned char code; /* AUN magic protocol byte */
|
unsigned char code; /* AUN magic protocol byte */
|
unsigned char port;
|
unsigned char port;
|
unsigned char cb;
|
unsigned char cb;
|
unsigned char pad;
|
unsigned char pad;
|
unsigned long handle;
|
unsigned long handle;
|
};
|
};
|
|
|
static unsigned long aun_seq;
|
static unsigned long aun_seq;
|
|
|
/* Queue of packets waiting to be transmitted. */
|
/* Queue of packets waiting to be transmitted. */
|
static struct sk_buff_head aun_queue;
|
static struct sk_buff_head aun_queue;
|
static struct timer_list ab_cleanup_timer;
|
static struct timer_list ab_cleanup_timer;
|
|
|
#endif /* CONFIG_ECONET_AUNUDP */
|
#endif /* CONFIG_ECONET_AUNUDP */
|
|
|
/* Per-packet information */
|
/* Per-packet information */
|
struct ec_cb
|
struct ec_cb
|
{
|
{
|
struct sockaddr_ec sec;
|
struct sockaddr_ec sec;
|
unsigned long cookie; /* Supplied by user. */
|
unsigned long cookie; /* Supplied by user. */
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
int done;
|
int done;
|
unsigned long seq; /* Sequencing */
|
unsigned long seq; /* Sequencing */
|
unsigned long timeout; /* Timeout */
|
unsigned long timeout; /* Timeout */
|
unsigned long start; /* jiffies */
|
unsigned long start; /* jiffies */
|
#endif
|
#endif
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
void (*sent)(struct sk_buff *, int result);
|
void (*sent)(struct sk_buff *, int result);
|
#endif
|
#endif
|
};
|
};
|
|
|
/*
|
/*
|
* Pull a packet from our receive queue and hand it to the user.
|
* Pull a packet from our receive queue and hand it to the user.
|
* If necessary we block.
|
* If necessary we block.
|
*/
|
*/
|
|
|
static int econet_recvmsg(struct socket *sock, struct msghdr *msg, int len,
|
static int econet_recvmsg(struct socket *sock, struct msghdr *msg, int len,
|
int flags, struct scm_cookie *scm)
|
int flags, struct scm_cookie *scm)
|
{
|
{
|
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
struct sk_buff *skb;
|
struct sk_buff *skb;
|
int copied, err;
|
int copied, err;
|
|
|
msg->msg_namelen = sizeof(struct sockaddr_ec);
|
msg->msg_namelen = sizeof(struct sockaddr_ec);
|
|
|
/*
|
/*
|
* Call the generic datagram receiver. This handles all sorts
|
* Call the generic datagram receiver. This handles all sorts
|
* of horrible races and re-entrancy so we can forget about it
|
* of horrible races and re-entrancy so we can forget about it
|
* in the protocol layers.
|
* in the protocol layers.
|
*
|
*
|
* Now it will return ENETDOWN, if device have just gone down,
|
* Now it will return ENETDOWN, if device have just gone down,
|
* but then it will block.
|
* but then it will block.
|
*/
|
*/
|
|
|
skb=skb_recv_datagram(sk,flags,flags&MSG_DONTWAIT,&err);
|
skb=skb_recv_datagram(sk,flags,flags&MSG_DONTWAIT,&err);
|
|
|
/*
|
/*
|
* An error occurred so return it. Because skb_recv_datagram()
|
* An error occurred so return it. Because skb_recv_datagram()
|
* handles the blocking we don't see and worry about blocking
|
* handles the blocking we don't see and worry about blocking
|
* retries.
|
* retries.
|
*/
|
*/
|
|
|
if(skb==NULL)
|
if(skb==NULL)
|
goto out;
|
goto out;
|
|
|
/*
|
/*
|
* You lose any data beyond the buffer you gave. If it worries a
|
* You lose any data beyond the buffer you gave. If it worries a
|
* user program they can ask the device for its MTU anyway.
|
* user program they can ask the device for its MTU anyway.
|
*/
|
*/
|
|
|
copied = skb->len;
|
copied = skb->len;
|
if (copied > len)
|
if (copied > len)
|
{
|
{
|
copied=len;
|
copied=len;
|
msg->msg_flags|=MSG_TRUNC;
|
msg->msg_flags|=MSG_TRUNC;
|
}
|
}
|
|
|
/* We can't use skb_copy_datagram here */
|
/* We can't use skb_copy_datagram here */
|
err = memcpy_toiovec(msg->msg_iov, skb->data, copied);
|
err = memcpy_toiovec(msg->msg_iov, skb->data, copied);
|
if (err)
|
if (err)
|
goto out_free;
|
goto out_free;
|
sk->stamp=skb->stamp;
|
sk->stamp=skb->stamp;
|
|
|
if (msg->msg_name)
|
if (msg->msg_name)
|
memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
|
memcpy(msg->msg_name, skb->cb, msg->msg_namelen);
|
|
|
/*
|
/*
|
* Free or return the buffer as appropriate. Again this
|
* Free or return the buffer as appropriate. Again this
|
* hides all the races and re-entrancy issues from us.
|
* hides all the races and re-entrancy issues from us.
|
*/
|
*/
|
err = copied;
|
err = copied;
|
|
|
out_free:
|
out_free:
|
skb_free_datagram(sk, skb);
|
skb_free_datagram(sk, skb);
|
out:
|
out:
|
return err;
|
return err;
|
}
|
}
|
|
|
/*
|
/*
|
* Bind an Econet socket.
|
* Bind an Econet socket.
|
*/
|
*/
|
|
|
static int econet_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
|
static int econet_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
|
{
|
{
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
|
struct sock *sk=sock->sk;
|
struct sock *sk=sock->sk;
|
|
|
/*
|
/*
|
* Check legality
|
* Check legality
|
*/
|
*/
|
|
|
if (addr_len < sizeof(struct sockaddr_ec) ||
|
if (addr_len < sizeof(struct sockaddr_ec) ||
|
sec->sec_family != AF_ECONET)
|
sec->sec_family != AF_ECONET)
|
return -EINVAL;
|
return -EINVAL;
|
|
|
sk->protinfo.af_econet->cb = sec->cb;
|
sk->protinfo.af_econet->cb = sec->cb;
|
sk->protinfo.af_econet->port = sec->port;
|
sk->protinfo.af_econet->port = sec->port;
|
sk->protinfo.af_econet->station = sec->addr.station;
|
sk->protinfo.af_econet->station = sec->addr.station;
|
sk->protinfo.af_econet->net = sec->addr.net;
|
sk->protinfo.af_econet->net = sec->addr.net;
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* Queue a transmit result for the user to be told about.
|
* Queue a transmit result for the user to be told about.
|
*/
|
*/
|
|
|
static void tx_result(struct sock *sk, unsigned long cookie, int result)
|
static void tx_result(struct sock *sk, unsigned long cookie, int result)
|
{
|
{
|
struct sk_buff *skb = alloc_skb(0, GFP_ATOMIC);
|
struct sk_buff *skb = alloc_skb(0, GFP_ATOMIC);
|
struct ec_cb *eb;
|
struct ec_cb *eb;
|
struct sockaddr_ec *sec;
|
struct sockaddr_ec *sec;
|
|
|
if (skb == NULL)
|
if (skb == NULL)
|
{
|
{
|
printk(KERN_DEBUG "ec: memory squeeze, transmit result dropped.\n");
|
printk(KERN_DEBUG "ec: memory squeeze, transmit result dropped.\n");
|
return;
|
return;
|
}
|
}
|
|
|
eb = (struct ec_cb *)&skb->cb;
|
eb = (struct ec_cb *)&skb->cb;
|
sec = (struct sockaddr_ec *)&eb->sec;
|
sec = (struct sockaddr_ec *)&eb->sec;
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
sec->cookie = cookie;
|
sec->cookie = cookie;
|
sec->type = ECTYPE_TRANSMIT_STATUS | result;
|
sec->type = ECTYPE_TRANSMIT_STATUS | result;
|
sec->sec_family = AF_ECONET;
|
sec->sec_family = AF_ECONET;
|
|
|
if (sock_queue_rcv_skb(sk, skb) < 0)
|
if (sock_queue_rcv_skb(sk, skb) < 0)
|
kfree_skb(skb);
|
kfree_skb(skb);
|
}
|
}
|
|
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
/*
|
/*
|
* Called by the Econet hardware driver when a packet transmit
|
* Called by the Econet hardware driver when a packet transmit
|
* has completed. Tell the user.
|
* has completed. Tell the user.
|
*/
|
*/
|
|
|
static void ec_tx_done(struct sk_buff *skb, int result)
|
static void ec_tx_done(struct sk_buff *skb, int result)
|
{
|
{
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
tx_result(skb->sk, eb->cookie, result);
|
tx_result(skb->sk, eb->cookie, result);
|
}
|
}
|
#endif
|
#endif
|
|
|
/*
|
/*
|
* Send a packet. We have to work out which device it's going out on
|
* Send a packet. We have to work out which device it's going out on
|
* and hence whether to use real Econet or the UDP emulation.
|
* and hence whether to use real Econet or the UDP emulation.
|
*/
|
*/
|
|
|
static int econet_sendmsg(struct socket *sock, struct msghdr *msg, int len,
|
static int econet_sendmsg(struct socket *sock, struct msghdr *msg, int len,
|
struct scm_cookie *scm)
|
struct scm_cookie *scm)
|
{
|
{
|
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
struct sockaddr_ec *saddr=(struct sockaddr_ec *)msg->msg_name;
|
struct sockaddr_ec *saddr=(struct sockaddr_ec *)msg->msg_name;
|
struct net_device *dev;
|
struct net_device *dev;
|
struct ec_addr addr;
|
struct ec_addr addr;
|
int err;
|
int err;
|
unsigned char port, cb;
|
unsigned char port, cb;
|
struct sk_buff *skb;
|
struct sk_buff *skb;
|
struct ec_cb *eb;
|
struct ec_cb *eb;
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
unsigned short proto = 0;
|
unsigned short proto = 0;
|
#endif
|
#endif
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
struct msghdr udpmsg;
|
struct msghdr udpmsg;
|
struct iovec iov[msg->msg_iovlen+1];
|
struct iovec iov[msg->msg_iovlen+1];
|
struct aunhdr ah;
|
struct aunhdr ah;
|
struct sockaddr_in udpdest;
|
struct sockaddr_in udpdest;
|
__kernel_size_t size;
|
__kernel_size_t size;
|
int i;
|
int i;
|
mm_segment_t oldfs;
|
mm_segment_t oldfs;
|
#endif
|
#endif
|
|
|
/*
|
/*
|
* Check the flags.
|
* Check the flags.
|
*/
|
*/
|
|
|
if (msg->msg_flags&~MSG_DONTWAIT)
|
if (msg->msg_flags&~MSG_DONTWAIT)
|
return(-EINVAL);
|
return(-EINVAL);
|
|
|
/*
|
/*
|
* Get and verify the address.
|
* Get and verify the address.
|
*/
|
*/
|
|
|
if (saddr == NULL) {
|
if (saddr == NULL) {
|
addr.station = sk->protinfo.af_econet->station;
|
addr.station = sk->protinfo.af_econet->station;
|
addr.net = sk->protinfo.af_econet->net;
|
addr.net = sk->protinfo.af_econet->net;
|
port = sk->protinfo.af_econet->port;
|
port = sk->protinfo.af_econet->port;
|
cb = sk->protinfo.af_econet->cb;
|
cb = sk->protinfo.af_econet->cb;
|
} else {
|
} else {
|
if (msg->msg_namelen < sizeof(struct sockaddr_ec))
|
if (msg->msg_namelen < sizeof(struct sockaddr_ec))
|
return -EINVAL;
|
return -EINVAL;
|
addr.station = saddr->addr.station;
|
addr.station = saddr->addr.station;
|
addr.net = saddr->addr.net;
|
addr.net = saddr->addr.net;
|
port = saddr->port;
|
port = saddr->port;
|
cb = saddr->cb;
|
cb = saddr->cb;
|
}
|
}
|
|
|
/* Look for a device with the right network number. */
|
/* Look for a device with the right network number. */
|
dev = net2dev_map[addr.net];
|
dev = net2dev_map[addr.net];
|
|
|
/* If not directly reachable, use some default */
|
/* If not directly reachable, use some default */
|
if (dev == NULL)
|
if (dev == NULL)
|
{
|
{
|
dev = net2dev_map[0];
|
dev = net2dev_map[0];
|
/* No interfaces at all? */
|
/* No interfaces at all? */
|
if (dev == NULL)
|
if (dev == NULL)
|
return -ENETDOWN;
|
return -ENETDOWN;
|
}
|
}
|
|
|
if (dev->type == ARPHRD_ECONET)
|
if (dev->type == ARPHRD_ECONET)
|
{
|
{
|
/* Real hardware Econet. We're not worthy etc. */
|
/* Real hardware Econet. We're not worthy etc. */
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
atomic_inc(&dev->refcnt);
|
atomic_inc(&dev->refcnt);
|
|
|
skb = sock_alloc_send_skb(sk, len+dev->hard_header_len+15,
|
skb = sock_alloc_send_skb(sk, len+dev->hard_header_len+15,
|
msg->msg_flags & MSG_DONTWAIT, &err);
|
msg->msg_flags & MSG_DONTWAIT, &err);
|
if (skb==NULL)
|
if (skb==NULL)
|
goto out_unlock;
|
goto out_unlock;
|
|
|
skb_reserve(skb, (dev->hard_header_len+15)&~15);
|
skb_reserve(skb, (dev->hard_header_len+15)&~15);
|
skb->nh.raw = skb->data;
|
skb->nh.raw = skb->data;
|
|
|
eb = (struct ec_cb *)&skb->cb;
|
eb = (struct ec_cb *)&skb->cb;
|
|
|
/* BUG: saddr may be NULL */
|
/* BUG: saddr may be NULL */
|
eb->cookie = saddr->cookie;
|
eb->cookie = saddr->cookie;
|
eb->sec = *saddr;
|
eb->sec = *saddr;
|
eb->sent = ec_tx_done;
|
eb->sent = ec_tx_done;
|
|
|
if (dev->hard_header) {
|
if (dev->hard_header) {
|
int res;
|
int res;
|
struct ec_framehdr *fh;
|
struct ec_framehdr *fh;
|
err = -EINVAL;
|
err = -EINVAL;
|
res = dev->hard_header(skb, dev, ntohs(proto),
|
res = dev->hard_header(skb, dev, ntohs(proto),
|
&addr, NULL, len);
|
&addr, NULL, len);
|
/* Poke in our control byte and
|
/* Poke in our control byte and
|
port number. Hack, hack. */
|
port number. Hack, hack. */
|
fh = (struct ec_framehdr *)(skb->data);
|
fh = (struct ec_framehdr *)(skb->data);
|
fh->cb = cb;
|
fh->cb = cb;
|
fh->port = port;
|
fh->port = port;
|
if (sock->type != SOCK_DGRAM) {
|
if (sock->type != SOCK_DGRAM) {
|
skb->tail = skb->data;
|
skb->tail = skb->data;
|
skb->len = 0;
|
skb->len = 0;
|
} else if (res < 0)
|
} else if (res < 0)
|
goto out_free;
|
goto out_free;
|
}
|
}
|
|
|
/* Copy the data. Returns -EFAULT on error */
|
/* Copy the data. Returns -EFAULT on error */
|
err = memcpy_fromiovec(skb_put(skb,len), msg->msg_iov, len);
|
err = memcpy_fromiovec(skb_put(skb,len), msg->msg_iov, len);
|
skb->protocol = proto;
|
skb->protocol = proto;
|
skb->dev = dev;
|
skb->dev = dev;
|
skb->priority = sk->priority;
|
skb->priority = sk->priority;
|
if (err)
|
if (err)
|
goto out_free;
|
goto out_free;
|
|
|
err = -ENETDOWN;
|
err = -ENETDOWN;
|
if (!(dev->flags & IFF_UP))
|
if (!(dev->flags & IFF_UP))
|
goto out_free;
|
goto out_free;
|
|
|
/*
|
/*
|
* Now send it
|
* Now send it
|
*/
|
*/
|
|
|
dev_queue_xmit(skb);
|
dev_queue_xmit(skb);
|
dev_put(dev);
|
dev_put(dev);
|
return(len);
|
return(len);
|
|
|
out_free:
|
out_free:
|
kfree_skb(skb);
|
kfree_skb(skb);
|
out_unlock:
|
out_unlock:
|
if (dev)
|
if (dev)
|
dev_put(dev);
|
dev_put(dev);
|
#else
|
#else
|
err = -EPROTOTYPE;
|
err = -EPROTOTYPE;
|
#endif
|
#endif
|
return err;
|
return err;
|
}
|
}
|
|
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
/* AUN virtual Econet. */
|
/* AUN virtual Econet. */
|
|
|
if (udpsock == NULL)
|
if (udpsock == NULL)
|
return -ENETDOWN; /* No socket - can't send */
|
return -ENETDOWN; /* No socket - can't send */
|
|
|
/* Make up a UDP datagram and hand it off to some higher intellect. */
|
/* Make up a UDP datagram and hand it off to some higher intellect. */
|
|
|
memset(&udpdest, 0, sizeof(udpdest));
|
memset(&udpdest, 0, sizeof(udpdest));
|
udpdest.sin_family = AF_INET;
|
udpdest.sin_family = AF_INET;
|
udpdest.sin_port = htons(AUN_PORT);
|
udpdest.sin_port = htons(AUN_PORT);
|
|
|
/* At the moment we use the stupid Acorn scheme of Econet address
|
/* At the moment we use the stupid Acorn scheme of Econet address
|
y.x maps to IP a.b.c.x. This should be replaced with something
|
y.x maps to IP a.b.c.x. This should be replaced with something
|
more flexible and more aware of subnet masks. */
|
more flexible and more aware of subnet masks. */
|
{
|
{
|
struct in_device *idev = in_dev_get(dev);
|
struct in_device *idev = in_dev_get(dev);
|
unsigned long network = 0;
|
unsigned long network = 0;
|
if (idev) {
|
if (idev) {
|
read_lock(&idev->lock);
|
read_lock(&idev->lock);
|
if (idev->ifa_list)
|
if (idev->ifa_list)
|
network = ntohl(idev->ifa_list->ifa_address) &
|
network = ntohl(idev->ifa_list->ifa_address) &
|
0xffffff00; /* !!! */
|
0xffffff00; /* !!! */
|
read_unlock(&idev->lock);
|
read_unlock(&idev->lock);
|
in_dev_put(idev);
|
in_dev_put(idev);
|
}
|
}
|
udpdest.sin_addr.s_addr = htonl(network | addr.station);
|
udpdest.sin_addr.s_addr = htonl(network | addr.station);
|
}
|
}
|
|
|
ah.port = port;
|
ah.port = port;
|
ah.cb = cb & 0x7f;
|
ah.cb = cb & 0x7f;
|
ah.code = 2; /* magic */
|
ah.code = 2; /* magic */
|
ah.pad = 0;
|
ah.pad = 0;
|
|
|
/* tack our header on the front of the iovec */
|
/* tack our header on the front of the iovec */
|
size = sizeof(struct aunhdr);
|
size = sizeof(struct aunhdr);
|
iov[0].iov_base = (void *)&ah;
|
iov[0].iov_base = (void *)&ah;
|
iov[0].iov_len = size;
|
iov[0].iov_len = size;
|
for (i = 0; i < msg->msg_iovlen; i++) {
|
for (i = 0; i < msg->msg_iovlen; i++) {
|
void *base = msg->msg_iov[i].iov_base;
|
void *base = msg->msg_iov[i].iov_base;
|
size_t len = msg->msg_iov[i].iov_len;
|
size_t len = msg->msg_iov[i].iov_len;
|
/* Check it now since we switch to KERNEL_DS later. */
|
/* Check it now since we switch to KERNEL_DS later. */
|
if ((err = verify_area(VERIFY_READ, base, len)) < 0)
|
if ((err = verify_area(VERIFY_READ, base, len)) < 0)
|
return err;
|
return err;
|
iov[i+1].iov_base = base;
|
iov[i+1].iov_base = base;
|
iov[i+1].iov_len = len;
|
iov[i+1].iov_len = len;
|
size += len;
|
size += len;
|
}
|
}
|
|
|
/* Get a skbuff (no data, just holds our cb information) */
|
/* Get a skbuff (no data, just holds our cb information) */
|
if ((skb = sock_alloc_send_skb(sk, 0,
|
if ((skb = sock_alloc_send_skb(sk, 0,
|
msg->msg_flags & MSG_DONTWAIT, &err)) == NULL)
|
msg->msg_flags & MSG_DONTWAIT, &err)) == NULL)
|
return err;
|
return err;
|
|
|
eb = (struct ec_cb *)&skb->cb;
|
eb = (struct ec_cb *)&skb->cb;
|
|
|
eb->cookie = saddr->cookie;
|
eb->cookie = saddr->cookie;
|
eb->timeout = (5*HZ);
|
eb->timeout = (5*HZ);
|
eb->start = jiffies;
|
eb->start = jiffies;
|
ah.handle = aun_seq;
|
ah.handle = aun_seq;
|
eb->seq = (aun_seq++);
|
eb->seq = (aun_seq++);
|
eb->sec = *saddr;
|
eb->sec = *saddr;
|
|
|
skb_queue_tail(&aun_queue, skb);
|
skb_queue_tail(&aun_queue, skb);
|
|
|
udpmsg.msg_name = (void *)&udpdest;
|
udpmsg.msg_name = (void *)&udpdest;
|
udpmsg.msg_namelen = sizeof(udpdest);
|
udpmsg.msg_namelen = sizeof(udpdest);
|
udpmsg.msg_iov = &iov[0];
|
udpmsg.msg_iov = &iov[0];
|
udpmsg.msg_iovlen = msg->msg_iovlen + 1;
|
udpmsg.msg_iovlen = msg->msg_iovlen + 1;
|
udpmsg.msg_control = NULL;
|
udpmsg.msg_control = NULL;
|
udpmsg.msg_controllen = 0;
|
udpmsg.msg_controllen = 0;
|
udpmsg.msg_flags=0;
|
udpmsg.msg_flags=0;
|
|
|
oldfs = get_fs(); set_fs(KERNEL_DS); /* More privs :-) */
|
oldfs = get_fs(); set_fs(KERNEL_DS); /* More privs :-) */
|
err = sock_sendmsg(udpsock, &udpmsg, size);
|
err = sock_sendmsg(udpsock, &udpmsg, size);
|
set_fs(oldfs);
|
set_fs(oldfs);
|
#else
|
#else
|
err = -EPROTOTYPE;
|
err = -EPROTOTYPE;
|
#endif
|
#endif
|
return err;
|
return err;
|
}
|
}
|
|
|
/*
|
/*
|
* Look up the address of a socket.
|
* Look up the address of a socket.
|
*/
|
*/
|
|
|
static int econet_getname(struct socket *sock, struct sockaddr *uaddr,
|
static int econet_getname(struct socket *sock, struct sockaddr *uaddr,
|
int *uaddr_len, int peer)
|
int *uaddr_len, int peer)
|
{
|
{
|
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)uaddr;
|
|
|
if (peer)
|
if (peer)
|
return -EOPNOTSUPP;
|
return -EOPNOTSUPP;
|
|
|
sec->sec_family = AF_ECONET;
|
sec->sec_family = AF_ECONET;
|
sec->port = sk->protinfo.af_econet->port;
|
sec->port = sk->protinfo.af_econet->port;
|
sec->addr.station = sk->protinfo.af_econet->station;
|
sec->addr.station = sk->protinfo.af_econet->station;
|
sec->addr.net = sk->protinfo.af_econet->net;
|
sec->addr.net = sk->protinfo.af_econet->net;
|
|
|
*uaddr_len = sizeof(*sec);
|
*uaddr_len = sizeof(*sec);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
static void econet_destroy_timer(unsigned long data)
|
static void econet_destroy_timer(unsigned long data)
|
{
|
{
|
struct sock *sk=(struct sock *)data;
|
struct sock *sk=(struct sock *)data;
|
|
|
if (!atomic_read(&sk->wmem_alloc) && !atomic_read(&sk->rmem_alloc)) {
|
if (!atomic_read(&sk->wmem_alloc) && !atomic_read(&sk->rmem_alloc)) {
|
sk_free(sk);
|
sk_free(sk);
|
MOD_DEC_USE_COUNT;
|
MOD_DEC_USE_COUNT;
|
return;
|
return;
|
}
|
}
|
|
|
sk->timer.expires=jiffies+10*HZ;
|
sk->timer.expires=jiffies+10*HZ;
|
add_timer(&sk->timer);
|
add_timer(&sk->timer);
|
printk(KERN_DEBUG "econet socket destroy delayed\n");
|
printk(KERN_DEBUG "econet socket destroy delayed\n");
|
}
|
}
|
|
|
/*
|
/*
|
* Close an econet socket.
|
* Close an econet socket.
|
*/
|
*/
|
|
|
static int econet_release(struct socket *sock)
|
static int econet_release(struct socket *sock)
|
{
|
{
|
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
|
|
if (!sk)
|
if (!sk)
|
return 0;
|
return 0;
|
|
|
sklist_remove_socket(&econet_sklist, sk);
|
sklist_remove_socket(&econet_sklist, sk);
|
|
|
/*
|
/*
|
* Now the socket is dead. No more input will appear.
|
* Now the socket is dead. No more input will appear.
|
*/
|
*/
|
|
|
sk->state_change(sk); /* It is useless. Just for sanity. */
|
sk->state_change(sk); /* It is useless. Just for sanity. */
|
|
|
sock->sk = NULL;
|
sock->sk = NULL;
|
sk->socket = NULL;
|
sk->socket = NULL;
|
sk->dead = 1;
|
sk->dead = 1;
|
|
|
/* Purge queues */
|
/* Purge queues */
|
|
|
skb_queue_purge(&sk->receive_queue);
|
skb_queue_purge(&sk->receive_queue);
|
|
|
if (atomic_read(&sk->rmem_alloc) || atomic_read(&sk->wmem_alloc)) {
|
if (atomic_read(&sk->rmem_alloc) || atomic_read(&sk->wmem_alloc)) {
|
sk->timer.data=(unsigned long)sk;
|
sk->timer.data=(unsigned long)sk;
|
sk->timer.expires=jiffies+HZ;
|
sk->timer.expires=jiffies+HZ;
|
sk->timer.function=econet_destroy_timer;
|
sk->timer.function=econet_destroy_timer;
|
add_timer(&sk->timer);
|
add_timer(&sk->timer);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
sk_free(sk);
|
sk_free(sk);
|
MOD_DEC_USE_COUNT;
|
MOD_DEC_USE_COUNT;
|
return 0;
|
return 0;
|
}
|
}
|
|
|
/*
|
/*
|
* Create an Econet socket
|
* Create an Econet socket
|
*/
|
*/
|
|
|
static int econet_create(struct socket *sock, int protocol)
|
static int econet_create(struct socket *sock, int protocol)
|
{
|
{
|
struct sock *sk;
|
struct sock *sk;
|
int err;
|
int err;
|
|
|
/* Econet only provides datagram services. */
|
/* Econet only provides datagram services. */
|
if (sock->type != SOCK_DGRAM)
|
if (sock->type != SOCK_DGRAM)
|
return -ESOCKTNOSUPPORT;
|
return -ESOCKTNOSUPPORT;
|
|
|
sock->state = SS_UNCONNECTED;
|
sock->state = SS_UNCONNECTED;
|
MOD_INC_USE_COUNT;
|
MOD_INC_USE_COUNT;
|
|
|
err = -ENOBUFS;
|
err = -ENOBUFS;
|
sk = sk_alloc(PF_ECONET, GFP_KERNEL, 1);
|
sk = sk_alloc(PF_ECONET, GFP_KERNEL, 1);
|
if (sk == NULL)
|
if (sk == NULL)
|
goto out;
|
goto out;
|
|
|
sk->reuse = 1;
|
sk->reuse = 1;
|
sock->ops = &econet_ops;
|
sock->ops = &econet_ops;
|
sock_init_data(sock,sk);
|
sock_init_data(sock,sk);
|
|
|
sk->protinfo.af_econet = kmalloc(sizeof(struct econet_opt), GFP_KERNEL);
|
sk->protinfo.af_econet = kmalloc(sizeof(struct econet_opt), GFP_KERNEL);
|
if (sk->protinfo.af_econet == NULL)
|
if (sk->protinfo.af_econet == NULL)
|
goto out_free;
|
goto out_free;
|
memset(sk->protinfo.af_econet, 0, sizeof(struct econet_opt));
|
memset(sk->protinfo.af_econet, 0, sizeof(struct econet_opt));
|
sk->zapped=0;
|
sk->zapped=0;
|
sk->family = PF_ECONET;
|
sk->family = PF_ECONET;
|
sk->num = protocol;
|
sk->num = protocol;
|
|
|
sklist_insert_socket(&econet_sklist, sk);
|
sklist_insert_socket(&econet_sklist, sk);
|
return(0);
|
return(0);
|
|
|
out_free:
|
out_free:
|
sk_free(sk);
|
sk_free(sk);
|
out:
|
out:
|
MOD_DEC_USE_COUNT;
|
MOD_DEC_USE_COUNT;
|
return err;
|
return err;
|
}
|
}
|
|
|
/*
|
/*
|
* Handle Econet specific ioctls
|
* Handle Econet specific ioctls
|
*/
|
*/
|
|
|
static int ec_dev_ioctl(struct socket *sock, unsigned int cmd, void *arg)
|
static int ec_dev_ioctl(struct socket *sock, unsigned int cmd, void *arg)
|
{
|
{
|
struct ifreq ifr;
|
struct ifreq ifr;
|
struct ec_device *edev;
|
struct ec_device *edev;
|
struct net_device *dev;
|
struct net_device *dev;
|
struct sockaddr_ec *sec;
|
struct sockaddr_ec *sec;
|
|
|
/*
|
/*
|
* Fetch the caller's info block into kernel space
|
* Fetch the caller's info block into kernel space
|
*/
|
*/
|
|
|
if (copy_from_user(&ifr, arg, sizeof(struct ifreq)))
|
if (copy_from_user(&ifr, arg, sizeof(struct ifreq)))
|
return -EFAULT;
|
return -EFAULT;
|
|
|
if ((dev = dev_get_by_name(ifr.ifr_name)) == NULL)
|
if ((dev = dev_get_by_name(ifr.ifr_name)) == NULL)
|
return -ENODEV;
|
return -ENODEV;
|
|
|
sec = (struct sockaddr_ec *)&ifr.ifr_addr;
|
sec = (struct sockaddr_ec *)&ifr.ifr_addr;
|
|
|
switch (cmd)
|
switch (cmd)
|
{
|
{
|
case SIOCSIFADDR:
|
case SIOCSIFADDR:
|
edev = dev->ec_ptr;
|
edev = dev->ec_ptr;
|
if (edev == NULL)
|
if (edev == NULL)
|
{
|
{
|
/* Magic up a new one. */
|
/* Magic up a new one. */
|
edev = kmalloc(sizeof(struct ec_device), GFP_KERNEL);
|
edev = kmalloc(sizeof(struct ec_device), GFP_KERNEL);
|
if (edev == NULL) {
|
if (edev == NULL) {
|
printk("af_ec: memory squeeze.\n");
|
printk("af_ec: memory squeeze.\n");
|
dev_put(dev);
|
dev_put(dev);
|
return -ENOMEM;
|
return -ENOMEM;
|
}
|
}
|
memset(edev, 0, sizeof(struct ec_device));
|
memset(edev, 0, sizeof(struct ec_device));
|
dev->ec_ptr = edev;
|
dev->ec_ptr = edev;
|
}
|
}
|
else
|
else
|
net2dev_map[edev->net] = NULL;
|
net2dev_map[edev->net] = NULL;
|
edev->station = sec->addr.station;
|
edev->station = sec->addr.station;
|
edev->net = sec->addr.net;
|
edev->net = sec->addr.net;
|
net2dev_map[sec->addr.net] = dev;
|
net2dev_map[sec->addr.net] = dev;
|
if (!net2dev_map[0])
|
if (!net2dev_map[0])
|
net2dev_map[0] = dev;
|
net2dev_map[0] = dev;
|
dev_put(dev);
|
dev_put(dev);
|
return 0;
|
return 0;
|
|
|
case SIOCGIFADDR:
|
case SIOCGIFADDR:
|
edev = dev->ec_ptr;
|
edev = dev->ec_ptr;
|
if (edev == NULL)
|
if (edev == NULL)
|
{
|
{
|
dev_put(dev);
|
dev_put(dev);
|
return -ENODEV;
|
return -ENODEV;
|
}
|
}
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
sec->addr.station = edev->station;
|
sec->addr.station = edev->station;
|
sec->addr.net = edev->net;
|
sec->addr.net = edev->net;
|
sec->sec_family = AF_ECONET;
|
sec->sec_family = AF_ECONET;
|
dev_put(dev);
|
dev_put(dev);
|
if (copy_to_user(arg, &ifr, sizeof(struct ifreq)))
|
if (copy_to_user(arg, &ifr, sizeof(struct ifreq)))
|
return -EFAULT;
|
return -EFAULT;
|
return 0;
|
return 0;
|
}
|
}
|
|
|
dev_put(dev);
|
dev_put(dev);
|
return -EINVAL;
|
return -EINVAL;
|
}
|
}
|
|
|
/*
|
/*
|
* Handle generic ioctls
|
* Handle generic ioctls
|
*/
|
*/
|
|
|
static int econet_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
|
static int econet_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
|
{
|
{
|
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
int pid;
|
int pid;
|
|
|
switch(cmd)
|
switch(cmd)
|
{
|
{
|
case FIOSETOWN:
|
case FIOSETOWN:
|
case SIOCSPGRP:
|
case SIOCSPGRP:
|
if (get_user(pid, (int *) arg))
|
if (get_user(pid, (int *) arg))
|
return -EFAULT;
|
return -EFAULT;
|
if (current->pid != pid && current->pgrp != -pid && !capable(CAP_NET_ADMIN))
|
if (current->pid != pid && current->pgrp != -pid && !capable(CAP_NET_ADMIN))
|
return -EPERM;
|
return -EPERM;
|
sk->proc = pid;
|
sk->proc = pid;
|
return(0);
|
return(0);
|
case FIOGETOWN:
|
case FIOGETOWN:
|
case SIOCGPGRP:
|
case SIOCGPGRP:
|
return put_user(sk->proc, (int *)arg);
|
return put_user(sk->proc, (int *)arg);
|
case SIOCGSTAMP:
|
case SIOCGSTAMP:
|
if(sk->stamp.tv_sec==0)
|
if(sk->stamp.tv_sec==0)
|
return -ENOENT;
|
return -ENOENT;
|
return copy_to_user((void *)arg, &sk->stamp, sizeof(struct timeval)) ? -EFAULT : 0;
|
return copy_to_user((void *)arg, &sk->stamp, sizeof(struct timeval)) ? -EFAULT : 0;
|
case SIOCGIFFLAGS:
|
case SIOCGIFFLAGS:
|
case SIOCSIFFLAGS:
|
case SIOCSIFFLAGS:
|
case SIOCGIFCONF:
|
case SIOCGIFCONF:
|
case SIOCGIFMETRIC:
|
case SIOCGIFMETRIC:
|
case SIOCSIFMETRIC:
|
case SIOCSIFMETRIC:
|
case SIOCGIFMEM:
|
case SIOCGIFMEM:
|
case SIOCSIFMEM:
|
case SIOCSIFMEM:
|
case SIOCGIFMTU:
|
case SIOCGIFMTU:
|
case SIOCSIFMTU:
|
case SIOCSIFMTU:
|
case SIOCSIFLINK:
|
case SIOCSIFLINK:
|
case SIOCGIFHWADDR:
|
case SIOCGIFHWADDR:
|
case SIOCSIFHWADDR:
|
case SIOCSIFHWADDR:
|
case SIOCSIFMAP:
|
case SIOCSIFMAP:
|
case SIOCGIFMAP:
|
case SIOCGIFMAP:
|
case SIOCSIFSLAVE:
|
case SIOCSIFSLAVE:
|
case SIOCGIFSLAVE:
|
case SIOCGIFSLAVE:
|
case SIOCGIFINDEX:
|
case SIOCGIFINDEX:
|
case SIOCGIFNAME:
|
case SIOCGIFNAME:
|
case SIOCGIFCOUNT:
|
case SIOCGIFCOUNT:
|
case SIOCSIFHWBROADCAST:
|
case SIOCSIFHWBROADCAST:
|
return(dev_ioctl(cmd,(void *) arg));
|
return(dev_ioctl(cmd,(void *) arg));
|
|
|
case SIOCSIFADDR:
|
case SIOCSIFADDR:
|
case SIOCGIFADDR:
|
case SIOCGIFADDR:
|
return ec_dev_ioctl(sock, cmd, (void *)arg);
|
return ec_dev_ioctl(sock, cmd, (void *)arg);
|
break;
|
break;
|
|
|
default:
|
default:
|
return(dev_ioctl(cmd,(void *) arg));
|
return(dev_ioctl(cmd,(void *) arg));
|
}
|
}
|
/*NOTREACHED*/
|
/*NOTREACHED*/
|
return 0;
|
return 0;
|
}
|
}
|
|
|
static struct net_proto_family econet_family_ops = {
|
static struct net_proto_family econet_family_ops = {
|
family: PF_ECONET,
|
family: PF_ECONET,
|
create: econet_create,
|
create: econet_create,
|
};
|
};
|
|
|
static struct proto_ops SOCKOPS_WRAPPED(econet_ops) = {
|
static struct proto_ops SOCKOPS_WRAPPED(econet_ops) = {
|
family: PF_ECONET,
|
family: PF_ECONET,
|
|
|
release: econet_release,
|
release: econet_release,
|
bind: econet_bind,
|
bind: econet_bind,
|
connect: sock_no_connect,
|
connect: sock_no_connect,
|
socketpair: sock_no_socketpair,
|
socketpair: sock_no_socketpair,
|
accept: sock_no_accept,
|
accept: sock_no_accept,
|
getname: econet_getname,
|
getname: econet_getname,
|
poll: datagram_poll,
|
poll: datagram_poll,
|
ioctl: econet_ioctl,
|
ioctl: econet_ioctl,
|
listen: sock_no_listen,
|
listen: sock_no_listen,
|
shutdown: sock_no_shutdown,
|
shutdown: sock_no_shutdown,
|
setsockopt: sock_no_setsockopt,
|
setsockopt: sock_no_setsockopt,
|
getsockopt: sock_no_getsockopt,
|
getsockopt: sock_no_getsockopt,
|
sendmsg: econet_sendmsg,
|
sendmsg: econet_sendmsg,
|
recvmsg: econet_recvmsg,
|
recvmsg: econet_recvmsg,
|
mmap: sock_no_mmap,
|
mmap: sock_no_mmap,
|
sendpage: sock_no_sendpage,
|
sendpage: sock_no_sendpage,
|
};
|
};
|
|
|
#include <linux/smp_lock.h>
|
#include <linux/smp_lock.h>
|
SOCKOPS_WRAP(econet, PF_ECONET);
|
SOCKOPS_WRAP(econet, PF_ECONET);
|
|
|
/*
|
/*
|
* Find the listening socket, if any, for the given data.
|
* Find the listening socket, if any, for the given data.
|
*/
|
*/
|
|
|
static struct sock *ec_listening_socket(unsigned char port, unsigned char
|
static struct sock *ec_listening_socket(unsigned char port, unsigned char
|
station, unsigned char net)
|
station, unsigned char net)
|
{
|
{
|
struct sock *sk = econet_sklist;
|
struct sock *sk = econet_sklist;
|
|
|
while (sk)
|
while (sk)
|
{
|
{
|
struct econet_opt *opt = sk->protinfo.af_econet;
|
struct econet_opt *opt = sk->protinfo.af_econet;
|
if ((opt->port == port || opt->port == 0) &&
|
if ((opt->port == port || opt->port == 0) &&
|
(opt->station == station || opt->station == 0) &&
|
(opt->station == station || opt->station == 0) &&
|
(opt->net == net || opt->net == 0))
|
(opt->net == net || opt->net == 0))
|
return sk;
|
return sk;
|
|
|
sk = sk->next;
|
sk = sk->next;
|
}
|
}
|
|
|
return NULL;
|
return NULL;
|
}
|
}
|
|
|
/*
|
/*
|
* Queue a received packet for a socket.
|
* Queue a received packet for a socket.
|
*/
|
*/
|
|
|
static int ec_queue_packet(struct sock *sk, struct sk_buff *skb,
|
static int ec_queue_packet(struct sock *sk, struct sk_buff *skb,
|
unsigned char stn, unsigned char net,
|
unsigned char stn, unsigned char net,
|
unsigned char cb, unsigned char port)
|
unsigned char cb, unsigned char port)
|
{
|
{
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)&eb->sec;
|
struct sockaddr_ec *sec = (struct sockaddr_ec *)&eb->sec;
|
|
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
memset(sec, 0, sizeof(struct sockaddr_ec));
|
sec->sec_family = AF_ECONET;
|
sec->sec_family = AF_ECONET;
|
sec->type = ECTYPE_PACKET_RECEIVED;
|
sec->type = ECTYPE_PACKET_RECEIVED;
|
sec->port = port;
|
sec->port = port;
|
sec->cb = cb;
|
sec->cb = cb;
|
sec->addr.net = net;
|
sec->addr.net = net;
|
sec->addr.station = stn;
|
sec->addr.station = stn;
|
|
|
return sock_queue_rcv_skb(sk, skb);
|
return sock_queue_rcv_skb(sk, skb);
|
}
|
}
|
|
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
|
|
/*
|
/*
|
* Send an AUN protocol response.
|
* Send an AUN protocol response.
|
*/
|
*/
|
|
|
static void aun_send_response(__u32 addr, unsigned long seq, int code, int cb)
|
static void aun_send_response(__u32 addr, unsigned long seq, int code, int cb)
|
{
|
{
|
struct sockaddr_in sin;
|
struct sockaddr_in sin;
|
struct iovec iov;
|
struct iovec iov;
|
struct aunhdr ah;
|
struct aunhdr ah;
|
struct msghdr udpmsg;
|
struct msghdr udpmsg;
|
int err;
|
int err;
|
mm_segment_t oldfs;
|
mm_segment_t oldfs;
|
|
|
memset(&sin, 0, sizeof(sin));
|
memset(&sin, 0, sizeof(sin));
|
sin.sin_family = AF_INET;
|
sin.sin_family = AF_INET;
|
sin.sin_port = htons(AUN_PORT);
|
sin.sin_port = htons(AUN_PORT);
|
sin.sin_addr.s_addr = addr;
|
sin.sin_addr.s_addr = addr;
|
|
|
ah.code = code;
|
ah.code = code;
|
ah.pad = 0;
|
ah.pad = 0;
|
ah.port = 0;
|
ah.port = 0;
|
ah.cb = cb;
|
ah.cb = cb;
|
ah.handle = seq;
|
ah.handle = seq;
|
|
|
iov.iov_base = (void *)&ah;
|
iov.iov_base = (void *)&ah;
|
iov.iov_len = sizeof(ah);
|
iov.iov_len = sizeof(ah);
|
|
|
udpmsg.msg_name = (void *)&sin;
|
udpmsg.msg_name = (void *)&sin;
|
udpmsg.msg_namelen = sizeof(sin);
|
udpmsg.msg_namelen = sizeof(sin);
|
udpmsg.msg_iov = &iov;
|
udpmsg.msg_iov = &iov;
|
udpmsg.msg_iovlen = 1;
|
udpmsg.msg_iovlen = 1;
|
udpmsg.msg_control = NULL;
|
udpmsg.msg_control = NULL;
|
udpmsg.msg_controllen = 0;
|
udpmsg.msg_controllen = 0;
|
udpmsg.msg_flags=0;
|
udpmsg.msg_flags=0;
|
|
|
oldfs = get_fs(); set_fs(KERNEL_DS);
|
oldfs = get_fs(); set_fs(KERNEL_DS);
|
err = sock_sendmsg(udpsock, &udpmsg, sizeof(ah));
|
err = sock_sendmsg(udpsock, &udpmsg, sizeof(ah));
|
set_fs(oldfs);
|
set_fs(oldfs);
|
}
|
}
|
|
|
|
|
/*
|
/*
|
* Handle incoming AUN packets. Work out if anybody wants them,
|
* Handle incoming AUN packets. Work out if anybody wants them,
|
* and send positive or negative acknowledgements as appropriate.
|
* and send positive or negative acknowledgements as appropriate.
|
*/
|
*/
|
|
|
static void aun_incoming(struct sk_buff *skb, struct aunhdr *ah, size_t len)
|
static void aun_incoming(struct sk_buff *skb, struct aunhdr *ah, size_t len)
|
{
|
{
|
struct iphdr *ip = skb->nh.iph;
|
struct iphdr *ip = skb->nh.iph;
|
unsigned char stn = ntohl(ip->saddr) & 0xff;
|
unsigned char stn = ntohl(ip->saddr) & 0xff;
|
struct sock *sk;
|
struct sock *sk;
|
struct sk_buff *newskb;
|
struct sk_buff *newskb;
|
struct ec_device *edev = skb->dev->ec_ptr;
|
struct ec_device *edev = skb->dev->ec_ptr;
|
|
|
if (! edev)
|
if (! edev)
|
goto bad;
|
goto bad;
|
|
|
if ((sk = ec_listening_socket(ah->port, stn, edev->net)) == NULL)
|
if ((sk = ec_listening_socket(ah->port, stn, edev->net)) == NULL)
|
goto bad; /* Nobody wants it */
|
goto bad; /* Nobody wants it */
|
|
|
newskb = alloc_skb((len - sizeof(struct aunhdr) + 15) & ~15,
|
newskb = alloc_skb((len - sizeof(struct aunhdr) + 15) & ~15,
|
GFP_ATOMIC);
|
GFP_ATOMIC);
|
if (newskb == NULL)
|
if (newskb == NULL)
|
{
|
{
|
printk(KERN_DEBUG "AUN: memory squeeze, dropping packet.\n");
|
printk(KERN_DEBUG "AUN: memory squeeze, dropping packet.\n");
|
/* Send nack and hope sender tries again */
|
/* Send nack and hope sender tries again */
|
goto bad;
|
goto bad;
|
}
|
}
|
|
|
memcpy(skb_put(newskb, len - sizeof(struct aunhdr)), (void *)(ah+1),
|
memcpy(skb_put(newskb, len - sizeof(struct aunhdr)), (void *)(ah+1),
|
len - sizeof(struct aunhdr));
|
len - sizeof(struct aunhdr));
|
|
|
if (ec_queue_packet(sk, newskb, stn, edev->net, ah->cb, ah->port))
|
if (ec_queue_packet(sk, newskb, stn, edev->net, ah->cb, ah->port))
|
{
|
{
|
/* Socket is bankrupt. */
|
/* Socket is bankrupt. */
|
kfree_skb(newskb);
|
kfree_skb(newskb);
|
goto bad;
|
goto bad;
|
}
|
}
|
|
|
aun_send_response(ip->saddr, ah->handle, 3, 0);
|
aun_send_response(ip->saddr, ah->handle, 3, 0);
|
return;
|
return;
|
|
|
bad:
|
bad:
|
aun_send_response(ip->saddr, ah->handle, 4, 0);
|
aun_send_response(ip->saddr, ah->handle, 4, 0);
|
}
|
}
|
|
|
/*
|
/*
|
* Handle incoming AUN transmit acknowledgements. If the sequence
|
* Handle incoming AUN transmit acknowledgements. If the sequence
|
* number matches something in our backlog then kill it and tell
|
* number matches something in our backlog then kill it and tell
|
* the user. If the remote took too long to reply then we may have
|
* the user. If the remote took too long to reply then we may have
|
* dropped the packet already.
|
* dropped the packet already.
|
*/
|
*/
|
|
|
static void aun_tx_ack(unsigned long seq, int result)
|
static void aun_tx_ack(unsigned long seq, int result)
|
{
|
{
|
struct sk_buff *skb;
|
struct sk_buff *skb;
|
unsigned long flags;
|
unsigned long flags;
|
struct ec_cb *eb;
|
struct ec_cb *eb;
|
|
|
spin_lock_irqsave(&aun_queue_lock, flags);
|
spin_lock_irqsave(&aun_queue_lock, flags);
|
skb = skb_peek(&aun_queue);
|
skb = skb_peek(&aun_queue);
|
while (skb && skb != (struct sk_buff *)&aun_queue)
|
while (skb && skb != (struct sk_buff *)&aun_queue)
|
{
|
{
|
struct sk_buff *newskb = skb->next;
|
struct sk_buff *newskb = skb->next;
|
eb = (struct ec_cb *)&skb->cb;
|
eb = (struct ec_cb *)&skb->cb;
|
if (eb->seq == seq)
|
if (eb->seq == seq)
|
goto foundit;
|
goto foundit;
|
|
|
skb = newskb;
|
skb = newskb;
|
}
|
}
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
printk(KERN_DEBUG "AUN: unknown sequence %ld\n", seq);
|
printk(KERN_DEBUG "AUN: unknown sequence %ld\n", seq);
|
return;
|
return;
|
|
|
foundit:
|
foundit:
|
tx_result(skb->sk, eb->cookie, result);
|
tx_result(skb->sk, eb->cookie, result);
|
skb_unlink(skb);
|
skb_unlink(skb);
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
kfree_skb(skb);
|
kfree_skb(skb);
|
}
|
}
|
|
|
/*
|
/*
|
* Deal with received AUN frames - sort out what type of thing it is
|
* Deal with received AUN frames - sort out what type of thing it is
|
* and hand it to the right function.
|
* and hand it to the right function.
|
*/
|
*/
|
|
|
static void aun_data_available(struct sock *sk, int slen)
|
static void aun_data_available(struct sock *sk, int slen)
|
{
|
{
|
int err;
|
int err;
|
struct sk_buff *skb;
|
struct sk_buff *skb;
|
unsigned char *data;
|
unsigned char *data;
|
struct aunhdr *ah;
|
struct aunhdr *ah;
|
struct iphdr *ip;
|
struct iphdr *ip;
|
size_t len;
|
size_t len;
|
|
|
while ((skb = skb_recv_datagram(sk, 0, 1, &err)) == NULL) {
|
while ((skb = skb_recv_datagram(sk, 0, 1, &err)) == NULL) {
|
if (err == -EAGAIN) {
|
if (err == -EAGAIN) {
|
printk(KERN_ERR "AUN: no data available?!");
|
printk(KERN_ERR "AUN: no data available?!");
|
return;
|
return;
|
}
|
}
|
printk(KERN_DEBUG "AUN: recvfrom() error %d\n", -err);
|
printk(KERN_DEBUG "AUN: recvfrom() error %d\n", -err);
|
}
|
}
|
|
|
data = skb->h.raw + sizeof(struct udphdr);
|
data = skb->h.raw + sizeof(struct udphdr);
|
ah = (struct aunhdr *)data;
|
ah = (struct aunhdr *)data;
|
len = skb->len - sizeof(struct udphdr);
|
len = skb->len - sizeof(struct udphdr);
|
ip = skb->nh.iph;
|
ip = skb->nh.iph;
|
|
|
switch (ah->code)
|
switch (ah->code)
|
{
|
{
|
case 2:
|
case 2:
|
aun_incoming(skb, ah, len);
|
aun_incoming(skb, ah, len);
|
break;
|
break;
|
case 3:
|
case 3:
|
aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_OK);
|
aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_OK);
|
break;
|
break;
|
case 4:
|
case 4:
|
aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_NOT_LISTENING);
|
aun_tx_ack(ah->handle, ECTYPE_TRANSMIT_NOT_LISTENING);
|
break;
|
break;
|
#if 0
|
#if 0
|
/* This isn't quite right yet. */
|
/* This isn't quite right yet. */
|
case 5:
|
case 5:
|
aun_send_response(ip->saddr, ah->handle, 6, ah->cb);
|
aun_send_response(ip->saddr, ah->handle, 6, ah->cb);
|
break;
|
break;
|
#endif
|
#endif
|
default:
|
default:
|
printk(KERN_DEBUG "unknown AUN packet (type %d)\n", data[0]);
|
printk(KERN_DEBUG "unknown AUN packet (type %d)\n", data[0]);
|
}
|
}
|
|
|
skb_free_datagram(sk, skb);
|
skb_free_datagram(sk, skb);
|
}
|
}
|
|
|
/*
|
/*
|
* Called by the timer to manage the AUN transmit queue. If a packet
|
* Called by the timer to manage the AUN transmit queue. If a packet
|
* was sent to a dead or nonexistent host then we will never get an
|
* was sent to a dead or nonexistent host then we will never get an
|
* acknowledgement back. After a few seconds we need to spot this and
|
* acknowledgement back. After a few seconds we need to spot this and
|
* drop the packet.
|
* drop the packet.
|
*/
|
*/
|
|
|
static void ab_cleanup(unsigned long h)
|
static void ab_cleanup(unsigned long h)
|
{
|
{
|
struct sk_buff *skb;
|
struct sk_buff *skb;
|
unsigned long flags;
|
unsigned long flags;
|
|
|
spin_lock_irqsave(&aun_queue_lock, flags);
|
spin_lock_irqsave(&aun_queue_lock, flags);
|
skb = skb_peek(&aun_queue);
|
skb = skb_peek(&aun_queue);
|
while (skb && skb != (struct sk_buff *)&aun_queue)
|
while (skb && skb != (struct sk_buff *)&aun_queue)
|
{
|
{
|
struct sk_buff *newskb = skb->next;
|
struct sk_buff *newskb = skb->next;
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
struct ec_cb *eb = (struct ec_cb *)&skb->cb;
|
if ((jiffies - eb->start) > eb->timeout)
|
if ((jiffies - eb->start) > eb->timeout)
|
{
|
{
|
tx_result(skb->sk, eb->cookie,
|
tx_result(skb->sk, eb->cookie,
|
ECTYPE_TRANSMIT_NOT_PRESENT);
|
ECTYPE_TRANSMIT_NOT_PRESENT);
|
skb_unlink(skb);
|
skb_unlink(skb);
|
kfree_skb(skb);
|
kfree_skb(skb);
|
}
|
}
|
skb = newskb;
|
skb = newskb;
|
}
|
}
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
spin_unlock_irqrestore(&aun_queue_lock, flags);
|
|
|
mod_timer(&ab_cleanup_timer, jiffies + (HZ*2));
|
mod_timer(&ab_cleanup_timer, jiffies + (HZ*2));
|
}
|
}
|
|
|
static int __init aun_udp_initialise(void)
|
static int __init aun_udp_initialise(void)
|
{
|
{
|
int error;
|
int error;
|
struct sockaddr_in sin;
|
struct sockaddr_in sin;
|
|
|
skb_queue_head_init(&aun_queue);
|
skb_queue_head_init(&aun_queue);
|
spin_lock_init(&aun_queue_lock);
|
spin_lock_init(&aun_queue_lock);
|
init_timer(&ab_cleanup_timer);
|
init_timer(&ab_cleanup_timer);
|
ab_cleanup_timer.expires = jiffies + (HZ*2);
|
ab_cleanup_timer.expires = jiffies + (HZ*2);
|
ab_cleanup_timer.function = ab_cleanup;
|
ab_cleanup_timer.function = ab_cleanup;
|
add_timer(&ab_cleanup_timer);
|
add_timer(&ab_cleanup_timer);
|
|
|
memset(&sin, 0, sizeof(sin));
|
memset(&sin, 0, sizeof(sin));
|
sin.sin_port = htons(AUN_PORT);
|
sin.sin_port = htons(AUN_PORT);
|
|
|
/* We can count ourselves lucky Acorn machines are too dim to
|
/* We can count ourselves lucky Acorn machines are too dim to
|
speak IPv6. :-) */
|
speak IPv6. :-) */
|
if ((error = sock_create(PF_INET, SOCK_DGRAM, 0, &udpsock)) < 0)
|
if ((error = sock_create(PF_INET, SOCK_DGRAM, 0, &udpsock)) < 0)
|
{
|
{
|
printk("AUN: socket error %d\n", -error);
|
printk("AUN: socket error %d\n", -error);
|
return error;
|
return error;
|
}
|
}
|
|
|
udpsock->sk->reuse = 1;
|
udpsock->sk->reuse = 1;
|
udpsock->sk->allocation = GFP_ATOMIC; /* we're going to call it
|
udpsock->sk->allocation = GFP_ATOMIC; /* we're going to call it
|
from interrupts */
|
from interrupts */
|
|
|
error = udpsock->ops->bind(udpsock, (struct sockaddr *)&sin,
|
error = udpsock->ops->bind(udpsock, (struct sockaddr *)&sin,
|
sizeof(sin));
|
sizeof(sin));
|
if (error < 0)
|
if (error < 0)
|
{
|
{
|
printk("AUN: bind error %d\n", -error);
|
printk("AUN: bind error %d\n", -error);
|
goto release;
|
goto release;
|
}
|
}
|
|
|
udpsock->sk->data_ready = aun_data_available;
|
udpsock->sk->data_ready = aun_data_available;
|
|
|
return 0;
|
return 0;
|
|
|
release:
|
release:
|
sock_release(udpsock);
|
sock_release(udpsock);
|
udpsock = NULL;
|
udpsock = NULL;
|
return error;
|
return error;
|
}
|
}
|
#endif
|
#endif
|
|
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
|
|
/*
|
/*
|
* Receive an Econet frame from a device.
|
* Receive an Econet frame from a device.
|
*/
|
*/
|
|
|
static int econet_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *pt)
|
static int econet_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *pt)
|
{
|
{
|
struct ec_framehdr *hdr = (struct ec_framehdr *)skb->data;
|
struct ec_framehdr *hdr = (struct ec_framehdr *)skb->data;
|
struct sock *sk;
|
struct sock *sk;
|
struct ec_device *edev = dev->ec_ptr;
|
struct ec_device *edev = dev->ec_ptr;
|
|
|
if (! edev)
|
if (! edev)
|
{
|
{
|
kfree_skb(skb);
|
kfree_skb(skb);
|
return NET_RX_DROP;
|
return NET_RX_DROP;
|
}
|
}
|
|
|
if (skb->len < sizeof(struct ec_framehdr))
|
if (skb->len < sizeof(struct ec_framehdr))
|
{
|
{
|
/* Frame is too small to be any use */
|
/* Frame is too small to be any use */
|
kfree_skb(skb);
|
kfree_skb(skb);
|
return NET_RX_DROP;
|
return NET_RX_DROP;
|
}
|
}
|
|
|
/* First check for encapsulated IP */
|
/* First check for encapsulated IP */
|
if (hdr->port == EC_PORT_IP)
|
if (hdr->port == EC_PORT_IP)
|
{
|
{
|
skb->protocol = htons(ETH_P_IP);
|
skb->protocol = htons(ETH_P_IP);
|
skb_pull(skb, sizeof(struct ec_framehdr));
|
skb_pull(skb, sizeof(struct ec_framehdr));
|
netif_rx(skb);
|
netif_rx(skb);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
sk = ec_listening_socket(hdr->port, hdr->src_stn, hdr->src_net);
|
sk = ec_listening_socket(hdr->port, hdr->src_stn, hdr->src_net);
|
if (!sk)
|
if (!sk)
|
{
|
{
|
kfree_skb(skb);
|
kfree_skb(skb);
|
return NET_RX_DROP;
|
return NET_RX_DROP;
|
}
|
}
|
|
|
if (ec_queue_packet(sk, skb, edev->net, hdr->src_stn, hdr->cb,
|
if (ec_queue_packet(sk, skb, edev->net, hdr->src_stn, hdr->cb,
|
hdr->port)) {
|
hdr->port)) {
|
kfree_skb(skb);
|
kfree_skb(skb);
|
return NET_RX_DROP;
|
return NET_RX_DROP;
|
}
|
}
|
return 0;
|
return 0;
|
}
|
}
|
|
|
static struct packet_type econet_packet_type = {
|
static struct packet_type econet_packet_type = {
|
type: __constant_htons(ETH_P_ECONET),
|
type: __constant_htons(ETH_P_ECONET),
|
func: econet_rcv,
|
func: econet_rcv,
|
};
|
};
|
|
|
static void econet_hw_initialise(void)
|
static void econet_hw_initialise(void)
|
{
|
{
|
dev_add_pack(&econet_packet_type);
|
dev_add_pack(&econet_packet_type);
|
}
|
}
|
|
|
#endif
|
#endif
|
|
|
static int econet_notifier(struct notifier_block *this, unsigned long msg, void *data)
|
static int econet_notifier(struct notifier_block *this, unsigned long msg, void *data)
|
{
|
{
|
struct net_device *dev = (struct net_device *)data;
|
struct net_device *dev = (struct net_device *)data;
|
struct ec_device *edev;
|
struct ec_device *edev;
|
|
|
switch (msg) {
|
switch (msg) {
|
case NETDEV_UNREGISTER:
|
case NETDEV_UNREGISTER:
|
/* A device has gone down - kill any data we hold for it. */
|
/* A device has gone down - kill any data we hold for it. */
|
edev = dev->ec_ptr;
|
edev = dev->ec_ptr;
|
if (edev)
|
if (edev)
|
{
|
{
|
if (net2dev_map[0] == dev)
|
if (net2dev_map[0] == dev)
|
net2dev_map[0] = 0;
|
net2dev_map[0] = 0;
|
net2dev_map[edev->net] = NULL;
|
net2dev_map[edev->net] = NULL;
|
kfree(edev);
|
kfree(edev);
|
dev->ec_ptr = NULL;
|
dev->ec_ptr = NULL;
|
}
|
}
|
break;
|
break;
|
}
|
}
|
|
|
return NOTIFY_DONE;
|
return NOTIFY_DONE;
|
}
|
}
|
|
|
static struct notifier_block econet_netdev_notifier = {
|
static struct notifier_block econet_netdev_notifier = {
|
notifier_call: econet_notifier,
|
notifier_call: econet_notifier,
|
};
|
};
|
|
|
static void __exit econet_proto_exit(void)
|
static void __exit econet_proto_exit(void)
|
{
|
{
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
del_timer(&ab_cleanup_timer);
|
del_timer(&ab_cleanup_timer);
|
if (udpsock)
|
if (udpsock)
|
sock_release(udpsock);
|
sock_release(udpsock);
|
#endif
|
#endif
|
unregister_netdevice_notifier(&econet_netdev_notifier);
|
unregister_netdevice_notifier(&econet_netdev_notifier);
|
sock_unregister(econet_family_ops.family);
|
sock_unregister(econet_family_ops.family);
|
}
|
}
|
|
|
static int __init econet_proto_init(void)
|
static int __init econet_proto_init(void)
|
{
|
{
|
sock_register(&econet_family_ops);
|
sock_register(&econet_family_ops);
|
#ifdef CONFIG_ECONET_AUNUDP
|
#ifdef CONFIG_ECONET_AUNUDP
|
spin_lock_init(&aun_queue_lock);
|
spin_lock_init(&aun_queue_lock);
|
aun_udp_initialise();
|
aun_udp_initialise();
|
#endif
|
#endif
|
#ifdef CONFIG_ECONET_NATIVE
|
#ifdef CONFIG_ECONET_NATIVE
|
econet_hw_initialise();
|
econet_hw_initialise();
|
#endif
|
#endif
|
register_netdevice_notifier(&econet_netdev_notifier);
|
register_netdevice_notifier(&econet_netdev_notifier);
|
return 0;
|
return 0;
|
}
|
}
|
|
|
module_init(econet_proto_init);
|
module_init(econet_proto_init);
|
module_exit(econet_proto_exit);
|
module_exit(econet_proto_exit);
|
|
|
MODULE_LICENSE("GPL");
|
MODULE_LICENSE("GPL");
|
|
|
