mirror of
https://github.com/ipxe/ipxe
synced 2025-12-15 09:04:37 +03:00
[arp] Maintain an ARP transmission queue
Allow packet transmission to be deferred pending successful ARP resolution. This avoids the time spent waiting for a higher-level protocol (e.g. TCP or TFTP) to attempt retransmission. Signed-off-by: Michael Brown <mcb30@ipxe.org>
This commit is contained in:
@@ -35,10 +35,8 @@ struct arp_net_protocol {
|
|||||||
|
|
||||||
extern struct net_protocol arp_protocol __net_protocol;
|
extern struct net_protocol arp_protocol __net_protocol;
|
||||||
|
|
||||||
extern int arp_resolve ( struct net_device *netdev,
|
extern int arp_tx ( struct io_buffer *iobuf, struct net_device *netdev,
|
||||||
struct net_protocol *net_protocol,
|
struct net_protocol *net_protocol, const void *net_dest,
|
||||||
const void *dest_net_addr,
|
const void *net_source, const void *ll_source );
|
||||||
const void *source_net_addr,
|
|
||||||
void *dest_ll_addr );
|
|
||||||
|
|
||||||
#endif /* _IPXE_ARP_H */
|
#endif /* _IPXE_ARP_H */
|
||||||
|
|||||||
422
src/net/arp.c
422
src/net/arp.c
@@ -19,6 +19,7 @@
|
|||||||
FILE_LICENCE ( GPL2_OR_LATER );
|
FILE_LICENCE ( GPL2_OR_LATER );
|
||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
|
#include <stdlib.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <byteswap.h>
|
#include <byteswap.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
@@ -26,6 +27,10 @@ FILE_LICENCE ( GPL2_OR_LATER );
|
|||||||
#include <ipxe/if_arp.h>
|
#include <ipxe/if_arp.h>
|
||||||
#include <ipxe/iobuf.h>
|
#include <ipxe/iobuf.h>
|
||||||
#include <ipxe/netdevice.h>
|
#include <ipxe/netdevice.h>
|
||||||
|
#include <ipxe/list.h>
|
||||||
|
#include <ipxe/retry.h>
|
||||||
|
#include <ipxe/timer.h>
|
||||||
|
#include <ipxe/malloc.h>
|
||||||
#include <ipxe/arp.h>
|
#include <ipxe/arp.h>
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
@@ -38,104 +43,263 @@ FILE_LICENCE ( GPL2_OR_LATER );
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
/** ARP minimum timeout */
|
||||||
|
#define ARP_MIN_TIMEOUT ( TICKS_PER_SEC / 8 )
|
||||||
|
|
||||||
|
/** ARP maximum timeout */
|
||||||
|
#define ARP_MAX_TIMEOUT ( TICKS_PER_SEC * 3 )
|
||||||
|
|
||||||
/** An ARP cache entry */
|
/** An ARP cache entry */
|
||||||
struct arp_entry {
|
struct arp_entry {
|
||||||
|
/** List of ARP cache entries */
|
||||||
|
struct list_head list;
|
||||||
|
/** Network device */
|
||||||
|
struct net_device *netdev;
|
||||||
/** Network-layer protocol */
|
/** Network-layer protocol */
|
||||||
struct net_protocol *net_protocol;
|
struct net_protocol *net_protocol;
|
||||||
/** Link-layer protocol */
|
/** Network-layer destination address */
|
||||||
struct ll_protocol *ll_protocol;
|
uint8_t net_dest[MAX_NET_ADDR_LEN];
|
||||||
/** Network-layer address */
|
/** Network-layer source address */
|
||||||
uint8_t net_addr[MAX_NET_ADDR_LEN];
|
uint8_t net_source[MAX_NET_ADDR_LEN];
|
||||||
/** Link-layer address */
|
/** Link-layer destination address */
|
||||||
uint8_t ll_addr[MAX_LL_ADDR_LEN];
|
uint8_t ll_dest[MAX_LL_ADDR_LEN];
|
||||||
|
/** Retransmission timer */
|
||||||
|
struct retry_timer timer;
|
||||||
|
/** Pending I/O buffers */
|
||||||
|
struct list_head tx_queue;
|
||||||
};
|
};
|
||||||
|
|
||||||
/** Number of entries in the ARP cache
|
|
||||||
*
|
|
||||||
* This is a global cache, covering all network interfaces,
|
|
||||||
* network-layer protocols and link-layer protocols.
|
|
||||||
*/
|
|
||||||
#define NUM_ARP_ENTRIES 4
|
|
||||||
|
|
||||||
/** The ARP cache */
|
/** The ARP cache */
|
||||||
static struct arp_entry arp_table[NUM_ARP_ENTRIES];
|
static LIST_HEAD ( arp_entries );
|
||||||
#define arp_table_end &arp_table[NUM_ARP_ENTRIES]
|
|
||||||
|
|
||||||
static unsigned int next_new_arp_entry = 0;
|
|
||||||
|
|
||||||
struct net_protocol arp_protocol __net_protocol;
|
struct net_protocol arp_protocol __net_protocol;
|
||||||
|
|
||||||
|
static void arp_expired ( struct retry_timer *timer, int over );
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Create ARP cache entry
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
* @v net_protocol Network-layer protocol
|
||||||
|
* @v net_dest Destination network-layer address
|
||||||
|
* @v net_source Source network-layer address
|
||||||
|
* @ret arp ARP cache entry, or NULL if allocation failed
|
||||||
|
*/
|
||||||
|
static struct arp_entry * arp_create ( struct net_device *netdev,
|
||||||
|
struct net_protocol *net_protocol,
|
||||||
|
const void *net_dest,
|
||||||
|
const void *net_source ) {
|
||||||
|
struct arp_entry *arp;
|
||||||
|
|
||||||
|
/* Allocate entry and add to cache */
|
||||||
|
arp = zalloc ( sizeof ( *arp ) );
|
||||||
|
if ( ! arp )
|
||||||
|
return NULL;
|
||||||
|
|
||||||
|
/* Initialise entry and add to cache */
|
||||||
|
arp->netdev = netdev_get ( netdev );
|
||||||
|
arp->net_protocol = net_protocol;
|
||||||
|
memcpy ( arp->net_dest, net_dest,
|
||||||
|
net_protocol->net_addr_len );
|
||||||
|
memcpy ( arp->net_source, net_source,
|
||||||
|
net_protocol->net_addr_len );
|
||||||
|
timer_init ( &arp->timer, arp_expired, NULL );
|
||||||
|
arp->timer.min_timeout = ARP_MIN_TIMEOUT;
|
||||||
|
arp->timer.max_timeout = ARP_MAX_TIMEOUT;
|
||||||
|
INIT_LIST_HEAD ( &arp->tx_queue );
|
||||||
|
list_add ( &arp->list, &arp_entries );
|
||||||
|
|
||||||
|
/* Start timer running to trigger initial transmission */
|
||||||
|
start_timer_nodelay ( &arp->timer );
|
||||||
|
|
||||||
|
DBGC ( arp, "ARP %p %s %s %s created\n", arp, netdev->name,
|
||||||
|
net_protocol->name, net_protocol->ntoa ( net_dest ) );
|
||||||
|
return arp;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Find entry in the ARP cache
|
* Find entry in the ARP cache
|
||||||
*
|
*
|
||||||
* @v ll_protocol Link-layer protocol
|
* @v netdev Network device
|
||||||
* @v net_protocol Network-layer protocol
|
* @v net_protocol Network-layer protocol
|
||||||
* @v net_addr Network-layer address
|
* @v net_dest Destination network-layer address
|
||||||
* @ret arp ARP cache entry, or NULL if not found
|
* @ret arp ARP cache entry, or NULL if not found
|
||||||
*
|
|
||||||
*/
|
*/
|
||||||
static struct arp_entry *
|
static struct arp_entry * arp_find ( struct net_device *netdev,
|
||||||
arp_find_entry ( struct ll_protocol *ll_protocol,
|
|
||||||
struct net_protocol *net_protocol,
|
struct net_protocol *net_protocol,
|
||||||
const void *net_addr ) {
|
const void *net_dest ) {
|
||||||
struct arp_entry *arp;
|
struct arp_entry *arp;
|
||||||
|
|
||||||
for ( arp = arp_table ; arp < arp_table_end ; arp++ ) {
|
list_for_each_entry ( arp, &arp_entries, list ) {
|
||||||
if ( ( arp->ll_protocol == ll_protocol ) &&
|
if ( ( arp->netdev == netdev ) &&
|
||||||
( arp->net_protocol == net_protocol ) &&
|
( arp->net_protocol == net_protocol ) &&
|
||||||
( memcmp ( arp->net_addr, net_addr,
|
( memcmp ( arp->net_dest, net_dest,
|
||||||
net_protocol->net_addr_len ) == 0 ) )
|
net_protocol->net_addr_len ) == 0 ) ) {
|
||||||
|
|
||||||
|
/* Move to start of cache */
|
||||||
|
list_del ( &arp->list );
|
||||||
|
list_add ( &arp->list, &arp_entries );
|
||||||
|
|
||||||
return arp;
|
return arp;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
return NULL;
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Look up media-specific link-layer address in the ARP cache
|
* Destroy ARP cache entry
|
||||||
*
|
*
|
||||||
|
* @v arp ARP cache entry
|
||||||
|
* @v rc Reason for destruction
|
||||||
|
*/
|
||||||
|
static void arp_destroy ( struct arp_entry *arp, int rc ) {
|
||||||
|
struct net_device *netdev = arp->netdev;
|
||||||
|
struct net_protocol *net_protocol = arp->net_protocol;
|
||||||
|
struct io_buffer *iobuf;
|
||||||
|
struct io_buffer *tmp;
|
||||||
|
|
||||||
|
/* Stop timer */
|
||||||
|
stop_timer ( &arp->timer );
|
||||||
|
|
||||||
|
/* Discard any outstanding I/O buffers */
|
||||||
|
list_for_each_entry_safe ( iobuf, tmp, &arp->tx_queue, list ) {
|
||||||
|
DBGC2 ( arp, "ARP %p %s %s %s discarding deferred packet: "
|
||||||
|
"%s\n", arp, netdev->name, net_protocol->name,
|
||||||
|
net_protocol->ntoa ( arp->net_dest ), strerror ( rc ) );
|
||||||
|
list_del ( &iobuf->list );
|
||||||
|
netdev_tx_err ( arp->netdev, iobuf, rc );
|
||||||
|
}
|
||||||
|
|
||||||
|
DBGC ( arp, "ARP %p %s %s %s destroyed: %s\n", arp, netdev->name,
|
||||||
|
net_protocol->name, net_protocol->ntoa ( arp->net_dest ),
|
||||||
|
strerror ( rc ) );
|
||||||
|
|
||||||
|
/* Drop reference to network device, remove from cache and free */
|
||||||
|
netdev_put ( arp->netdev );
|
||||||
|
list_del ( &arp->list );
|
||||||
|
free ( arp );
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Test if ARP cache entry has a valid link-layer address
|
||||||
|
*
|
||||||
|
* @v arp ARP cache entry
|
||||||
|
* @ret resolved ARP cache entry is resolved
|
||||||
|
*/
|
||||||
|
static inline int arp_resolved ( struct arp_entry *arp ) {
|
||||||
|
return ( ! timer_running ( &arp->timer ) );
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Transmit packet, determining link-layer address via ARP
|
||||||
|
*
|
||||||
|
* @v iobuf I/O buffer
|
||||||
* @v netdev Network device
|
* @v netdev Network device
|
||||||
* @v net_protocol Network-layer protocol
|
* @v net_protocol Network-layer protocol
|
||||||
* @v dest_net_addr Destination network-layer address
|
* @v net_dest Destination network-layer address
|
||||||
* @v source_net_addr Source network-layer address
|
* @v net_source Source network-layer address
|
||||||
* @ret dest_ll_addr Destination link layer address
|
* @v ll_source Source link-layer address
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
|
||||||
* This function will use the ARP cache to look up the link-layer
|
|
||||||
* address for the link-layer protocol associated with the network
|
|
||||||
* device and the given network-layer protocol and addresses. If
|
|
||||||
* found, the destination link-layer address will be filled in in @c
|
|
||||||
* dest_ll_addr.
|
|
||||||
*
|
|
||||||
* If no address is found in the ARP cache, an ARP request will be
|
|
||||||
* transmitted on the specified network device and -ENOENT will be
|
|
||||||
* returned.
|
|
||||||
*/
|
*/
|
||||||
int arp_resolve ( struct net_device *netdev, struct net_protocol *net_protocol,
|
int arp_tx ( struct io_buffer *iobuf, struct net_device *netdev,
|
||||||
const void *dest_net_addr, const void *source_net_addr,
|
struct net_protocol *net_protocol, const void *net_dest,
|
||||||
void *dest_ll_addr ) {
|
const void *net_source, const void *ll_source ) {
|
||||||
|
struct arp_entry *arp;
|
||||||
|
|
||||||
|
/* Find or create ARP cache entry */
|
||||||
|
arp = arp_find ( netdev, net_protocol, net_dest );
|
||||||
|
if ( ! arp ) {
|
||||||
|
arp = arp_create ( netdev, net_protocol, net_dest,
|
||||||
|
net_source );
|
||||||
|
if ( ! arp )
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* If a link-layer address is available then transmit
|
||||||
|
* immediately, otherwise queue for later transmission.
|
||||||
|
*/
|
||||||
|
if ( arp_resolved ( arp ) ) {
|
||||||
|
return net_tx ( iobuf, netdev, net_protocol, arp->ll_dest,
|
||||||
|
ll_source );
|
||||||
|
} else {
|
||||||
|
DBGC2 ( arp, "ARP %p %s %s %s deferring packet\n",
|
||||||
|
arp, netdev->name, net_protocol->name,
|
||||||
|
net_protocol->ntoa ( net_dest ) );
|
||||||
|
list_add_tail ( &iobuf->list, &arp->tx_queue );
|
||||||
|
return -EAGAIN;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Update ARP cache entry
|
||||||
|
*
|
||||||
|
* @v arp ARP cache entry
|
||||||
|
* @v ll_dest Destination link-layer address
|
||||||
|
*/
|
||||||
|
static void arp_update ( struct arp_entry *arp, const void *ll_dest ) {
|
||||||
|
struct net_device *netdev = arp->netdev;
|
||||||
struct ll_protocol *ll_protocol = netdev->ll_protocol;
|
struct ll_protocol *ll_protocol = netdev->ll_protocol;
|
||||||
const struct arp_entry *arp;
|
struct net_protocol *net_protocol = arp->net_protocol;
|
||||||
|
struct io_buffer *iobuf;
|
||||||
|
struct io_buffer *tmp;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
DBGC ( arp, "ARP %p %s %s %s updated => %s\n", arp, netdev->name,
|
||||||
|
net_protocol->name, net_protocol->ntoa ( arp->net_dest ),
|
||||||
|
ll_protocol->ntoa ( ll_dest ) );
|
||||||
|
|
||||||
|
/* Fill in link-layer address */
|
||||||
|
memcpy ( arp->ll_dest, ll_dest, ll_protocol->ll_addr_len );
|
||||||
|
|
||||||
|
/* Stop retransmission timer */
|
||||||
|
stop_timer ( &arp->timer );
|
||||||
|
|
||||||
|
/* Transmit any packets in queue */
|
||||||
|
list_for_each_entry_safe ( iobuf, tmp, &arp->tx_queue, list ) {
|
||||||
|
DBGC2 ( arp, "ARP %p %s %s %s transmitting deferred packet\n",
|
||||||
|
arp, netdev->name, net_protocol->name,
|
||||||
|
net_protocol->ntoa ( arp->net_dest ) );
|
||||||
|
list_del ( &iobuf->list );
|
||||||
|
if ( ( rc = net_tx ( iobuf, netdev, net_protocol, ll_dest,
|
||||||
|
netdev->ll_addr ) ) != 0 ) {
|
||||||
|
DBGC ( arp, "ARP %p could not transmit deferred "
|
||||||
|
"packet: %s\n", arp, strerror ( rc ) );
|
||||||
|
/* Ignore error and continue */
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Handle ARP timer expiry
|
||||||
|
*
|
||||||
|
* @v timer Retry timer
|
||||||
|
* @v fail Failure indicator
|
||||||
|
*/
|
||||||
|
static void arp_expired ( struct retry_timer *timer, int fail ) {
|
||||||
|
struct arp_entry *arp = container_of ( timer, struct arp_entry, timer );
|
||||||
|
struct net_device *netdev = arp->netdev;
|
||||||
|
struct ll_protocol *ll_protocol = netdev->ll_protocol;
|
||||||
|
struct net_protocol *net_protocol = arp->net_protocol;
|
||||||
struct io_buffer *iobuf;
|
struct io_buffer *iobuf;
|
||||||
struct arphdr *arphdr;
|
struct arphdr *arphdr;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
/* Look for existing entry in ARP table */
|
/* If we have failed, destroy the cache entry */
|
||||||
arp = arp_find_entry ( ll_protocol, net_protocol, dest_net_addr );
|
if ( fail ) {
|
||||||
if ( arp ) {
|
arp_destroy ( arp, -ETIMEDOUT );
|
||||||
DBG ( "ARP cache hit: %s %s => %s %s\n",
|
return;
|
||||||
net_protocol->name, net_protocol->ntoa ( arp->net_addr ),
|
|
||||||
ll_protocol->name, ll_protocol->ntoa ( arp->ll_addr ) );
|
|
||||||
memcpy ( dest_ll_addr, arp->ll_addr, ll_protocol->ll_addr_len);
|
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
DBG ( "ARP cache miss: %s %s\n", net_protocol->name,
|
|
||||||
net_protocol->ntoa ( dest_net_addr ) );
|
/* Restart the timer */
|
||||||
|
start_timer ( &arp->timer );
|
||||||
|
|
||||||
/* Allocate ARP packet */
|
/* Allocate ARP packet */
|
||||||
iobuf = alloc_iob ( MAX_LL_HEADER_LEN + sizeof ( *arphdr ) +
|
iobuf = alloc_iob ( MAX_LL_HEADER_LEN + sizeof ( *arphdr ) +
|
||||||
2 * ( MAX_LL_ADDR_LEN + MAX_NET_ADDR_LEN ) );
|
( 2 * ( MAX_LL_ADDR_LEN + MAX_NET_ADDR_LEN ) ) );
|
||||||
if ( ! iobuf )
|
if ( ! iobuf ) {
|
||||||
return -ENOMEM;
|
/* Leave timer running and try again later */
|
||||||
|
return;
|
||||||
|
}
|
||||||
iob_reserve ( iobuf, MAX_LL_HEADER_LEN );
|
iob_reserve ( iobuf, MAX_LL_HEADER_LEN );
|
||||||
|
|
||||||
/* Build up ARP request */
|
/* Build up ARP request */
|
||||||
@@ -148,18 +312,19 @@ int arp_resolve ( struct net_device *netdev, struct net_protocol *net_protocol,
|
|||||||
memcpy ( iob_put ( iobuf, ll_protocol->ll_addr_len ),
|
memcpy ( iob_put ( iobuf, ll_protocol->ll_addr_len ),
|
||||||
netdev->ll_addr, ll_protocol->ll_addr_len );
|
netdev->ll_addr, ll_protocol->ll_addr_len );
|
||||||
memcpy ( iob_put ( iobuf, net_protocol->net_addr_len ),
|
memcpy ( iob_put ( iobuf, net_protocol->net_addr_len ),
|
||||||
source_net_addr, net_protocol->net_addr_len );
|
arp->net_source, net_protocol->net_addr_len );
|
||||||
memset ( iob_put ( iobuf, ll_protocol->ll_addr_len ),
|
memset ( iob_put ( iobuf, ll_protocol->ll_addr_len ),
|
||||||
0, ll_protocol->ll_addr_len );
|
0, ll_protocol->ll_addr_len );
|
||||||
memcpy ( iob_put ( iobuf, net_protocol->net_addr_len ),
|
memcpy ( iob_put ( iobuf, net_protocol->net_addr_len ),
|
||||||
dest_net_addr, net_protocol->net_addr_len );
|
arp->net_dest, net_protocol->net_addr_len );
|
||||||
|
|
||||||
/* Transmit ARP request */
|
/* Transmit ARP request */
|
||||||
if ( ( rc = net_tx ( iobuf, netdev, &arp_protocol,
|
if ( ( rc = net_tx ( iobuf, netdev, &arp_protocol,
|
||||||
netdev->ll_broadcast, netdev->ll_addr ) ) != 0 )
|
netdev->ll_broadcast, netdev->ll_addr ) ) != 0 ) {
|
||||||
return rc;
|
DBGC ( arp, "ARP %p could not transmit request: %s\n",
|
||||||
|
arp, strerror ( rc ) );
|
||||||
return -ENOENT;
|
return;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@@ -188,12 +353,6 @@ static struct arp_net_protocol * arp_find_protocol ( uint16_t net_proto ) {
|
|||||||
* @v ll_source Link-layer source address
|
* @v ll_source Link-layer source address
|
||||||
* @v flags Packet flags
|
* @v flags Packet flags
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
|
||||||
* This handles ARP requests and responses as detailed in RFC826. The
|
|
||||||
* method detailed within the RFC is pretty optimised, handling
|
|
||||||
* requests and responses with basically a single code path and
|
|
||||||
* avoiding the need for extraneous ARP requests; read the RFC for
|
|
||||||
* details.
|
|
||||||
*/
|
*/
|
||||||
static int arp_rx ( struct io_buffer *iobuf, struct net_device *netdev,
|
static int arp_rx ( struct io_buffer *iobuf, struct net_device *netdev,
|
||||||
const void *ll_dest __unused,
|
const void *ll_dest __unused,
|
||||||
@@ -204,57 +363,46 @@ static int arp_rx ( struct io_buffer *iobuf, struct net_device *netdev,
|
|||||||
struct net_protocol *net_protocol;
|
struct net_protocol *net_protocol;
|
||||||
struct ll_protocol *ll_protocol;
|
struct ll_protocol *ll_protocol;
|
||||||
struct arp_entry *arp;
|
struct arp_entry *arp;
|
||||||
int merge = 0;
|
int rc;
|
||||||
|
|
||||||
/* Identify network-layer and link-layer protocols */
|
/* Identify network-layer and link-layer protocols */
|
||||||
arp_net_protocol = arp_find_protocol ( arphdr->ar_pro );
|
arp_net_protocol = arp_find_protocol ( arphdr->ar_pro );
|
||||||
if ( ! arp_net_protocol )
|
if ( ! arp_net_protocol ) {
|
||||||
|
rc = -EPROTONOSUPPORT;
|
||||||
goto done;
|
goto done;
|
||||||
|
}
|
||||||
net_protocol = arp_net_protocol->net_protocol;
|
net_protocol = arp_net_protocol->net_protocol;
|
||||||
ll_protocol = netdev->ll_protocol;
|
ll_protocol = netdev->ll_protocol;
|
||||||
|
|
||||||
/* Sanity checks */
|
/* Sanity checks */
|
||||||
if ( ( arphdr->ar_hrd != ll_protocol->ll_proto ) ||
|
if ( ( arphdr->ar_hrd != ll_protocol->ll_proto ) ||
|
||||||
( arphdr->ar_hln != ll_protocol->ll_addr_len ) ||
|
( arphdr->ar_hln != ll_protocol->ll_addr_len ) ||
|
||||||
( arphdr->ar_pln != net_protocol->net_addr_len ) )
|
( arphdr->ar_pln != net_protocol->net_addr_len ) ) {
|
||||||
|
rc = -EINVAL;
|
||||||
goto done;
|
goto done;
|
||||||
|
|
||||||
/* See if we have an entry for this sender, and update it if so */
|
|
||||||
arp = arp_find_entry ( ll_protocol, net_protocol,
|
|
||||||
arp_sender_pa ( arphdr ) );
|
|
||||||
if ( arp ) {
|
|
||||||
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
|
||||||
arphdr->ar_hln );
|
|
||||||
merge = 1;
|
|
||||||
DBG ( "ARP cache update: %s %s => %s %s\n",
|
|
||||||
net_protocol->name, net_protocol->ntoa ( arp->net_addr ),
|
|
||||||
ll_protocol->name, ll_protocol->ntoa ( arp->ll_addr ) );
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* See if we own the target protocol address */
|
/* See if we have an entry for this sender, and update it if so */
|
||||||
if ( arp_net_protocol->check ( netdev, arp_target_pa ( arphdr ) ) != 0)
|
arp = arp_find ( netdev, net_protocol, arp_sender_pa ( arphdr ) );
|
||||||
goto done;
|
if ( arp ) {
|
||||||
|
arp_update ( arp, arp_sender_ha ( arphdr ) );
|
||||||
/* Create new ARP table entry if necessary */
|
|
||||||
if ( ! merge ) {
|
|
||||||
arp = &arp_table[next_new_arp_entry++ % NUM_ARP_ENTRIES];
|
|
||||||
arp->ll_protocol = ll_protocol;
|
|
||||||
arp->net_protocol = net_protocol;
|
|
||||||
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
|
||||||
arphdr->ar_hln );
|
|
||||||
memcpy ( arp->net_addr, arp_sender_pa ( arphdr ),
|
|
||||||
arphdr->ar_pln);
|
|
||||||
DBG ( "ARP cache add: %s %s => %s %s\n",
|
|
||||||
net_protocol->name, net_protocol->ntoa ( arp->net_addr ),
|
|
||||||
ll_protocol->name, ll_protocol->ntoa ( arp->ll_addr ) );
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/* If it's not a request, there's nothing more to do */
|
/* If it's not a request, there's nothing more to do */
|
||||||
if ( arphdr->ar_op != htons ( ARPOP_REQUEST ) )
|
if ( arphdr->ar_op != htons ( ARPOP_REQUEST ) ) {
|
||||||
|
rc = 0;
|
||||||
goto done;
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* See if we own the target protocol address */
|
||||||
|
if ( arp_net_protocol->check ( netdev, arp_target_pa ( arphdr ) ) != 0){
|
||||||
|
rc = 0;
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
/* Change request to a reply */
|
/* Change request to a reply */
|
||||||
DBG ( "ARP reply: %s %s => %s %s\n", net_protocol->name,
|
DBGC ( netdev, "ARP reply %s %s %s => %s %s\n",
|
||||||
|
netdev->name, net_protocol->name,
|
||||||
net_protocol->ntoa ( arp_target_pa ( arphdr ) ),
|
net_protocol->ntoa ( arp_target_pa ( arphdr ) ),
|
||||||
ll_protocol->name, ll_protocol->ntoa ( netdev->ll_addr ) );
|
ll_protocol->name, ll_protocol->ntoa ( netdev->ll_addr ) );
|
||||||
arphdr->ar_op = htons ( ARPOP_REPLY );
|
arphdr->ar_op = htons ( ARPOP_REPLY );
|
||||||
@@ -263,12 +411,20 @@ static int arp_rx ( struct io_buffer *iobuf, struct net_device *netdev,
|
|||||||
memcpy ( arp_sender_ha ( arphdr ), netdev->ll_addr, arphdr->ar_hln );
|
memcpy ( arp_sender_ha ( arphdr ), netdev->ll_addr, arphdr->ar_hln );
|
||||||
|
|
||||||
/* Send reply */
|
/* Send reply */
|
||||||
net_tx ( iob_disown ( iobuf ), netdev, &arp_protocol,
|
if ( ( rc = net_tx ( iob_disown ( iobuf ), netdev, &arp_protocol,
|
||||||
arp_target_ha ( arphdr ), netdev->ll_addr );
|
arp_target_ha ( arphdr ),
|
||||||
|
netdev->ll_addr ) ) != 0 ) {
|
||||||
|
DBGC ( netdev, "ARP could not transmit reply via %s: %s\n",
|
||||||
|
netdev->name, strerror ( rc ) );
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Success */
|
||||||
|
rc = 0;
|
||||||
|
|
||||||
done:
|
done:
|
||||||
free_iob ( iobuf );
|
free_iob ( iobuf );
|
||||||
return 0;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
@@ -290,3 +446,59 @@ struct net_protocol arp_protocol __net_protocol = {
|
|||||||
.rx = arp_rx,
|
.rx = arp_rx,
|
||||||
.ntoa = arp_ntoa,
|
.ntoa = arp_ntoa,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Update ARP cache on network device creation
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
*/
|
||||||
|
static int arp_probe ( struct net_device *netdev __unused ) {
|
||||||
|
/* Nothing to do */
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Update ARP cache on network device state change or removal
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
*/
|
||||||
|
static void arp_flush ( struct net_device *netdev ) {
|
||||||
|
struct arp_entry *arp;
|
||||||
|
struct arp_entry *tmp;
|
||||||
|
|
||||||
|
/* Remove all ARP cache entries when a network device is closed */
|
||||||
|
if ( ! netdev_is_open ( netdev ) ) {
|
||||||
|
list_for_each_entry_safe ( arp, tmp, &arp_entries, list )
|
||||||
|
arp_destroy ( arp, -ENODEV );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/** ARP driver (for net device notifications) */
|
||||||
|
struct net_driver arp_net_driver __net_driver = {
|
||||||
|
.name = "ARP",
|
||||||
|
.probe = arp_probe,
|
||||||
|
.notify = arp_flush,
|
||||||
|
.remove = arp_flush,
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Discard some cached ARP entries
|
||||||
|
*
|
||||||
|
* @ret discarded Number of cached items discarded
|
||||||
|
*/
|
||||||
|
static unsigned int arp_discard ( void ) {
|
||||||
|
struct arp_entry *arp;
|
||||||
|
|
||||||
|
/* Drop oldest cache entry, if any */
|
||||||
|
list_for_each_entry_reverse ( arp, &arp_entries, list ) {
|
||||||
|
arp_destroy ( arp, -ENOBUFS );
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/** ARP cache discarder */
|
||||||
|
struct cache_discarder arp_cache_discarder __cache_discarder = {
|
||||||
|
.discard = arp_discard,
|
||||||
|
};
|
||||||
|
|||||||
@@ -281,35 +281,6 @@ static uint16_t ipv4_pshdr_chksum ( struct io_buffer *iobuf, uint16_t csum ) {
|
|||||||
return tcpip_continue_chksum ( csum, &pshdr, sizeof ( pshdr ) );
|
return tcpip_continue_chksum ( csum, &pshdr, sizeof ( pshdr ) );
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
|
||||||
* Determine link-layer address
|
|
||||||
*
|
|
||||||
* @v dest IPv4 destination address
|
|
||||||
* @v src IPv4 source address
|
|
||||||
* @v netmask IPv4 subnet mask
|
|
||||||
* @v netdev Network device
|
|
||||||
* @v ll_dest Link-layer destination address buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*/
|
|
||||||
static int ipv4_ll_addr ( struct in_addr dest, struct in_addr src,
|
|
||||||
struct in_addr netmask, struct net_device *netdev,
|
|
||||||
uint8_t *ll_dest ) {
|
|
||||||
struct ll_protocol *ll_protocol = netdev->ll_protocol;
|
|
||||||
|
|
||||||
if ( ( ( dest.s_addr ^ INADDR_BROADCAST ) & ~netmask.s_addr ) == 0 ) {
|
|
||||||
/* Broadcast address */
|
|
||||||
memcpy ( ll_dest, netdev->ll_broadcast,
|
|
||||||
ll_protocol->ll_addr_len );
|
|
||||||
return 0;
|
|
||||||
} else if ( IN_MULTICAST ( ntohl ( dest.s_addr ) ) ) {
|
|
||||||
return ll_protocol->mc_hash ( AF_INET, &dest, ll_dest );
|
|
||||||
} else {
|
|
||||||
/* Unicast address: resolve via ARP */
|
|
||||||
return arp_resolve ( netdev, &ipv4_protocol, &dest,
|
|
||||||
&src, ll_dest );
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Transmit IP packet
|
* Transmit IP packet
|
||||||
*
|
*
|
||||||
@@ -335,7 +306,8 @@ static int ipv4_tx ( struct io_buffer *iobuf,
|
|||||||
struct ipv4_miniroute *miniroute;
|
struct ipv4_miniroute *miniroute;
|
||||||
struct in_addr next_hop;
|
struct in_addr next_hop;
|
||||||
struct in_addr netmask = { .s_addr = 0 };
|
struct in_addr netmask = { .s_addr = 0 };
|
||||||
uint8_t ll_dest[MAX_LL_ADDR_LEN];
|
uint8_t ll_dest_buf[MAX_LL_ADDR_LEN];
|
||||||
|
const void *ll_dest;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
/* Fill up the IP header, except source address */
|
/* Fill up the IP header, except source address */
|
||||||
@@ -373,16 +345,6 @@ static int ipv4_tx ( struct io_buffer *iobuf,
|
|||||||
( ( netdev->rx_stats.bad & 0xf ) << 4 ) |
|
( ( netdev->rx_stats.bad & 0xf ) << 4 ) |
|
||||||
( ( netdev->rx_stats.good & 0xf ) << 0 ) );
|
( ( netdev->rx_stats.good & 0xf ) << 0 ) );
|
||||||
|
|
||||||
/* Determine link-layer destination address */
|
|
||||||
if ( ( rc = ipv4_ll_addr ( next_hop, iphdr->src, netmask, netdev,
|
|
||||||
ll_dest ) ) != 0 ) {
|
|
||||||
DBGC ( sin_dest->sin_addr, "IPv4 has no link-layer address for "
|
|
||||||
"%s: %s\n", inet_ntoa ( next_hop ), strerror ( rc ) );
|
|
||||||
/* Record error for diagnosis */
|
|
||||||
netdev_tx_err ( netdev, iob_disown ( iobuf ), rc );
|
|
||||||
goto err;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Fix up checksums */
|
/* Fix up checksums */
|
||||||
if ( trans_csum )
|
if ( trans_csum )
|
||||||
*trans_csum = ipv4_pshdr_chksum ( iobuf, *trans_csum );
|
*trans_csum = ipv4_pshdr_chksum ( iobuf, *trans_csum );
|
||||||
@@ -395,13 +357,43 @@ static int ipv4_tx ( struct io_buffer *iobuf,
|
|||||||
iphdr->protocol, ntohs ( iphdr->ident ),
|
iphdr->protocol, ntohs ( iphdr->ident ),
|
||||||
ntohs ( iphdr->chksum ) );
|
ntohs ( iphdr->chksum ) );
|
||||||
|
|
||||||
/* Hand off to link layer */
|
/* Calculate link-layer destination address, if possible */
|
||||||
|
if ( ( ( next_hop.s_addr ^ INADDR_BROADCAST ) & ~netmask.s_addr ) == 0){
|
||||||
|
/* Broadcast address */
|
||||||
|
ll_dest = netdev->ll_broadcast;
|
||||||
|
} else if ( IN_MULTICAST ( ntohl ( next_hop.s_addr ) ) ) {
|
||||||
|
/* Multicast address */
|
||||||
|
if ( ( rc = netdev->ll_protocol->mc_hash ( AF_INET, &next_hop,
|
||||||
|
ll_dest_buf ) ) !=0){
|
||||||
|
DBGC ( sin_dest->sin_addr, "IPv4 could not hash "
|
||||||
|
"multicast %s: %s\n",
|
||||||
|
inet_ntoa ( next_hop ), strerror ( rc ) );
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
ll_dest = ll_dest_buf;
|
||||||
|
} else {
|
||||||
|
/* Unicast address */
|
||||||
|
ll_dest = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Hand off to link layer (via ARP if applicable) */
|
||||||
|
if ( ll_dest ) {
|
||||||
if ( ( rc = net_tx ( iobuf, netdev, &ipv4_protocol, ll_dest,
|
if ( ( rc = net_tx ( iobuf, netdev, &ipv4_protocol, ll_dest,
|
||||||
netdev->ll_addr ) ) != 0 ) {
|
netdev->ll_addr ) ) != 0 ) {
|
||||||
DBGC ( sin_dest->sin_addr, "IPv4 could not transmit packet "
|
DBGC ( sin_dest->sin_addr, "IPv4 could not transmit "
|
||||||
"via %s: %s\n", netdev->name, strerror ( rc ) );
|
"packet via %s: %s\n",
|
||||||
|
netdev->name, strerror ( rc ) );
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
} else {
|
||||||
|
if ( ( rc = arp_tx ( iobuf, netdev, &ipv4_protocol, &next_hop,
|
||||||
|
&iphdr->src, netdev->ll_addr ) ) != 0 ) {
|
||||||
|
DBGC ( sin_dest->sin_addr, "IPv4 could not transmit "
|
||||||
|
"packet via %s: %s\n",
|
||||||
|
netdev->name, strerror ( rc ) );
|
||||||
|
return rc;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user