Subversion Repositories openrisc_2011-10-31

/*

 * (C) Copyright 2000

 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.

 *

 * See file CREDITS for list of people who contributed to this

 * project.

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License as

 * published by the Free Software Foundation; either version 2 of

 * the License, or (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,

 * MA 02111-1307 USA

 */

#include "common.h"

#include "support.h"

#include "net.h"

#include "bootp.h"

#include "tftp.h"

#include "arp.h"

#include "string.h"

#define TIMEOUT         5               /* Seconds before trying ARP again */

#define TIMEOUT_COUNT   1               /* # of timeouts before giving up  */

#define DEBUG // jb

static void ArpHandler(unsigned char *pkt, unsigned dest, unsigned src, unsigned len);

static void ArpTimeout(void);

int     ArpTry = 0;

/*

 *      Handle a ARP received packet.

 */

static void

ArpHandler(unsigned char *pkt, unsigned dest, unsigned src, unsigned len)

{

        /* Check if the frame is really an ARP reply */

        if (memcmp (NetServerEther, NetBcastAddr, 6) != 0) {

#ifdef  DEBUG

                printf("Got good ARP - start TFTP\n");

#endif

                TftpStart ();

        }

}

/*

 *      Timeout on ARP request.

 */

static void

ArpTimeout(void)

{

        if (ArpTry >= TIMEOUT_COUNT) {

                printf("\nRetry count exceeded; starting again\n");

                NetStartAgain ();

        } else {

                NetSetTimeout (TIMEOUT * TICKS_PER_SEC, ArpTimeout);

                ArpRequest ();

        }

}

void

ArpRequest (void)

{

        int i;

        volatile unsigned char *pkt;

        ARP_t * arp;

#ifdef  DEBUG

        printf("ARP broadcast %d\n", ++ArpTry);

#endif  

        pkt = NetTxPacket;

        NetSetEther(pkt, NetBcastAddr, PROT_ARP);

        pkt += ETHER_HDR_SIZE;

        arp = (ARP_t *)pkt;

        arp->ar_hrd = ARP_ETHER;

        arp->ar_pro = PROT_IP;

        arp->ar_hln = 6;

        arp->ar_pln = 4;

        arp->ar_op  = ARPOP_REQUEST;

        NetCopyEther(&arp->ar_data[0], NetOurEther);     /* source ET addr */

        //*(IPaddr_t *)(&arp->ar_data[6]) = NetOurIP;   /* source IP addr */

        memcpy(&arp->ar_data[6], (unsigned char*) &NetOurIP, 4);

        for (i=10; i<16; ++i) {

                arp->ar_data[i] = 0;                     /* dest ET addr = 0*/

        }

        if((NetServerIP & NetOurSubnetMask) != (NetOurIP & NetOurSubnetMask)) {

          //*(IPaddr_t *)(&arp->ar_data[16]) = NetOurGatewayIP;

          memcpy(&arp->ar_data[16], (unsigned char*) &NetOurGatewayIP,

                 sizeof(IPaddr_t));

        } else {

          //*((IPaddr_t *)(&(arp->ar_data[16]))) = NetServerIP;

          memcpy(&arp->ar_data[16], (unsigned char*) &NetServerIP,

                 sizeof(IPaddr_t));

        }

        NetSendPacket(NetTxPacket, ETHER_HDR_SIZE + ARP_HDR_SIZE);

        NetSetTimeout(TIMEOUT * TICKS_PER_SEC, ArpTimeout);

        NetSetHandler(ArpHandler);

}