/* * NET/ROM release 004 * * This is ALPHA test software. This code may break your machine, randomly fail to work with new * releases, misbehave and/or generally screw up. It might even work. * * This code REQUIRES 1.3.0 or higher/ NET3.029 * * This module: * This module is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version * 2 of the License, or (at your option) any later version. * * History * NET/ROM 001 Jonathan(G4KLX) Cloned from loopback.c * NET/ROM 002 Steve Whitehouse(GW7RRM) fixed the set_mac_address * NET/ROM 003 Jonathan(G4KLX) Put nr_rebuild_header into line with * ax25_rebuild_header * NET/ROM 004 Jonathan(G4KLX) Callsign registration with AX.25. */ #include #if defined(CONFIG_NETROM) || defined(CONFIG_NETROM_MODULE) #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* For the statistics structure. */ #include #include #include #include #include #include #include #include #include #include #include #include /* * Only allow IP over NET/ROM frames through if the netrom device is up. */ int nr_rx_ip(struct sk_buff *skb, struct device *dev) { struct enet_statistics *stats = (struct enet_statistics *)dev->priv; if (!dev->start) { stats->rx_errors++; return 0; } stats->rx_packets++; skb->protocol = htons(ETH_P_IP); /* Spoof incoming device */ skb->dev = dev; skb->h.raw = skb->data; ip_rcv(skb, skb->dev, NULL); return 1; } static int nr_header(struct sk_buff *skb, struct device *dev, unsigned short type, void *daddr, void *saddr, unsigned len) { unsigned char *buff = skb_push(skb, NR_NETWORK_LEN + NR_TRANSPORT_LEN); memcpy(buff, (saddr != NULL) ? saddr : dev->dev_addr, dev->addr_len); buff[6] &= ~LAPB_C; buff[6] &= ~LAPB_E; buff[6] |= SSSID_SPARE; buff += AX25_ADDR_LEN; if (daddr != NULL) memcpy(buff, daddr, dev->addr_len); buff[6] &= ~LAPB_C; buff[6] |= LAPB_E; buff[6] |= SSSID_SPARE; buff += AX25_ADDR_LEN; *buff++ = sysctl_netrom_network_ttl_initialiser; *buff++ = NR_PROTO_IP; *buff++ = NR_PROTO_IP; *buff++ = 0; *buff++ = 0; *buff++ = NR_PROTOEXT; if (daddr != NULL) return 37; return -37; } static int nr_rebuild_header(void *buff, struct device *dev, unsigned long raddr, struct sk_buff *skb) { struct enet_statistics *stats = (struct enet_statistics *)dev->priv; unsigned char *bp = (unsigned char *)buff; struct sk_buff *skbn; if (!arp_query(bp + 7, raddr, dev)) { dev_kfree_skb(skb, FREE_WRITE); return 1; } bp[6] &= ~LAPB_C; bp[6] &= ~LAPB_E; bp[6] |= SSSID_SPARE; bp += AX25_ADDR_LEN; bp[6] &= ~LAPB_C; bp[6] |= LAPB_E; bp[6] |= SSSID_SPARE; if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) { dev_kfree_skb(skb, FREE_WRITE); return 1; } skbn->sk = skb->sk; if (skbn->sk != NULL) atomic_add(skbn->truesize, &skbn->sk->wmem_alloc); dev_kfree_skb(skb, FREE_WRITE); if (!nr_route_frame(skbn, NULL)) { dev_kfree_skb(skbn, FREE_WRITE); stats->tx_errors++; } stats->tx_packets++; return 1; } static int nr_set_mac_address(struct device *dev, void *addr) { struct sockaddr *sa = addr; ax25_listen_release((ax25_address *)dev->dev_addr, NULL); memcpy(dev->dev_addr, sa->sa_data, dev->addr_len); ax25_listen_register((ax25_address *)dev->dev_addr, NULL); return 0; } static int nr_open(struct device *dev) { dev->tbusy = 0; dev->start = 1; MOD_INC_USE_COUNT; ax25_listen_register((ax25_address *)dev->dev_addr, NULL); return 0; } static int nr_close(struct device *dev) { dev->tbusy = 1; dev->start = 0; ax25_listen_release((ax25_address *)dev->dev_addr, NULL); MOD_DEC_USE_COUNT; return 0; } static int nr_xmit(struct sk_buff *skb, struct device *dev) { struct enet_statistics *stats = (struct enet_statistics *)dev->priv; if (skb == NULL || dev == NULL) return 0; if (!dev->start) { printk(KERN_ERR "netrom: xmit call when iface is down\n"); return 1; } cli(); if (dev->tbusy != 0) { sti(); stats->tx_errors++; return 1; } dev->tbusy = 1; sti(); dev_kfree_skb(skb, FREE_WRITE); stats->tx_errors++; dev->tbusy = 0; mark_bh(NET_BH); return 0; } static struct enet_statistics *nr_get_stats(struct device *dev) { return (struct enet_statistics *)dev->priv; } int nr_init(struct device *dev) { int i; dev->mtu = 236; /* MTU */ dev->tbusy = 0; dev->hard_start_xmit = nr_xmit; dev->open = nr_open; dev->stop = nr_close; dev->hard_header = nr_header; dev->hard_header_len = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + NR_NETWORK_LEN + NR_TRANSPORT_LEN; dev->addr_len = AX25_ADDR_LEN; dev->type = ARPHRD_NETROM; dev->rebuild_header = nr_rebuild_header; dev->set_mac_address = nr_set_mac_address; /* New-style flags. */ dev->flags = 0; dev->family = AF_INET; dev->pa_addr = 0; dev->pa_brdaddr = 0; dev->pa_mask = 0; dev->pa_alen = sizeof(unsigned long); if ((dev->priv = kmalloc(sizeof(struct enet_statistics), GFP_KERNEL)) == NULL) return -ENOMEM; memset(dev->priv, 0, sizeof(struct enet_statistics)); dev->get_stats = nr_get_stats; /* Fill in the generic fields of the device structure. */ for (i = 0; i < DEV_NUMBUFFS; i++) skb_queue_head_init(&dev->buffs[i]); return 0; }; #ifdef MODULE extern struct proto_ops nr_proto_ops; extern struct notifier_block nr_dev_notifier; static struct device dev_nr[] = { {"nr0", 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL, nr_init}, {"nr1", 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL, nr_init}, {"nr2", 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL, nr_init}, {"nr3", 0, 0, 0, 0, 0, 0, 0, 0, 0, NULL, nr_init} }; int init_module(void) { int i; for (i = 0; i < 4; i++) register_netdev(&dev_nr[i]); register_symtab(NULL); nr_proto_init(NULL); return 0; } void cleanup_module(void) { int i; #ifdef CONFIG_PROC_FS proc_net_unregister(PROC_NET_NR); proc_net_unregister(PROC_NET_NR_NEIGH); proc_net_unregister(PROC_NET_NR_NODES); #endif nr_rt_free(); ax25_protocol_release(AX25_P_NETROM); ax25_linkfail_release(nr_link_failed); unregister_netdevice_notifier(&nr_dev_notifier); nr_unregister_sysctl(); sock_unregister(nr_proto_ops.family); for (i = 0; i < 4; i++) { if (dev_nr[i].priv != NULL) { kfree(dev_nr[i].priv); dev_nr[i].priv = NULL; unregister_netdev(&dev_nr[i]); } } } #endif #endif