kill command for the gdb stub to return to hbc

[libogc.git] / libdb / uIP / uip_arp.c

/**
 * \addtogroup uip
 * @{
 */

/**
 * \defgroup uiparp uIP Address Resolution Protocol
 * @{
 * 
 * The Address Resolution Protocol ARP is used for mapping between IP
 * addresses and link level addresses such as the Ethernet MAC
 * addresses. ARP uses broadcast queries to ask for the link level
 * address of a known IP address and the host which is configured with
 * the IP address for which the query was meant, will respond with its
 * link level address.
 *
 * \note This ARP implementation only supports Ethernet.
 */
 
/**
 * \file
 * Implementation of the ARP Address Resolution Protocol.
 * \author Adam Dunkels <adam@dunkels.com>
 *
 */

/*
 * Copyright (c) 2001-2003, Adam Dunkels.
 * All rights reserved. 
 *
 * Redistribution and use in source and binary forms, with or without 
 * modification, are permitted provided that the following conditions 
 * are met: 
 * 1. Redistributions of source code must retain the above copyright 
 *    notice, this list of conditions and the following disclaimer. 
 * 2. Redistributions in binary form must reproduce the above copyright 
 *    notice, this list of conditions and the following disclaimer in the 
 *    documentation and/or other materials provided with the distribution. 
 * 3. The name of the author may not be used to endorse or promote
 *    products derived from this software without specific prior
 *    written permission.  
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE
 * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.  
 *
 * This file is part of the uIP TCP/IP stack.
 *
 *
 */


#include "uip_pbuf.h"
#include "uip_netif.h"
#include "uip_arp.h"

#include <string.h>

#if UIP_LOGGING == 1
#include <stdio.h>
#define UIP_LOG(m) uip_log(__FILE__,__LINE__,m)
#else
#define UIP_LOG(m)
#endif /* UIP_LOGGING == 1 */

#if UIP_STATISTICS == 1
struct uip_stats uip_stat;
#define UIP_STAT(s) s
#else
#define UIP_STAT(s)
#endif /* UIP_STATISTICS == 1 */


#define ARP_TRY_HARD 0x01

#define ARP_MAXAGE 240
#define ARP_MAXPENDING 2

#define ARP_REQUEST 1
#define ARP_REPLY   2

#define ARP_HWTYPE_ETH 1

#define ARPH_HWLEN(hdr) (ntohs((hdr)->_hwlen_protolen) >> 8)
#define ARPH_PROTOLEN(hdr) (ntohs((hdr)->_hwlen_protolen) & 0xff)

#define ARPH_HWLEN_SET(hdr, len) (hdr)->_hwlen_protolen = htons(ARPH_PROTOLEN(hdr) | ((len) << 8))
#define ARPH_PROTOLEN_SET(hdr, len) (hdr)->_hwlen_protolen = htons((len) | (ARPH_HWLEN(hdr) << 8))

enum arp_state {
        ARP_STATE_EMPTY,
        ARP_STATE_PENDING,
        ARP_STATE_STABLE,
        ARP_STATE_EXPIRED
};

struct arp_entry {
  struct uip_ip_addr ipaddr;
  struct uip_eth_addr ethaddr;
  enum arp_state state;
  u8_t time;
};

static const struct uip_eth_addr ethbroadcast = {{0xff,0xff,0xff,0xff,0xff,0xff}};
static struct arp_entry arp_table[UIP_ARPTAB_SIZE];
/*-----------------------------------------------------------------------------------*/
/**
 * Initialize the ARP module.
 *
 */
/*-----------------------------------------------------------------------------------*/
void
uip_arp_init(void)
{
        s32_t i;
        for(i = 0; i < UIP_ARPTAB_SIZE; ++i) {
                arp_table[i].state = ARP_STATE_EMPTY;
                arp_table[i].time = 0;
        }
}
/*-----------------------------------------------------------------------------------*/
/**
 * Periodic ARP processing function.
 *
 * This function performs periodic timer processing in the ARP module
 * and should be called at regular intervals. The recommended interval
 * is 10 seconds between the calls.
 *
 */
/*-----------------------------------------------------------------------------------*/
void
uip_arp_timer(void)
{
        u8_t i;

        for(i=0;i<UIP_ARPTAB_SIZE;i++) {
                arp_table[i].time++;
                if(arp_table[i].state==ARP_STATE_STABLE && arp_table[i].time>=ARP_MAXAGE) {
                        arp_table[i].state = ARP_STATE_EXPIRED;
                } else if(arp_table[i].state==ARP_STATE_PENDING) {
                        if(arp_table[i].time>=ARP_MAXPENDING) arp_table[i].state = ARP_STATE_EXPIRED;
                }

                if(arp_table[i].state==ARP_STATE_EXPIRED) arp_table[i].state = ARP_STATE_EMPTY;
        }
}

