Subversion Repositories openrisc

/*
 * (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
	// NetTxPacket is a char* to global buffer used for constructing 
	// a packet to send.
	pkt = NetTxPacket; 
 
	// Setup an ethernet header for ARP protocol in packet
	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);
}