11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Generic HDLC support routines for Linux 31da177e4SLinus Torvalds * HDLC Ethernet emulation support 41da177e4SLinus Torvalds * 51da177e4SLinus Torvalds * Copyright (C) 2002-2003 Krzysztof Halasa <khc@pm.waw.pl> 61da177e4SLinus Torvalds * 71da177e4SLinus Torvalds * This program is free software; you can redistribute it and/or modify it 81da177e4SLinus Torvalds * under the terms of version 2 of the GNU General Public License 91da177e4SLinus Torvalds * as published by the Free Software Foundation. 101da177e4SLinus Torvalds */ 111da177e4SLinus Torvalds 121da177e4SLinus Torvalds #include <linux/module.h> 131da177e4SLinus Torvalds #include <linux/kernel.h> 141da177e4SLinus Torvalds #include <linux/slab.h> 151da177e4SLinus Torvalds #include <linux/poll.h> 161da177e4SLinus Torvalds #include <linux/errno.h> 171da177e4SLinus Torvalds #include <linux/if_arp.h> 181da177e4SLinus Torvalds #include <linux/init.h> 191da177e4SLinus Torvalds #include <linux/skbuff.h> 201da177e4SLinus Torvalds #include <linux/pkt_sched.h> 211da177e4SLinus Torvalds #include <linux/random.h> 221da177e4SLinus Torvalds #include <linux/inetdevice.h> 231da177e4SLinus Torvalds #include <linux/lapb.h> 241da177e4SLinus Torvalds #include <linux/rtnetlink.h> 251da177e4SLinus Torvalds #include <linux/etherdevice.h> 261da177e4SLinus Torvalds #include <linux/hdlc.h> 271da177e4SLinus Torvalds 281da177e4SLinus Torvalds 291da177e4SLinus Torvalds static int eth_tx(struct sk_buff *skb, struct net_device *dev) 301da177e4SLinus Torvalds { 311da177e4SLinus Torvalds int pad = ETH_ZLEN - skb->len; 321da177e4SLinus Torvalds if (pad > 0) { /* Pad the frame with zeros */ 331da177e4SLinus Torvalds int len = skb->len; 341da177e4SLinus Torvalds if (skb_tailroom(skb) < pad) 351da177e4SLinus Torvalds if (pskb_expand_head(skb, 0, pad, GFP_ATOMIC)) { 361da177e4SLinus Torvalds hdlc_stats(dev)->tx_dropped++; 371da177e4SLinus Torvalds dev_kfree_skb(skb); 381da177e4SLinus Torvalds return 0; 391da177e4SLinus Torvalds } 401da177e4SLinus Torvalds skb_put(skb, pad); 411da177e4SLinus Torvalds memset(skb->data + len, 0, pad); 421da177e4SLinus Torvalds } 431da177e4SLinus Torvalds return dev_to_hdlc(dev)->xmit(skb, dev); 441da177e4SLinus Torvalds } 451da177e4SLinus Torvalds 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds int hdlc_raw_eth_ioctl(struct net_device *dev, struct ifreq *ifr) 481da177e4SLinus Torvalds { 491da177e4SLinus Torvalds raw_hdlc_proto __user *raw_s = ifr->ifr_settings.ifs_ifsu.raw_hdlc; 501da177e4SLinus Torvalds const size_t size = sizeof(raw_hdlc_proto); 511da177e4SLinus Torvalds raw_hdlc_proto new_settings; 521da177e4SLinus Torvalds hdlc_device *hdlc = dev_to_hdlc(dev); 531da177e4SLinus Torvalds int result; 541da177e4SLinus Torvalds void *old_ch_mtu; 551da177e4SLinus Torvalds int old_qlen; 561da177e4SLinus Torvalds 571da177e4SLinus Torvalds switch (ifr->ifr_settings.type) { 581da177e4SLinus Torvalds case IF_GET_PROTO: 591da177e4SLinus Torvalds ifr->ifr_settings.type = IF_PROTO_HDLC_ETH; 601da177e4SLinus Torvalds if (ifr->ifr_settings.size < size) { 611da177e4SLinus Torvalds ifr->ifr_settings.size = size; /* data size wanted */ 621da177e4SLinus Torvalds return -ENOBUFS; 631da177e4SLinus Torvalds } 641da177e4SLinus Torvalds if (copy_to_user(raw_s, &hdlc->state.raw_hdlc.settings, size)) 651da177e4SLinus Torvalds return -EFAULT; 661da177e4SLinus Torvalds return 0; 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds case IF_PROTO_HDLC_ETH: 691da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 701da177e4SLinus Torvalds return -EPERM; 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds if (dev->flags & IFF_UP) 731da177e4SLinus Torvalds return -EBUSY; 741da177e4SLinus Torvalds 751da177e4SLinus Torvalds if (copy_from_user(&new_settings, raw_s, size)) 761da177e4SLinus Torvalds return -EFAULT; 771da177e4SLinus Torvalds 781da177e4SLinus Torvalds if (new_settings.encoding == ENCODING_DEFAULT) 791da177e4SLinus Torvalds new_settings.encoding = ENCODING_NRZ; 801da177e4SLinus Torvalds 811da177e4SLinus Torvalds if (new_settings.parity == PARITY_DEFAULT) 821da177e4SLinus Torvalds new_settings.parity = PARITY_CRC16_PR1_CCITT; 831da177e4SLinus Torvalds 841da177e4SLinus Torvalds result = hdlc->attach(dev, new_settings.encoding, 851da177e4SLinus Torvalds new_settings.parity); 861da177e4SLinus Torvalds if (result) 871da177e4SLinus Torvalds return result; 881da177e4SLinus Torvalds 891da177e4SLinus Torvalds hdlc_proto_detach(hdlc); 901da177e4SLinus Torvalds memcpy(&hdlc->state.raw_hdlc.settings, &new_settings, size); 911da177e4SLinus Torvalds memset(&hdlc->proto, 0, sizeof(hdlc->proto)); 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds hdlc->proto.type_trans = eth_type_trans; 941da177e4SLinus Torvalds hdlc->proto.id = IF_PROTO_HDLC_ETH; 951da177e4SLinus Torvalds dev->hard_start_xmit = eth_tx; 961da177e4SLinus Torvalds old_ch_mtu = dev->change_mtu; 971da177e4SLinus Torvalds old_qlen = dev->tx_queue_len; 981da177e4SLinus Torvalds ether_setup(dev); 991da177e4SLinus Torvalds dev->change_mtu = old_ch_mtu; 1001da177e4SLinus Torvalds dev->tx_queue_len = old_qlen; 1011da177e4SLinus Torvalds memcpy(dev->dev_addr, "\x00\x01", 2); 1021da177e4SLinus Torvalds get_random_bytes(dev->dev_addr + 2, ETH_ALEN - 2); 1031da177e4SLinus Torvalds return 0; 1041da177e4SLinus Torvalds } 1051da177e4SLinus Torvalds 1061da177e4SLinus Torvalds return -EINVAL; 1071da177e4SLinus Torvalds } 108