static s8_t uip_arp_findentry(struct uip_ip_addr *ipaddr,u8_t flags)
{
        s8_t old_pending = UIP_ARPTAB_SIZE, old_stable = UIP_ARPTAB_SIZE;
        s8_t empty = UIP_ARPTAB_SIZE;
        u8_t i = 0,age_pending = 0,age_stable = 0;

        /* Walk through the ARP mapping table and try to find an entry to
           update. If none is found, the IP -> MAC address mapping is
           inserted in the ARP table. */
        for(i = 0; i < UIP_ARPTAB_SIZE; ++i) {
                if(empty==UIP_ARPTAB_SIZE && arp_table[i].state==ARP_STATE_EMPTY) {
                        empty = i;
                } else if(arp_table[i].state==ARP_STATE_PENDING) {
                        if(ipaddr && ip_addr_cmp(ipaddr,&arp_table[i].ipaddr)) return i;
                        else if(arp_table[i].time>=age_pending) {
                                old_pending = i;
                                age_pending = arp_table[i].time;
                        }
                } else if(arp_table[i].state==ARP_STATE_STABLE) {
                        if(ipaddr && ip_addr_cmp(ipaddr,&arp_table[i].ipaddr)) return i;
                        else if(arp_table[i].time>=age_stable) {
                                old_stable = i;
                                age_stable = arp_table[i].time;
                        }
                }
        }
        if(empty==UIP_ARPTAB_SIZE && !(flags&ARP_TRY_HARD)) return UIP_ERR_MEM;
        
        if(empty<UIP_ARPTAB_SIZE) i = empty;
        else if(old_stable<UIP_ARPTAB_SIZE) i = old_stable;
        else if(old_pending<UIP_ARPTAB_SIZE) i = old_pending;
        else return UIP_ERR_MEM;

        arp_table[i].time = 0;
        arp_table[i].state = ARP_STATE_EMPTY;
        if(ipaddr!=NULL) ip_addr_set(&arp_table[i].ipaddr,ipaddr);
        
        return (s8_t)i;
}

/*-----------------------------------------------------------------------------------*/
static s8_t uip_arp_update(struct uip_netif *netif,struct uip_ip_addr *ipaddr, struct uip_eth_addr *ethaddr,u8_t flags)
{
        s8_t i,k;

        if(ip_addr_isany(ipaddr) ||
                ip_addr_isbroadcast(ipaddr,netif) ||
                ip_addr_ismulticast(ipaddr)) return UIP_ERR_ARG;

        i = uip_arp_findentry(ipaddr,flags);
        if(i<0) return i;

        arp_table[i].time = 0;
        arp_table[i].state = ARP_STATE_STABLE;
        for(k=0;k<netif->hwaddr_len;k++) arp_table[i].ethaddr.addr[k] = ethaddr->addr[k];

        return UIP_ERR_OK;
}
/*-----------------------------------------------------------------------------------*/
/**
 * ARP processing for incoming IP packets
 *
 * This function should be called by the device driver when an IP
 * packet has been received. The function will check if the address is
 * in the ARP cache, and if so the ARP cache entry will be
 * refreshed. If no ARP cache entry was found, a new one is created.
 *
 * This function expects an IP packet with a prepended Ethernet header
 * in the uip_buf[] buffer, and the length of the packet in the global
 * variable uip_len.
 */
/*-----------------------------------------------------------------------------------*/
void
uip_arp_ipin(struct uip_netif *netif,struct uip_pbuf *p)
{
        struct uip_ethip_hdr *hdr;

        hdr = p->payload;
        if(!ip_addr_netcmp(&hdr->ip.src,&netif->ip_addr,&netif->netmask)) return;
        
        uip_arp_update(netif,&hdr->ip.src,&hdr->ethhdr.src,0);
 }

/*-----------------------------------------------------------------------------------*/
/**
 * ARP processing for incoming ARP packets.
 *
 * This function should be called by the device driver when an ARP
 * packet has been received. The function will act differently
 * depending on the ARP packet type: if it is a reply for a request
 * that we previously sent out, the ARP cache will be filled in with
 * the values from the ARP reply. If the incoming ARP packet is an ARP
 * request for our IP address, an ARP reply packet is created and put
 * into the uip_buf[] buffer.
 *
 * When the function returns, the value of the global variable uip_len
 * indicates whether the device driver should send out a packet or
 * not. If uip_len is zero, no packet should be sent. If uip_len is
 * non-zero, it contains the length of the outbound packet that is
 * present in the uip_buf[] buffer.
 *
 * This function expects an ARP packet with a prepended Ethernet
 * header in the uip_buf[] buffer, and the length of the packet in the
 * global variable uip_len.
 */
