Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  * This program is free software; you can redistribute it and/or modify
  3  * it under the terms of the GNU General Public License as published by
  4  * the Free Software Foundation; either version 2 of the License, or
  5  * (at your option) any later version.
  6  *
  7  * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
  8  */
  9 #include <linux/config.h>
 10 #include <linux/module.h>
 11 #include <linux/proc_fs.h>
 12 #include <linux/kernel.h>
 13 #include <linux/sched.h>
 14 #include <linux/interrupt.h>
 15 #include <linux/fs.h>
 16 #include <linux/types.h>
 17 #include <linux/sysctl.h>
 18 #include <linux/string.h>
 19 #include <linux/socket.h>
 20 #include <linux/errno.h>
 21 #include <linux/fcntl.h>
 22 #include <linux/in.h>
 23 #include <linux/if_ether.h>
 24 
 25 #include <asm/system.h>
 26 #include <asm/io.h>
 27 
 28 #include <linux/inet.h>
 29 #include <linux/netdevice.h>
 30 #include <linux/etherdevice.h>
 31 #include <linux/if_arp.h>
 32 #include <linux/skbuff.h>
 33 
 34 #include <net/ip.h>
 35 #include <net/arp.h>
 36 
 37 #include <net/ax25.h>
 38 #include <net/rose.h>
 39 
 40 static int rose_header(struct sk_buff *skb, struct net_device *dev, unsigned short type,
 41         void *daddr, void *saddr, unsigned len)
 42 {
 43         unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2);
 44 
 45         *buff++ = ROSE_GFI | ROSE_Q_BIT;
 46         *buff++ = 0x00;
 47         *buff++ = ROSE_DATA;
 48         *buff++ = 0x7F;
 49         *buff++ = AX25_P_IP;
 50 
 51         if (daddr != NULL)
 52                 return 37;
 53 
 54         return -37;
 55 }
 56 
 57 static int rose_rebuild_header(struct sk_buff *skb)
 58 {
 59         struct net_device *dev = skb->dev;
 60         struct net_device_stats *stats = netdev_priv(dev);
 61         unsigned char *bp = (unsigned char *)skb->data;
 62         struct sk_buff *skbn;
 63 
 64 #ifdef CONFIG_INET
 65         if (arp_find(bp + 7, skb)) {
 66                 return 1;
 67         }
 68 
 69         if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) {
 70                 kfree_skb(skb);
 71                 return 1;
 72         }
 73 
 74         if (skb->sk != NULL)
 75                 skb_set_owner_w(skbn, skb->sk);
 76 
 77         kfree_skb(skb);
 78 
 79         if (!rose_route_frame(skbn, NULL)) {
 80                 kfree_skb(skbn);
 81                 stats->tx_errors++;
 82                 return 1;
 83         }
 84 
 85         stats->tx_packets++;
 86         stats->tx_bytes += skbn->len;
 87 #endif
 88         return 1;
 89 }
 90 
 91 static int rose_set_mac_address(struct net_device *dev, void *addr)
 92 {
 93         struct sockaddr *sa = addr;
 94 
 95         rose_del_loopback_node((rose_address *)dev->dev_addr);
 96 
 97         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
 98 
 99         rose_add_loopback_node((rose_address *)dev->dev_addr);
100 
101         return 0;
102 }
103 
104 static int rose_open(struct net_device *dev)
105 {
106         netif_start_queue(dev);
107         rose_add_loopback_node((rose_address *)dev->dev_addr);
108         return 0;
109 }
110 
111 static int rose_close(struct net_device *dev)
112 {
113         netif_stop_queue(dev);
114         rose_del_loopback_node((rose_address *)dev->dev_addr);
115         return 0;
116 }
117 
118 static int rose_xmit(struct sk_buff *skb, struct net_device *dev)
119 {
120         struct net_device_stats *stats = netdev_priv(dev);
121 
122         if (!netif_running(dev)) {
123                 printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n");
124                 return 1;
125         }
126         dev_kfree_skb(skb);
127         stats->tx_errors++;
128         return 0;
129 }
130 
131 static struct net_device_stats *rose_get_stats(struct net_device *dev)
132 {
133         return netdev_priv(dev);
134 }
135 
136 void rose_setup(struct net_device *dev)
137 {
138         SET_MODULE_OWNER(dev);
139         dev->mtu                = ROSE_MAX_PACKET_SIZE - 2;
140         dev->hard_start_xmit    = rose_xmit;
141         dev->open               = rose_open;
142         dev->stop               = rose_close;
143 
144         dev->hard_header        = rose_header;
145         dev->hard_header_len    = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN;
146         dev->addr_len           = ROSE_ADDR_LEN;
147         dev->type               = ARPHRD_ROSE;
148         dev->rebuild_header     = rose_rebuild_header;
149         dev->set_mac_address    = rose_set_mac_address;
150 
151         /* New-style flags. */
152         dev->flags              = 0;
153         dev->get_stats = rose_get_stats;
154 }
155 
  This page was automatically generated by the LXR engine.