11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or modify 31da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 41da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 51da177e4SLinus Torvalds * (at your option) any later version. 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk) 81da177e4SLinus Torvalds */ 91da177e4SLinus Torvalds #include <linux/module.h> 101da177e4SLinus Torvalds #include <linux/proc_fs.h> 111da177e4SLinus Torvalds #include <linux/kernel.h> 121da177e4SLinus Torvalds #include <linux/interrupt.h> 131da177e4SLinus Torvalds #include <linux/fs.h> 141da177e4SLinus Torvalds #include <linux/types.h> 151da177e4SLinus Torvalds #include <linux/sysctl.h> 161da177e4SLinus Torvalds #include <linux/string.h> 171da177e4SLinus Torvalds #include <linux/socket.h> 181da177e4SLinus Torvalds #include <linux/errno.h> 191da177e4SLinus Torvalds #include <linux/fcntl.h> 201da177e4SLinus Torvalds #include <linux/in.h> 211da177e4SLinus Torvalds #include <linux/if_ether.h> 225a0e3ad6STejun Heo #include <linux/slab.h> 231da177e4SLinus Torvalds 241da177e4SLinus Torvalds #include <asm/io.h> 251da177e4SLinus Torvalds 261da177e4SLinus Torvalds #include <linux/inet.h> 271da177e4SLinus Torvalds #include <linux/netdevice.h> 281da177e4SLinus Torvalds #include <linux/etherdevice.h> 291da177e4SLinus Torvalds #include <linux/if_arp.h> 301da177e4SLinus Torvalds #include <linux/skbuff.h> 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds #include <net/ip.h> 331da177e4SLinus Torvalds #include <net/arp.h> 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds #include <net/ax25.h> 361da177e4SLinus Torvalds #include <net/rose.h> 371da177e4SLinus Torvalds 383b04dddeSStephen Hemminger static int rose_header(struct sk_buff *skb, struct net_device *dev, 393b04dddeSStephen Hemminger unsigned short type, 4095c96174SEric Dumazet const void *daddr, const void *saddr, unsigned int len) 411da177e4SLinus Torvalds { 421da177e4SLinus Torvalds unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2); 431da177e4SLinus Torvalds 44b753af31SEric W. Biederman if (daddr) 45b753af31SEric W. Biederman memcpy(buff + 7, daddr, dev->addr_len); 46b753af31SEric W. Biederman 471da177e4SLinus Torvalds *buff++ = ROSE_GFI | ROSE_Q_BIT; 481da177e4SLinus Torvalds *buff++ = 0x00; 491da177e4SLinus Torvalds *buff++ = ROSE_DATA; 501da177e4SLinus Torvalds *buff++ = 0x7F; 511da177e4SLinus Torvalds *buff++ = AX25_P_IP; 521da177e4SLinus Torvalds 531da177e4SLinus Torvalds if (daddr != NULL) 541da177e4SLinus Torvalds return 37; 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds return -37; 571da177e4SLinus Torvalds } 581da177e4SLinus Torvalds 591da177e4SLinus Torvalds static int rose_rebuild_header(struct sk_buff *skb) 601da177e4SLinus Torvalds { 6178f150bfSPavel Emelyanov #ifdef CONFIG_INET 621da177e4SLinus Torvalds unsigned char *bp = (unsigned char *)skb->data; 631da177e4SLinus Torvalds 641da177e4SLinus Torvalds if (arp_find(bp + 7, skb)) { 651da177e4SLinus Torvalds return 1; 661da177e4SLinus Torvalds } 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds #endif 69*03ec2ac0SEric W. Biederman return 0; 701da177e4SLinus Torvalds } 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds static int rose_set_mac_address(struct net_device *dev, void *addr) 731da177e4SLinus Torvalds { 741da177e4SLinus Torvalds struct sockaddr *sa = addr; 75a159aaa3SRalf Baechle int err; 76a159aaa3SRalf Baechle 7781213b5eSdanborkmann@iogearbox.net if (!memcmp(dev->dev_addr, sa->sa_data, dev->addr_len)) 78a159aaa3SRalf Baechle return 0; 79a159aaa3SRalf Baechle 80a159aaa3SRalf Baechle if (dev->flags & IFF_UP) { 8181213b5eSdanborkmann@iogearbox.net err = rose_add_loopback_node((rose_address *)sa->sa_data); 82a159aaa3SRalf Baechle if (err) 83a159aaa3SRalf Baechle return err; 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds rose_del_loopback_node((rose_address *)dev->dev_addr); 86a159aaa3SRalf Baechle } 871da177e4SLinus Torvalds 881da177e4SLinus Torvalds memcpy(dev->dev_addr, sa->sa_data, dev->addr_len); 891da177e4SLinus Torvalds 901da177e4SLinus Torvalds return 0; 911da177e4SLinus Torvalds } 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds static int rose_open(struct net_device *dev) 941da177e4SLinus Torvalds { 95a159aaa3SRalf Baechle int err; 96a159aaa3SRalf Baechle 97a159aaa3SRalf Baechle err = rose_add_loopback_node((rose_address *)dev->dev_addr); 98a159aaa3SRalf Baechle if (err) 99a159aaa3SRalf Baechle return err; 100a159aaa3SRalf Baechle 1011da177e4SLinus Torvalds netif_start_queue(dev); 102a159aaa3SRalf Baechle 1031da177e4SLinus Torvalds return 0; 1041da177e4SLinus Torvalds } 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds static int rose_close(struct net_device *dev) 1071da177e4SLinus Torvalds { 1081da177e4SLinus Torvalds netif_stop_queue(dev); 1091da177e4SLinus Torvalds rose_del_loopback_node((rose_address *)dev->dev_addr); 1101da177e4SLinus Torvalds return 0; 1111da177e4SLinus Torvalds } 1121da177e4SLinus Torvalds 11336e4d64aSStephen Hemminger static netdev_tx_t rose_xmit(struct sk_buff *skb, struct net_device *dev) 1141da177e4SLinus Torvalds { 115d289d120SStephen Hemminger struct net_device_stats *stats = &dev->stats; 116*03ec2ac0SEric W. Biederman unsigned int len = skb->len; 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds if (!netif_running(dev)) { 1191da177e4SLinus Torvalds printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n"); 1205b548140SPatrick McHardy return NETDEV_TX_BUSY; 1211da177e4SLinus Torvalds } 122*03ec2ac0SEric W. Biederman 123*03ec2ac0SEric W. Biederman if (!rose_route_frame(skb, NULL)) { 1241da177e4SLinus Torvalds dev_kfree_skb(skb); 1251da177e4SLinus Torvalds stats->tx_errors++; 1266ed10654SPatrick McHardy return NETDEV_TX_OK; 1271da177e4SLinus Torvalds } 1281da177e4SLinus Torvalds 129*03ec2ac0SEric W. Biederman stats->tx_packets++; 130*03ec2ac0SEric W. Biederman stats->tx_bytes += len; 131*03ec2ac0SEric W. Biederman return NETDEV_TX_OK; 132*03ec2ac0SEric W. Biederman } 133*03ec2ac0SEric W. Biederman 1343b04dddeSStephen Hemminger static const struct header_ops rose_header_ops = { 1353b04dddeSStephen Hemminger .create = rose_header, 1363b04dddeSStephen Hemminger .rebuild = rose_rebuild_header, 1373b04dddeSStephen Hemminger }; 1383b04dddeSStephen Hemminger 1393170c656SStephen Hemminger static const struct net_device_ops rose_netdev_ops = { 1403170c656SStephen Hemminger .ndo_open = rose_open, 1413170c656SStephen Hemminger .ndo_stop = rose_close, 1423170c656SStephen Hemminger .ndo_start_xmit = rose_xmit, 1433170c656SStephen Hemminger .ndo_set_mac_address = rose_set_mac_address, 1443170c656SStephen Hemminger }; 1453170c656SStephen Hemminger 1461da177e4SLinus Torvalds void rose_setup(struct net_device *dev) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds dev->mtu = ROSE_MAX_PACKET_SIZE - 2; 1493170c656SStephen Hemminger dev->netdev_ops = &rose_netdev_ops; 1501da177e4SLinus Torvalds 1513b04dddeSStephen Hemminger dev->header_ops = &rose_header_ops; 1521da177e4SLinus Torvalds dev->hard_header_len = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN; 1531da177e4SLinus Torvalds dev->addr_len = ROSE_ADDR_LEN; 1541da177e4SLinus Torvalds dev->type = ARPHRD_ROSE; 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds /* New-style flags. */ 157d2ce4bc3SRalf Baechle dev->flags = IFF_NOARP; 1581da177e4SLinus Torvalds } 159