/*-----------------------------------------------------------------------------------*/
void
uip_arp_arpin(struct uip_netif *netif,struct uip_eth_addr *ethaddr,struct uip_pbuf *p)
{
        u8_t i,for_us;
        struct uip_ip_addr sipaddr,dipaddr;
        struct uip_arp_hdr *hdr;

        if(p->tot_len<sizeof(struct uip_arp_hdr)) {
                uip_pbuf_free(p);
                return;
        }
        
        hdr = p->payload;
        
        *(struct uip_ip_addr2*)((void*)&sipaddr) = hdr->sipaddr;
        *(struct uip_ip_addr2*)((void*)&dipaddr) = hdr->dipaddr;
        
        if(netif->ip_addr.addr==0) for_us = 0;
        else for_us = ip_addr_cmp(&dipaddr,&netif->ip_addr);

        if(for_us) uip_arp_update(netif,&sipaddr,&hdr->shwaddr,ARP_TRY_HARD);
        else uip_arp_update(netif,&sipaddr,&hdr->shwaddr,0);

        switch(htons(hdr->opcode)) {
                case ARP_REQUEST:
                        if(for_us) {
                                hdr->opcode = htons(ARP_REPLY);
                                hdr->dipaddr = hdr->sipaddr;
                                hdr->sipaddr = *(struct uip_ip_addr2*)((void*)&netif->ip_addr);
                                
                                for(i=0;i<netif->hwaddr_len;i++) {
                                        hdr->dhwaddr.addr[i] = hdr->shwaddr.addr[i];
                                        hdr->shwaddr.addr[i] = ethaddr->addr[i];
                                        hdr->ethhdr.dest.addr[i] = hdr->dhwaddr.addr[i];
                                        hdr->ethhdr.src.addr[i] = ethaddr->addr[i];
                                }
                                
                                hdr->hwtype = htons(ARP_HWTYPE_ETH);
                                ARPH_HWLEN_SET(hdr,netif->hwaddr_len);

                                hdr->protocol = htons(UIP_ETHTYPE_IP);
                                ARPH_PROTOLEN_SET(hdr,sizeof(struct uip_ip_addr));

                                netif->linkoutput(netif,p);
                        } else {
                                UIP_LOG("uip_arp_arpin: ip packet not for us.\n");
                        }
                        break;
                case ARP_REPLY:
                        break;
                default:
                        UIP_LOG("uip_arp_arpin: ARP unknown opcode type.\n");
                        break;
        }
        uip_pbuf_free(p);
}
/*-----------------------------------------------------------------------------------*/
/**
 * Prepend Ethernet header to an outbound IP packet and see if we need
 * to send out an ARP request.
 *
 * This function should be called before sending out an IP packet. The
 * function checks the destination IP address of the IP packet to see
 * what Ethernet MAC address that should be used as a destination MAC
 * address on the Ethernet.
 *
 * If the destination IP address is in the local network (determined
 * by logical ANDing of netmask and our IP address), the function
 * checks the ARP cache to see if an entry for the destination IP
 * address is found. If so, an Ethernet header is prepended and the
 * function returns. If no ARP cache entry is found for the
 * destination IP address, the packet in the uip_buf[] is replaced by
 * an ARP request packet for the IP address. The IP packet is dropped
 * and it is assumed that they higher level protocols (e.g., TCP)
 * eventually will retransmit the dropped packet.
 *
 * If the destination IP address is not on the local network, the IP
 * address of the default router is used instead.
 *
 * When the function returns, a packet is present in the uip_buf[]
 * buffer, and the length of the packet is in the global variable
 * uip_len.
 */
