mirror of
https://github.com/ipxe/ipxe
synced 2025-12-19 19:49:45 +03:00
Network API now allows for multiple network devices (although the
implementation allows for only one, and does so without compromising on the efficiency of static allocation). Link-layer protocols are cleanly separated from the device drivers. Network-layer protocols are cleanly separated from individual network devices. Link-layer and network-layer protocols are cleanly separated from each other.
This commit is contained in:
@@ -12,21 +12,21 @@ Bochs Pseudo NIC driver for Etherboot
|
|||||||
* See pnic_api.h for an explanation of the Bochs Pseudo NIC.
|
* See pnic_api.h for an explanation of the Bochs Pseudo NIC.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/* to get some global routines like printf */
|
#include <stdint.h>
|
||||||
#include "etherboot.h"
|
#include <io.h>
|
||||||
/* to get the interface to the body of the program */
|
#include <vsprintf.h>
|
||||||
#include "nic.h"
|
#include <errno.h>
|
||||||
/* to get the PCI support functions, if this is a PCI NIC */
|
#include <gpxe/pci.h>
|
||||||
#include "pci.h"
|
#include <gpxe/if_ether.h>
|
||||||
|
#include <gpxe/ethernet.h>
|
||||||
|
#include <gpxe/pkbuff.h>
|
||||||
|
#include <gpxe/netdevice.h>
|
||||||
|
|
||||||
/* PNIC API */
|
|
||||||
#include "pnic_api.h"
|
#include "pnic_api.h"
|
||||||
|
|
||||||
/* Function prototypes */
|
struct pnic {
|
||||||
static int pnic_api_check ( uint16_t api_version );
|
unsigned short ioaddr;
|
||||||
|
};
|
||||||
/* NIC specific static variables go here */
|
|
||||||
uint8_t tx_buffer[ETH_FRAME_LEN] __shared;
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Utility functions: issue a PNIC command, retrieve result. Use
|
* Utility functions: issue a PNIC command, retrieve result. Use
|
||||||
@@ -40,7 +40,7 @@ uint8_t tx_buffer[ETH_FRAME_LEN] __shared;
|
|||||||
* of data).
|
* of data).
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static uint16_t pnic_command_quiet ( struct nic *nic, uint16_t command,
|
static uint16_t pnic_command_quiet ( struct pnic *pnic, uint16_t command,
|
||||||
void *input, uint16_t input_length,
|
void *input, uint16_t input_length,
|
||||||
void *output, uint16_t output_max_length,
|
void *output, uint16_t output_max_length,
|
||||||
uint16_t *output_length ) {
|
uint16_t *output_length ) {
|
||||||
@@ -50,18 +50,19 @@ static uint16_t pnic_command_quiet ( struct nic *nic, uint16_t command,
|
|||||||
|
|
||||||
if ( input != NULL ) {
|
if ( input != NULL ) {
|
||||||
/* Write input length */
|
/* Write input length */
|
||||||
outw ( input_length, nic->ioaddr + PNIC_REG_LEN );
|
outw ( input_length, pnic->ioaddr + PNIC_REG_LEN );
|
||||||
/* Write input data */
|
/* Write input data */
|
||||||
for ( i = 0; i < input_length; i++ ) {
|
for ( i = 0; i < input_length; i++ ) {
|
||||||
outb( ((char*)input)[i], nic->ioaddr + PNIC_REG_DATA );
|
outb( ((char*)input)[i],
|
||||||
|
pnic->ioaddr + PNIC_REG_DATA );
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
/* Write command */
|
/* Write command */
|
||||||
outw ( command, nic->ioaddr + PNIC_REG_CMD );
|
outw ( command, pnic->ioaddr + PNIC_REG_CMD );
|
||||||
/* Retrieve status */
|
/* Retrieve status */
|
||||||
status = inw ( nic->ioaddr + PNIC_REG_STAT );
|
status = inw ( pnic->ioaddr + PNIC_REG_STAT );
|
||||||
/* Retrieve output length */
|
/* Retrieve output length */
|
||||||
_output_length = inw ( nic->ioaddr + PNIC_REG_LEN );
|
_output_length = inw ( pnic->ioaddr + PNIC_REG_LEN );
|
||||||
if ( output_length == NULL ) {
|
if ( output_length == NULL ) {
|
||||||
if ( _output_length != output_max_length ) {
|
if ( _output_length != output_max_length ) {
|
||||||
printf ( "pnic_command %#hx: wrong data length "
|
printf ( "pnic_command %#hx: wrong data length "
|
||||||
@@ -81,17 +82,17 @@ static uint16_t pnic_command_quiet ( struct nic *nic, uint16_t command,
|
|||||||
/* Retrieve output data */
|
/* Retrieve output data */
|
||||||
for ( i = 0; i < _output_length; i++ ) {
|
for ( i = 0; i < _output_length; i++ ) {
|
||||||
((char*)output)[i] =
|
((char*)output)[i] =
|
||||||
inb ( nic->ioaddr + PNIC_REG_DATA );
|
inb ( pnic->ioaddr + PNIC_REG_DATA );
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
static uint16_t pnic_command ( struct nic *nic, uint16_t command,
|
static uint16_t pnic_command ( struct pnic *pnic, uint16_t command,
|
||||||
void *input, uint16_t input_length,
|
void *input, uint16_t input_length,
|
||||||
void *output, uint16_t output_max_length,
|
void *output, uint16_t output_max_length,
|
||||||
uint16_t *output_length ) {
|
uint16_t *output_length ) {
|
||||||
uint16_t status = pnic_command_quiet ( nic, command,
|
uint16_t status = pnic_command_quiet ( pnic, command,
|
||||||
input, input_length,
|
input, input_length,
|
||||||
output, output_max_length,
|
output, output_max_length,
|
||||||
output_length );
|
output_length );
|
||||||
@@ -110,135 +111,134 @@ static int pnic_api_check ( uint16_t api_version ) {
|
|||||||
PNIC_API_VERSION >> 8, PNIC_API_VERSION & 0xff );
|
PNIC_API_VERSION >> 8, PNIC_API_VERSION & 0xff );
|
||||||
}
|
}
|
||||||
if ( api_version < PNIC_API_VERSION ) {
|
if ( api_version < PNIC_API_VERSION ) {
|
||||||
printf ( "*** You may need to update your copy of Bochs ***\n" );
|
printf ( "** You may need to update your copy of Bochs **\n" );
|
||||||
}
|
}
|
||||||
return ( api_version == PNIC_API_VERSION );
|
return ( api_version == PNIC_API_VERSION );
|
||||||
}
|
}
|
||||||
|
|
||||||
/**************************************************************************
|
|
||||||
CONNECT - connect adapter to the network
|
|
||||||
***************************************************************************/
|
|
||||||
static int pnic_connect ( struct nic *nic __unused ) {
|
|
||||||
/* Nothing to do */
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**************************************************************************
|
/**************************************************************************
|
||||||
POLL - Wait for a frame
|
POLL - Wait for a frame
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
static int pnic_poll ( struct nic *nic, int retrieve ) {
|
static void pnic_poll ( struct net_device *netdev ) {
|
||||||
|
struct pnic *pnic = netdev->priv;
|
||||||
|
struct pk_buff *pkb;
|
||||||
uint16_t length;
|
uint16_t length;
|
||||||
uint16_t qlen;
|
uint16_t qlen;
|
||||||
|
|
||||||
/* Check receive queue length to see if there's anything to
|
/* Fetch all available packets */
|
||||||
* get. Necessary since once we've called PNIC_CMD_RECV we
|
while ( 1 ) {
|
||||||
* have to read out the packet, otherwise it's lost forever.
|
if ( pnic_command ( pnic, PNIC_CMD_RECV_QLEN, NULL, 0,
|
||||||
*/
|
|
||||||
if ( pnic_command ( nic, PNIC_CMD_RECV_QLEN, NULL, 0,
|
|
||||||
&qlen, sizeof ( qlen ), NULL )
|
&qlen, sizeof ( qlen ), NULL )
|
||||||
!= PNIC_STATUS_OK ) return ( 0 );
|
!= PNIC_STATUS_OK )
|
||||||
if ( qlen == 0 ) return ( 0 );
|
break;
|
||||||
|
if ( qlen == 0 )
|
||||||
/* There is a packet ready. Return 1 if we're only checking. */
|
break;
|
||||||
if ( ! retrieve ) return ( 1 );
|
pkb = alloc_pkb ( ETH_FRAME_LEN );
|
||||||
|
if ( ! pkb )
|
||||||
/* Retrieve the packet */
|
break;
|
||||||
if ( pnic_command ( nic, PNIC_CMD_RECV, NULL, 0,
|
if ( pnic_command ( pnic, PNIC_CMD_RECV, NULL, 0,
|
||||||
nic->packet, ETH_FRAME_LEN, &length )
|
pkb->data, ETH_FRAME_LEN, &length )
|
||||||
!= PNIC_STATUS_OK ) return ( 0 );
|
!= PNIC_STATUS_OK ) {
|
||||||
nic->packetlen = length;
|
free_pkb ( pkb );
|
||||||
return ( 1 );
|
break;
|
||||||
|
}
|
||||||
|
pkb_put ( pkb, length );
|
||||||
|
netdev_rx ( netdev, pkb );
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
/**************************************************************************
|
/**************************************************************************
|
||||||
TRANSMIT - Transmit a frame
|
TRANSMIT - Transmit a frame
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
static void pnic_transmit ( struct nic *nic, const char *dest,
|
static int pnic_transmit ( struct net_device *netdev, struct pk_buff *pkb ) {
|
||||||
unsigned int type, unsigned int size,
|
struct pnic *pnic = netdev->priv;
|
||||||
const char *data ) {
|
|
||||||
unsigned int nstype = htons ( type );
|
|
||||||
|
|
||||||
if ( ( ETH_HLEN + size ) >= ETH_FRAME_LEN ) {
|
pnic_command ( pnic, PNIC_CMD_XMIT, pkb, pkb_len ( pkb ),
|
||||||
printf ( "pnic_transmit: packet too large\n" );
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Assemble packet */
|
|
||||||
memcpy ( tx_buffer, dest, ETH_ALEN );
|
|
||||||
memcpy ( tx_buffer + ETH_ALEN, nic->node_addr, ETH_ALEN );
|
|
||||||
memcpy ( tx_buffer + 2 * ETH_ALEN, &nstype, 2 );
|
|
||||||
memcpy ( tx_buffer + ETH_HLEN, data, size );
|
|
||||||
|
|
||||||
pnic_command ( nic, PNIC_CMD_XMIT, tx_buffer, ETH_HLEN + size,
|
|
||||||
NULL, 0, NULL );
|
NULL, 0, NULL );
|
||||||
}
|
free_pkb ( pkb );
|
||||||
|
return 0;
|
||||||
/**************************************************************************
|
|
||||||
DISABLE - Turn off ethernet interface
|
|
||||||
***************************************************************************/
|
|
||||||
static void pnic_disable ( struct nic *nic, struct pci_device *pci __unused ) {
|
|
||||||
nic_disable ( nic );
|
|
||||||
pnic_command ( nic, PNIC_CMD_RESET, NULL, 0, NULL, 0, NULL );
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/**************************************************************************
|
/**************************************************************************
|
||||||
IRQ - Handle card interrupt status
|
IRQ - Handle card interrupt status
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
static void pnic_irq ( struct nic *nic, irq_action_t action ) {
|
#if 0
|
||||||
|
static void pnic_irq ( struct net_device *netdev, irq_action_t action ) {
|
||||||
|
struct pnic *pnic = netdev->priv;
|
||||||
uint8_t enabled;
|
uint8_t enabled;
|
||||||
|
|
||||||
switch ( action ) {
|
switch ( action ) {
|
||||||
case DISABLE :
|
case DISABLE :
|
||||||
case ENABLE :
|
case ENABLE :
|
||||||
enabled = ( action == ENABLE ? 1 : 0 );
|
enabled = ( action == ENABLE ? 1 : 0 );
|
||||||
pnic_command ( nic, PNIC_CMD_MASK_IRQ,
|
pnic_command ( pnic, PNIC_CMD_MASK_IRQ,
|
||||||
&enabled, sizeof ( enabled ), NULL, 0, NULL );
|
&enabled, sizeof ( enabled ), NULL, 0, NULL );
|
||||||
break;
|
break;
|
||||||
case FORCE :
|
case FORCE :
|
||||||
pnic_command ( nic, PNIC_CMD_FORCE_IRQ,
|
pnic_command ( pnic, PNIC_CMD_FORCE_IRQ,
|
||||||
NULL, 0, NULL, 0, NULL );
|
NULL, 0, NULL, 0, NULL );
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
/**************************************************************************
|
/**************************************************************************
|
||||||
NIC operations table
|
DISABLE - Turn off ethernet interface
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
static struct nic_operations pnic_operations = {
|
static void pnic_remove ( struct pci_device *pci ) {
|
||||||
.connect = pnic_connect,
|
struct net_device *netdev = pci_get_drvdata ( pci );
|
||||||
.poll = pnic_poll,
|
struct pnic *pnic = netdev->priv;
|
||||||
.transmit = pnic_transmit,
|
|
||||||
.irq = pnic_irq,
|
unregister_netdev ( netdev );
|
||||||
};
|
pnic_command ( pnic, PNIC_CMD_RESET, NULL, 0, NULL, 0, NULL );
|
||||||
|
}
|
||||||
|
|
||||||
/**************************************************************************
|
/**************************************************************************
|
||||||
PROBE - Look for an adapter, this routine's visible to the outside
|
PROBE - Look for an adapter, this routine's visible to the outside
|
||||||
***************************************************************************/
|
***************************************************************************/
|
||||||
static int pnic_probe ( struct nic *nic, struct pci_device *pci ) {
|
static int pnic_probe ( struct pci_device *pci ) {
|
||||||
|
struct net_device *netdev;
|
||||||
|
struct pnic *pnic;
|
||||||
uint16_t api_version;
|
uint16_t api_version;
|
||||||
uint16_t status;
|
uint16_t status;
|
||||||
|
int rc;
|
||||||
|
|
||||||
/* Retrieve relevant information about PCI device */
|
/* Allocate net device */
|
||||||
pci_fill_nic ( nic, pci );
|
netdev = alloc_etherdev ( sizeof ( *pnic ) );
|
||||||
|
if ( ! netdev ) {
|
||||||
|
rc = -ENOMEM;
|
||||||
|
goto err;
|
||||||
|
}
|
||||||
|
pnic = netdev->priv;
|
||||||
|
pci_set_drvdata ( pci, netdev );
|
||||||
|
pnic->ioaddr = pci->ioaddr;
|
||||||
|
|
||||||
/* API version check */
|
/* API version check */
|
||||||
status = pnic_command_quiet( nic, PNIC_CMD_API_VER, NULL, 0,
|
status = pnic_command_quiet ( pnic, PNIC_CMD_API_VER, NULL, 0,
|
||||||
&api_version,
|
&api_version,
|
||||||
sizeof ( api_version ), NULL );
|
sizeof ( api_version ), NULL );
|
||||||
if ( status != PNIC_STATUS_OK ) {
|
if ( status != PNIC_STATUS_OK ) {
|
||||||
printf ( "PNIC failed installation check, code %#hx\n",
|
printf ( "PNIC failed installation check, code %#hx\n",
|
||||||
status );
|
status );
|
||||||
return 0;
|
rc = -EIO;
|
||||||
|
goto err;
|
||||||
}
|
}
|
||||||
pnic_api_check ( api_version );
|
pnic_api_check ( api_version );
|
||||||
|
|
||||||
/* Get MAC address */
|
/* Get MAC address */
|
||||||
status = pnic_command ( nic, PNIC_CMD_READ_MAC, NULL, 0,
|
status = pnic_command ( pnic, PNIC_CMD_READ_MAC, NULL, 0,
|
||||||
nic->node_addr, ETH_ALEN, NULL );
|
netdev->ll_addr, ETH_ALEN, NULL );
|
||||||
|
|
||||||
/* point to NIC specific routines */
|
/* Point to NIC specific routines */
|
||||||
nic->nic_op = &pnic_operations;
|
netdev->poll = pnic_poll;
|
||||||
return 1;
|
netdev->transmit = pnic_transmit;
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
err:
|
||||||
|
/* Free net device */
|
||||||
|
free_netdev ( netdev );
|
||||||
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct pci_id pnic_nics[] = {
|
static struct pci_id pnic_nics[] = {
|
||||||
@@ -246,7 +246,18 @@ static struct pci_id pnic_nics[] = {
|
|||||||
PCI_ROM ( 0xfefe, 0xefef, "pnic", "Bochs Pseudo NIC Adaptor" ),
|
PCI_ROM ( 0xfefe, 0xefef, "pnic", "Bochs Pseudo NIC Adaptor" ),
|
||||||
};
|
};
|
||||||
|
|
||||||
PCI_DRIVER ( pnic_driver, pnic_nics, PCI_NO_CLASS );
|
static struct pci_driver pnic_driver = {
|
||||||
|
.ids = pnic_nics,
|
||||||
|
.id_count = ( sizeof ( pnic_nics ) / sizeof ( pnic_nics[0] ) ),
|
||||||
|
.class = PCI_NO_CLASS,
|
||||||
|
// .probe = pnic_probe,
|
||||||
|
// .remove = pnic_remove,
|
||||||
|
};
|
||||||
|
|
||||||
DRIVER ( "PNIC", nic_driver, pci_driver, pnic_driver,
|
// PCI_DRIVER ( pnic_driver );
|
||||||
pnic_probe, pnic_disable );
|
|
||||||
|
#include "dev.h"
|
||||||
|
extern struct type_driver test_driver;
|
||||||
|
|
||||||
|
DRIVER ( "PNIC", test_driver, pci_driver, pnic_driver,
|
||||||
|
pnic_probe, pnic_remove );
|
||||||
|
|||||||
@@ -1,5 +1,5 @@
|
|||||||
#ifndef _ARP_H
|
#ifndef _GPXE_ARP_H
|
||||||
#define _ARP_H
|
#define _GPXE_ARP_H
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
*
|
*
|
||||||
@@ -7,17 +7,10 @@
|
|||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
struct net_device;
|
struct net_header;
|
||||||
struct net_interface;
|
struct ll_header;
|
||||||
struct pk_buff;
|
|
||||||
|
|
||||||
extern int arp_resolve ( struct net_device *netdev, struct pk_buff *pkb,
|
extern int arp_resolve ( const struct net_header *nethdr,
|
||||||
const void **ll_addr );
|
struct ll_header *llhdr );
|
||||||
|
|
||||||
extern int arp_process ( struct net_interface *arp_netif,
|
#endif /* _GPXE_ARP_H */
|
||||||
struct pk_buff *pkb );
|
|
||||||
|
|
||||||
extern int arp_add_generic_header ( struct net_interface *arp_netif,
|
|
||||||
struct pk_buff *pkb );
|
|
||||||
|
|
||||||
#endif /* _ARP_H */
|
|
||||||
|
|||||||
@@ -1,33 +1,197 @@
|
|||||||
#ifndef _NETDEVICE_H
|
#ifndef _GPXE_NETDEVICE_H
|
||||||
#define _NETDEVICE_H
|
#define _GPXE_NETDEVICE_H
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
*
|
*
|
||||||
* Network device and network interface
|
* Network device management
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <gpxe/list.h>
|
#include <gpxe/tables.h>
|
||||||
|
|
||||||
struct net_device;
|
|
||||||
struct net_interface;
|
|
||||||
struct pk_buff;
|
struct pk_buff;
|
||||||
|
struct net_protocol;
|
||||||
|
struct ll_protocol;
|
||||||
|
|
||||||
/** Maximum length of a link-layer address */
|
/** Maximum length of a link-layer address */
|
||||||
#define MAX_LLH_ADDR_LEN 6
|
#define MAX_LL_ADDR_LEN 6
|
||||||
|
|
||||||
/** Maximum length of a network-layer address */
|
/** Maximum length of a network-layer address */
|
||||||
#define MAX_NET_ADDR_LEN 4
|
#define MAX_NET_ADDR_LEN 4
|
||||||
|
|
||||||
|
/* Network-layer address may be required to hold a link-layer address
|
||||||
|
* (if NETADDR_FL_RAW is set
|
||||||
|
*/
|
||||||
|
#if MAX_NET_ADDR_LEN < MAX_LL_ADDR_LEN
|
||||||
|
#undef MAX_NET_ADDR_LEN
|
||||||
|
#define MAX_NET_ADDR_LEN MAX_LL_ADDR_LEN
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/** A generic network-layer header */
|
||||||
|
struct net_header {
|
||||||
|
/** Network-layer protocol */
|
||||||
|
struct net_protocol *net_protocol;
|
||||||
|
/** Destination address flags
|
||||||
|
*
|
||||||
|
* This is the bitwise OR of zero or more NETADDR_FL_XXX
|
||||||
|
* values.
|
||||||
|
*/
|
||||||
|
int dest_flags;
|
||||||
|
/** Network-layer destination address */
|
||||||
|
uint8_t dest_net_addr[MAX_NET_ADDR_LEN];
|
||||||
|
/** Network-layer source address */
|
||||||
|
uint8_t source_net_addr[MAX_NET_ADDR_LEN];
|
||||||
|
};
|
||||||
|
|
||||||
|
/** Address is a broadcast address */
|
||||||
|
#define NETADDR_FL_BROADCAST 0x01
|
||||||
|
|
||||||
|
/** Address is a multicast address */
|
||||||
|
#define NETADDR_FL_MULTICAST 0x02
|
||||||
|
|
||||||
|
/** Address is a raw hardware address */
|
||||||
|
#define NETADDR_FL_RAW 0x04
|
||||||
|
|
||||||
|
/** A generic link-layer header */
|
||||||
|
struct ll_header {
|
||||||
|
/** Link-layer protocol */
|
||||||
|
struct ll_protocol *ll_protocol;
|
||||||
|
/** Destination address flags
|
||||||
|
*
|
||||||
|
* This is the bitwise OR of zero or more NETADDR_FL_XXX
|
||||||
|
* values.
|
||||||
|
*/
|
||||||
|
int dest_flags;
|
||||||
|
/** Link-layer destination address */
|
||||||
|
uint8_t dest_ll_addr[MAX_LL_ADDR_LEN];
|
||||||
|
/** Link-layer source address */
|
||||||
|
uint8_t source_ll_addr[MAX_LL_ADDR_LEN];
|
||||||
|
/** Network-layer protocol
|
||||||
|
*
|
||||||
|
*
|
||||||
|
* This is an ETH_P_XXX constant, in network-byte order
|
||||||
|
*/
|
||||||
|
uint16_t net_proto;
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* A network-layer protocol
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
struct net_protocol {
|
||||||
|
/**
|
||||||
|
* Perform network-layer routing
|
||||||
|
*
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
* @ret source Network-layer source address
|
||||||
|
* @ret dest Network-layer destination address
|
||||||
|
* @ret rc Return status code
|
||||||
|
*
|
||||||
|
* This method should fill in the source and destination
|
||||||
|
* addresses with enough information to allow the link layer
|
||||||
|
* to route the packet.
|
||||||
|
*
|
||||||
|
* For example, in the case of IPv4, this method should fill
|
||||||
|
* in @c source with the IP addresses of the local adapter and
|
||||||
|
* @c dest with the next hop destination (e.g. the gateway).
|
||||||
|
*/
|
||||||
|
int ( * route ) ( const struct pk_buff *pkb,
|
||||||
|
struct net_header *nethdr );
|
||||||
|
/**
|
||||||
|
* Handle received packets
|
||||||
|
*
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
* @ret rc Return status code
|
||||||
|
*
|
||||||
|
* If this method returns success, it has taken ownership of
|
||||||
|
* the packet buffer.
|
||||||
|
*/
|
||||||
|
int ( * rx ) ( struct pk_buff *pkb );
|
||||||
|
/** Network-layer protocol
|
||||||
|
*
|
||||||
|
* This is an ETH_P_XXX constant, in network-byte order
|
||||||
|
*/
|
||||||
|
uint16_t net_proto;
|
||||||
|
/** Network-layer address length */
|
||||||
|
uint8_t net_addr_len;
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* A link-layer protocol
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
struct ll_protocol {
|
||||||
|
/**
|
||||||
|
* Perform link-layer routing
|
||||||
|
*
|
||||||
|
* @v nethdr Generic network-layer header
|
||||||
|
* @ret llhdr Generic link-layer header
|
||||||
|
* @ret rc Return status code
|
||||||
|
*
|
||||||
|
* This method should construct the generic link-layer header
|
||||||
|
* based on the generic network-layer header.
|
||||||
|
*
|
||||||
|
* If a link-layer header cannot be constructed (e.g. because
|
||||||
|
* of a missing ARP cache entry), then this method should
|
||||||
|
* return an error (after transmitting an ARP request, if
|
||||||
|
* applicable).
|
||||||
|
*/
|
||||||
|
int ( * route ) ( const struct net_header *nethdr,
|
||||||
|
struct ll_header *llhdr );
|
||||||
|
/**
|
||||||
|
* Fill media-specific link-layer header
|
||||||
|
*
|
||||||
|
* @v llhdr Generic link-layer header
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
*
|
||||||
|
* This method should fill in the link-layer header in the
|
||||||
|
* packet buffer based on information in the generic
|
||||||
|
* link-layer header.
|
||||||
|
*/
|
||||||
|
void ( * fill_llh ) ( const struct ll_header *llhdr,
|
||||||
|
struct pk_buff *pkb );
|
||||||
|
/**
|
||||||
|
* Parse media-specific link-layer header
|
||||||
|
*
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
* @v llhdr Generic link-layer header
|
||||||
|
*
|
||||||
|
* This method should fill in the generic link-layer header
|
||||||
|
* based on information in the link-layer header in the packet
|
||||||
|
* buffer.
|
||||||
|
*/
|
||||||
|
void ( * parse_llh ) ( const struct pk_buff *pkb,
|
||||||
|
struct ll_header *llhdr );
|
||||||
|
|
||||||
|
/** Link-layer protocol
|
||||||
|
*
|
||||||
|
* This is an ARPHRD_XXX constant, in network byte order.
|
||||||
|
*/
|
||||||
|
uint16_t ll_proto;
|
||||||
|
/** Link-layer address length */
|
||||||
|
uint8_t ll_addr_len;
|
||||||
|
/** Link-layer header length */
|
||||||
|
uint8_t ll_header_len;
|
||||||
|
};
|
||||||
|
|
||||||
|
/**
|
||||||
|
* A network-layer address assigned to a network device
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
struct net_address {
|
||||||
|
/** Network-layer protocol */
|
||||||
|
struct net_protocol *net_protocol;
|
||||||
|
/** Network-layer address */
|
||||||
|
uint8_t net_addr[MAX_NET_ADDR_LEN];
|
||||||
|
};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* A network device
|
* A network device
|
||||||
*
|
*
|
||||||
* This structure represents a piece of networking hardware. It has
|
* This structure represents a piece of networking hardware. It has
|
||||||
* properties such as a link-layer address and methods for
|
* properties such as a link-layer address and methods for
|
||||||
* transmitting and receiving raw packets. It does not know anything
|
* transmitting and receiving raw packets.
|
||||||
* about network-layer protocols (e.g. IP) or their addresses; these
|
|
||||||
* are handled by struct @c net_interface instead.
|
|
||||||
*
|
*
|
||||||
* Note that this structure must represent a generic network device,
|
* Note that this structure must represent a generic network device,
|
||||||
* not just an Ethernet device.
|
* not just an Ethernet device.
|
||||||
@@ -40,164 +204,123 @@ struct net_device {
|
|||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
*
|
||||||
* This method should cause the hardware to initiate
|
* This method should cause the hardware to initiate
|
||||||
* transmission of the packet buffer. The buffer may be
|
* transmission of the packet buffer.
|
||||||
* reused immediately after the method returns, and so the
|
*
|
||||||
* method should either wait for packet transmission to
|
* If the method returns success, ownership of the packet
|
||||||
* complete, or take a copy of the buffer contents.
|
* buffer is transferred to the @c net_device, which must
|
||||||
|
* eventually call free_pkb() to release the buffer.
|
||||||
*/
|
*/
|
||||||
int ( * transmit ) ( struct net_device *netdev,
|
int ( * transmit ) ( struct net_device *netdev, struct pk_buff *pkb );
|
||||||
struct pk_buff *pkb );
|
|
||||||
/** Poll for received packet
|
/** Poll for received packet
|
||||||
*
|
*
|
||||||
* @v netdev Network device
|
* @v netdev Network device
|
||||||
* @v pkb Packet buffer to contain received packet
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
*
|
||||||
* This method should cause the hardware to check for a
|
* This method should cause the hardware to check for received
|
||||||
* received packet. If no packet is available, the method
|
* packets. Any received packets should be delivered via
|
||||||
* should return -EAGAIN (i.e. this method is *always*
|
* netdev_rx().
|
||||||
* considered to be a non-blocking read). If a packet is
|
|
||||||
* available, the method should fill the packet buffer and
|
|
||||||
* return zero for success.
|
|
||||||
*/
|
*/
|
||||||
int ( * poll ) ( struct net_device *netdev, struct pk_buff *pkb );
|
void ( * poll ) ( struct net_device *netdev );
|
||||||
/** Build link-layer header
|
|
||||||
*
|
/** Link-layer protocol */
|
||||||
* @v netdev Network device
|
struct ll_protocol *ll_protocol;
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* This method should fill in the link-layer header based on
|
|
||||||
* the metadata contained in @c pkb.
|
|
||||||
*
|
|
||||||
* If a link-layer header cannot be constructed (e.g. because
|
|
||||||
* of a missing ARP cache entry), then this method should
|
|
||||||
* return an error (after transmitting an ARP request, if
|
|
||||||
* applicable).
|
|
||||||
*/
|
|
||||||
int ( * build_llh ) ( struct net_device *netdev, struct pk_buff *pkb );
|
|
||||||
/** Parse link-layer header
|
|
||||||
*
|
|
||||||
* @v netdev Network device
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* This method should parse the link-layer header and fill in
|
|
||||||
* the metadata in @c pkb.
|
|
||||||
*/
|
|
||||||
int ( * parse_llh ) ( struct net_device *netdev, struct pk_buff *pkb );
|
|
||||||
/** Link-layer protocol
|
|
||||||
*
|
|
||||||
* This is an ARPHRD_XXX constant, in network byte order.
|
|
||||||
*/
|
|
||||||
uint16_t ll_proto;
|
|
||||||
/** Link-layer header length */
|
|
||||||
uint8_t ll_hlen;
|
|
||||||
/** Link-layer address length */
|
|
||||||
uint8_t ll_addr_len;
|
|
||||||
/** Link-layer address
|
/** Link-layer address
|
||||||
*
|
*
|
||||||
* For Ethernet, this is the MAC address.
|
* For Ethernet, this is the MAC address.
|
||||||
*/
|
*/
|
||||||
uint8_t ll_addr[MAX_LLH_ADDR_LEN];
|
uint8_t ll_addr[MAX_LL_ADDR_LEN];
|
||||||
/** Linked list of network devices */
|
|
||||||
struct list_head devices;
|
|
||||||
/** List of network interfaces */
|
|
||||||
struct list_head interfaces;
|
|
||||||
/** Driver private data */
|
/** Driver private data */
|
||||||
void *priv;
|
void *priv;
|
||||||
};
|
};
|
||||||
|
|
||||||
/**
|
|
||||||
* A network interface
|
|
||||||
*
|
|
||||||
* This structure represents a particular network layer protocol's
|
|
||||||
* interface to a piece of network hardware (a struct @c net_device).
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
struct net_interface {
|
|
||||||
/** Underlying net device */
|
|
||||||
struct net_device *netdev;
|
|
||||||
/** Linked list of interfaces for this device */
|
|
||||||
struct list_head interfaces;
|
|
||||||
/** Network-layer protocol
|
|
||||||
*
|
|
||||||
* This is an ETH_P_XXX constant, in network byte order.
|
|
||||||
*/
|
|
||||||
uint16_t net_proto;
|
|
||||||
/** Network-layer address length */
|
|
||||||
uint8_t net_addr_len;
|
|
||||||
/** Network-layer address */
|
|
||||||
uint8_t net_addr[MAX_NET_ADDR_LEN];
|
|
||||||
/** Fill in packet metadata
|
|
||||||
*
|
|
||||||
* @v netif Network interface
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* This method should fill in the @c pkb metadata with enough
|
|
||||||
* information to enable net_device::build_llh to construct
|
|
||||||
* the link-layer header.
|
|
||||||
*/
|
|
||||||
int ( * add_llh_metadata ) ( struct net_interface *netif,
|
|
||||||
struct pk_buff *pkb );
|
|
||||||
/** Received packet processor
|
|
||||||
*
|
|
||||||
* @v netif Network interface
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* This method is called for packets arriving on the
|
|
||||||
* associated network device that match this interface's
|
|
||||||
* network-layer protocol.
|
|
||||||
*
|
|
||||||
* When this method is called, the link-layer header will
|
|
||||||
* already have been stripped from the packet.
|
|
||||||
*/
|
|
||||||
int ( * rx_packet ) ( struct net_interface *netif,
|
|
||||||
struct pk_buff *pkb );
|
|
||||||
};
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Find interface for a specific protocol
|
|
||||||
*
|
|
||||||
* @v netdev Network device
|
|
||||||
* @v net_proto Network-layer protocol, in network byte order
|
|
||||||
* @ret netif Network interface, or NULL if none found
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
static inline struct net_interface *
|
|
||||||
netdev_find_netif ( const struct net_device *netdev, uint16_t net_proto ) {
|
|
||||||
struct net_interface *netif;
|
|
||||||
|
|
||||||
list_for_each_entry ( netif, &netdev->interfaces, interfaces ) {
|
|
||||||
if ( netif->net_proto == net_proto )
|
|
||||||
return netif;
|
|
||||||
}
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
extern int register_netdevice ( struct net_device *netdev );
|
|
||||||
extern void unregister_netdevice ( struct net_device *netdev );
|
|
||||||
extern int netdev_send ( struct net_device *netdev, struct pk_buff *pkb );
|
|
||||||
extern int netdev_poll ( struct net_device *netdev, struct pk_buff *pkb );
|
|
||||||
extern int netif_send ( struct net_interface *netif, struct pk_buff *pkb );
|
|
||||||
extern int netdev_rx_packet ( struct net_device *netdev, struct pk_buff *pkb );
|
|
||||||
extern int net_poll ( struct pk_buff *pkb, struct net_device **netdev );
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
extern struct net_device static_single_netdev;
|
extern struct net_device static_single_netdev;
|
||||||
|
|
||||||
/* Must be a macro because priv_data[] is of variable size */
|
/**
|
||||||
#define alloc_netdevice( priv_size ) ( { \
|
* Allocate network device
|
||||||
|
*
|
||||||
|
* @v priv_size Size of private data area (net_device::priv)
|
||||||
|
* @ret netdev Network device, or NULL
|
||||||
|
*
|
||||||
|
* Allocates space for a network device and its private data area.
|
||||||
|
*
|
||||||
|
* This macro allows for a very efficient implementation in the case
|
||||||
|
* of a single static network device; it neatly avoids dynamic
|
||||||
|
* allocation and can never return failure, meaning that the failure
|
||||||
|
* path will be optimised away. However, driver writers should not
|
||||||
|
* rely on this feature; the drivers should be written to allow for
|
||||||
|
* multiple instances of network devices.
|
||||||
|
*/
|
||||||
|
#define alloc_netdev( priv_size ) ( { \
|
||||||
static char priv_data[priv_size]; \
|
static char priv_data[priv_size]; \
|
||||||
static_single_netdev.priv = priv_data; \
|
static_single_netdev.priv = priv_data; \
|
||||||
&static_single_netdev; } )
|
&static_single_netdev; } )
|
||||||
|
|
||||||
|
/**
|
||||||
static inline void free_netdevice ( struct net_device *netdev __unused ) {
|
* Register network device
|
||||||
/* Do nothing */
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
* @ret rc Return status code
|
||||||
|
*
|
||||||
|
* Adds the network device to the list of network devices.
|
||||||
|
*/
|
||||||
|
static inline int
|
||||||
|
register_netdev ( struct net_device *netdev __attribute__ (( unused )) ) {
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* _NETDEVICE_H */
|
/**
|
||||||
|
* Unregister network device
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
*
|
||||||
|
* Removes the network device from the list of network devices.
|
||||||
|
*/
|
||||||
|
static inline void
|
||||||
|
unregister_netdev ( struct net_device *netdev __attribute__ (( unused )) ) {
|
||||||
|
/* Nothing to do */
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Free network device
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
*/
|
||||||
|
static inline void
|
||||||
|
free_netdev ( struct net_device *netdev __attribute__ (( unused )) ) {
|
||||||
|
/* Nothing to do */
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Register a link-layer protocol
|
||||||
|
*
|
||||||
|
* @v protocol Link-layer protocol
|
||||||
|
*/
|
||||||
|
#define LL_PROTOCOL( protocol ) \
|
||||||
|
struct ll_protocol protocol __table ( ll_protocols, 00 )
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Register a network-layer protocol
|
||||||
|
*
|
||||||
|
* @v protocol Network-layer protocol
|
||||||
|
*/
|
||||||
|
#define NET_PROTOCOL( protocol ) \
|
||||||
|
struct net_protocol protocol __table ( net_protocols, 00 )
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Register a network-layer address for the static single network device
|
||||||
|
*
|
||||||
|
* @v net_address Network-layer address
|
||||||
|
*/
|
||||||
|
#define STATIC_SINGLE_NETDEV_ADDRESS( address ) \
|
||||||
|
struct net_address address __table ( sgl_netdev_addresses, 00 )
|
||||||
|
|
||||||
|
extern struct net_protocol *net_find_protocol ( uint16_t net_proto );
|
||||||
|
extern struct net_device * net_find_address ( struct net_protocol *net_proto,
|
||||||
|
void *net_addr );
|
||||||
|
|
||||||
|
extern int net_transmit ( struct pk_buff *pkb );
|
||||||
|
extern int net_poll ( void );
|
||||||
|
extern void netdev_rx ( struct net_device *netdev, struct pk_buff *pkb );
|
||||||
|
extern struct pk_buff * net_rx_dequeue ( void );
|
||||||
|
|
||||||
|
#endif /* _GPXE_NETDEVICE_H */
|
||||||
|
|||||||
@@ -1,5 +1,5 @@
|
|||||||
#ifndef _PKBUFF_H
|
#ifndef _GPXE_PKBUFF_H
|
||||||
#define _PKBUFF_H
|
#define _GPXE_PKBUFF_H
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
*
|
*
|
||||||
@@ -12,6 +12,10 @@
|
|||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <assert.h>
|
#include <assert.h>
|
||||||
|
#include <gpxe/list.h>
|
||||||
|
|
||||||
|
struct net_protocol;
|
||||||
|
struct ll_protocol;
|
||||||
|
|
||||||
/** A packet buffer
|
/** A packet buffer
|
||||||
*
|
*
|
||||||
@@ -27,39 +31,15 @@ struct pk_buff {
|
|||||||
/** End of the buffer */
|
/** End of the buffer */
|
||||||
void *end;
|
void *end;
|
||||||
|
|
||||||
/** The network-layer protocol
|
/** List of which this buffer is a member */
|
||||||
*
|
struct list_head list;
|
||||||
* This is the network-layer protocol expressed as an
|
|
||||||
* ETH_P_XXX constant, in network-byte order.
|
/** The network-layer protocol */
|
||||||
*/
|
struct net_protocol *net_protocol;
|
||||||
uint16_t net_proto;
|
/** The link-layer protocol */
|
||||||
/** Flags
|
struct ll_protocol *ll_protocol;
|
||||||
*
|
|
||||||
* Filled in only on outgoing packets. Value is the
|
|
||||||
* bitwise-OR of zero or more PKB_FL_XXX constants.
|
|
||||||
*/
|
|
||||||
uint8_t flags;
|
|
||||||
/** Network-layer address length
|
|
||||||
*
|
|
||||||
* Filled in only on outgoing packets.
|
|
||||||
*/
|
|
||||||
uint8_t net_addr_len;
|
|
||||||
/** Network-layer address
|
|
||||||
*
|
|
||||||
* Filled in only on outgoing packets.
|
|
||||||
*/
|
|
||||||
void *net_addr;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
/** Packet is a broadcast packet */
|
|
||||||
#define PKB_FL_BROADCAST 0x01
|
|
||||||
|
|
||||||
/** Packet is a multicast packet */
|
|
||||||
#define PKB_FL_MULTICAST 0x02
|
|
||||||
|
|
||||||
/** Network-layer address is a raw hardware address */
|
|
||||||
#define PKB_FL_RAW_NET_ADDR 0x04
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Add data to start of packet buffer
|
* Add data to start of packet buffer
|
||||||
*
|
*
|
||||||
@@ -130,4 +110,7 @@ static inline size_t pkb_len ( struct pk_buff *pkb ) {
|
|||||||
return ( pkb->tail - pkb->data );
|
return ( pkb->tail - pkb->data );
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* _PKBUFF_H */
|
extern struct pk_buff * alloc_pkb ( size_t len );
|
||||||
|
extern void free_pkb ( struct pk_buff *pkb );
|
||||||
|
|
||||||
|
#endif /* _GPXE_PKBUFF_H */
|
||||||
|
|||||||
181
src/net/arp.c
181
src/net/arp.c
@@ -39,13 +39,13 @@
|
|||||||
/** An ARP cache entry */
|
/** An ARP cache entry */
|
||||||
struct arp_entry {
|
struct arp_entry {
|
||||||
/** Network-layer protocol */
|
/** Network-layer protocol */
|
||||||
uint16_t net_proto;
|
struct net_protocol *net_protocol;
|
||||||
/** Link-layer protocol */
|
/** Link-layer protocol */
|
||||||
uint16_t ll_proto;
|
struct ll_protocol *ll_protocol;
|
||||||
/** Network-layer address */
|
/** Network-layer address */
|
||||||
uint8_t net_addr[MAX_NET_ADDR_LEN];
|
uint8_t net_addr[MAX_NET_ADDR_LEN];
|
||||||
/** Link-layer address */
|
/** Link-layer address */
|
||||||
uint8_t ll_addr[MAX_LLH_ADDR_LEN];
|
uint8_t ll_addr[MAX_LL_ADDR_LEN];
|
||||||
};
|
};
|
||||||
|
|
||||||
/** Number of entries in the ARP cache
|
/** Number of entries in the ARP cache
|
||||||
@@ -61,25 +61,28 @@ static struct arp_entry arp_table[NUM_ARP_ENTRIES];
|
|||||||
|
|
||||||
static unsigned int next_new_arp_entry = 0;
|
static unsigned int next_new_arp_entry = 0;
|
||||||
|
|
||||||
|
struct net_protocol arp_protocol;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Find entry in the ARP cache
|
* Find entry in the ARP cache
|
||||||
*
|
*
|
||||||
* @v ll_proto Link-layer protocol
|
* @v ll_protocol Link-layer protocol
|
||||||
* @v net_proto Network-layer protocol
|
* @v net_protocol Network-layer protocol
|
||||||
* @v net_addr Network-layer address
|
* @v net_addr Network-layer address
|
||||||
* @v net_addr_len Network-layer address length
|
|
||||||
* @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_entry ( uint16_t ll_proto, uint16_t net_proto, const void *net_addr,
|
arp_find_entry ( struct ll_protocol *ll_protocol,
|
||||||
size_t net_addr_len ) {
|
struct net_protocol *net_protocol,
|
||||||
|
const void *net_addr ) {
|
||||||
struct arp_entry *arp;
|
struct arp_entry *arp;
|
||||||
|
|
||||||
for ( arp = arp_table ; arp < arp_table_end ; arp++ ) {
|
for ( arp = arp_table ; arp < arp_table_end ; arp++ ) {
|
||||||
if ( ( arp->ll_proto == ll_proto ) &&
|
if ( ( arp->ll_protocol == ll_protocol ) &&
|
||||||
( arp->net_proto == net_proto ) &&
|
( arp->net_protocol == net_protocol ) &&
|
||||||
( memcmp ( arp->net_addr, net_addr, net_addr_len ) == 0 ))
|
( memcmp ( arp->net_addr, net_addr,
|
||||||
|
net_protocol->net_addr_len ) == 0 ) )
|
||||||
return arp;
|
return arp;
|
||||||
}
|
}
|
||||||
return NULL;
|
return NULL;
|
||||||
@@ -88,59 +91,64 @@ arp_find_entry ( uint16_t ll_proto, uint16_t net_proto, const void *net_addr,
|
|||||||
/**
|
/**
|
||||||
* Look up media-specific link-layer address in the ARP cache
|
* Look up media-specific link-layer address in the ARP cache
|
||||||
*
|
*
|
||||||
* @v netdev Network device
|
* @v nethdr Generic network-layer header
|
||||||
* @v pkb Packet buffer
|
* @ret llhdr Generic link-layer header
|
||||||
* @ret ll_addr Pointer to 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
|
* This function will use the ARP cache to look up the link-layer
|
||||||
* address for the media corresponding to @c netdev and the
|
* address for the link-layer protocol specified in @c llhdr and the
|
||||||
* network-layer address as specified in the @c pkb metadata.
|
* network-layer protocol and address as specified in @c nethdr. If
|
||||||
|
* found, the destination link-layer address will be filled in in @c
|
||||||
|
* llhdr.
|
||||||
*
|
*
|
||||||
* If no address is found in the ARP cache, an ARP request will be
|
* If no address is found in the ARP cache, an ARP request will be
|
||||||
* transmitted, -ENOENT will be returned, and the packet buffer
|
* transmitted and -ENOENT will be returned.
|
||||||
* contents will be undefined.
|
|
||||||
*/
|
*/
|
||||||
int arp_resolve ( struct net_device *netdev, struct pk_buff *pkb,
|
int arp_resolve ( const struct net_header *nethdr, struct ll_header *llhdr ) {
|
||||||
const void **ll_addr ) {
|
struct net_protocol *net_protocol = nethdr->net_protocol;
|
||||||
|
struct ll_protocol *ll_protocol = llhdr->ll_protocol;
|
||||||
const struct arp_entry *arp;
|
const struct arp_entry *arp;
|
||||||
struct net_interface *netif;
|
struct pk_buff *pkb;
|
||||||
struct arphdr *arphdr;
|
struct arphdr *arphdr;
|
||||||
|
int rc;
|
||||||
|
|
||||||
/* Look for existing entry in ARP table */
|
/* Look for existing entry in ARP table */
|
||||||
arp = arp_find_entry ( netdev->ll_proto, pkb->net_proto,
|
arp = arp_find_entry ( ll_protocol, net_protocol,
|
||||||
pkb->net_addr, pkb->net_addr_len );
|
nethdr->dest_net_addr );
|
||||||
if ( arp ) {
|
if ( arp ) {
|
||||||
*ll_addr = arp->ll_addr;
|
memcpy ( llhdr->dest_ll_addr, arp->ll_addr,
|
||||||
|
sizeof ( llhdr->dest_ll_addr ) );
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Find interface for this protocol */
|
/* Allocate ARP packet */
|
||||||
netif = netdev_find_netif ( netdev, pkb->net_proto );
|
pkb = alloc_pkb ( sizeof ( *arphdr ) +
|
||||||
if ( ! netif )
|
2 * ( MAX_LL_ADDR_LEN + MAX_NET_ADDR_LEN ) );
|
||||||
return -EAFNOSUPPORT;
|
if ( ! pkb )
|
||||||
|
return -ENOMEM;
|
||||||
|
pkb->net_protocol = &arp_protocol;
|
||||||
|
|
||||||
/* Build up ARP request */
|
/* Build up ARP request */
|
||||||
pkb_empty ( pkb );
|
|
||||||
arphdr = pkb_put ( pkb, sizeof ( *arphdr ) );
|
arphdr = pkb_put ( pkb, sizeof ( *arphdr ) );
|
||||||
arphdr->ar_hrd = netdev->ll_proto;
|
arphdr->ar_hrd = ll_protocol->ll_proto;
|
||||||
arphdr->ar_hln = netdev->ll_addr_len;
|
arphdr->ar_hln = ll_protocol->ll_addr_len;
|
||||||
arphdr->ar_pro = pkb->net_proto;
|
arphdr->ar_pro = net_protocol->net_proto;
|
||||||
arphdr->ar_pln = pkb->net_addr_len;
|
arphdr->ar_pln = net_protocol->net_addr_len;
|
||||||
arphdr->ar_op = htons ( ARPOP_REQUEST );
|
arphdr->ar_op = htons ( ARPOP_REQUEST );
|
||||||
memcpy ( pkb_put ( pkb, netdev->ll_addr_len ),
|
memcpy ( pkb_put ( pkb, ll_protocol->ll_addr_len ),
|
||||||
netdev->ll_addr, netdev->ll_addr_len );
|
llhdr->source_ll_addr, ll_protocol->ll_addr_len );
|
||||||
memcpy ( pkb_put ( pkb, netif->net_addr_len ),
|
memcpy ( pkb_put ( pkb, net_protocol->net_addr_len ),
|
||||||
netif->net_addr, netif->net_addr_len );
|
nethdr->source_net_addr, net_protocol->net_addr_len );
|
||||||
memset ( pkb_put ( pkb, netdev->ll_addr_len ),
|
memset ( pkb_put ( pkb, ll_protocol->ll_addr_len ),
|
||||||
0xff, netdev->ll_addr_len );
|
0, ll_protocol->ll_addr_len );
|
||||||
memcpy ( pkb_put ( pkb, netif->net_addr_len ),
|
memcpy ( pkb_put ( pkb, net_protocol->net_addr_len ),
|
||||||
pkb->net_addr, netif->net_addr_len );
|
nethdr->dest_net_addr, net_protocol->net_addr_len );
|
||||||
|
|
||||||
/* Locate ARP interface and send ARP request */
|
/* Transmit ARP request */
|
||||||
netif = netdev_find_netif ( netdev, htons ( ETH_P_ARP ) );
|
if ( ( rc = net_transmit ( pkb ) ) != 0 ) {
|
||||||
assert ( netif != NULL );
|
free_pkb ( pkb );
|
||||||
netif_send ( netif, pkb );
|
return rc;
|
||||||
|
}
|
||||||
|
|
||||||
return -ENOENT;
|
return -ENOENT;
|
||||||
}
|
}
|
||||||
@@ -148,7 +156,6 @@ int arp_resolve ( struct net_device *netdev, struct pk_buff *pkb,
|
|||||||
/**
|
/**
|
||||||
* Process incoming ARP packets
|
* Process incoming ARP packets
|
||||||
*
|
*
|
||||||
* @v arp_netif Network interface for ARP packets
|
|
||||||
* @v pkb Packet buffer
|
* @v pkb Packet buffer
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
*
|
||||||
@@ -158,44 +165,45 @@ int arp_resolve ( struct net_device *netdev, struct pk_buff *pkb,
|
|||||||
* avoiding the need for extraneous ARP requests; read the RFC for
|
* avoiding the need for extraneous ARP requests; read the RFC for
|
||||||
* details.
|
* details.
|
||||||
*/
|
*/
|
||||||
int arp_process ( struct net_interface *arp_netif, struct pk_buff *pkb ) {
|
static int arp_rx ( struct pk_buff *pkb ) {
|
||||||
struct arphdr *arphdr = pkb->data;
|
struct arphdr *arphdr = pkb->data;
|
||||||
struct net_device *netdev = arp_netif->netdev;
|
struct ll_protocol *ll_protocol;
|
||||||
struct net_interface *netif;
|
struct net_protocol *net_protocol;
|
||||||
struct arp_entry *arp;
|
struct arp_entry *arp;
|
||||||
|
struct net_device *netdev;
|
||||||
int merge = 0;
|
int merge = 0;
|
||||||
|
|
||||||
/* Check for correct link-layer protocol and length */
|
/* Identify link-layer and network-layer protocols */
|
||||||
if ( ( arphdr->ar_hrd != netdev->ll_proto ) ||
|
ll_protocol = pkb->ll_protocol;
|
||||||
( arphdr->ar_hln != netdev->ll_addr_len ) )
|
net_protocol = net_find_protocol ( arphdr->ar_pro );
|
||||||
return 0;
|
if ( ! net_protocol )
|
||||||
|
goto done;
|
||||||
|
|
||||||
/* See if we have an interface for this network-layer protocol */
|
/* Sanity checks */
|
||||||
netif = netdev_find_netif ( netdev, arphdr->ar_pro );
|
if ( ( arphdr->ar_hrd != ll_protocol->ll_proto ) ||
|
||||||
if ( ! netif )
|
( arphdr->ar_hln != ll_protocol->ll_addr_len ) ||
|
||||||
return 0;
|
( arphdr->ar_pln != net_protocol->net_addr_len ) )
|
||||||
if ( arphdr->ar_pln != netif->net_addr_len )
|
goto done;
|
||||||
return 0;
|
|
||||||
|
|
||||||
/* See if we have an entry for this sender, and update it if so */
|
/* See if we have an entry for this sender, and update it if so */
|
||||||
arp = arp_find_entry ( arphdr->ar_hrd, arphdr->ar_pro,
|
arp = arp_find_entry ( ll_protocol, net_protocol,
|
||||||
arp_sender_pa ( arphdr ), arphdr->ar_pln );
|
arp_sender_pa ( arphdr ) );
|
||||||
if ( arp ) {
|
if ( arp ) {
|
||||||
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
||||||
arphdr->ar_hln );
|
arphdr->ar_hln );
|
||||||
merge = 1;
|
merge = 1;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* See if we are the target protocol address */
|
/* See if we own the target protocol address */
|
||||||
if ( memcmp ( arp_target_pa ( arphdr ), netif->net_addr,
|
netdev = net_find_address ( net_protocol, arp_target_pa ( arphdr ) );
|
||||||
arphdr->ar_pln ) != 0 )
|
if ( ! netdev )
|
||||||
return 0;
|
goto done;
|
||||||
|
|
||||||
/* Create new ARP table entry if necessary */
|
/* Create new ARP table entry if necessary */
|
||||||
if ( ! merge ) {
|
if ( ! merge ) {
|
||||||
arp = &arp_table[next_new_arp_entry++ % NUM_ARP_ENTRIES];
|
arp = &arp_table[next_new_arp_entry++ % NUM_ARP_ENTRIES];
|
||||||
arp->ll_proto = arphdr->ar_hrd;
|
arp->ll_protocol = ll_protocol;
|
||||||
arp->net_proto = arphdr->ar_pro;
|
arp->net_protocol = net_protocol;
|
||||||
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
memcpy ( arp->ll_addr, arp_sender_ha ( arphdr ),
|
||||||
arphdr->ar_hln );
|
arphdr->ar_hln );
|
||||||
memcpy ( arp->net_addr, arp_sender_pa ( arphdr ),
|
memcpy ( arp->net_addr, arp_sender_pa ( arphdr ),
|
||||||
@@ -204,34 +212,49 @@ int arp_process ( struct net_interface *arp_netif, struct pk_buff *pkb ) {
|
|||||||
|
|
||||||
/* 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 ) )
|
||||||
return 0;
|
goto done;
|
||||||
|
|
||||||
/* Change request to a reply, and send it */
|
/* Change request to a reply, and send it */
|
||||||
arphdr->ar_op = htons ( ARPOP_REPLY );
|
arphdr->ar_op = htons ( ARPOP_REPLY );
|
||||||
memcpy ( arp_sender_ha ( arphdr ), arp_target_ha ( arphdr ),
|
memswap ( arp_sender_ha ( arphdr ), arp_target_ha ( arphdr ),
|
||||||
arphdr->ar_hln + arphdr->ar_pln );
|
arphdr->ar_hln + arphdr->ar_pln );
|
||||||
memcpy ( arp_target_ha ( arphdr ), netdev->ll_addr, arphdr->ar_hln );
|
memcpy ( arp_target_ha ( arphdr ), netdev->ll_addr, arphdr->ar_hln );
|
||||||
memcpy ( arp_target_pa ( arphdr ), netif->net_addr, arphdr->ar_pln );
|
if ( net_transmit ( pkb ) == 0 )
|
||||||
netif_send ( arp_netif, pkb );
|
pkb = NULL;
|
||||||
|
|
||||||
|
done:
|
||||||
|
free_pkb ( pkb );
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Add media-independent link-layer header
|
* Perform ARP network-layer routing
|
||||||
*
|
*
|
||||||
* @v arp_netif Network interface for ARP packets
|
|
||||||
* @v pkb Packet buffer
|
* @v pkb Packet buffer
|
||||||
|
* @ret source Network-layer source address
|
||||||
|
* @ret dest Network-layer destination address
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*/
|
*/
|
||||||
int arp_add_llh_metadata ( struct net_interface *arp_netif __unused,
|
static int arp_route ( const struct pk_buff *pkb,
|
||||||
struct pk_buff *pkb ) {
|
struct net_header *nethdr ) {
|
||||||
struct arphdr *arphdr = pkb->data;
|
struct arphdr *arphdr = pkb->data;
|
||||||
|
|
||||||
pkb->net_proto = htons ( ETH_P_ARP );
|
memcpy ( nethdr->source_net_addr, arp_sender_ha ( arphdr ),
|
||||||
pkb->flags = PKB_FL_RAW_NET_ADDR;
|
arphdr->ar_hln );
|
||||||
pkb->net_addr_len = arphdr->ar_hln;
|
memcpy ( nethdr->dest_net_addr, arp_target_ha ( arphdr ),
|
||||||
pkb->net_addr = arp_target_ha ( arphdr );
|
arphdr->ar_hln );
|
||||||
|
nethdr->dest_flags = NETADDR_FL_RAW;
|
||||||
|
if ( arphdr->ar_op == htons ( ARPOP_REQUEST ) )
|
||||||
|
nethdr->dest_flags |= NETADDR_FL_BROADCAST;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/** ARP protocol */
|
||||||
|
struct net_protocol arp_protocol = {
|
||||||
|
.net_proto = ETH_P_ARP,
|
||||||
|
.rx = arp_rx,
|
||||||
|
.route = arp_route,
|
||||||
|
};
|
||||||
|
|
||||||
|
NET_PROTOCOL ( arp_protocol );
|
||||||
|
|||||||
@@ -20,10 +20,12 @@
|
|||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <byteswap.h>
|
#include <byteswap.h>
|
||||||
#include <assert.h>
|
#include <assert.h>
|
||||||
|
#include <gpxe/if_arp.h>
|
||||||
#include <gpxe/if_ether.h>
|
#include <gpxe/if_ether.h>
|
||||||
#include <gpxe/netdevice.h>
|
#include <gpxe/netdevice.h>
|
||||||
#include <gpxe/pkbuff.h>
|
#include <gpxe/pkbuff.h>
|
||||||
#include <gpxe/arp.h>
|
#include <gpxe/arp.h>
|
||||||
|
#include <gpxe/ethernet.h>
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
*
|
*
|
||||||
@@ -32,85 +34,104 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
/** Ethernet broadcast MAC address */
|
/** Ethernet broadcast MAC address */
|
||||||
static uint8_t eth_broadcast[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
|
static uint8_t eth_broadcast[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Build Ethernet link-layer header
|
* Perform Ethernet routing
|
||||||
*
|
*
|
||||||
* @v netdev Network device
|
* @v nethdr Generic network-layer header
|
||||||
* @v pkb Packet buffer
|
* @ret llhdr Generic link-layer header
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
*
|
||||||
* This constructs the Ethernet link-layer header (destination MAC,
|
* Constructs the generic link-layer header based on the generic
|
||||||
* source MAC, network-layer protocol) based on the metadata found in
|
* network-layer header, i.e. maps network-layer addresses (e.g. IPv4
|
||||||
* @c pkb.
|
* addresses) to MAC addresses.
|
||||||
*
|
*
|
||||||
* If the destination MAC address cannot be determined, an ARP request
|
* If the destination MAC address cannot be determined, an ARP request
|
||||||
* is sent for the requested network-layer address instead.
|
* is sent for the requested network-layer address and -ENOENT is
|
||||||
|
* returned.
|
||||||
*/
|
*/
|
||||||
int eth_build_llh ( struct net_device *netdev, struct pk_buff *pkb ) {
|
static int eth_route ( const struct net_header *nethdr,
|
||||||
struct ethhdr *ethhdr = pkb->data;
|
struct ll_header *llhdr ) {
|
||||||
const void *eth_dest;
|
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
/* Do the easy bits */
|
|
||||||
ethhdr->h_protocol = pkb->net_proto;
|
|
||||||
memcpy ( ethhdr->h_source, netdev->ll_addr,
|
|
||||||
sizeof ( ethhdr->h_source ) );
|
|
||||||
|
|
||||||
/* Work out the destination MAC address */
|
/* Work out the destination MAC address */
|
||||||
if ( pkb->flags & PKB_FL_RAW_NET_ADDR ) {
|
if ( nethdr->dest_flags & NETADDR_FL_RAW ) {
|
||||||
eth_dest = pkb->net_addr;
|
memcpy ( llhdr->dest_ll_addr, nethdr->dest_net_addr, ETH_ALEN);
|
||||||
} else if ( pkb->flags & PKB_FL_BROADCAST ) {
|
} else if ( nethdr->dest_flags & NETADDR_FL_BROADCAST ) {
|
||||||
eth_dest = eth_broadcast;
|
memcpy ( llhdr->dest_ll_addr, eth_broadcast, ETH_ALEN );
|
||||||
} else if ( pkb->flags & PKB_FL_MULTICAST ) {
|
} else if ( nethdr->dest_flags & NETADDR_FL_MULTICAST ) {
|
||||||
/* IP multicast is a special case; there exists a
|
/* IP multicast is a special case; there exists a
|
||||||
* direct mapping from IP address to MAC address
|
* direct mapping from IP address to MAC address
|
||||||
*/
|
*/
|
||||||
assert ( pkb->net_proto == htons ( ETH_P_IP ) );
|
assert ( nethdr->net_protocol->net_proto == htons(ETH_P_IP) );
|
||||||
ethhdr->h_dest[0] = 0x01;
|
llhdr->dest_ll_addr[0] = 0x01;
|
||||||
ethhdr->h_dest[1] = 0x00;
|
llhdr->dest_ll_addr[1] = 0x00;
|
||||||
ethhdr->h_dest[2] = 0x5e;
|
llhdr->dest_ll_addr[2] = 0x5e;
|
||||||
ethhdr->h_dest[3] = *( ( char * ) pkb->net_addr + 1 ) & 0x7f;
|
llhdr->dest_ll_addr[3] = nethdr->dest_net_addr[1] & 0x7f;
|
||||||
ethhdr->h_dest[4] = *( ( char * ) pkb->net_addr + 2 );
|
llhdr->dest_ll_addr[4] = nethdr->dest_net_addr[2];
|
||||||
ethhdr->h_dest[5] = *( ( char * ) pkb->net_addr + 3 );
|
llhdr->dest_ll_addr[5] = nethdr->dest_net_addr[3];
|
||||||
eth_dest = ethhdr->h_dest;
|
|
||||||
} else {
|
} else {
|
||||||
/* Otherwise, look up the address using ARP */
|
/* Otherwise, look up the address using ARP */
|
||||||
if ( ( rc = arp_resolve ( netdev, pkb, ð_dest ) ) != 0 )
|
if ( ( rc = arp_resolve ( nethdr, llhdr ) ) != 0 )
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Fill in destination MAC address */
|
|
||||||
memcpy ( ethhdr->h_dest, eth_dest, sizeof ( ethhdr->h_dest ) );
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Fill in Ethernet link-layer header
|
||||||
|
*
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
* @v llhdr Generic link-layer header
|
||||||
|
*
|
||||||
|
* Fills in the Ethernet link-layer header in the packet buffer based
|
||||||
|
* on information in the generic link-layer header.
|
||||||
|
*/
|
||||||
|
static void eth_fill_llh ( const struct ll_header *llhdr,
|
||||||
|
struct pk_buff *pkb ) {
|
||||||
|
struct ethhdr *ethhdr = pkb->data;
|
||||||
|
|
||||||
|
memcpy ( ethhdr->h_dest, llhdr->dest_ll_addr, ETH_ALEN );
|
||||||
|
memcpy ( ethhdr->h_source, llhdr->source_ll_addr, ETH_ALEN );
|
||||||
|
ethhdr->h_protocol = llhdr->net_proto;
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Parse Ethernet link-layer header
|
* Parse Ethernet link-layer header
|
||||||
*
|
*
|
||||||
* @v netdev Network device
|
|
||||||
* @v pkb Packet buffer
|
* @v pkb Packet buffer
|
||||||
* @ret rc Return status code
|
* @v llhdr Generic link-layer header
|
||||||
*
|
*
|
||||||
* This parses the Ethernet link-layer header (destination MAC, source
|
* Fills in the generic link-layer header based on information in the
|
||||||
* MAC, network-layer protocol) and fills in the metadata in @c pkb.
|
* Ethernet link-layer header in the packet buffer.
|
||||||
*/
|
*/
|
||||||
int eth_parse_llh ( struct net_device *netdev __unused, struct pk_buff *pkb ) {
|
static void eth_parse_llh ( const struct pk_buff *pkb,
|
||||||
|
struct ll_header *llhdr ) {
|
||||||
struct ethhdr *ethhdr = pkb->data;
|
struct ethhdr *ethhdr = pkb->data;
|
||||||
|
|
||||||
pkb->net_proto = ethhdr->h_protocol;
|
memcpy ( llhdr->dest_ll_addr, ethhdr->h_dest, ETH_ALEN );
|
||||||
pkb->flags = PKB_FL_RAW_NET_ADDR;
|
memcpy ( llhdr->source_ll_addr, ethhdr->h_source, ETH_ALEN );
|
||||||
pkb->net_addr_len = sizeof ( ethhdr->h_dest );
|
llhdr->net_proto = ethhdr->h_protocol;
|
||||||
pkb->net_addr = ethhdr->h_dest;
|
|
||||||
|
|
||||||
if ( memcmp ( ethhdr->h_dest, eth_broadcast,
|
if ( memcmp ( ethhdr->h_dest, eth_broadcast, ETH_ALEN ) == 0 ) {
|
||||||
sizeof ( ethhdr->h_dest ) ) == 0 ) {
|
llhdr->dest_flags = NETADDR_FL_BROADCAST;
|
||||||
pkb->flags |= PKB_FL_BROADCAST;
|
|
||||||
} else if ( ethhdr->h_dest[0] & 0x01 ) {
|
} else if ( ethhdr->h_dest[0] & 0x01 ) {
|
||||||
pkb->flags |= PKB_FL_MULTICAST;
|
llhdr->dest_flags = NETADDR_FL_MULTICAST;
|
||||||
|
} else {
|
||||||
|
llhdr->dest_flags = 0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
/** Ethernet protocol */
|
||||||
}
|
struct ll_protocol ethernet_protocol = {
|
||||||
|
.ll_proto = htons ( ARPHRD_ETHER ),
|
||||||
|
.ll_addr_len = ETH_ALEN,
|
||||||
|
.ll_header_len = ETH_HLEN,
|
||||||
|
.route = eth_route,
|
||||||
|
.fill_llh = eth_fill_llh,
|
||||||
|
.parse_llh = eth_parse_llh,
|
||||||
|
};
|
||||||
|
|
||||||
|
LL_PROTOCOL ( ethernet_protocol );
|
||||||
|
|||||||
@@ -18,146 +18,231 @@
|
|||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <byteswap.h>
|
#include <byteswap.h>
|
||||||
|
#include <string.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
#include <gpxe/if_ether.h>
|
#include <gpxe/if_ether.h>
|
||||||
#include <gpxe/pkbuff.h>
|
#include <gpxe/pkbuff.h>
|
||||||
|
#include <gpxe/tables.h>
|
||||||
#include <gpxe/netdevice.h>
|
#include <gpxe/netdevice.h>
|
||||||
|
|
||||||
/** @file
|
/** @file
|
||||||
*
|
*
|
||||||
* Network devices and network interfaces
|
* Network device management
|
||||||
*
|
*
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/** List of all registered network devices */
|
|
||||||
static LIST_HEAD ( net_devices );
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Register network device
|
* Static single instance of a network device
|
||||||
*
|
*
|
||||||
* @v netdev Network device
|
* The gPXE API is designed to accommodate multiple network devices.
|
||||||
|
* However, in the interests of code size, the implementation behind
|
||||||
|
* the API supports only a single instance of a network device.
|
||||||
|
*
|
||||||
|
* No code outside of netdevice.c should ever refer directly to @c
|
||||||
|
* static_single_netdev.
|
||||||
|
*
|
||||||
|
* Callers should always check the return status of alloc_netdev(),
|
||||||
|
* register_netdev() etc. In the current implementation this code
|
||||||
|
* will be optimised out by the compiler, so there is no penalty.
|
||||||
|
*/
|
||||||
|
struct net_device static_single_netdev;
|
||||||
|
|
||||||
|
/** Registered network-layer protocols */
|
||||||
|
static struct net_protocol net_protocols[0] __table_start ( net_protocols );
|
||||||
|
static struct net_protocol net_protocols_end[0] __table_end ( net_protocols );
|
||||||
|
|
||||||
|
/** Network-layer addresses for @c static_single_netdev */
|
||||||
|
static struct net_address static_single_netdev_addresses[0]
|
||||||
|
__table_start ( sgl_netdev_addresses );
|
||||||
|
static struct net_address static_single_netdev_addresses_end[0]
|
||||||
|
__table_end ( sgl_netdev_addresses );
|
||||||
|
|
||||||
|
/** Recevied packet queue */
|
||||||
|
static LIST_HEAD ( rx_queue );
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Identify network protocol
|
||||||
|
*
|
||||||
|
* @v net_proto Network-layer protocol, in network-byte order
|
||||||
|
* @ret net_protocol Network-layer protocol, or NULL
|
||||||
|
*
|
||||||
|
* Identify a network-layer protocol from a protocol number, which
|
||||||
|
* must be an ETH_P_XXX constant in network-byte order.
|
||||||
|
*/
|
||||||
|
struct net_protocol * net_find_protocol ( uint16_t net_proto ) {
|
||||||
|
struct net_protocol *net_protocol;
|
||||||
|
|
||||||
|
for ( net_protocol = net_protocols ; net_protocol < net_protocols_end ;
|
||||||
|
net_protocol++ ) {
|
||||||
|
if ( net_protocol->net_proto == net_proto )
|
||||||
|
return net_protocol;
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Identify network device by network-layer address
|
||||||
|
*
|
||||||
|
* @v net_protocol Network-layer protocol
|
||||||
|
* @v net_addr Network-layer address
|
||||||
|
* @ret netdev Network device, or NULL
|
||||||
|
*
|
||||||
|
* Searches through all network devices to find the device with the
|
||||||
|
* specified network-layer address.
|
||||||
|
*
|
||||||
|
* Note that even with a static single network device, this function
|
||||||
|
* can still return NULL.
|
||||||
|
*/
|
||||||
|
struct net_device * net_find_address ( struct net_protocol *net_protocol,
|
||||||
|
void *net_addr ) {
|
||||||
|
struct net_address *net_address;
|
||||||
|
struct net_device *netdev = &static_single_netdev;
|
||||||
|
|
||||||
|
for ( net_address = static_single_netdev_addresses ;
|
||||||
|
net_address < static_single_netdev_addresses_end ;
|
||||||
|
net_address ++ ) {
|
||||||
|
if ( ( net_address->net_protocol == net_protocol ) &&
|
||||||
|
( memcmp ( net_address->net_addr, net_addr,
|
||||||
|
net_protocol->net_addr_len ) == 0 ) )
|
||||||
|
return netdev;
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Transmit packet
|
||||||
|
*
|
||||||
|
* @v pkb Packet buffer
|
||||||
* @ret rc Return status code
|
* @ret rc Return status code
|
||||||
*
|
*
|
||||||
* Adds the network device to the list of network devices.
|
* Transmits the packet via the appropriate network device. If this
|
||||||
|
* function returns success, it has taken ownership of the packet
|
||||||
|
* buffer.
|
||||||
*/
|
*/
|
||||||
int register_netdevice ( struct net_device *netdev ) {
|
int net_transmit ( struct pk_buff *pkb ) {
|
||||||
list_add ( &netdev->devices, &net_devices );
|
struct net_protocol *net_protocol;
|
||||||
|
struct net_header nethdr;
|
||||||
|
struct ll_protocol *ll_protocol;
|
||||||
|
struct ll_header llhdr;
|
||||||
|
struct net_device *netdev;
|
||||||
|
int rc;
|
||||||
|
|
||||||
|
/* Perform network-layer routing */
|
||||||
|
net_protocol = pkb->net_protocol;
|
||||||
|
nethdr.net_protocol = net_protocol;
|
||||||
|
if ( ( rc = net_protocol->route ( pkb, &nethdr ) ) != 0 )
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
/* Identify transmitting network device */
|
||||||
|
netdev = net_find_address ( net_protocol, nethdr.source_net_addr );
|
||||||
|
if ( ! netdev )
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
/* Perform link-layer routing */
|
||||||
|
ll_protocol = netdev->ll_protocol;
|
||||||
|
llhdr.ll_protocol = ll_protocol;
|
||||||
|
llhdr.net_proto = net_protocol->net_proto;
|
||||||
|
memcpy ( llhdr.source_ll_addr, netdev->ll_addr,
|
||||||
|
ll_protocol->ll_addr_len);
|
||||||
|
if ( ( rc = ll_protocol->route ( &nethdr, &llhdr ) ) != 0 )
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
/* Prepend link-layer header */
|
||||||
|
pkb_push ( pkb, ll_protocol->ll_header_len );
|
||||||
|
ll_protocol->fill_llh ( &llhdr, pkb );
|
||||||
|
|
||||||
|
/* Transmit packet */
|
||||||
|
if ( ( rc = netdev->transmit ( netdev, pkb ) ) != 0 )
|
||||||
|
goto err;
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
err:
|
||||||
* Unregister network device
|
free_pkb ( pkb );
|
||||||
*
|
|
||||||
* @v netdev Network device
|
|
||||||
*
|
|
||||||
* Removes the network device from the list of network devices.
|
|
||||||
*/
|
|
||||||
void unregister_netdevice ( struct net_device *netdev ) {
|
|
||||||
list_del ( &netdev->devices );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Transmit packet via network device
|
|
||||||
*
|
|
||||||
* @v netdev Network device
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* Transmits the packet via the network device. The @c pkb link-layer
|
|
||||||
* metadata must already have been filled in, and space for the
|
|
||||||
* link-layer header must already be present in the packet buffer.
|
|
||||||
*/
|
|
||||||
int netdev_send ( struct net_device *netdev, struct pk_buff *pkb ) {
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if ( pkb->net_proto != ETH_P_RAW ) {
|
|
||||||
if ( ( rc = netdev->build_llh ( netdev, pkb ) ) != 0 )
|
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
return netdev->transmit ( netdev, pkb );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Poll for packet on network device
|
|
||||||
*
|
|
||||||
* @v netdev Network device
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* Polls the network device for a packet. If a packet is available,
|
|
||||||
* it will be added to the packet buffer, and the link-layer metadata
|
|
||||||
* fields in @c pkb will be filled in.
|
|
||||||
*/
|
|
||||||
int netdev_poll ( struct net_device *netdev, struct pk_buff *pkb ) {
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if ( ( rc = netdev->poll ( netdev, pkb ) ) != 0 )
|
|
||||||
return rc;
|
|
||||||
return netdev->parse_llh ( netdev, pkb );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Transmit packet via network interface
|
|
||||||
*
|
|
||||||
* @v netif Network interface
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* Transmits the packet via the network interface. The packet must
|
|
||||||
* start with a network-layer header (e.g. an IP header, for an IP
|
|
||||||
* interface). The packet contents are undefined on return.
|
|
||||||
*/
|
|
||||||
int netif_send ( struct net_interface *netif, struct pk_buff *pkb ) {
|
|
||||||
struct net_device *netdev = netif->netdev;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if ( ( rc = netif->add_llh_metadata ( netif, pkb ) ) != 0 )
|
|
||||||
return rc;
|
|
||||||
pkb_push ( pkb, netdev->ll_hlen );
|
|
||||||
return netdev_send ( netdev, pkb );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* Process received packet
|
|
||||||
*
|
|
||||||
* @v netif Network interface
|
|
||||||
* @v pkb Packet buffer
|
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
|
||||||
* Processes a packet received via netdev_poll(). The interface
|
|
||||||
* corresponding to the network-layer protocol is identified, the
|
|
||||||
* link-layer header is stripped from the packet and the packet is
|
|
||||||
* passed to the net_interface::rx_packet() method.
|
|
||||||
*/
|
|
||||||
int netdev_rx_packet ( struct net_device *netdev, struct pk_buff *pkb ) {
|
|
||||||
struct net_interface *netif;
|
|
||||||
|
|
||||||
netif = netdev_find_netif ( netdev, pkb->net_proto );
|
|
||||||
if ( ! netif )
|
|
||||||
return -EAFNOSUPPORT;
|
|
||||||
|
|
||||||
pkb_pull ( pkb, netdev->ll_hlen );
|
|
||||||
return netif->rx_packet ( netif, pkb );
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Poll for packet on all network devices
|
* Poll for packet on all network devices
|
||||||
*
|
*
|
||||||
* @v pkb Packet buffer
|
* @ret True There are packets present in the receive queue
|
||||||
* @ret netdev Network device
|
* @ret False There are no packets present in the receive queue
|
||||||
* @ret rc Return status code
|
|
||||||
*
|
*
|
||||||
* Polls all network devices for a packet. If a packet is available
|
* Polls all network devices for received packets. Any received
|
||||||
* on any interface, @c netdev will be filled in and the packet will
|
* packets will be added to the RX packet queue via netdev_rx().
|
||||||
* be received as per netdev_poll().
|
|
||||||
*/
|
*/
|
||||||
int net_poll ( struct pk_buff *pkb, struct net_device **netdev ) {
|
int net_poll ( void ) {
|
||||||
int rc;
|
struct net_device *netdev = &static_single_netdev;
|
||||||
|
|
||||||
list_for_each_entry ( (*netdev), &net_devices, devices ) {
|
netdev->poll ( netdev );
|
||||||
if ( ( rc = netdev_poll ( *netdev, pkb ) ) == 0 )
|
|
||||||
return rc;
|
return ( ! list_empty ( &rx_queue ) );
|
||||||
}
|
}
|
||||||
|
|
||||||
return -EAGAIN;
|
/**
|
||||||
|
* Add packet to receive queue
|
||||||
|
*
|
||||||
|
* @v netdev Network device
|
||||||
|
* @v pkb Packet buffer
|
||||||
|
*
|
||||||
|
* The packet is added to the RX queue. Ownership of the packet is
|
||||||
|
* transferred to the RX queue; the caller must not touch the packet
|
||||||
|
* buffer after calling netdev_rx().
|
||||||
|
*/
|
||||||
|
void netdev_rx ( struct net_device *netdev, struct pk_buff *pkb ) {
|
||||||
|
pkb->ll_protocol = netdev->ll_protocol;
|
||||||
|
list_add_tail ( &pkb->list, &rx_queue );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Remove packet from receive queue
|
||||||
|
*
|
||||||
|
* @ret pkb Packet buffer, or NULL
|
||||||
|
*
|
||||||
|
* Removes the first packet from the RX queue and returns it.
|
||||||
|
* Ownership of the packet is transferred to the caller.
|
||||||
|
*/
|
||||||
|
struct pk_buff * net_rx_dequeue ( void ) {
|
||||||
|
struct pk_buff *pkb;
|
||||||
|
|
||||||
|
list_for_each_entry ( pkb, &rx_queue, list ) {
|
||||||
|
list_del ( &pkb->list );
|
||||||
|
return pkb;
|
||||||
|
}
|
||||||
|
return NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
void net_run ( void ) {
|
||||||
|
struct pk_buff *pkb;
|
||||||
|
struct ll_protocol *ll_protocol;
|
||||||
|
struct ll_header llhdr;
|
||||||
|
struct net_protocol *net_protocol;
|
||||||
|
|
||||||
|
while ( ( pkb = net_rx_dequeue () ) ) {
|
||||||
|
|
||||||
|
/* Parse link-layer header */
|
||||||
|
ll_protocol = pkb->ll_protocol;
|
||||||
|
ll_protocol->parse_llh ( pkb, &llhdr );
|
||||||
|
|
||||||
|
/* Identify network-layer protocol */
|
||||||
|
net_protocol = net_find_protocol ( llhdr.net_proto );
|
||||||
|
if ( ! net_protocol ) {
|
||||||
|
DBG ( "Unknown network-layer protocol %02x\n",
|
||||||
|
ntohs ( llhdr.net_proto ) );
|
||||||
|
free_pkb ( pkb );
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Strip off link-layer header */
|
||||||
|
pkb_pull ( pkb, ll_protocol->ll_header_len );
|
||||||
|
|
||||||
|
/* Hand off to network layer */
|
||||||
|
if ( net_protocol->rx ( pkb ) != 0 ) {
|
||||||
|
free_pkb ( pkb );
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|||||||
@@ -464,7 +464,7 @@ void uip_log(char *msg);
|
|||||||
*
|
*
|
||||||
* \hideinitializer
|
* \hideinitializer
|
||||||
*/
|
*/
|
||||||
#define UIP_LLH_LEN 14
|
#define UIP_LLH_LEN 0
|
||||||
|
|
||||||
|
|
||||||
/** @} */
|
/** @} */
|
||||||
|
|||||||
Reference in New Issue
Block a user