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/config.h> 101da177e4SLinus Torvalds #include <linux/module.h> 111da177e4SLinus Torvalds #include <linux/proc_fs.h> 121da177e4SLinus Torvalds #include <linux/kernel.h> 131da177e4SLinus Torvalds #include <linux/sched.h> 141da177e4SLinus Torvalds #include <linux/interrupt.h> 151da177e4SLinus Torvalds #include <linux/fs.h> 161da177e4SLinus Torvalds #include <linux/types.h> 171da177e4SLinus Torvalds #include <linux/sysctl.h> 181da177e4SLinus Torvalds #include <linux/string.h> 191da177e4SLinus Torvalds #include <linux/socket.h> 201da177e4SLinus Torvalds #include <linux/errno.h> 211da177e4SLinus Torvalds #include <linux/fcntl.h> 221da177e4SLinus Torvalds #include <linux/in.h> 231da177e4SLinus Torvalds #include <linux/if_ether.h> 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds #include <asm/system.h> 261da177e4SLinus Torvalds #include <asm/io.h> 271da177e4SLinus Torvalds 281da177e4SLinus Torvalds #include <linux/inet.h> 291da177e4SLinus Torvalds #include <linux/netdevice.h> 301da177e4SLinus Torvalds #include <linux/etherdevice.h> 311da177e4SLinus Torvalds #include <linux/if_arp.h> 321da177e4SLinus Torvalds #include <linux/skbuff.h> 331da177e4SLinus Torvalds 341da177e4SLinus Torvalds #include <net/ip.h> 351da177e4SLinus Torvalds #include <net/arp.h> 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds #include <net/ax25.h> 381da177e4SLinus Torvalds #include <net/rose.h> 391da177e4SLinus Torvalds 401da177e4SLinus Torvalds static int rose_header(struct sk_buff *skb, struct net_device *dev, unsigned short type, 411da177e4SLinus Torvalds void *daddr, void *saddr, unsigned len) 421da177e4SLinus Torvalds { 431da177e4SLinus Torvalds unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2); 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds *buff++ = ROSE_GFI | ROSE_Q_BIT; 461da177e4SLinus Torvalds *buff++ = 0x00; 471da177e4SLinus Torvalds *buff++ = ROSE_DATA; 481da177e4SLinus Torvalds *buff++ = 0x7F; 491da177e4SLinus Torvalds *buff++ = AX25_P_IP; 501da177e4SLinus Torvalds 511da177e4SLinus Torvalds if (daddr != NULL) 521da177e4SLinus Torvalds return 37; 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds return -37; 551da177e4SLinus Torvalds } 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds static int rose_rebuild_header(struct sk_buff *skb) 581da177e4SLinus Torvalds { 591da177e4SLinus Torvalds struct net_device *dev = skb->dev; 601da177e4SLinus Torvalds struct net_device_stats *stats = netdev_priv(dev); 611da177e4SLinus Torvalds unsigned char *bp = (unsigned char *)skb->data; 621da177e4SLinus Torvalds struct sk_buff *skbn; 631da177e4SLinus Torvalds 641da177e4SLinus Torvalds #ifdef CONFIG_INET 651da177e4SLinus Torvalds if (arp_find(bp + 7, skb)) { 661da177e4SLinus Torvalds return 1; 671da177e4SLinus Torvalds } 681da177e4SLinus Torvalds 691da177e4SLinus Torvalds if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) { 701da177e4SLinus Torvalds kfree_skb(skb); 711da177e4SLinus Torvalds return 1; 721da177e4SLinus Torvalds } 731da177e4SLinus Torvalds 741da177e4SLinus Torvalds if (skb->sk != NULL) 751da177e4SLinus Torvalds skb_set_owner_w(skbn, skb->sk); 761da177e4SLinus Torvalds 771da177e4SLinus Torvalds kfree_skb(skb); 781da177e4SLinus Torvalds 791da177e4SLinus Torvalds if (!rose_route_frame(skbn, NULL)) { 801da177e4SLinus Torvalds kfree_skb(skbn); 811da177e4SLinus Torvalds stats->tx_errors++; 821da177e4SLinus Torvalds return 1; 831da177e4SLinus Torvalds } 841da177e4SLinus Torvalds 851da177e4SLinus Torvalds stats->tx_packets++; 861da177e4SLinus Torvalds stats->tx_bytes += skbn->len; 871da177e4SLinus Torvalds #endif 881da177e4SLinus Torvalds return 1; 891da177e4SLinus Torvalds } 901da177e4SLinus Torvalds 911da177e4SLinus Torvalds static int rose_set_mac_address(struct net_device *dev, void *addr) 921da177e4SLinus Torvalds { 931da177e4SLinus Torvalds struct sockaddr *sa = addr; 941da177e4SLinus Torvalds 951da177e4SLinus Torvalds rose_del_loopback_node((rose_address *)dev->dev_addr); 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds memcpy(dev->dev_addr, sa->sa_data, dev->addr_len); 981da177e4SLinus Torvalds 991da177e4SLinus Torvalds rose_add_loopback_node((rose_address *)dev->dev_addr); 1001da177e4SLinus Torvalds 1011da177e4SLinus Torvalds return 0; 1021da177e4SLinus Torvalds } 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds static int rose_open(struct net_device *dev) 1051da177e4SLinus Torvalds { 1061da177e4SLinus Torvalds netif_start_queue(dev); 1071da177e4SLinus Torvalds rose_add_loopback_node((rose_address *)dev->dev_addr); 1081da177e4SLinus Torvalds return 0; 1091da177e4SLinus Torvalds } 1101da177e4SLinus Torvalds 1111da177e4SLinus Torvalds static int rose_close(struct net_device *dev) 1121da177e4SLinus Torvalds { 1131da177e4SLinus Torvalds netif_stop_queue(dev); 1141da177e4SLinus Torvalds rose_del_loopback_node((rose_address *)dev->dev_addr); 1151da177e4SLinus Torvalds return 0; 1161da177e4SLinus Torvalds } 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds static int rose_xmit(struct sk_buff *skb, struct net_device *dev) 1191da177e4SLinus Torvalds { 1201da177e4SLinus Torvalds struct net_device_stats *stats = netdev_priv(dev); 1211da177e4SLinus Torvalds 1221da177e4SLinus Torvalds if (!netif_running(dev)) { 1231da177e4SLinus Torvalds printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n"); 1241da177e4SLinus Torvalds return 1; 1251da177e4SLinus Torvalds } 1261da177e4SLinus Torvalds dev_kfree_skb(skb); 1271da177e4SLinus Torvalds stats->tx_errors++; 1281da177e4SLinus Torvalds return 0; 1291da177e4SLinus Torvalds } 1301da177e4SLinus Torvalds 1311da177e4SLinus Torvalds static struct net_device_stats *rose_get_stats(struct net_device *dev) 1321da177e4SLinus Torvalds { 1331da177e4SLinus Torvalds return netdev_priv(dev); 1341da177e4SLinus Torvalds } 1351da177e4SLinus Torvalds 1361da177e4SLinus Torvalds void rose_setup(struct net_device *dev) 1371da177e4SLinus Torvalds { 1381da177e4SLinus Torvalds SET_MODULE_OWNER(dev); 1391da177e4SLinus Torvalds dev->mtu = ROSE_MAX_PACKET_SIZE - 2; 1401da177e4SLinus Torvalds dev->hard_start_xmit = rose_xmit; 1411da177e4SLinus Torvalds dev->open = rose_open; 1421da177e4SLinus Torvalds dev->stop = rose_close; 1431da177e4SLinus Torvalds 1441da177e4SLinus Torvalds dev->hard_header = rose_header; 1451da177e4SLinus Torvalds dev->hard_header_len = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN; 1461da177e4SLinus Torvalds dev->addr_len = ROSE_ADDR_LEN; 1471da177e4SLinus Torvalds dev->type = ARPHRD_ROSE; 1481da177e4SLinus Torvalds dev->rebuild_header = rose_rebuild_header; 1491da177e4SLinus Torvalds dev->set_mac_address = rose_set_mac_address; 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds /* New-style flags. */ 152*d2ce4bc3SRalf Baechle dev->flags = IFF_NOARP; 1531da177e4SLinus Torvalds dev->get_stats = rose_get_stats; 1541da177e4SLinus Torvalds } 155