/*-----------------------------------------------------------------------------------*/
s8_t uip_arp_out(struct uip_netif *netif,struct uip_ip_addr *ipaddr,struct uip_pbuf *q)
{
        u8_t i;
        struct uip_eth_addr *dest,*srcaddr,mcastaddr;
        struct uip_eth_hdr *ethhdr;

        if(uip_pbuf_header(q,sizeof(struct uip_eth_hdr))!=0) {
                UIP_LOG("uip_arp_out: could not allocate room for header.\n");
                return UIP_ERR_BUF;
        }

        dest = NULL;
        if(ip_addr_isbroadcast(ipaddr,netif)) {
                dest = (struct uip_eth_addr*)&ethbroadcast;
        } else if(ip_addr_ismulticast(ipaddr)) {
                /* Hash IP multicast address to MAC address.*/
                mcastaddr.addr[0] = 0x01;
                mcastaddr.addr[1] = 0x00;
                mcastaddr.addr[2] = 0x5e;
                mcastaddr.addr[3] = ip4_addr2(ipaddr) & 0x7f;
                mcastaddr.addr[4] = ip4_addr3(ipaddr);
                mcastaddr.addr[5] = ip4_addr4(ipaddr);
                /* destination Ethernet address is multicast */
           dest = &mcastaddr;
        } else {
                if(!ip_addr_netcmp(ipaddr,&netif->ip_addr,&netif->netmask)) {
                        if(netif->gw.addr!=0) ipaddr = &netif->gw;
                        else return UIP_ERR_RTE;
                }
                return uip_arp_arpquery(netif,ipaddr,q);
        }

        srcaddr = (struct uip_eth_addr*)netif->hwaddr;
        ethhdr = q->payload;
        for(i=0;i<netif->hwaddr_len;i++) {
                ethhdr->dest.addr[i] = dest->addr[i];
                ethhdr->src.addr[i] = srcaddr->addr[i];
        }

        ethhdr->type = htons(UIP_ETHTYPE_IP);
        return netif->linkoutput(netif,q);
}
/*-----------------------------------------------------------------------------------*/

s8_t uip_arp_arpquery(struct uip_netif *netif,struct uip_ip_addr *ipaddr,struct uip_pbuf *q)
{
        s8_t i,k;
        s8_t err = UIP_ERR_MEM;
        struct uip_eth_addr *srcaddr = (struct uip_eth_addr*)netif->hwaddr;

        if(ip_addr_isbroadcast(ipaddr,netif) || 
                ip_addr_ismulticast(ipaddr) ||
                ip_addr_isany(ipaddr)) return UIP_ERR_ARG;

        i = uip_arp_findentry(ipaddr,ARP_TRY_HARD);
        if(i<0) return i;

        if(arp_table[i].state==ARP_STATE_EMPTY) arp_table[i].state = ARP_STATE_PENDING;
        if(arp_table[i].state==ARP_STATE_PENDING || q==NULL) err = uip_arp_arprequest(netif,ipaddr);

        if(q!=NULL) {
                if(arp_table[i].state==ARP_STATE_STABLE) {
                        
                        struct uip_eth_hdr *hdr = q->payload;
                        for(k=0;k<netif->hwaddr_len;k++) {
                                hdr->dest.addr[k] = arp_table[i].ethaddr.addr[k];
                                hdr->src.addr[k] = srcaddr->addr[k];
                        }

                        hdr->type = htons(UIP_ETHTYPE_IP);
                        err = netif->linkoutput(netif,q);
                } else if(arp_table[i].state==ARP_STATE_PENDING) {
                        UIP_LOG("uip_arp_query: Ethernet destination address unknown, queueing disabled, packet dropped.\n");
                }
        }
        return err;
}

s8_t uip_arp_arprequest(struct uip_netif *netif,struct uip_ip_addr *ipaddr)
{
        s8_t k;
        s8_t err = UIP_ERR_MEM;
        struct uip_arp_hdr *hdr;
        struct uip_pbuf *p;
        struct uip_eth_addr *srcaddr = (struct uip_eth_addr*)netif->hwaddr;

        p = uip_pbuf_alloc(UIP_PBUF_LINK,sizeof(struct uip_arp_hdr),UIP_PBUF_RAM);
        if(p==NULL) return err;

        hdr = p->payload;
        hdr->opcode = htons(ARP_REQUEST);
        
        for(k=0;k<netif->hwaddr_len;k++) {
                hdr->shwaddr.addr[k] = srcaddr->addr[k];
                hdr->dhwaddr.addr[k] = 0;
        }

        hdr->dipaddr = *(struct uip_ip_addr2*)((void*)ipaddr);
        hdr->sipaddr = *(struct uip_ip_addr2*)((void*)&netif->ip_addr);

        hdr->hwtype = htons(ARP_HWTYPE_ETH);
        ARPH_HWLEN_SET(hdr,netif->hwaddr_len);

        hdr->protocol = htons(UIP_ETHTYPE_IP);
        ARPH_PROTOLEN_SET(hdr,sizeof(struct uip_ip_addr));
        for(k=0;k<netif->hwaddr_len;k++) {
                hdr->ethhdr.dest.addr[k] = 0xff;
                hdr->ethhdr.src.addr[k] = srcaddr->addr[k];
        }
        hdr->ethhdr.type = htons(UIP_ETHTYPE_ARP);

        err = netif->linkoutput(netif,p);
        uip_pbuf_free(p);

        return err;
}

/** @} */
/** @} */