UDPtest - Some quick code to use UDP-only (no TCP) with mBe…

Users » pehrhovey » Code » UDPtest

Some quick code to use UDP-only (no TCP) with mBed. Echos received packets and sends packets when a button is pressed

Core/lwIP/netif/etharp.c@0:a548a085de55, 2010-03-14 (annotated)

Committer:: pehrhovey
Date:: Sun Mar 14 00:54:12 2010 +0000
Revision:: 0:a548a085de55

Who changed what in which revision?

User	Revision	Line number	New contents of line
pehrhovey	0:a548a085de55	1	/**
pehrhovey	0:a548a085de55	2	* @file
pehrhovey	0:a548a085de55	3	* Address Resolution Protocol module for IP over Ethernet
pehrhovey	0:a548a085de55	4	*
pehrhovey	0:a548a085de55	5	* Functionally, ARP is divided into two parts. The first maps an IP address
pehrhovey	0:a548a085de55	6	* to a physical address when sending a packet, and the second part answers
pehrhovey	0:a548a085de55	7	* requests from other machines for our physical address.
pehrhovey	0:a548a085de55	8	*
pehrhovey	0:a548a085de55	9	* This implementation complies with RFC 826 (Ethernet ARP). It supports
pehrhovey	0:a548a085de55	10	* Gratuitious ARP from RFC3220 (IP Mobility Support for IPv4) section 4.6
pehrhovey	0:a548a085de55	11	* if an interface calls etharp_gratuitous(our_netif) upon address change.
pehrhovey	0:a548a085de55	12	*/
pehrhovey	0:a548a085de55	13
pehrhovey	0:a548a085de55	14	/*
pehrhovey	0:a548a085de55	15	* Copyright (c) 2001-2003 Swedish Institute of Computer Science.
pehrhovey	0:a548a085de55	16	* Copyright (c) 2003-2004 Leon Woestenberg <leon.woestenberg@axon.tv>
pehrhovey	0:a548a085de55	17	* Copyright (c) 2003-2004 Axon Digital Design B.V., The Netherlands.
pehrhovey	0:a548a085de55	18	* All rights reserved.
pehrhovey	0:a548a085de55	19	*
pehrhovey	0:a548a085de55	20	* Redistribution and use in source and binary forms, with or without modification,
pehrhovey	0:a548a085de55	21	* are permitted provided that the following conditions are met:
pehrhovey	0:a548a085de55	22	*
pehrhovey	0:a548a085de55	23	* 1. Redistributions of source code must retain the above copyright notice,
pehrhovey	0:a548a085de55	24	* this list of conditions and the following disclaimer.
pehrhovey	0:a548a085de55	25	* 2. Redistributions in binary form must reproduce the above copyright notice,
pehrhovey	0:a548a085de55	26	* this list of conditions and the following disclaimer in the documentation
pehrhovey	0:a548a085de55	27	* and/or other materials provided with the distribution.
pehrhovey	0:a548a085de55	28	* 3. The name of the author may not be used to endorse or promote products
pehrhovey	0:a548a085de55	29	* derived from this software without specific prior written permission.
pehrhovey	0:a548a085de55	30	*
pehrhovey	0:a548a085de55	31	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED
pehrhovey	0:a548a085de55	32	* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
pehrhovey	0:a548a085de55	33	* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT
pehrhovey	0:a548a085de55	34	* SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
pehrhovey	0:a548a085de55	35	* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT
pehrhovey	0:a548a085de55	36	* OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
pehrhovey	0:a548a085de55	37	* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
pehrhovey	0:a548a085de55	38	* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
pehrhovey	0:a548a085de55	39	* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
pehrhovey	0:a548a085de55	40	* OF SUCH DAMAGE.
pehrhovey	0:a548a085de55	41	*
pehrhovey	0:a548a085de55	42	* This file is part of the lwIP TCP/IP stack.
pehrhovey	0:a548a085de55	43	*
pehrhovey	0:a548a085de55	44	*/
pehrhovey	0:a548a085de55	45
pehrhovey	0:a548a085de55	46	#include "lwip/opt.h"
pehrhovey	0:a548a085de55	47
pehrhovey	0:a548a085de55	48	#if LWIP_ARP /* don't build if not configured for use in lwipopts.h */
pehrhovey	0:a548a085de55	49
pehrhovey	0:a548a085de55	50	#include "lwip/inet.h"
pehrhovey	0:a548a085de55	51	#include "lwip/ip.h"
pehrhovey	0:a548a085de55	52	#include "lwip/stats.h"
pehrhovey	0:a548a085de55	53	#include "lwip/snmp.h"
pehrhovey	0:a548a085de55	54	#include "lwip/dhcp.h"
pehrhovey	0:a548a085de55	55	#include "lwip/autoip.h"
pehrhovey	0:a548a085de55	56	#include "netif/etharp.h"
pehrhovey	0:a548a085de55	57
pehrhovey	0:a548a085de55	58	#if PPPOE_SUPPORT
pehrhovey	0:a548a085de55	59	#include "netif/ppp_oe.h"
pehrhovey	0:a548a085de55	60	#endif /* PPPOE_SUPPORT */
pehrhovey	0:a548a085de55	61
pehrhovey	0:a548a085de55	62	#include <string.h>
pehrhovey	0:a548a085de55	63
pehrhovey	0:a548a085de55	64	/** the time an ARP entry stays valid after its last update,
pehrhovey	0:a548a085de55	65	* for ARP_TMR_INTERVAL = 5000, this is
pehrhovey	0:a548a085de55	66	* (240 * 5) seconds = 20 minutes.
pehrhovey	0:a548a085de55	67	*/
pehrhovey	0:a548a085de55	68	#define ARP_MAXAGE 240
pehrhovey	0:a548a085de55	69	/** the time an ARP entry stays pending after first request,
pehrhovey	0:a548a085de55	70	* for ARP_TMR_INTERVAL = 5000, this is
pehrhovey	0:a548a085de55	71	* (2 * 5) seconds = 10 seconds.
pehrhovey	0:a548a085de55	72	*
pehrhovey	0:a548a085de55	73	* @internal Keep this number at least 2, otherwise it might
pehrhovey	0:a548a085de55	74	* run out instantly if the timeout occurs directly after a request.
pehrhovey	0:a548a085de55	75	*/
pehrhovey	0:a548a085de55	76	#define ARP_MAXPENDING 2
pehrhovey	0:a548a085de55	77
pehrhovey	0:a548a085de55	78	#define HWTYPE_ETHERNET 1
pehrhovey	0:a548a085de55	79
pehrhovey	0:a548a085de55	80	#define ARPH_HWLEN(hdr) (ntohs((hdr)->_hwlen_protolen) >> 8)
pehrhovey	0:a548a085de55	81	#define ARPH_PROTOLEN(hdr) (ntohs((hdr)->_hwlen_protolen) & 0xff)
pehrhovey	0:a548a085de55	82
pehrhovey	0:a548a085de55	83	#define ARPH_HWLEN_SET(hdr, len) (hdr)->_hwlen_protolen = htons(ARPH_PROTOLEN(hdr) \| ((len) << 8))
pehrhovey	0:a548a085de55	84	#define ARPH_PROTOLEN_SET(hdr, len) (hdr)->_hwlen_protolen = htons((len) \| (ARPH_HWLEN(hdr) << 8))
pehrhovey	0:a548a085de55	85
pehrhovey	0:a548a085de55	86	enum etharp_state {
pehrhovey	0:a548a085de55	87	ETHARP_STATE_EMPTY = 0,
pehrhovey	0:a548a085de55	88	ETHARP_STATE_PENDING,
pehrhovey	0:a548a085de55	89	ETHARP_STATE_STABLE
pehrhovey	0:a548a085de55	90	};
pehrhovey	0:a548a085de55	91
pehrhovey	0:a548a085de55	92	struct etharp_entry {
pehrhovey	0:a548a085de55	93	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	94	/**
pehrhovey	0:a548a085de55	95	* Pointer to queue of pending outgoing packets on this ARP entry.
pehrhovey	0:a548a085de55	96	*/
pehrhovey	0:a548a085de55	97	struct etharp_q_entry *q;
pehrhovey	0:a548a085de55	98	#endif
pehrhovey	0:a548a085de55	99	struct ip_addr ipaddr;
pehrhovey	0:a548a085de55	100	struct eth_addr ethaddr;
pehrhovey	0:a548a085de55	101	enum etharp_state state;
pehrhovey	0:a548a085de55	102	u8_t ctime;
pehrhovey	0:a548a085de55	103	struct netif *netif;
pehrhovey	0:a548a085de55	104	};
pehrhovey	0:a548a085de55	105
pehrhovey	0:a548a085de55	106	const struct eth_addr ethbroadcast = {{0xff,0xff,0xff,0xff,0xff,0xff}};
pehrhovey	0:a548a085de55	107	const struct eth_addr ethzero = {{0,0,0,0,0,0}};
pehrhovey	0:a548a085de55	108	static struct etharp_entry arp_table[ARP_TABLE_SIZE] MEM_POSITION;
pehrhovey	0:a548a085de55	109	#if !LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	110	static u8_t etharp_cached_entry MEM_POSITION;
pehrhovey	0:a548a085de55	111	#endif
pehrhovey	0:a548a085de55	112
pehrhovey	0:a548a085de55	113	/**
pehrhovey	0:a548a085de55	114	* Try hard to create a new entry - we want the IP address to appear in
pehrhovey	0:a548a085de55	115	* the cache (even if this means removing an active entry or so). */
pehrhovey	0:a548a085de55	116	#define ETHARP_TRY_HARD 1
pehrhovey	0:a548a085de55	117	#define ETHARP_FIND_ONLY 2
pehrhovey	0:a548a085de55	118
pehrhovey	0:a548a085de55	119	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	120	#define NETIF_SET_HINT(netif, hint) if (((netif) != NULL) && ((netif)->addr_hint != NULL)) \
pehrhovey	0:a548a085de55	121	*((netif)->addr_hint) = (hint);
pehrhovey	0:a548a085de55	122	static s8_t find_entry(struct ip_addr ipaddr, u8_t flags, struct netif netif);
pehrhovey	0:a548a085de55	123	#else /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	124	static s8_t find_entry(struct ip_addr *ipaddr, u8_t flags);
pehrhovey	0:a548a085de55	125	#endif /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	126
pehrhovey	0:a548a085de55	127	static err_t update_arp_entry(struct netif netif, struct ip_addr ipaddr, struct eth_addr *ethaddr, u8_t flags);
pehrhovey	0:a548a085de55	128
pehrhovey	0:a548a085de55	129
pehrhovey	0:a548a085de55	130	/* Some checks, instead of etharp_init(): */
pehrhovey	0:a548a085de55	131	#if (LWIP_ARP && (ARP_TABLE_SIZE > 0x7f))
pehrhovey	0:a548a085de55	132	#error "If you want to use ARP, ARP_TABLE_SIZE must fit in an s8_t, so, you have to reduce it in your lwipopts.h"
pehrhovey	0:a548a085de55	133	#endif
pehrhovey	0:a548a085de55	134
pehrhovey	0:a548a085de55	135
pehrhovey	0:a548a085de55	136	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	137	/**
pehrhovey	0:a548a085de55	138	* Free a complete queue of etharp entries
pehrhovey	0:a548a085de55	139	*
pehrhovey	0:a548a085de55	140	* @param q a qeueue of etharp_q_entry's to free
pehrhovey	0:a548a085de55	141	*/
pehrhovey	0:a548a085de55	142	static void
pehrhovey	0:a548a085de55	143	free_etharp_q(struct etharp_q_entry *q)
pehrhovey	0:a548a085de55	144	{
pehrhovey	0:a548a085de55	145	struct etharp_q_entry *r;
pehrhovey	0:a548a085de55	146	LWIP_ASSERT("q != NULL", q != NULL);
pehrhovey	0:a548a085de55	147	LWIP_ASSERT("q->p != NULL", q->p != NULL);
pehrhovey	0:a548a085de55	148	while (q) {
pehrhovey	0:a548a085de55	149	r = q;
pehrhovey	0:a548a085de55	150	q = q->next;
pehrhovey	0:a548a085de55	151	LWIP_ASSERT("r->p != NULL", (r->p != NULL));
pehrhovey	0:a548a085de55	152	pbuf_free(r->p);
pehrhovey	0:a548a085de55	153	memp_free(MEMP_ARP_QUEUE, r);
pehrhovey	0:a548a085de55	154	}
pehrhovey	0:a548a085de55	155	}
pehrhovey	0:a548a085de55	156	#endif
pehrhovey	0:a548a085de55	157
pehrhovey	0:a548a085de55	158	/**
pehrhovey	0:a548a085de55	159	* Clears expired entries in the ARP table.
pehrhovey	0:a548a085de55	160	*
pehrhovey	0:a548a085de55	161	* This function should be called every ETHARP_TMR_INTERVAL microseconds (5 seconds),
pehrhovey	0:a548a085de55	162	* in order to expire entries in the ARP table.
pehrhovey	0:a548a085de55	163	*/
pehrhovey	0:a548a085de55	164	void
pehrhovey	0:a548a085de55	165	etharp_tmr(void)
pehrhovey	0:a548a085de55	166	{
pehrhovey	0:a548a085de55	167	u8_t i;
pehrhovey	0:a548a085de55	168
pehrhovey	0:a548a085de55	169	LWIP_DEBUGF(ETHARP_DEBUG, ("etharp_timer\n"));
pehrhovey	0:a548a085de55	170	/* remove expired entries from the ARP table */
pehrhovey	0:a548a085de55	171	for (i = 0; i < ARP_TABLE_SIZE; ++i) {
pehrhovey	0:a548a085de55	172	arp_table[i].ctime++;
pehrhovey	0:a548a085de55	173	if (((arp_table[i].state == ETHARP_STATE_STABLE) &&
pehrhovey	0:a548a085de55	174	(arp_table[i].ctime >= ARP_MAXAGE)) \|\|
pehrhovey	0:a548a085de55	175	((arp_table[i].state == ETHARP_STATE_PENDING) &&
pehrhovey	0:a548a085de55	176	(arp_table[i].ctime >= ARP_MAXPENDING))) {
pehrhovey	0:a548a085de55	177	/* pending or stable entry has become old! */
pehrhovey	0:a548a085de55	178	LWIP_DEBUGF(ETHARP_DEBUG, ("etharp_timer: expired %s entry %"U16_F".\n",
pehrhovey	0:a548a085de55	179	arp_table[i].state == ETHARP_STATE_STABLE ? "stable" : "pending", (u16_t)i));
pehrhovey	0:a548a085de55	180	/* clean up entries that have just been expired */
pehrhovey	0:a548a085de55	181	/* remove from SNMP ARP index tree */
pehrhovey	0:a548a085de55	182	snmp_delete_arpidx_tree(arp_table[i].netif, &arp_table[i].ipaddr);
pehrhovey	0:a548a085de55	183	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	184	/* and empty packet queue */
pehrhovey	0:a548a085de55	185	if (arp_table[i].q != NULL) {
pehrhovey	0:a548a085de55	186	/* remove all queued packets */
pehrhovey	0:a548a085de55	187	LWIP_DEBUGF(ETHARP_DEBUG, ("etharp_timer: freeing entry %"U16_F", packet queue %p.\n", (u16_t)i, (void *)(arp_table[i].q)));
pehrhovey	0:a548a085de55	188	free_etharp_q(arp_table[i].q);
pehrhovey	0:a548a085de55	189	arp_table[i].q = NULL;
pehrhovey	0:a548a085de55	190	}
pehrhovey	0:a548a085de55	191	#endif
pehrhovey	0:a548a085de55	192	/* recycle entry for re-use */
pehrhovey	0:a548a085de55	193	arp_table[i].state = ETHARP_STATE_EMPTY;
pehrhovey	0:a548a085de55	194	}
pehrhovey	0:a548a085de55	195	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	196	/* still pending entry? (not expired) */
pehrhovey	0:a548a085de55	197	if (arp_table[i].state == ETHARP_STATE_PENDING) {
pehrhovey	0:a548a085de55	198	/* resend an ARP query here? */
pehrhovey	0:a548a085de55	199	}
pehrhovey	0:a548a085de55	200	#endif
pehrhovey	0:a548a085de55	201	}
pehrhovey	0:a548a085de55	202	}
pehrhovey	0:a548a085de55	203
pehrhovey	0:a548a085de55	204	/**
pehrhovey	0:a548a085de55	205	* Search the ARP table for a matching or new entry.
pehrhovey	0:a548a085de55	206	*
pehrhovey	0:a548a085de55	207	* If an IP address is given, return a pending or stable ARP entry that matches
pehrhovey	0:a548a085de55	208	* the address. If no match is found, create a new entry with this address set,
pehrhovey	0:a548a085de55	209	* but in state ETHARP_EMPTY. The caller must check and possibly change the
pehrhovey	0:a548a085de55	210	* state of the returned entry.
pehrhovey	0:a548a085de55	211	*
pehrhovey	0:a548a085de55	212	* If ipaddr is NULL, return a initialized new entry in state ETHARP_EMPTY.
pehrhovey	0:a548a085de55	213	*
pehrhovey	0:a548a085de55	214	* In all cases, attempt to create new entries from an empty entry. If no
pehrhovey	0:a548a085de55	215	* empty entries are available and ETHARP_TRY_HARD flag is set, recycle
pehrhovey	0:a548a085de55	216	* old entries. Heuristic choose the least important entry for recycling.
pehrhovey	0:a548a085de55	217	*
pehrhovey	0:a548a085de55	218	* @param ipaddr IP address to find in ARP cache, or to add if not found.
pehrhovey	0:a548a085de55	219	* @param flags
pehrhovey	0:a548a085de55	220	* - ETHARP_TRY_HARD: Try hard to create a entry by allowing recycling of
pehrhovey	0:a548a085de55	221	* active (stable or pending) entries.
pehrhovey	0:a548a085de55	222	*
pehrhovey	0:a548a085de55	223	* @return The ARP entry index that matched or is created, ERR_MEM if no
pehrhovey	0:a548a085de55	224	* entry is found or could be recycled.
pehrhovey	0:a548a085de55	225	*/
pehrhovey	0:a548a085de55	226	static s8_t
pehrhovey	0:a548a085de55	227	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	228	find_entry(struct ip_addr ipaddr, u8_t flags, struct netif netif)
pehrhovey	0:a548a085de55	229	#else /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	230	find_entry(struct ip_addr *ipaddr, u8_t flags)
pehrhovey	0:a548a085de55	231	#endif /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	232	{
pehrhovey	0:a548a085de55	233	s8_t old_pending = ARP_TABLE_SIZE, old_stable = ARP_TABLE_SIZE;
pehrhovey	0:a548a085de55	234	s8_t empty = ARP_TABLE_SIZE;
pehrhovey	0:a548a085de55	235	u8_t i = 0, age_pending = 0, age_stable = 0;
pehrhovey	0:a548a085de55	236	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	237	/* oldest entry with packets on queue */
pehrhovey	0:a548a085de55	238	s8_t old_queue = ARP_TABLE_SIZE;
pehrhovey	0:a548a085de55	239	/* its age */
pehrhovey	0:a548a085de55	240	u8_t age_queue = 0;
pehrhovey	0:a548a085de55	241	#endif
pehrhovey	0:a548a085de55	242
pehrhovey	0:a548a085de55	243	/* First, test if the last call to this function asked for the
pehrhovey	0:a548a085de55	244	* same address. If so, we're really fast! */
pehrhovey	0:a548a085de55	245	if (ipaddr) {
pehrhovey	0:a548a085de55	246	/* ipaddr to search for was given */
pehrhovey	0:a548a085de55	247	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	248	if ((netif != NULL) && (netif->addr_hint != NULL)) {
pehrhovey	0:a548a085de55	249	/* per-pcb cached entry was given */
pehrhovey	0:a548a085de55	250	u8_t per_pcb_cache = *(netif->addr_hint);
pehrhovey	0:a548a085de55	251	if ((per_pcb_cache < ARP_TABLE_SIZE) && arp_table[per_pcb_cache].state == ETHARP_STATE_STABLE) {
pehrhovey	0:a548a085de55	252	/* the per-pcb-cached entry is stable */
pehrhovey	0:a548a085de55	253	if (ip_addr_cmp(ipaddr, &arp_table[per_pcb_cache].ipaddr)) {
pehrhovey	0:a548a085de55	254	/* per-pcb cached entry was the right one! */
pehrhovey	0:a548a085de55	255	ETHARP_STATS_INC(etharp.cachehit);
pehrhovey	0:a548a085de55	256	return per_pcb_cache;
pehrhovey	0:a548a085de55	257	}
pehrhovey	0:a548a085de55	258	}
pehrhovey	0:a548a085de55	259	}
pehrhovey	0:a548a085de55	260	#else /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	261	if (arp_table[etharp_cached_entry].state == ETHARP_STATE_STABLE) {
pehrhovey	0:a548a085de55	262	/* the cached entry is stable */
pehrhovey	0:a548a085de55	263	if (ip_addr_cmp(ipaddr, &arp_table[etharp_cached_entry].ipaddr)) {
pehrhovey	0:a548a085de55	264	/* cached entry was the right one! */
pehrhovey	0:a548a085de55	265	ETHARP_STATS_INC(etharp.cachehit);
pehrhovey	0:a548a085de55	266	return etharp_cached_entry;
pehrhovey	0:a548a085de55	267	}
pehrhovey	0:a548a085de55	268	}
pehrhovey	0:a548a085de55	269	#endif /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	270	}
pehrhovey	0:a548a085de55	271
pehrhovey	0:a548a085de55	272	/**
pehrhovey	0:a548a085de55	273	* a) do a search through the cache, remember candidates
pehrhovey	0:a548a085de55	274	* b) select candidate entry
pehrhovey	0:a548a085de55	275	* c) create new entry
pehrhovey	0:a548a085de55	276	*/
pehrhovey	0:a548a085de55	277
pehrhovey	0:a548a085de55	278	/* a) in a single search sweep, do all of this
pehrhovey	0:a548a085de55	279	* 1) remember the first empty entry (if any)
pehrhovey	0:a548a085de55	280	* 2) remember the oldest stable entry (if any)
pehrhovey	0:a548a085de55	281	* 3) remember the oldest pending entry without queued packets (if any)
pehrhovey	0:a548a085de55	282	* 4) remember the oldest pending entry with queued packets (if any)
pehrhovey	0:a548a085de55	283	* 5) search for a matching IP entry, either pending or stable
pehrhovey	0:a548a085de55	284	* until 5 matches, or all entries are searched for.
pehrhovey	0:a548a085de55	285	*/
pehrhovey	0:a548a085de55	286
pehrhovey	0:a548a085de55	287	for (i = 0; i < ARP_TABLE_SIZE; ++i) {
pehrhovey	0:a548a085de55	288	/* no empty entry found yet and now we do find one? */
pehrhovey	0:a548a085de55	289	if ((empty == ARP_TABLE_SIZE) && (arp_table[i].state == ETHARP_STATE_EMPTY)) {
pehrhovey	0:a548a085de55	290	LWIP_DEBUGF(ETHARP_DEBUG, ("find_entry: found empty entry %"U16_F"\n", (u16_t)i));
pehrhovey	0:a548a085de55	291	/* remember first empty entry */
pehrhovey	0:a548a085de55	292	empty = i;
pehrhovey	0:a548a085de55	293	}
pehrhovey	0:a548a085de55	294	/* pending entry? */
pehrhovey	0:a548a085de55	295	else if (arp_table[i].state == ETHARP_STATE_PENDING) {
pehrhovey	0:a548a085de55	296	/* if given, does IP address match IP address in ARP entry? */
pehrhovey	0:a548a085de55	297	if (ipaddr && ip_addr_cmp(ipaddr, &arp_table[i].ipaddr)) {
pehrhovey	0:a548a085de55	298	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: found matching pending entry %"U16_F"\n", (u16_t)i));
pehrhovey	0:a548a085de55	299	/* found exact IP address match, simply bail out */
pehrhovey	0:a548a085de55	300	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	301	NETIF_SET_HINT(netif, i);
pehrhovey	0:a548a085de55	302	#else /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	303	etharp_cached_entry = i;
pehrhovey	0:a548a085de55	304	#endif /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	305	return i;
pehrhovey	0:a548a085de55	306	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	307	/* pending with queued packets? */
pehrhovey	0:a548a085de55	308	} else if (arp_table[i].q != NULL) {
pehrhovey	0:a548a085de55	309	if (arp_table[i].ctime >= age_queue) {
pehrhovey	0:a548a085de55	310	old_queue = i;
pehrhovey	0:a548a085de55	311	age_queue = arp_table[i].ctime;
pehrhovey	0:a548a085de55	312	}
pehrhovey	0:a548a085de55	313	#endif
pehrhovey	0:a548a085de55	314	/* pending without queued packets? */
pehrhovey	0:a548a085de55	315	} else {
pehrhovey	0:a548a085de55	316	if (arp_table[i].ctime >= age_pending) {
pehrhovey	0:a548a085de55	317	old_pending = i;
pehrhovey	0:a548a085de55	318	age_pending = arp_table[i].ctime;
pehrhovey	0:a548a085de55	319	}
pehrhovey	0:a548a085de55	320	}
pehrhovey	0:a548a085de55	321	}
pehrhovey	0:a548a085de55	322	/* stable entry? */
pehrhovey	0:a548a085de55	323	else if (arp_table[i].state == ETHARP_STATE_STABLE) {
pehrhovey	0:a548a085de55	324	/* if given, does IP address match IP address in ARP entry? */
pehrhovey	0:a548a085de55	325	if (ipaddr && ip_addr_cmp(ipaddr, &arp_table[i].ipaddr)) {
pehrhovey	0:a548a085de55	326	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: found matching stable entry %"U16_F"\n", (u16_t)i));
pehrhovey	0:a548a085de55	327	/* found exact IP address match, simply bail out */
pehrhovey	0:a548a085de55	328	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	329	NETIF_SET_HINT(netif, i);
pehrhovey	0:a548a085de55	330	#else /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	331	etharp_cached_entry = i;
pehrhovey	0:a548a085de55	332	#endif /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	333	return i;
pehrhovey	0:a548a085de55	334	/* remember entry with oldest stable entry in oldest, its age in maxtime */
pehrhovey	0:a548a085de55	335	} else if (arp_table[i].ctime >= age_stable) {
pehrhovey	0:a548a085de55	336	old_stable = i;
pehrhovey	0:a548a085de55	337	age_stable = arp_table[i].ctime;
pehrhovey	0:a548a085de55	338	}
pehrhovey	0:a548a085de55	339	}
pehrhovey	0:a548a085de55	340	}
pehrhovey	0:a548a085de55	341	/* { we have no match } => try to create a new entry */
pehrhovey	0:a548a085de55	342
pehrhovey	0:a548a085de55	343	/* no empty entry found and not allowed to recycle? */
pehrhovey	0:a548a085de55	344	if (((empty == ARP_TABLE_SIZE) && ((flags & ETHARP_TRY_HARD) == 0))
pehrhovey	0:a548a085de55	345	/* or don't create new entry, only search? */
pehrhovey	0:a548a085de55	346	\|\| ((flags & ETHARP_FIND_ONLY) != 0)) {
pehrhovey	0:a548a085de55	347	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: no empty entry found and not allowed to recycle\n"));
pehrhovey	0:a548a085de55	348	return (s8_t)ERR_MEM;
pehrhovey	0:a548a085de55	349	}
pehrhovey	0:a548a085de55	350
pehrhovey	0:a548a085de55	351	/* b) choose the least destructive entry to recycle:
pehrhovey	0:a548a085de55	352	* 1) empty entry
pehrhovey	0:a548a085de55	353	* 2) oldest stable entry
pehrhovey	0:a548a085de55	354	* 3) oldest pending entry without queued packets
pehrhovey	0:a548a085de55	355	* 4) oldest pending entry with queued packets
pehrhovey	0:a548a085de55	356	*
pehrhovey	0:a548a085de55	357	* { ETHARP_TRY_HARD is set at this point }
pehrhovey	0:a548a085de55	358	*/
pehrhovey	0:a548a085de55	359
pehrhovey	0:a548a085de55	360	/* 1) empty entry available? */
pehrhovey	0:a548a085de55	361	if (empty < ARP_TABLE_SIZE) {
pehrhovey	0:a548a085de55	362	i = empty;
pehrhovey	0:a548a085de55	363	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: selecting empty entry %"U16_F"\n", (u16_t)i));
pehrhovey	0:a548a085de55	364	}
pehrhovey	0:a548a085de55	365	/* 2) found recyclable stable entry? */
pehrhovey	0:a548a085de55	366	else if (old_stable < ARP_TABLE_SIZE) {
pehrhovey	0:a548a085de55	367	/* recycle oldest stable*/
pehrhovey	0:a548a085de55	368	i = old_stable;
pehrhovey	0:a548a085de55	369	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: selecting oldest stable entry %"U16_F"\n", (u16_t)i));
pehrhovey	0:a548a085de55	370	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	371	/* no queued packets should exist on stable entries */
pehrhovey	0:a548a085de55	372	LWIP_ASSERT("arp_table[i].q == NULL", arp_table[i].q == NULL);
pehrhovey	0:a548a085de55	373	#endif
pehrhovey	0:a548a085de55	374	/* 3) found recyclable pending entry without queued packets? */
pehrhovey	0:a548a085de55	375	} else if (old_pending < ARP_TABLE_SIZE) {
pehrhovey	0:a548a085de55	376	/* recycle oldest pending */
pehrhovey	0:a548a085de55	377	i = old_pending;
pehrhovey	0:a548a085de55	378	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: selecting oldest pending entry %"U16_F" (without queue)\n", (u16_t)i));
pehrhovey	0:a548a085de55	379	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	380	/* 4) found recyclable pending entry with queued packets? */
pehrhovey	0:a548a085de55	381	} else if (old_queue < ARP_TABLE_SIZE) {
pehrhovey	0:a548a085de55	382	/* recycle oldest pending */
pehrhovey	0:a548a085de55	383	i = old_queue;
pehrhovey	0:a548a085de55	384	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("find_entry: selecting oldest pending entry %"U16_F", freeing packet queue %p\n", (u16_t)i, (void *)(arp_table[i].q)));
pehrhovey	0:a548a085de55	385	free_etharp_q(arp_table[i].q);
pehrhovey	0:a548a085de55	386	arp_table[i].q = NULL;
pehrhovey	0:a548a085de55	387	#endif
pehrhovey	0:a548a085de55	388	/* no empty or recyclable entries found */
pehrhovey	0:a548a085de55	389	} else {
pehrhovey	0:a548a085de55	390	return (s8_t)ERR_MEM;
pehrhovey	0:a548a085de55	391	}
pehrhovey	0:a548a085de55	392
pehrhovey	0:a548a085de55	393	/* { empty or recyclable entry found } */
pehrhovey	0:a548a085de55	394	LWIP_ASSERT("i < ARP_TABLE_SIZE", i < ARP_TABLE_SIZE);
pehrhovey	0:a548a085de55	395
pehrhovey	0:a548a085de55	396	if (arp_table[i].state != ETHARP_STATE_EMPTY)
pehrhovey	0:a548a085de55	397	{
pehrhovey	0:a548a085de55	398	snmp_delete_arpidx_tree(arp_table[i].netif, &arp_table[i].ipaddr);
pehrhovey	0:a548a085de55	399	}
pehrhovey	0:a548a085de55	400	/* recycle entry (no-op for an already empty entry) */
pehrhovey	0:a548a085de55	401	arp_table[i].state = ETHARP_STATE_EMPTY;
pehrhovey	0:a548a085de55	402
pehrhovey	0:a548a085de55	403	/* IP address given? */
pehrhovey	0:a548a085de55	404	if (ipaddr != NULL) {
pehrhovey	0:a548a085de55	405	/* set IP address */
pehrhovey	0:a548a085de55	406	ip_addr_set(&arp_table[i].ipaddr, ipaddr);
pehrhovey	0:a548a085de55	407	}
pehrhovey	0:a548a085de55	408	arp_table[i].ctime = 0;
pehrhovey	0:a548a085de55	409	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	410	NETIF_SET_HINT(netif, i);
pehrhovey	0:a548a085de55	411	#else /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	412	etharp_cached_entry = i;
pehrhovey	0:a548a085de55	413	#endif /* #if LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	414	return (err_t)i;
pehrhovey	0:a548a085de55	415	}
pehrhovey	0:a548a085de55	416
pehrhovey	0:a548a085de55	417	/**
pehrhovey	0:a548a085de55	418	* Send an IP packet on the network using netif->linkoutput
pehrhovey	0:a548a085de55	419	* The ethernet header is filled in before sending.
pehrhovey	0:a548a085de55	420	*
pehrhovey	0:a548a085de55	421	* @params netif the lwIP network interface on which to send the packet
pehrhovey	0:a548a085de55	422	* @params p the packet to send, p->payload pointing to the (uninitialized) ethernet header
pehrhovey	0:a548a085de55	423	* @params src the source MAC address to be copied into the ethernet header
pehrhovey	0:a548a085de55	424	* @params dst the destination MAC address to be copied into the ethernet header
pehrhovey	0:a548a085de55	425	* @return ERR_OK if the packet was sent, any other err_t on failure
pehrhovey	0:a548a085de55	426	*/
pehrhovey	0:a548a085de55	427	static err_t
pehrhovey	0:a548a085de55	428	etharp_send_ip(struct netif netif, struct pbuf p, struct eth_addr src, struct eth_addr dst)
pehrhovey	0:a548a085de55	429	{
pehrhovey	0:a548a085de55	430	struct eth_hdr ethhdr = (struct eth_hdr )p->payload;
pehrhovey	0:a548a085de55	431	u8_t k;
pehrhovey	0:a548a085de55	432
pehrhovey	0:a548a085de55	433	LWIP_ASSERT("netif->hwaddr_len must be the same as ETHARP_HWADDR_LEN for etharp!",
pehrhovey	0:a548a085de55	434	(netif->hwaddr_len == ETHARP_HWADDR_LEN));
pehrhovey	0:a548a085de55	435	k = ETHARP_HWADDR_LEN;
pehrhovey	0:a548a085de55	436	while(k > 0) {
pehrhovey	0:a548a085de55	437	k--;
pehrhovey	0:a548a085de55	438	ethhdr->dest.addr[k] = dst->addr[k];
pehrhovey	0:a548a085de55	439	ethhdr->src.addr[k] = src->addr[k];
pehrhovey	0:a548a085de55	440	}
pehrhovey	0:a548a085de55	441	ethhdr->type = htons(ETHTYPE_IP);
pehrhovey	0:a548a085de55	442	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_send_ip: sending packet %p\n", (void *)p));
pehrhovey	0:a548a085de55	443	/* send the packet */
pehrhovey	0:a548a085de55	444	return netif->linkoutput(netif, p);
pehrhovey	0:a548a085de55	445	}
pehrhovey	0:a548a085de55	446
pehrhovey	0:a548a085de55	447	/**
pehrhovey	0:a548a085de55	448	* Update (or insert) a IP/MAC address pair in the ARP cache.
pehrhovey	0:a548a085de55	449	*
pehrhovey	0:a548a085de55	450	* If a pending entry is resolved, any queued packets will be sent
pehrhovey	0:a548a085de55	451	* at this point.
pehrhovey	0:a548a085de55	452	*
pehrhovey	0:a548a085de55	453	* @param ipaddr IP address of the inserted ARP entry.
pehrhovey	0:a548a085de55	454	* @param ethaddr Ethernet address of the inserted ARP entry.
pehrhovey	0:a548a085de55	455	* @param flags Defines behaviour:
pehrhovey	0:a548a085de55	456	* - ETHARP_TRY_HARD Allows ARP to insert this as a new item. If not specified,
pehrhovey	0:a548a085de55	457	* only existing ARP entries will be updated.
pehrhovey	0:a548a085de55	458	*
pehrhovey	0:a548a085de55	459	* @return
pehrhovey	0:a548a085de55	460	* - ERR_OK Succesfully updated ARP cache.
pehrhovey	0:a548a085de55	461	* - ERR_MEM If we could not add a new ARP entry when ETHARP_TRY_HARD was set.
pehrhovey	0:a548a085de55	462	* - ERR_ARG Non-unicast address given, those will not appear in ARP cache.
pehrhovey	0:a548a085de55	463	*
pehrhovey	0:a548a085de55	464	* @see pbuf_free()
pehrhovey	0:a548a085de55	465	*/
pehrhovey	0:a548a085de55	466	static err_t
pehrhovey	0:a548a085de55	467	update_arp_entry(struct netif netif, struct ip_addr ipaddr, struct eth_addr *ethaddr, u8_t flags)
pehrhovey	0:a548a085de55	468	{
pehrhovey	0:a548a085de55	469	s8_t i;
pehrhovey	0:a548a085de55	470	u8_t k;
pehrhovey	0:a548a085de55	471	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE \| 3, ("update_arp_entry()\n"));
pehrhovey	0:a548a085de55	472	LWIP_ASSERT("netif->hwaddr_len == ETHARP_HWADDR_LEN", netif->hwaddr_len == ETHARP_HWADDR_LEN);
pehrhovey	0:a548a085de55	473	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("update_arp_entry: %"U16_F".%"U16_F".%"U16_F".%"U16_F" - %02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F":%02"X16_F"\n",
pehrhovey	0:a548a085de55	474	ip4_addr1(ipaddr), ip4_addr2(ipaddr), ip4_addr3(ipaddr), ip4_addr4(ipaddr),
pehrhovey	0:a548a085de55	475	ethaddr->addr[0], ethaddr->addr[1], ethaddr->addr[2],
pehrhovey	0:a548a085de55	476	ethaddr->addr[3], ethaddr->addr[4], ethaddr->addr[5]));
pehrhovey	0:a548a085de55	477	/* non-unicast address? */
pehrhovey	0:a548a085de55	478	if (ip_addr_isany(ipaddr) \|\|
pehrhovey	0:a548a085de55	479	ip_addr_isbroadcast(ipaddr, netif) \|\|
pehrhovey	0:a548a085de55	480	ip_addr_ismulticast(ipaddr)) {
pehrhovey	0:a548a085de55	481	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("update_arp_entry: will not add non-unicast IP address to ARP cache\n"));
pehrhovey	0:a548a085de55	482	return ERR_ARG;
pehrhovey	0:a548a085de55	483	}
pehrhovey	0:a548a085de55	484	/* find or create ARP entry */
pehrhovey	0:a548a085de55	485	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	486	i = find_entry(ipaddr, flags, netif);
pehrhovey	0:a548a085de55	487	#else /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	488	i = find_entry(ipaddr, flags);
pehrhovey	0:a548a085de55	489	#endif /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	490	/* bail out if no entry could be found */
pehrhovey	0:a548a085de55	491	if (i < 0)
pehrhovey	0:a548a085de55	492	return (err_t)i;
pehrhovey	0:a548a085de55	493
pehrhovey	0:a548a085de55	494	/* mark it stable */
pehrhovey	0:a548a085de55	495	arp_table[i].state = ETHARP_STATE_STABLE;
pehrhovey	0:a548a085de55	496	/* record network interface */
pehrhovey	0:a548a085de55	497	arp_table[i].netif = netif;
pehrhovey	0:a548a085de55	498
pehrhovey	0:a548a085de55	499	/* insert in SNMP ARP index tree */
pehrhovey	0:a548a085de55	500	snmp_insert_arpidx_tree(netif, &arp_table[i].ipaddr);
pehrhovey	0:a548a085de55	501
pehrhovey	0:a548a085de55	502	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("update_arp_entry: updating stable entry %"S16_F"\n", (s16_t)i));
pehrhovey	0:a548a085de55	503	/* update address */
pehrhovey	0:a548a085de55	504	k = ETHARP_HWADDR_LEN;
pehrhovey	0:a548a085de55	505	while (k > 0) {
pehrhovey	0:a548a085de55	506	k--;
pehrhovey	0:a548a085de55	507	arp_table[i].ethaddr.addr[k] = ethaddr->addr[k];
pehrhovey	0:a548a085de55	508	}
pehrhovey	0:a548a085de55	509	/* reset time stamp */
pehrhovey	0:a548a085de55	510	arp_table[i].ctime = 0;
pehrhovey	0:a548a085de55	511	#if ARP_QUEUEING
pehrhovey	0:a548a085de55	512	/* this is where we will send out queued packets! */
pehrhovey	0:a548a085de55	513	while (arp_table[i].q != NULL) {
pehrhovey	0:a548a085de55	514	struct pbuf *p;
pehrhovey	0:a548a085de55	515	/* remember remainder of queue */
pehrhovey	0:a548a085de55	516	struct etharp_q_entry *q = arp_table[i].q;
pehrhovey	0:a548a085de55	517	/* pop first item off the queue */
pehrhovey	0:a548a085de55	518	arp_table[i].q = q->next;
pehrhovey	0:a548a085de55	519	/* get the packet pointer */
pehrhovey	0:a548a085de55	520	p = q->p;
pehrhovey	0:a548a085de55	521	/* now queue entry can be freed */
pehrhovey	0:a548a085de55	522	memp_free(MEMP_ARP_QUEUE, q);
pehrhovey	0:a548a085de55	523	/* send the queued IP packet */
pehrhovey	0:a548a085de55	524	etharp_send_ip(netif, p, (struct eth_addr*)(netif->hwaddr), ethaddr);
pehrhovey	0:a548a085de55	525	/* free the queued IP packet */
pehrhovey	0:a548a085de55	526	pbuf_free(p);
pehrhovey	0:a548a085de55	527	}
pehrhovey	0:a548a085de55	528	#endif
pehrhovey	0:a548a085de55	529	return ERR_OK;
pehrhovey	0:a548a085de55	530	}
pehrhovey	0:a548a085de55	531
pehrhovey	0:a548a085de55	532	/**
pehrhovey	0:a548a085de55	533	* Finds (stable) ethernet/IP address pair from ARP table
pehrhovey	0:a548a085de55	534	* using interface and IP address index.
pehrhovey	0:a548a085de55	535	* @note the addresses in the ARP table are in network order!
pehrhovey	0:a548a085de55	536	*
pehrhovey	0:a548a085de55	537	* @param netif points to interface index
pehrhovey	0:a548a085de55	538	* @param ipaddr points to the (network order) IP address index
pehrhovey	0:a548a085de55	539	* @param eth_ret points to return pointer
pehrhovey	0:a548a085de55	540	* @param ip_ret points to return pointer
pehrhovey	0:a548a085de55	541	* @return table index if found, -1 otherwise
pehrhovey	0:a548a085de55	542	*/
pehrhovey	0:a548a085de55	543	s8_t
pehrhovey	0:a548a085de55	544	etharp_find_addr(struct netif netif, struct ip_addr ipaddr,
pehrhovey	0:a548a085de55	545	struct eth_addr eth_ret, struct ip_addr ip_ret)
pehrhovey	0:a548a085de55	546	{
pehrhovey	0:a548a085de55	547	s8_t i;
pehrhovey	0:a548a085de55	548
pehrhovey	0:a548a085de55	549	LWIP_UNUSED_ARG(netif);
pehrhovey	0:a548a085de55	550
pehrhovey	0:a548a085de55	551	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	552	i = find_entry(ipaddr, ETHARP_FIND_ONLY, NULL);
pehrhovey	0:a548a085de55	553	#else /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	554	i = find_entry(ipaddr, ETHARP_FIND_ONLY);
pehrhovey	0:a548a085de55	555	#endif /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	556	if((i >= 0) && arp_table[i].state == ETHARP_STATE_STABLE) {
pehrhovey	0:a548a085de55	557	*eth_ret = &arp_table[i].ethaddr;
pehrhovey	0:a548a085de55	558	*ip_ret = &arp_table[i].ipaddr;
pehrhovey	0:a548a085de55	559	return i;
pehrhovey	0:a548a085de55	560	}
pehrhovey	0:a548a085de55	561	return -1;
pehrhovey	0:a548a085de55	562	}
pehrhovey	0:a548a085de55	563
pehrhovey	0:a548a085de55	564	/**
pehrhovey	0:a548a085de55	565	* Updates the ARP table using the given IP packet.
pehrhovey	0:a548a085de55	566	*
pehrhovey	0:a548a085de55	567	* Uses the incoming IP packet's source address to update the
pehrhovey	0:a548a085de55	568	* ARP cache for the local network. The function does not alter
pehrhovey	0:a548a085de55	569	* or free the packet. This function must be called before the
pehrhovey	0:a548a085de55	570	* packet p is passed to the IP layer.
pehrhovey	0:a548a085de55	571	*
pehrhovey	0:a548a085de55	572	* @param netif The lwIP network interface on which the IP packet pbuf arrived.
pehrhovey	0:a548a085de55	573	* @param p The IP packet that arrived on netif.
pehrhovey	0:a548a085de55	574	*
pehrhovey	0:a548a085de55	575	* @return NULL
pehrhovey	0:a548a085de55	576	*
pehrhovey	0:a548a085de55	577	* @see pbuf_free()
pehrhovey	0:a548a085de55	578	*/
pehrhovey	0:a548a085de55	579	void
pehrhovey	0:a548a085de55	580	etharp_ip_input(struct netif netif, struct pbuf p)
pehrhovey	0:a548a085de55	581	{
pehrhovey	0:a548a085de55	582	struct eth_hdr *ethhdr;
pehrhovey	0:a548a085de55	583	struct ip_hdr *iphdr;
pehrhovey	0:a548a085de55	584	LWIP_ERROR("netif != NULL", (netif != NULL), return;);
pehrhovey	0:a548a085de55	585	/* Only insert an entry if the source IP address of the
pehrhovey	0:a548a085de55	586	incoming IP packet comes from a host on the local network. */
pehrhovey	0:a548a085de55	587	ethhdr = (struct eth_hdr *)p->payload;
pehrhovey	0:a548a085de55	588	iphdr = (struct ip_hdr )((u8_t)ethhdr + SIZEOF_ETH_HDR);
pehrhovey	0:a548a085de55	589	#if ETHARP_SUPPORT_VLAN
pehrhovey	0:a548a085de55	590	if (ethhdr->type == ETHTYPE_VLAN) {
pehrhovey	0:a548a085de55	591	iphdr = (struct ip_hdr )((u8_t)ethhdr + SIZEOF_ETH_HDR + SIZEOF_VLAN_HDR);
pehrhovey	0:a548a085de55	592	}
pehrhovey	0:a548a085de55	593	#endif /* ETHARP_SUPPORT_VLAN */
pehrhovey	0:a548a085de55	594
pehrhovey	0:a548a085de55	595	/* source is not on the local network? */
pehrhovey	0:a548a085de55	596	if (!ip_addr_netcmp(&(iphdr->src), &(netif->ip_addr), &(netif->netmask))) {
pehrhovey	0:a548a085de55	597	/* do nothing */
pehrhovey	0:a548a085de55	598	return;
pehrhovey	0:a548a085de55	599	}
pehrhovey	0:a548a085de55	600
pehrhovey	0:a548a085de55	601	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_ip_input: updating ETHARP table.\n"));
pehrhovey	0:a548a085de55	602	/* update ARP table */
pehrhovey	0:a548a085de55	603	/* @todo We could use ETHARP_TRY_HARD if we think we are going to talk
pehrhovey	0:a548a085de55	604	* back soon (for example, if the destination IP address is ours. */
pehrhovey	0:a548a085de55	605	update_arp_entry(netif, &(iphdr->src), &(ethhdr->src), 0);
pehrhovey	0:a548a085de55	606	}
pehrhovey	0:a548a085de55	607
pehrhovey	0:a548a085de55	608
pehrhovey	0:a548a085de55	609	/**
pehrhovey	0:a548a085de55	610	* Responds to ARP requests to us. Upon ARP replies to us, add entry to cache
pehrhovey	0:a548a085de55	611	* send out queued IP packets. Updates cache with snooped address pairs.
pehrhovey	0:a548a085de55	612	*
pehrhovey	0:a548a085de55	613	* Should be called for incoming ARP packets. The pbuf in the argument
pehrhovey	0:a548a085de55	614	* is freed by this function.
pehrhovey	0:a548a085de55	615	*
pehrhovey	0:a548a085de55	616	* @param netif The lwIP network interface on which the ARP packet pbuf arrived.
pehrhovey	0:a548a085de55	617	* @param ethaddr Ethernet address of netif.
pehrhovey	0:a548a085de55	618	* @param p The ARP packet that arrived on netif. Is freed by this function.
pehrhovey	0:a548a085de55	619	*
pehrhovey	0:a548a085de55	620	* @return NULL
pehrhovey	0:a548a085de55	621	*
pehrhovey	0:a548a085de55	622	* @see pbuf_free()
pehrhovey	0:a548a085de55	623	*/
pehrhovey	0:a548a085de55	624	void
pehrhovey	0:a548a085de55	625	etharp_arp_input(struct netif netif, struct eth_addr ethaddr, struct pbuf *p)
pehrhovey	0:a548a085de55	626	{
pehrhovey	0:a548a085de55	627	struct etharp_hdr *hdr;
pehrhovey	0:a548a085de55	628	struct eth_hdr *ethhdr;
pehrhovey	0:a548a085de55	629	/* these are aligned properly, whereas the ARP header fields might not be */
pehrhovey	0:a548a085de55	630	struct ip_addr sipaddr, dipaddr;
pehrhovey	0:a548a085de55	631	u8_t i;
pehrhovey	0:a548a085de55	632	u8_t for_us;
pehrhovey	0:a548a085de55	633	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	634	const u8_t * ethdst_hwaddr;
pehrhovey	0:a548a085de55	635	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	636
pehrhovey	0:a548a085de55	637	LWIP_ERROR("netif != NULL", (netif != NULL), return;);
pehrhovey	0:a548a085de55	638
pehrhovey	0:a548a085de55	639	/* drop short ARP packets: we have to check for p->len instead of p->tot_len here
pehrhovey	0:a548a085de55	640	since a struct etharp_hdr is pointed to p->payload, so it musn't be chained! */
pehrhovey	0:a548a085de55	641	if (p->len < SIZEOF_ETHARP_PACKET) {
pehrhovey	0:a548a085de55	642	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE \| 1, ("etharp_arp_input: packet dropped, too short (%"S16_F"/%"S16_F")\n", p->tot_len, (s16_t)SIZEOF_ETHARP_PACKET));
pehrhovey	0:a548a085de55	643	ETHARP_STATS_INC(etharp.lenerr);
pehrhovey	0:a548a085de55	644	ETHARP_STATS_INC(etharp.drop);
pehrhovey	0:a548a085de55	645	pbuf_free(p);
pehrhovey	0:a548a085de55	646	return;
pehrhovey	0:a548a085de55	647	}
pehrhovey	0:a548a085de55	648
pehrhovey	0:a548a085de55	649	ethhdr = (struct eth_hdr *)p->payload;
pehrhovey	0:a548a085de55	650	hdr = (struct etharp_hdr )((u8_t)ethhdr + SIZEOF_ETH_HDR);
pehrhovey	0:a548a085de55	651	#if ETHARP_SUPPORT_VLAN
pehrhovey	0:a548a085de55	652	if (ethhdr->type == ETHTYPE_VLAN) {
pehrhovey	0:a548a085de55	653	hdr = (struct etharp_hdr )(((u8_t)ethhdr) + SIZEOF_ETH_HDR + SIZEOF_VLAN_HDR);
pehrhovey	0:a548a085de55	654	}
pehrhovey	0:a548a085de55	655	#endif /* ETHARP_SUPPORT_VLAN */
pehrhovey	0:a548a085de55	656
pehrhovey	0:a548a085de55	657	/* RFC 826 "Packet Reception": */
pehrhovey	0:a548a085de55	658	if ((hdr->hwtype != htons(HWTYPE_ETHERNET)) \|\|
pehrhovey	0:a548a085de55	659	(hdr->_hwlen_protolen != htons((ETHARP_HWADDR_LEN << 8) \| sizeof(struct ip_addr))) \|\|
pehrhovey	0:a548a085de55	660	(hdr->proto != htons(ETHTYPE_IP)) \|\|
pehrhovey	0:a548a085de55	661	(ethhdr->type != htons(ETHTYPE_ARP))) {
pehrhovey	0:a548a085de55	662	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE \| 1,
pehrhovey	0:a548a085de55	663	("etharp_arp_input: packet dropped, wrong hw type, hwlen, proto, protolen or ethernet type (%"U16_F"/%"U16_F"/%"U16_F"/%"U16_F"/%"U16_F")\n",
pehrhovey	0:a548a085de55	664	hdr->hwtype, ARPH_HWLEN(hdr), hdr->proto, ARPH_PROTOLEN(hdr), ethhdr->type));
pehrhovey	0:a548a085de55	665	ETHARP_STATS_INC(etharp.proterr);
pehrhovey	0:a548a085de55	666	ETHARP_STATS_INC(etharp.drop);
pehrhovey	0:a548a085de55	667	pbuf_free(p);
pehrhovey	0:a548a085de55	668	return;
pehrhovey	0:a548a085de55	669	}
pehrhovey	0:a548a085de55	670	ETHARP_STATS_INC(etharp.recv);
pehrhovey	0:a548a085de55	671
pehrhovey	0:a548a085de55	672	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	673	/* We have to check if a host already has configured our random
pehrhovey	0:a548a085de55	674	* created link local address and continously check if there is
pehrhovey	0:a548a085de55	675	* a host with this IP-address so we can detect collisions */
pehrhovey	0:a548a085de55	676	autoip_arp_reply(netif, hdr);
pehrhovey	0:a548a085de55	677	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	678
pehrhovey	0:a548a085de55	679	/* Copy struct ip_addr2 to aligned ip_addr, to support compilers without
pehrhovey	0:a548a085de55	680	* structure packing (not using structure copy which breaks strict-aliasing rules). */
pehrhovey	0:a548a085de55	681	SMEMCPY(&sipaddr, &hdr->sipaddr, sizeof(sipaddr));
pehrhovey	0:a548a085de55	682	SMEMCPY(&dipaddr, &hdr->dipaddr, sizeof(dipaddr));
pehrhovey	0:a548a085de55	683
pehrhovey	0:a548a085de55	684	/* this interface is not configured? */
pehrhovey	0:a548a085de55	685	if (netif->ip_addr.addr == 0) {
pehrhovey	0:a548a085de55	686	for_us = 0;
pehrhovey	0:a548a085de55	687	} else {
pehrhovey	0:a548a085de55	688	/* ARP packet directed to us? */
pehrhovey	0:a548a085de55	689	for_us = ip_addr_cmp(&dipaddr, &(netif->ip_addr));
pehrhovey	0:a548a085de55	690	}
pehrhovey	0:a548a085de55	691
pehrhovey	0:a548a085de55	692	/* ARP message directed to us? */
pehrhovey	0:a548a085de55	693	if (for_us) {
pehrhovey	0:a548a085de55	694	/* add IP address in ARP cache; assume requester wants to talk to us.
pehrhovey	0:a548a085de55	695	* can result in directly sending the queued packets for this host. */
pehrhovey	0:a548a085de55	696	update_arp_entry(netif, &sipaddr, &(hdr->shwaddr), ETHARP_TRY_HARD);
pehrhovey	0:a548a085de55	697	/* ARP message not directed to us? */
pehrhovey	0:a548a085de55	698	} else {
pehrhovey	0:a548a085de55	699	/* update the source IP address in the cache, if present */
pehrhovey	0:a548a085de55	700	update_arp_entry(netif, &sipaddr, &(hdr->shwaddr), 0);
pehrhovey	0:a548a085de55	701	}
pehrhovey	0:a548a085de55	702
pehrhovey	0:a548a085de55	703	/* now act on the message itself */
pehrhovey	0:a548a085de55	704	switch (htons(hdr->opcode)) {
pehrhovey	0:a548a085de55	705	/* ARP request? */
pehrhovey	0:a548a085de55	706	case ARP_REQUEST:
pehrhovey	0:a548a085de55	707	/* ARP request. If it asked for our address, we send out a
pehrhovey	0:a548a085de55	708	* reply. In any case, we time-stamp any existing ARP entry,
pehrhovey	0:a548a085de55	709	* and possiby send out an IP packet that was queued on it. */
pehrhovey	0:a548a085de55	710
pehrhovey	0:a548a085de55	711	LWIP_DEBUGF (ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: incoming ARP request\n"));
pehrhovey	0:a548a085de55	712	/* ARP request for our address? */
pehrhovey	0:a548a085de55	713	if (for_us) {
pehrhovey	0:a548a085de55	714
pehrhovey	0:a548a085de55	715	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: replying to ARP request for our IP address\n"));
pehrhovey	0:a548a085de55	716	/* Re-use pbuf to send ARP reply.
pehrhovey	0:a548a085de55	717	Since we are re-using an existing pbuf, we can't call etharp_raw since
pehrhovey	0:a548a085de55	718	that would allocate a new pbuf. */
pehrhovey	0:a548a085de55	719	hdr->opcode = htons(ARP_REPLY);
pehrhovey	0:a548a085de55	720
pehrhovey	0:a548a085de55	721	hdr->dipaddr = hdr->sipaddr;
pehrhovey	0:a548a085de55	722	SMEMCPY(&hdr->sipaddr, &netif->ip_addr, sizeof(hdr->sipaddr));
pehrhovey	0:a548a085de55	723
pehrhovey	0:a548a085de55	724	LWIP_ASSERT("netif->hwaddr_len must be the same as ETHARP_HWADDR_LEN for etharp!",
pehrhovey	0:a548a085de55	725	(netif->hwaddr_len == ETHARP_HWADDR_LEN));
pehrhovey	0:a548a085de55	726	i = ETHARP_HWADDR_LEN;
pehrhovey	0:a548a085de55	727	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	728	/* If we are using Link-Local, ARP packets must be broadcast on the
pehrhovey	0:a548a085de55	729	* link layer. (See RFC3927 Section 2.5) */
pehrhovey	0:a548a085de55	730	ethdst_hwaddr = ((netif->autoip != NULL) && (netif->autoip->state != AUTOIP_STATE_OFF)) ? (u8_t*)(ethbroadcast.addr) : hdr->shwaddr.addr;
pehrhovey	0:a548a085de55	731	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	732
pehrhovey	0:a548a085de55	733	while(i > 0) {
pehrhovey	0:a548a085de55	734	i--;
pehrhovey	0:a548a085de55	735	hdr->dhwaddr.addr[i] = hdr->shwaddr.addr[i];
pehrhovey	0:a548a085de55	736	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	737	ethhdr->dest.addr[i] = ethdst_hwaddr[i];
pehrhovey	0:a548a085de55	738	#else /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	739	ethhdr->dest.addr[i] = hdr->shwaddr.addr[i];
pehrhovey	0:a548a085de55	740	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	741	hdr->shwaddr.addr[i] = ethaddr->addr[i];
pehrhovey	0:a548a085de55	742	ethhdr->src.addr[i] = ethaddr->addr[i];
pehrhovey	0:a548a085de55	743	}
pehrhovey	0:a548a085de55	744
pehrhovey	0:a548a085de55	745	/* hwtype, hwaddr_len, proto, protolen and the type in the ethernet header
pehrhovey	0:a548a085de55	746	are already correct, we tested that before */
pehrhovey	0:a548a085de55	747
pehrhovey	0:a548a085de55	748	/* return ARP reply */
pehrhovey	0:a548a085de55	749	netif->linkoutput(netif, p);
pehrhovey	0:a548a085de55	750	/* we are not configured? */
pehrhovey	0:a548a085de55	751	} else if (netif->ip_addr.addr == 0) {
pehrhovey	0:a548a085de55	752	/* { for_us == 0 and netif->ip_addr.addr == 0 } */
pehrhovey	0:a548a085de55	753	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: we are unconfigured, ARP request ignored.\n"));
pehrhovey	0:a548a085de55	754	/* request was not directed to us */
pehrhovey	0:a548a085de55	755	} else {
pehrhovey	0:a548a085de55	756	/* { for_us == 0 and netif->ip_addr.addr != 0 } */
pehrhovey	0:a548a085de55	757	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: ARP request was not for us.\n"));
pehrhovey	0:a548a085de55	758	}
pehrhovey	0:a548a085de55	759	break;
pehrhovey	0:a548a085de55	760	case ARP_REPLY:
pehrhovey	0:a548a085de55	761	/* ARP reply. We already updated the ARP cache earlier. */
pehrhovey	0:a548a085de55	762	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: incoming ARP reply\n"));
pehrhovey	0:a548a085de55	763	#if (LWIP_DHCP && DHCP_DOES_ARP_CHECK)
pehrhovey	0:a548a085de55	764	/* DHCP wants to know about ARP replies from any host with an
pehrhovey	0:a548a085de55	765	* IP address also offered to us by the DHCP server. We do not
pehrhovey	0:a548a085de55	766	* want to take a duplicate IP address on a single network.
pehrhovey	0:a548a085de55	767	* @todo How should we handle redundant (fail-over) interfaces? */
pehrhovey	0:a548a085de55	768	dhcp_arp_reply(netif, &sipaddr);
pehrhovey	0:a548a085de55	769	#endif
pehrhovey	0:a548a085de55	770	break;
pehrhovey	0:a548a085de55	771	default:
pehrhovey	0:a548a085de55	772	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_arp_input: ARP unknown opcode type %"S16_F"\n", htons(hdr->opcode)));
pehrhovey	0:a548a085de55	773	ETHARP_STATS_INC(etharp.err);
pehrhovey	0:a548a085de55	774	break;
pehrhovey	0:a548a085de55	775	}
pehrhovey	0:a548a085de55	776	/* free ARP packet */
pehrhovey	0:a548a085de55	777	pbuf_free(p);
pehrhovey	0:a548a085de55	778	}
pehrhovey	0:a548a085de55	779
pehrhovey	0:a548a085de55	780	/**
pehrhovey	0:a548a085de55	781	* Resolve and fill-in Ethernet address header for outgoing IP packet.
pehrhovey	0:a548a085de55	782	*
pehrhovey	0:a548a085de55	783	* For IP multicast and broadcast, corresponding Ethernet addresses
pehrhovey	0:a548a085de55	784	* are selected and the packet is transmitted on the link.
pehrhovey	0:a548a085de55	785	*
pehrhovey	0:a548a085de55	786	* For unicast addresses, the packet is submitted to etharp_query(). In
pehrhovey	0:a548a085de55	787	* case the IP address is outside the local network, the IP address of
pehrhovey	0:a548a085de55	788	* the gateway is used.
pehrhovey	0:a548a085de55	789	*
pehrhovey	0:a548a085de55	790	* @param netif The lwIP network interface which the IP packet will be sent on.
pehrhovey	0:a548a085de55	791	* @param q The pbuf(s) containing the IP packet to be sent.
pehrhovey	0:a548a085de55	792	* @param ipaddr The IP address of the packet destination.
pehrhovey	0:a548a085de55	793	*
pehrhovey	0:a548a085de55	794	* @return
pehrhovey	0:a548a085de55	795	* - ERR_RTE No route to destination (no gateway to external networks),
pehrhovey	0:a548a085de55	796	* or the return type of either etharp_query() or etharp_send_ip().
pehrhovey	0:a548a085de55	797	*/
pehrhovey	0:a548a085de55	798	err_t
pehrhovey	0:a548a085de55	799	etharp_output(struct netif netif, struct pbuf q, struct ip_addr *ipaddr)
pehrhovey	0:a548a085de55	800	{
pehrhovey	0:a548a085de55	801	struct eth_addr *dest, mcastaddr;
pehrhovey	0:a548a085de55	802
pehrhovey	0:a548a085de55	803	/* make room for Ethernet header - should not fail */
pehrhovey	0:a548a085de55	804	if (pbuf_header(q, sizeof(struct eth_hdr)) != 0) {
pehrhovey	0:a548a085de55	805	/* bail out */
pehrhovey	0:a548a085de55	806	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE \| 2, ("etharp_output: could not allocate room for header.\n"));
pehrhovey	0:a548a085de55	807	LINK_STATS_INC(link.lenerr);
pehrhovey	0:a548a085de55	808	return ERR_BUF;
pehrhovey	0:a548a085de55	809	}
pehrhovey	0:a548a085de55	810
pehrhovey	0:a548a085de55	811	/* assume unresolved Ethernet address */
pehrhovey	0:a548a085de55	812	dest = NULL;
pehrhovey	0:a548a085de55	813	/* Determine on destination hardware address. Broadcasts and multicasts
pehrhovey	0:a548a085de55	814	* are special, other IP addresses are looked up in the ARP table. */
pehrhovey	0:a548a085de55	815
pehrhovey	0:a548a085de55	816	/* broadcast destination IP address? */
pehrhovey	0:a548a085de55	817	if (ip_addr_isbroadcast(ipaddr, netif)) {
pehrhovey	0:a548a085de55	818	/* broadcast on Ethernet also */
pehrhovey	0:a548a085de55	819	dest = (struct eth_addr *)&ethbroadcast;
pehrhovey	0:a548a085de55	820	/* multicast destination IP address? */
pehrhovey	0:a548a085de55	821	} else if (ip_addr_ismulticast(ipaddr)) {
pehrhovey	0:a548a085de55	822	/* Hash IP multicast address to MAC address.*/
pehrhovey	0:a548a085de55	823	mcastaddr.addr[0] = 0x01;
pehrhovey	0:a548a085de55	824	mcastaddr.addr[1] = 0x00;
pehrhovey	0:a548a085de55	825	mcastaddr.addr[2] = 0x5e;
pehrhovey	0:a548a085de55	826	mcastaddr.addr[3] = ip4_addr2(ipaddr) & 0x7f;
pehrhovey	0:a548a085de55	827	mcastaddr.addr[4] = ip4_addr3(ipaddr);
pehrhovey	0:a548a085de55	828	mcastaddr.addr[5] = ip4_addr4(ipaddr);
pehrhovey	0:a548a085de55	829	/* destination Ethernet address is multicast */
pehrhovey	0:a548a085de55	830	dest = &mcastaddr;
pehrhovey	0:a548a085de55	831	/* unicast destination IP address? */
pehrhovey	0:a548a085de55	832	} else {
pehrhovey	0:a548a085de55	833	/* outside local network? */
pehrhovey	0:a548a085de55	834	if (!ip_addr_netcmp(ipaddr, &(netif->ip_addr), &(netif->netmask))) {
pehrhovey	0:a548a085de55	835	/* interface has default gateway? */
pehrhovey	0:a548a085de55	836	if (netif->gw.addr != 0) {
pehrhovey	0:a548a085de55	837	/* send to hardware address of default gateway IP address */
pehrhovey	0:a548a085de55	838	ipaddr = &(netif->gw);
pehrhovey	0:a548a085de55	839	/* no default gateway available */
pehrhovey	0:a548a085de55	840	} else {
pehrhovey	0:a548a085de55	841	/* no route to destination error (default gateway missing) */
pehrhovey	0:a548a085de55	842	return ERR_RTE;
pehrhovey	0:a548a085de55	843	}
pehrhovey	0:a548a085de55	844	}
pehrhovey	0:a548a085de55	845	/* queue on destination Ethernet address belonging to ipaddr */
pehrhovey	0:a548a085de55	846	return etharp_query(netif, ipaddr, q);
pehrhovey	0:a548a085de55	847	}
pehrhovey	0:a548a085de55	848
pehrhovey	0:a548a085de55	849	/* continuation for multicast/broadcast destinations */
pehrhovey	0:a548a085de55	850	/* obtain source Ethernet address of the given interface */
pehrhovey	0:a548a085de55	851	/* send packet directly on the link */
pehrhovey	0:a548a085de55	852	return etharp_send_ip(netif, q, (struct eth_addr*)(netif->hwaddr), dest);
pehrhovey	0:a548a085de55	853	}
pehrhovey	0:a548a085de55	854
pehrhovey	0:a548a085de55	855	/**
pehrhovey	0:a548a085de55	856	* Send an ARP request for the given IP address and/or queue a packet.
pehrhovey	0:a548a085de55	857	*
pehrhovey	0:a548a085de55	858	* If the IP address was not yet in the cache, a pending ARP cache entry
pehrhovey	0:a548a085de55	859	* is added and an ARP request is sent for the given address. The packet
pehrhovey	0:a548a085de55	860	* is queued on this entry.
pehrhovey	0:a548a085de55	861	*
pehrhovey	0:a548a085de55	862	* If the IP address was already pending in the cache, a new ARP request
pehrhovey	0:a548a085de55	863	* is sent for the given address. The packet is queued on this entry.
pehrhovey	0:a548a085de55	864	*
pehrhovey	0:a548a085de55	865	* If the IP address was already stable in the cache, and a packet is
pehrhovey	0:a548a085de55	866	* given, it is directly sent and no ARP request is sent out.
pehrhovey	0:a548a085de55	867	*
pehrhovey	0:a548a085de55	868	* If the IP address was already stable in the cache, and no packet is
pehrhovey	0:a548a085de55	869	* given, an ARP request is sent out.
pehrhovey	0:a548a085de55	870	*
pehrhovey	0:a548a085de55	871	* @param netif The lwIP network interface on which ipaddr
pehrhovey	0:a548a085de55	872	* must be queried for.
pehrhovey	0:a548a085de55	873	* @param ipaddr The IP address to be resolved.
pehrhovey	0:a548a085de55	874	* @param q If non-NULL, a pbuf that must be delivered to the IP address.
pehrhovey	0:a548a085de55	875	* q is not freed by this function.
pehrhovey	0:a548a085de55	876	*
pehrhovey	0:a548a085de55	877	* @note q must only be ONE packet, not a packet queue!
pehrhovey	0:a548a085de55	878	*
pehrhovey	0:a548a085de55	879	* @return
pehrhovey	0:a548a085de55	880	* - ERR_BUF Could not make room for Ethernet header.
pehrhovey	0:a548a085de55	881	* - ERR_MEM Hardware address unknown, and no more ARP entries available
pehrhovey	0:a548a085de55	882	* to query for address or queue the packet.
pehrhovey	0:a548a085de55	883	* - ERR_MEM Could not queue packet due to memory shortage.
pehrhovey	0:a548a085de55	884	* - ERR_RTE No route to destination (no gateway to external networks).
pehrhovey	0:a548a085de55	885	* - ERR_ARG Non-unicast address given, those will not appear in ARP cache.
pehrhovey	0:a548a085de55	886	*
pehrhovey	0:a548a085de55	887	*/
pehrhovey	0:a548a085de55	888	err_t
pehrhovey	0:a548a085de55	889	etharp_query(struct netif netif, struct ip_addr ipaddr, struct pbuf *q)
pehrhovey	0:a548a085de55	890	{
pehrhovey	0:a548a085de55	891	struct eth_addr * srcaddr = (struct eth_addr *)netif->hwaddr;
pehrhovey	0:a548a085de55	892	err_t result = ERR_MEM;
pehrhovey	0:a548a085de55	893	s8_t i; /* ARP entry index */
pehrhovey	0:a548a085de55	894
pehrhovey	0:a548a085de55	895	/* non-unicast address? */
pehrhovey	0:a548a085de55	896	if (ip_addr_isbroadcast(ipaddr, netif) \|\|
pehrhovey	0:a548a085de55	897	ip_addr_ismulticast(ipaddr) \|\|
pehrhovey	0:a548a085de55	898	ip_addr_isany(ipaddr)) {
pehrhovey	0:a548a085de55	899	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: will not add non-unicast IP address to ARP cache\n"));
pehrhovey	0:a548a085de55	900	return ERR_ARG;
pehrhovey	0:a548a085de55	901	}
pehrhovey	0:a548a085de55	902
pehrhovey	0:a548a085de55	903	/* find entry in ARP cache, ask to create entry if queueing packet */
pehrhovey	0:a548a085de55	904	#if LWIP_NETIF_HWADDRHINT
pehrhovey	0:a548a085de55	905	i = find_entry(ipaddr, ETHARP_TRY_HARD, netif);
pehrhovey	0:a548a085de55	906	#else /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	907	i = find_entry(ipaddr, ETHARP_TRY_HARD);
pehrhovey	0:a548a085de55	908	#endif /* LWIP_NETIF_HWADDRHINT */
pehrhovey	0:a548a085de55	909
pehrhovey	0:a548a085de55	910	/* could not find or create entry? */
pehrhovey	0:a548a085de55	911	if (i < 0) {
pehrhovey	0:a548a085de55	912	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: could not create ARP entry\n"));
pehrhovey	0:a548a085de55	913	if (q) {
pehrhovey	0:a548a085de55	914	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: packet dropped\n"));
pehrhovey	0:a548a085de55	915	ETHARP_STATS_INC(etharp.memerr);
pehrhovey	0:a548a085de55	916	}
pehrhovey	0:a548a085de55	917	return (err_t)i;
pehrhovey	0:a548a085de55	918	}
pehrhovey	0:a548a085de55	919
pehrhovey	0:a548a085de55	920	/* mark a fresh entry as pending (we just sent a request) */
pehrhovey	0:a548a085de55	921	if (arp_table[i].state == ETHARP_STATE_EMPTY) {
pehrhovey	0:a548a085de55	922	arp_table[i].state = ETHARP_STATE_PENDING;
pehrhovey	0:a548a085de55	923	}
pehrhovey	0:a548a085de55	924
pehrhovey	0:a548a085de55	925	/* { i is either a STABLE or (new or existing) PENDING entry } */
pehrhovey	0:a548a085de55	926	LWIP_ASSERT("arp_table[i].state == PENDING or STABLE",
pehrhovey	0:a548a085de55	927	((arp_table[i].state == ETHARP_STATE_PENDING) \|\|
pehrhovey	0:a548a085de55	928	(arp_table[i].state == ETHARP_STATE_STABLE)));
pehrhovey	0:a548a085de55	929
pehrhovey	0:a548a085de55	930	/* do we have a pending entry? or an implicit query request? */
pehrhovey	0:a548a085de55	931	if ((arp_table[i].state == ETHARP_STATE_PENDING) \|\| (q == NULL)) {
pehrhovey	0:a548a085de55	932	/* try to resolve it; send out ARP request */
pehrhovey	0:a548a085de55	933	result = etharp_request(netif, ipaddr);
pehrhovey	0:a548a085de55	934	if (result != ERR_OK) {
pehrhovey	0:a548a085de55	935	/* ARP request couldn't be sent */
pehrhovey	0:a548a085de55	936	/* We don't re-send arp request in etharp_tmr, but we still queue packets,
pehrhovey	0:a548a085de55	937	since this failure could be temporary, and the next packet calling
pehrhovey	0:a548a085de55	938	etharp_query again could lead to sending the queued packets. */
pehrhovey	0:a548a085de55	939	}
pehrhovey	0:a548a085de55	940	}
pehrhovey	0:a548a085de55	941
pehrhovey	0:a548a085de55	942	/* packet given? */
pehrhovey	0:a548a085de55	943	if (q != NULL) {
pehrhovey	0:a548a085de55	944	/* stable entry? */
pehrhovey	0:a548a085de55	945	if (arp_table[i].state == ETHARP_STATE_STABLE) {
pehrhovey	0:a548a085de55	946	/* we have a valid IP->Ethernet address mapping */
pehrhovey	0:a548a085de55	947	/* send the packet */
pehrhovey	0:a548a085de55	948	result = etharp_send_ip(netif, q, srcaddr, &(arp_table[i].ethaddr));
pehrhovey	0:a548a085de55	949	/* pending entry? (either just created or already pending */
pehrhovey	0:a548a085de55	950	} else if (arp_table[i].state == ETHARP_STATE_PENDING) {
pehrhovey	0:a548a085de55	951	#if ARP_QUEUEING /* queue the given q packet */
pehrhovey	0:a548a085de55	952	struct pbuf *p;
pehrhovey	0:a548a085de55	953	int copy_needed = 0;
pehrhovey	0:a548a085de55	954	/* IF q includes a PBUF_REF, PBUF_POOL or PBUF_RAM, we have no choice but
pehrhovey	0:a548a085de55	955	* to copy the whole queue into a new PBUF_RAM (see bug #11400)
pehrhovey	0:a548a085de55	956	* PBUF_ROMs can be left as they are, since ROM must not get changed. */
pehrhovey	0:a548a085de55	957	p = q;
pehrhovey	0:a548a085de55	958	while (p) {
pehrhovey	0:a548a085de55	959	LWIP_ASSERT("no packet queues allowed!", (p->len != p->tot_len) \|\| (p->next == 0));
pehrhovey	0:a548a085de55	960	if(p->type != PBUF_ROM) {
pehrhovey	0:a548a085de55	961	copy_needed = 1;
pehrhovey	0:a548a085de55	962	break;
pehrhovey	0:a548a085de55	963	}
pehrhovey	0:a548a085de55	964	p = p->next;
pehrhovey	0:a548a085de55	965	}
pehrhovey	0:a548a085de55	966	if(copy_needed) {
pehrhovey	0:a548a085de55	967	/* copy the whole packet into new pbufs */
pehrhovey	0:a548a085de55	968	p = pbuf_alloc(PBUF_RAW, p->tot_len, PBUF_RAM);
pehrhovey	0:a548a085de55	969	if(p != NULL) {
pehrhovey	0:a548a085de55	970	if (pbuf_copy(p, q) != ERR_OK) {
pehrhovey	0:a548a085de55	971	pbuf_free(p);
pehrhovey	0:a548a085de55	972	p = NULL;
pehrhovey	0:a548a085de55	973	}
pehrhovey	0:a548a085de55	974	}
pehrhovey	0:a548a085de55	975	} else {
pehrhovey	0:a548a085de55	976	/* referencing the old pbuf is enough */
pehrhovey	0:a548a085de55	977	p = q;
pehrhovey	0:a548a085de55	978	pbuf_ref(p);
pehrhovey	0:a548a085de55	979	}
pehrhovey	0:a548a085de55	980	/* packet could be taken over? */
pehrhovey	0:a548a085de55	981	if (p != NULL) {
pehrhovey	0:a548a085de55	982	/* queue packet ... */
pehrhovey	0:a548a085de55	983	struct etharp_q_entry *new_entry;
pehrhovey	0:a548a085de55	984	/* allocate a new arp queue entry */
pehrhovey	0:a548a085de55	985	new_entry = memp_malloc(MEMP_ARP_QUEUE);
pehrhovey	0:a548a085de55	986	if (new_entry != NULL) {
pehrhovey	0:a548a085de55	987	new_entry->next = 0;
pehrhovey	0:a548a085de55	988	new_entry->p = p;
pehrhovey	0:a548a085de55	989	if(arp_table[i].q != NULL) {
pehrhovey	0:a548a085de55	990	/* queue was already existent, append the new entry to the end */
pehrhovey	0:a548a085de55	991	struct etharp_q_entry *r;
pehrhovey	0:a548a085de55	992	r = arp_table[i].q;
pehrhovey	0:a548a085de55	993	while (r->next != NULL) {
pehrhovey	0:a548a085de55	994	r = r->next;
pehrhovey	0:a548a085de55	995	}
pehrhovey	0:a548a085de55	996	r->next = new_entry;
pehrhovey	0:a548a085de55	997	} else {
pehrhovey	0:a548a085de55	998	/* queue did not exist, first item in queue */
pehrhovey	0:a548a085de55	999	arp_table[i].q = new_entry;
pehrhovey	0:a548a085de55	1000	}
pehrhovey	0:a548a085de55	1001	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: queued packet %p on ARP entry %"S16_F"\n", (void *)q, (s16_t)i));
pehrhovey	0:a548a085de55	1002	result = ERR_OK;
pehrhovey	0:a548a085de55	1003	} else {
pehrhovey	0:a548a085de55	1004	/* the pool MEMP_ARP_QUEUE is empty */
pehrhovey	0:a548a085de55	1005	pbuf_free(p);
pehrhovey	0:a548a085de55	1006	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: could not queue a copy of PBUF_REF packet %p (out of memory)\n", (void *)q));
pehrhovey	0:a548a085de55	1007	/* { result == ERR_MEM } through initialization */
pehrhovey	0:a548a085de55	1008	}
pehrhovey	0:a548a085de55	1009	} else {
pehrhovey	0:a548a085de55	1010	ETHARP_STATS_INC(etharp.memerr);
pehrhovey	0:a548a085de55	1011	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: could not queue a copy of PBUF_REF packet %p (out of memory)\n", (void *)q));
pehrhovey	0:a548a085de55	1012	/* { result == ERR_MEM } through initialization */
pehrhovey	0:a548a085de55	1013	}
pehrhovey	0:a548a085de55	1014	#else /* ARP_QUEUEING == 0 */
pehrhovey	0:a548a085de55	1015	/* q && state == PENDING && ARP_QUEUEING == 0 => result = ERR_MEM */
pehrhovey	0:a548a085de55	1016	/* { result == ERR_MEM } through initialization */
pehrhovey	0:a548a085de55	1017	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_query: Ethernet destination address unknown, queueing disabled, packet %p dropped\n", (void *)q));
pehrhovey	0:a548a085de55	1018	#endif
pehrhovey	0:a548a085de55	1019	}
pehrhovey	0:a548a085de55	1020	}
pehrhovey	0:a548a085de55	1021	return result;
pehrhovey	0:a548a085de55	1022	}
pehrhovey	0:a548a085de55	1023
pehrhovey	0:a548a085de55	1024	/**
pehrhovey	0:a548a085de55	1025	* Send a raw ARP packet (opcode and all addresses can be modified)
pehrhovey	0:a548a085de55	1026	*
pehrhovey	0:a548a085de55	1027	* @param netif the lwip network interface on which to send the ARP packet
pehrhovey	0:a548a085de55	1028	* @param ethsrc_addr the source MAC address for the ethernet header
pehrhovey	0:a548a085de55	1029	* @param ethdst_addr the destination MAC address for the ethernet header
pehrhovey	0:a548a085de55	1030	* @param hwsrc_addr the source MAC address for the ARP protocol header
pehrhovey	0:a548a085de55	1031	* @param ipsrc_addr the source IP address for the ARP protocol header
pehrhovey	0:a548a085de55	1032	* @param hwdst_addr the destination MAC address for the ARP protocol header
pehrhovey	0:a548a085de55	1033	* @param ipdst_addr the destination IP address for the ARP protocol header
pehrhovey	0:a548a085de55	1034	* @param opcode the type of the ARP packet
pehrhovey	0:a548a085de55	1035	* @return ERR_OK if the ARP packet has been sent
pehrhovey	0:a548a085de55	1036	* ERR_MEM if the ARP packet couldn't be allocated
pehrhovey	0:a548a085de55	1037	* any other err_t on failure
pehrhovey	0:a548a085de55	1038	*/
pehrhovey	0:a548a085de55	1039	#if !LWIP_AUTOIP
pehrhovey	0:a548a085de55	1040	static
pehrhovey	0:a548a085de55	1041	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	1042	err_t
pehrhovey	0:a548a085de55	1043	etharp_raw(struct netif netif, const struct eth_addr ethsrc_addr,
pehrhovey	0:a548a085de55	1044	const struct eth_addr *ethdst_addr,
pehrhovey	0:a548a085de55	1045	const struct eth_addr hwsrc_addr, const struct ip_addr ipsrc_addr,
pehrhovey	0:a548a085de55	1046	const struct eth_addr hwdst_addr, const struct ip_addr ipdst_addr,
pehrhovey	0:a548a085de55	1047	const u16_t opcode)
pehrhovey	0:a548a085de55	1048	{
pehrhovey	0:a548a085de55	1049	struct pbuf *p;
pehrhovey	0:a548a085de55	1050	err_t result = ERR_OK;
pehrhovey	0:a548a085de55	1051	u8_t k; /* ARP entry index */
pehrhovey	0:a548a085de55	1052	struct eth_hdr *ethhdr;
pehrhovey	0:a548a085de55	1053	struct etharp_hdr *hdr;
pehrhovey	0:a548a085de55	1054	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	1055	const u8_t * ethdst_hwaddr;
pehrhovey	0:a548a085de55	1056	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	1057
pehrhovey	0:a548a085de55	1058	/* allocate a pbuf for the outgoing ARP request packet */
pehrhovey	0:a548a085de55	1059	p = pbuf_alloc(PBUF_RAW, SIZEOF_ETHARP_PACKET, PBUF_RAM);
pehrhovey	0:a548a085de55	1060	/* could allocate a pbuf for an ARP request? */
pehrhovey	0:a548a085de55	1061	if (p == NULL) {
pehrhovey	0:a548a085de55	1062	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE \| 2, ("etharp_raw: could not allocate pbuf for ARP request.\n"));
pehrhovey	0:a548a085de55	1063	ETHARP_STATS_INC(etharp.memerr);
pehrhovey	0:a548a085de55	1064	return ERR_MEM;
pehrhovey	0:a548a085de55	1065	}
pehrhovey	0:a548a085de55	1066	LWIP_ASSERT("check that first pbuf can hold struct etharp_hdr",
pehrhovey	0:a548a085de55	1067	(p->len >= SIZEOF_ETHARP_PACKET));
pehrhovey	0:a548a085de55	1068
pehrhovey	0:a548a085de55	1069	ethhdr = (struct eth_hdr *)p->payload;
pehrhovey	0:a548a085de55	1070	hdr = (struct etharp_hdr )((u8_t)ethhdr + SIZEOF_ETH_HDR);
pehrhovey	0:a548a085de55	1071	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_raw: sending raw ARP packet.\n"));
pehrhovey	0:a548a085de55	1072	hdr->opcode = htons(opcode);
pehrhovey	0:a548a085de55	1073
pehrhovey	0:a548a085de55	1074	LWIP_ASSERT("netif->hwaddr_len must be the same as ETHARP_HWADDR_LEN for etharp!",
pehrhovey	0:a548a085de55	1075	(netif->hwaddr_len == ETHARP_HWADDR_LEN));
pehrhovey	0:a548a085de55	1076	k = ETHARP_HWADDR_LEN;
pehrhovey	0:a548a085de55	1077	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	1078	/* If we are using Link-Local, ARP packets must be broadcast on the
pehrhovey	0:a548a085de55	1079	* link layer. (See RFC3927 Section 2.5) */
pehrhovey	0:a548a085de55	1080	ethdst_hwaddr = ((netif->autoip != NULL) && (netif->autoip->state != AUTOIP_STATE_OFF)) ? (u8_t*)(ethbroadcast.addr) : ethdst_addr->addr;
pehrhovey	0:a548a085de55	1081	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	1082	/* Write MAC-Addresses (combined loop for both headers) */
pehrhovey	0:a548a085de55	1083	while(k > 0) {
pehrhovey	0:a548a085de55	1084	k--;
pehrhovey	0:a548a085de55	1085	/* Write the ARP MAC-Addresses */
pehrhovey	0:a548a085de55	1086	hdr->shwaddr.addr[k] = hwsrc_addr->addr[k];
pehrhovey	0:a548a085de55	1087	hdr->dhwaddr.addr[k] = hwdst_addr->addr[k];
pehrhovey	0:a548a085de55	1088	/* Write the Ethernet MAC-Addresses */
pehrhovey	0:a548a085de55	1089	#if LWIP_AUTOIP
pehrhovey	0:a548a085de55	1090	ethhdr->dest.addr[k] = ethdst_hwaddr[k];
pehrhovey	0:a548a085de55	1091	#else /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	1092	ethhdr->dest.addr[k] = ethdst_addr->addr[k];
pehrhovey	0:a548a085de55	1093	#endif /* LWIP_AUTOIP */
pehrhovey	0:a548a085de55	1094	ethhdr->src.addr[k] = ethsrc_addr->addr[k];
pehrhovey	0:a548a085de55	1095	}
pehrhovey	0:a548a085de55	1096	hdr->sipaddr = (struct ip_addr2 )ipsrc_addr;
pehrhovey	0:a548a085de55	1097	hdr->dipaddr = (struct ip_addr2 )ipdst_addr;
pehrhovey	0:a548a085de55	1098
pehrhovey	0:a548a085de55	1099	hdr->hwtype = htons(HWTYPE_ETHERNET);
pehrhovey	0:a548a085de55	1100	hdr->proto = htons(ETHTYPE_IP);
pehrhovey	0:a548a085de55	1101	/* set hwlen and protolen together */
pehrhovey	0:a548a085de55	1102	hdr->_hwlen_protolen = htons((ETHARP_HWADDR_LEN << 8) \| sizeof(struct ip_addr));
pehrhovey	0:a548a085de55	1103
pehrhovey	0:a548a085de55	1104	ethhdr->type = htons(ETHTYPE_ARP);
pehrhovey	0:a548a085de55	1105	/* send ARP query */
pehrhovey	0:a548a085de55	1106	result = netif->linkoutput(netif, p);
pehrhovey	0:a548a085de55	1107	ETHARP_STATS_INC(etharp.xmit);
pehrhovey	0:a548a085de55	1108	/* free ARP query packet */
pehrhovey	0:a548a085de55	1109	pbuf_free(p);
pehrhovey	0:a548a085de55	1110	p = NULL;
pehrhovey	0:a548a085de55	1111	/* could not allocate pbuf for ARP request */
pehrhovey	0:a548a085de55	1112
pehrhovey	0:a548a085de55	1113	return result;
pehrhovey	0:a548a085de55	1114	}
pehrhovey	0:a548a085de55	1115
pehrhovey	0:a548a085de55	1116	/**
pehrhovey	0:a548a085de55	1117	* Send an ARP request packet asking for ipaddr.
pehrhovey	0:a548a085de55	1118	*
pehrhovey	0:a548a085de55	1119	* @param netif the lwip network interface on which to send the request
pehrhovey	0:a548a085de55	1120	* @param ipaddr the IP address for which to ask
pehrhovey	0:a548a085de55	1121	* @return ERR_OK if the request has been sent
pehrhovey	0:a548a085de55	1122	* ERR_MEM if the ARP packet couldn't be allocated
pehrhovey	0:a548a085de55	1123	* any other err_t on failure
pehrhovey	0:a548a085de55	1124	*/
pehrhovey	0:a548a085de55	1125	err_t
pehrhovey	0:a548a085de55	1126	etharp_request(struct netif netif, struct ip_addr ipaddr)
pehrhovey	0:a548a085de55	1127	{
pehrhovey	0:a548a085de55	1128	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE, ("etharp_request: sending ARP request.\n"));
pehrhovey	0:a548a085de55	1129	return etharp_raw(netif, (struct eth_addr *)netif->hwaddr, &ethbroadcast,
pehrhovey	0:a548a085de55	1130	(struct eth_addr *)netif->hwaddr, &netif->ip_addr, &ethzero,
pehrhovey	0:a548a085de55	1131	ipaddr, ARP_REQUEST);
pehrhovey	0:a548a085de55	1132	}
pehrhovey	0:a548a085de55	1133
pehrhovey	0:a548a085de55	1134	/**
pehrhovey	0:a548a085de55	1135	* Process received ethernet frames. Using this function instead of directly
pehrhovey	0:a548a085de55	1136	* calling ip_input and passing ARP frames through etharp in ethernetif_input,
pehrhovey	0:a548a085de55	1137	* the ARP cache is protected from concurrent access.
pehrhovey	0:a548a085de55	1138	*
pehrhovey	0:a548a085de55	1139	* @param p the recevied packet, p->payload pointing to the ethernet header
pehrhovey	0:a548a085de55	1140	* @param netif the network interface on which the packet was received
pehrhovey	0:a548a085de55	1141	*/
pehrhovey	0:a548a085de55	1142	err_t
pehrhovey	0:a548a085de55	1143	ethernet_input(struct pbuf p, struct netif netif)
pehrhovey	0:a548a085de55	1144	{
pehrhovey	0:a548a085de55	1145	struct eth_hdr* ethhdr;
pehrhovey	0:a548a085de55	1146	u16_t type;
pehrhovey	0:a548a085de55	1147
pehrhovey	0:a548a085de55	1148	/* points to packet payload, which starts with an Ethernet header */
pehrhovey	0:a548a085de55	1149	ethhdr = (struct eth_hdr *)p->payload;
pehrhovey	0:a548a085de55	1150	LWIP_DEBUGF(ETHARP_DEBUG \| LWIP_DBG_TRACE,
pehrhovey	0:a548a085de55	1151	("ethernet_input: dest:%02x:%02x:%02x:%02x:%02x:%02x, src:%02x:%02x:%02x:%02x:%02x:%02x, type:%2hx\n",
pehrhovey	0:a548a085de55	1152	(unsigned)ethhdr->dest.addr[0], (unsigned)ethhdr->dest.addr[1], (unsigned)ethhdr->dest.addr[2],
pehrhovey	0:a548a085de55	1153	(unsigned)ethhdr->dest.addr[3], (unsigned)ethhdr->dest.addr[4], (unsigned)ethhdr->dest.addr[5],
pehrhovey	0:a548a085de55	1154	(unsigned)ethhdr->src.addr[0], (unsigned)ethhdr->src.addr[1], (unsigned)ethhdr->src.addr[2],
pehrhovey	0:a548a085de55	1155	(unsigned)ethhdr->src.addr[3], (unsigned)ethhdr->src.addr[4], (unsigned)ethhdr->src.addr[5],
pehrhovey	0:a548a085de55	1156	(unsigned)htons(ethhdr->type)));
pehrhovey	0:a548a085de55	1157
pehrhovey	0:a548a085de55	1158	type = htons(ethhdr->type);
pehrhovey	0:a548a085de55	1159	#if ETHARP_SUPPORT_VLAN
pehrhovey	0:a548a085de55	1160	if (type == ETHTYPE_VLAN) {
pehrhovey	0:a548a085de55	1161	struct eth_vlan_hdr vlan = (struct eth_vlan_hdr)(((char*)ethhdr) + SIZEOF_ETH_HDR);
pehrhovey	0:a548a085de55	1162	#ifdef ETHARP_VLAN_CHECK /* if not, allow all VLANs */
pehrhovey	0:a548a085de55	1163	if (VLAN_ID(vlan) != ETHARP_VLAN_CHECK) {
pehrhovey	0:a548a085de55	1164	/* silently ignore this packet: not for our VLAN */
pehrhovey	0:a548a085de55	1165	pbuf_free(p);
pehrhovey	0:a548a085de55	1166	return ERR_OK;
pehrhovey	0:a548a085de55	1167	}
pehrhovey	0:a548a085de55	1168	#endif /* ETHARP_VLAN_CHECK */
pehrhovey	0:a548a085de55	1169	type = htons(vlan->tpid);
pehrhovey	0:a548a085de55	1170	}
pehrhovey	0:a548a085de55	1171	#endif /* ETHARP_SUPPORT_VLAN */
pehrhovey	0:a548a085de55	1172
pehrhovey	0:a548a085de55	1173	switch (type) {
pehrhovey	0:a548a085de55	1174	/* IP packet? */
pehrhovey	0:a548a085de55	1175	case ETHTYPE_IP:
pehrhovey	0:a548a085de55	1176	#if ETHARP_TRUST_IP_MAC
pehrhovey	0:a548a085de55	1177	/* update ARP table */
pehrhovey	0:a548a085de55	1178	etharp_ip_input(netif, p);
pehrhovey	0:a548a085de55	1179	#endif /* ETHARP_TRUST_IP_MAC */
pehrhovey	0:a548a085de55	1180	/* skip Ethernet header */
pehrhovey	0:a548a085de55	1181	if(pbuf_header(p, -(s16_t)SIZEOF_ETH_HDR)) {
pehrhovey	0:a548a085de55	1182	LWIP_ASSERT("Can't move over header in packet", 0);
pehrhovey	0:a548a085de55	1183	pbuf_free(p);
pehrhovey	0:a548a085de55	1184	p = NULL;
pehrhovey	0:a548a085de55	1185	} else {
pehrhovey	0:a548a085de55	1186	/* pass to IP layer */
pehrhovey	0:a548a085de55	1187	ip_input(p, netif);
pehrhovey	0:a548a085de55	1188	}
pehrhovey	0:a548a085de55	1189	break;
pehrhovey	0:a548a085de55	1190
pehrhovey	0:a548a085de55	1191	case ETHTYPE_ARP:
pehrhovey	0:a548a085de55	1192	/* pass p to ARP module */
pehrhovey	0:a548a085de55	1193	etharp_arp_input(netif, (struct eth_addr*)(netif->hwaddr), p);
pehrhovey	0:a548a085de55	1194	break;
pehrhovey	0:a548a085de55	1195
pehrhovey	0:a548a085de55	1196	#if PPPOE_SUPPORT
pehrhovey	0:a548a085de55	1197	case ETHTYPE_PPPOEDISC: /* PPP Over Ethernet Discovery Stage */
pehrhovey	0:a548a085de55	1198	pppoe_disc_input(netif, p);
pehrhovey	0:a548a085de55	1199	break;
pehrhovey	0:a548a085de55	1200
pehrhovey	0:a548a085de55	1201	case ETHTYPE_PPPOE: /* PPP Over Ethernet Session Stage */
pehrhovey	0:a548a085de55	1202	pppoe_data_input(netif, p);
pehrhovey	0:a548a085de55	1203	break;
pehrhovey	0:a548a085de55	1204	#endif /* PPPOE_SUPPORT */
pehrhovey	0:a548a085de55	1205
pehrhovey	0:a548a085de55	1206	default:
pehrhovey	0:a548a085de55	1207	ETHARP_STATS_INC(etharp.proterr);
pehrhovey	0:a548a085de55	1208	ETHARP_STATS_INC(etharp.drop);
pehrhovey	0:a548a085de55	1209	pbuf_free(p);
pehrhovey	0:a548a085de55	1210	p = NULL;
pehrhovey	0:a548a085de55	1211	break;
pehrhovey	0:a548a085de55	1212	}
pehrhovey	0:a548a085de55	1213
pehrhovey	0:a548a085de55	1214	/* This means the pbuf is freed or consumed,
pehrhovey	0:a548a085de55	1215	so the caller doesn't have to free it again */
pehrhovey	0:a548a085de55	1216	return ERR_OK;
pehrhovey	0:a548a085de55	1217	}
pehrhovey	0:a548a085de55	1218	#endif /* LWIP_ARP */

Repository toolbox

Export to desktop IDE

Build repository

Repository details

Type:	Program
Mbed OS support:	Mbed 2 deprecated
Created:	14 Mar 2010
Imports:	240
Forks:	0
Commits:	1
Dependents:	0
Dependencies:	1
Followers:	5

Core/lwIP/netif/etharp.c@0:a548a085de55, 2010-03-14 (annotated)

Who changed what in which revision?

Repository toolbox

Repository details

Important Information for this Arm website

Access Warning