Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * INET		An implementation of the TCP/IP protocol suite for the LINUX
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *		operating system.  INET is implemented using the  BSD Socket
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *		interface as the means of communication with the user level.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *		HIPPI-type device handling.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9)  * Version:	@(#)hippi.c	1.0.0	05/29/97
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * Authors:	Ross Biro
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  *		Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13)  *		Mark Evans, <evansmp@uhura.aston.ac.uk>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14)  *		Florian  La Roche, <rzsfl@rz.uni-sb.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15)  *		Alan Cox, <gw4pts@gw4pts.ampr.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16)  *		Jes Sorensen, <Jes.Sorensen@cern.ch>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/socket.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/in.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/inet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/netdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #include <linux/hippidevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #include <linux/skbuff.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include <net/arp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #include <net/sock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36)  * Create the HIPPI MAC header for an arbitrary protocol layer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38)  * saddr=NULL	means use device source address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39)  * daddr=NULL	means leave destination address (eg unresolved arp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) static int hippi_header(struct sk_buff *skb, struct net_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 			unsigned short type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) 			const void *daddr, const void *saddr, unsigned int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct hippi_hdr *hip = skb_push(skb, HIPPI_HLEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	struct hippi_cb *hcb = (struct hippi_cb *) skb->cb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	if (!len){
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 		len = skb->len - HIPPI_HLEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 		printk("hippi_header(): length not supplied\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	 * Due to the stupidity of the little endian byte-order we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	 * have to set the fp field this way.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	hip->fp.fixed		= htonl(0x04800018);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	hip->fp.d2_size		= htonl(len + 8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	hip->le.fc		= 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	hip->le.double_wide	= 0;	/* only HIPPI 800 for the time being */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	hip->le.message_type	= 0;	/* Data PDU */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 	hip->le.dest_addr_type	= 2;	/* 12 bit SC address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	hip->le.src_addr_type	= 2;	/* 12 bit SC address */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	memcpy(hip->le.src_switch_addr, dev->dev_addr + 3, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	memset(&hip->le.reserved, 0, 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	hip->snap.dsap		= HIPPI_EXTENDED_SAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	hip->snap.ssap		= HIPPI_EXTENDED_SAP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	hip->snap.ctrl		= HIPPI_UI_CMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	hip->snap.oui[0]	= 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	hip->snap.oui[1]	= 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	hip->snap.oui[2]	= 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 	hip->snap.ethertype	= htons(type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 	if (daddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 		memcpy(hip->le.dest_switch_addr, daddr + 3, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		memcpy(&hcb->ifield, daddr + 2, 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		return HIPPI_HLEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	hcb->ifield = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	return -((int)HIPPI_HLEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90)  *	Determine the packet's protocol ID.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) __be16 hippi_type_trans(struct sk_buff *skb, struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	struct hippi_hdr *hip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	 * This is actually wrong ... question is if we really should
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	 * set the raw address here.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	skb->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	skb_reset_mac_header(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 	hip = (struct hippi_hdr *)skb_mac_header(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	skb_pull(skb, HIPPI_HLEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	 * No fancy promisc stuff here now.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	return hip->snap.ethertype;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) EXPORT_SYMBOL(hippi_type_trans);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)  * For HIPPI we will actually use the lower 4 bytes of the hardware
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)  * address as the I-FIELD rather than the actual hardware address.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) int hippi_mac_addr(struct net_device *dev, void *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 	struct sockaddr *addr = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	if (netif_running(dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) EXPORT_SYMBOL(hippi_mac_addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) int hippi_neigh_setup_dev(struct net_device *dev, struct neigh_parms *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	/* Never send broadcast/multicast ARP messages */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	NEIGH_VAR_INIT(p, MCAST_PROBES, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	/* In IPv6 unicast probes are valid even on NBMA,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	* because they are encapsulated in normal IPv6 protocol.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	* Should be a generic flag.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	if (p->tbl->family != AF_INET6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 		NEIGH_VAR_INIT(p, UCAST_PROBES, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) EXPORT_SYMBOL(hippi_neigh_setup_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) static const struct header_ops hippi_header_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	.create		= hippi_header,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) static void hippi_setup(struct net_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	dev->header_ops			= &hippi_header_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	 * We don't support HIPPI `ARP' for the time being, and probably
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	 * never will unless someone else implements it. However we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	 * still need a fake ARPHRD to make ifconfig and friends play ball.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	dev->type		= ARPHRD_HIPPI;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	dev->hard_header_len 	= HIPPI_HLEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	dev->mtu		= 65280;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	dev->min_mtu		= 68;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	dev->max_mtu		= 65280;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	dev->addr_len		= HIPPI_ALEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	dev->tx_queue_len	= 25 /* 5 */;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	memset(dev->broadcast, 0xFF, HIPPI_ALEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	 * HIPPI doesn't support broadcast+multicast and we only use
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	 * static ARP tables. ARP is disabled by hippi_neigh_setup_dev.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	dev->flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)  * alloc_hippi_dev - Register HIPPI device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)  * @sizeof_priv: Size of additional driver-private structure to be allocated
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178)  *	for this HIPPI device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)  * Fill in the fields of the device structure with HIPPI-generic values.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)  * Constructs a new net device, complete with a private data area of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)  * size @sizeof_priv.  A 32-byte (not bit) alignment is enforced for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)  * this private data area.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) struct net_device *alloc_hippi_dev(int sizeof_priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	return alloc_netdev(sizeof_priv, "hip%d", NET_NAME_UNKNOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 			    hippi_setup);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) EXPORT_SYMBOL(alloc_hippi_dev);