URL https://opencores.org/ocsvn/openrisc_2011-10-31/openrisc_2011-10-31/trunk

Subversion Repositories openrisc_2011-10-31

[/] [openrisc/] [trunk/] [bootloaders/] [orpmon/] [services/] [net.c] - Blame information for rev 343

Go to most recent revision | Details | Compare with Previous | View Log


/*
 *      Copied from Linux Monitor (LiMon) - Networking.
 *
 *      Copyright 1994 - 2000 Neil Russell.
 *      (See License)
 *      Copyright 2000 Roland Borde
 *      Copyright 2000 Paolo Scaffardi
 *      Copyright 2000, 2001 Wolfgang Denk
 */
 
/*
 * General Desription:
 *
 * The user interface supports commands for BOOTP, RARP, and TFTP.
 * Also, we support ARP internally. Depending on available data,
 * these interact as follows:
 *
 * BOOTP:
 *
 *      Prerequisites:  - own ethernet address
 *      We want:        - own IP address
 *                      - TFTP server IP address
 *                      - name of bootfile
 *      Next step:      ARP
 *
 * RARP:
 *
 *      Prerequisites:  - own ethernet address
 *      We want:        - own IP address
 *                      - TFTP server IP address
 *      Next step:      ARP
 *
 * ARP:
 *
 *      Prerequisites:  - own ethernet address
 *                      - own IP address
 *                      - TFTP server IP address
 *      We want:        - TFTP server ethernet address
 *      Next step:      TFTP
 *
 * DHCP:
 *
 *     Prerequisites:   - own ethernet address
 *     We want:         - IP, Netmask, ServerIP, Gateway IP
 *                      - bootfilename, lease time
 *     Next step:       - TFTP
 *
 * TFTP:
 *
 *      Prerequisites:  - own ethernet address
 *                      - own IP address
 *                      - TFTP server IP address
 *                      - TFTP server ethernet address
 *                      - name of bootfile (if unknown, we use a default name
 *                        derived from our own IP address)
 *      We want:        - load the boot file
 *      Next step:      none
 */
 
 
#include "common.h"
#include "support.h"
#include "net.h"
#include "bootp.h"
#include "tftp.h"
#include "rarp.h"
#include "arp.h"
#if OC_LAN==1
#include "eth.h"
#else 
# if SMC91111_LAN==1
#  include "smc91111.h"
# endif
#endif
 
#if 0
#define ET_DEBUG
#endif
 
/** BOOTP EXTENTIONS **/
 
IPaddr_t        NetOurSubnetMask=0;              /* Our subnet mask (0=unknown)  */
IPaddr_t        NetOurGatewayIP=0;               /* Our gateways IP address      */
IPaddr_t        NetOurDNSIP=0;                   /* Our DNS IP address           */
char            NetOurNISDomain[32]={0,};        /* Our NIS domain               */
char            NetOurHostName[32]={0,}; /* Our hostname                 */
char            NetOurRootPath[64]={0,}; /* Our bootpath                 */
unsigned short          NetBootFileSize=0;               /* Our bootfile size in blocks  */
 
/** END OF BOOTP EXTENTIONS **/
 
unsigned long           NetBootFileXferSize;    /* The actual transferred size of the bootfile (in bytes) */
unsigned char           NetOurEther[6];         /* Our ethernet address                 */
unsigned char           NetServerEther[6] =     /* Boot server enet address             */
  { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
IPaddr_t        NetOurIP;               /* Our IP addr (0 = unknown)            */
IPaddr_t        NetServerIP;            /* Our IP addr (0 = unknown)            */
volatile unsigned char *NetRxPkt;               /* Current receive packet               */
int             NetRxPktLen;            /* Current rx packet length             */
unsigned        NetIPID;                /* IP packet ID                         */
unsigned char           NetBcastAddr[6] =       /* Ethernet bcast address               */
  { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
int             NetState;               /* Network loop state                   */
 
char            BootFile[128];          /* Boot File name                       */
 
volatile unsigned char  PktBuf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];
 
volatile unsigned char *NetRxPackets[PKTBUFSRX]; /* Receive packets                     */
 
static rxhand_f *packetHandler;         /* Current RX packet handler            */
static thand_f *timeHandler;            /* Current timeout handler              */
static unsigned long    timeValue;              /* Current timeout value                */
volatile unsigned char *NetTxPacket = 0; /* THE transmit packet                  */
 
static int net_check_prereq (proto_t protocol);
 
/**********************************************************************/
/*
 *      Main network processing loop.
 */
int
NetLoop(proto_t protocol)
{
#if 1
  if (!NetTxPacket) {
    int i;
    printf("NetTxPacket begin setup\n");
    /*
     *  Setup packet buffers, aligned correctly.
     */
    NetTxPacket = &PktBuf[0] + (PKTALIGN - 1);
    NetTxPacket -= (unsigned long)NetTxPacket % PKTALIGN;
    for (i = 0; i < PKTBUFSRX; i++) {
      NetRxPackets[i] = NetTxPacket + (i+1)*PKTSIZE_ALIGN;
    }
  }
 
  eth_halt();
  eth_init(NetReceive);
 
 restart:
 
  NetCopyEther(NetOurEther, global.eth_add);
 
  NetState = NETLOOP_CONTINUE;
 
  /*
   *    Start the ball rolling with the given start function.  From
   *    here on, this code is a state machine driven by received
   *    packets and timer events.
   */
 
  if (protocol == TFTP) {                       /* TFTP */
    NetOurIP    = global.ip;
    NetServerIP = global.srv_ip;
    NetOurGatewayIP = global.gw_ip;
    NetOurSubnetMask= global.mask;
 
    if (net_check_prereq (protocol) != 0) {
      return 0;
    }
 
    /* always use ARP to get server ethernet address */
    ArpTry = 0;
 
    ArpRequest ();
 
#if (CONFIG_COMMANDS & CFG_CMD_DHCP)
  } else if (protocol == DHCP) {
    if (net_check_prereq (protocol) != 0) {
      return 0;
    }
 
    /* Start with a clean slate... */
    NetOurIP = 0;
    NetServerIP = 0;
    DhcpRequest();              /* Basically same as BOOTP */
 
#endif  /* CFG_CMD_DHCP */
 
  } else {                              /* BOOTP or RARP */
 
    /*
     * initialize our IP addr to 0 in order to accept ANY
     * IP addr assigned to us by the BOOTP / RARP server
     */
    NetOurIP = 0;
    NetServerIP = 0;
 
    if (net_check_prereq (protocol) != 0) {
      return 0;
    }
#ifdef BOOTP
    if (protocol == BOOTP) {
      BootpTry = 0;
      BootpRequest ();
    }
#endif
#ifdef RARP
    if {
      RarpTry    = 0;
      RarpRequest ();
    }
#endif
  }
 
  NetBootFileXferSize = 0;
 
  /*
   *    Main packet reception loop.  Loop receiving packets until
   *    someone sets `NetQuit'.
   */
  for (;;) {
    //          WATCHDOG_RESET();
    /*
     *  Check the ethernet for a new packet.  The ethernet
     *  receive routine will process it.
     */
    eth_rx();
 
    /*
     *  Abort if ctrl-c was pressed.
     */
    if (ctrlc()) {
      eth_halt();
      printf("\nAbort\n");
      return 0;
    }
 
 
    /*
     *  Check for a timeout, and run the timeout handler
     *  if we have one.
     */
    /*
      if (timeHandler && (get_timer(0) > timeValue)) {
      thand_f *x;
 
      x = timeHandler;
      timeHandler = (thand_f *)0;
      (*x)();
      }
    */
 
    switch (NetState) {
 
    case NETLOOP_RESTART:
      goto restart;
 
    case NETLOOP_SUCCESS:
      if (NetBootFileXferSize > 0) {
        printf("Bytes transferred = %ld (0x%lx)\n",
               NetBootFileXferSize,
               NetBootFileXferSize);
#ifdef TFTP_CALC_CHKSUM
        printf("CHKSUM: 0x%lx\n", TFTP_CHKSUM);
#endif
      }
      eth_halt();
      return NetBootFileXferSize;
 
    case NETLOOP_FAIL:
      return 0;
    }
  }
#endif
}
 
/**********************************************************************/
 
 
#if 1
void
NetStartAgain(void)
{
  NetState = NETLOOP_RESTART;
}
 
/**********************************************************************/
/*
 *      Miscelaneous bits.
 */
 
void
NetSetHandler(rxhand_f * f)
{
  packetHandler = f;
}
 
 
void
NetSetTimeout(int iv, thand_f * f)
{
  if (iv == 0) {
    timeHandler = (thand_f *)0;
  } else {
    timeHandler = f;
    timeValue = get_timer(0) + iv;
  }
}
 
 
void
NetSendPacket(volatile unsigned char * pkt, int len)
{
 
#if OC_LAN==1
  unsigned char *p = (unsigned char *)0;
  while (p == (unsigned char*) 0)
    p = eth_get_tx_buf();
 
  memcpy(p, (void *)pkt, len);
  eth_send(p, len);
#else
# if  SMC91111_LAN==1
  eth_send(pkt, len);
# endif
#endif
}
 
 
 
void
NetReceive(volatile unsigned char * pkt, int len)
{
  Ethernet_t *et;
  IP_t  *ip;
  ARP_t *arp;
  int   x;
  IPaddr_t ip_to_check; // Used as a temp variable to check IP
 
  NetRxPkt = pkt;
  NetRxPktLen = len;
  et = (Ethernet_t *)pkt;
 
  x = SWAP16(et->et_protlen);
 
  if (x < 1514) {
    /*
     *  Got a 802 packet.  Check the other protocol field.
     */
    x = SWAP16(et->et_prot);
    ip = (IP_t *)(pkt + E802_HDR_SIZE);
    len -= E802_HDR_SIZE;
  } else {
    ip = (IP_t *)(pkt + ETHER_HDR_SIZE);
    len -= ETHER_HDR_SIZE;
  }
 
#ifdef ET_DEBUG
  printf("Receive from protocol 0x%x\n", x);
#endif
 
  switch (x) {
 
  case PROT_ARP:
    /*
     * We have to deal with two types of ARP packets:
     * - REQUEST packets will be answered by sending  our
     *   IP address - if we know it.
     * - REPLY packates are expected only after we asked
     *   for the TFTP server's or the gateway's ethernet
     *   address; so if we receive such a packet, we set
     *   the server ethernet address
     */
#ifdef ET_DEBUG
    printf("Got ARP\n");
#endif
    arp = (ARP_t *)ip;
    if (len < ARP_HDR_SIZE) {
      printf("bad length %d < %d\n", len, ARP_HDR_SIZE);
      return;
    }
    if (SWAP16(arp->ar_hrd) != ARP_ETHER) {
      return;
    }
    if (SWAP16(arp->ar_pro) != PROT_IP) {
      return;
    }
    if (arp->ar_hln != 6) {
      return;
    }
    if (arp->ar_pln != 4) {
      return;
    }
 
    memcpy((void*) &ip_to_check, (void*)&arp->ar_data[16],
           sizeof(IPaddr_t));
    if (NetOurIP == 0 ||
        ip_to_check != NetOurIP) {
      return;
    }
 
    switch (SWAP16(arp->ar_op)) {
    case ARPOP_REQUEST:         /* reply with our IP address  */
#ifdef ET_DEBUG
      printf("Got ARP REQUEST, return our IP\n");
#endif
      NetSetEther((unsigned char *)et, et->et_src, PROT_ARP);
      arp->ar_op = SWAP16(ARPOP_REPLY);
      NetCopyEther(&arp->ar_data[10], &arp->ar_data[0]);
      NetCopyEther(&arp->ar_data[0], NetOurEther);
      //*(IPaddr_t *)(&arp->ar_data[16]) = *(IPaddr_t *)(&arp->ar_data[6]);
      memcpy((void*)&arp->ar_data[16],(void*) &arp->ar_data[6],
             sizeof(IPaddr_t));
      //*(IPaddr_t *)(&arp->ar_data[6]) = NetOurIP;
      memcpy((void*)&arp->ar_data[6],(void*) &NetOurIP,
             sizeof(IPaddr_t));
 
      NetSendPacket((unsigned char *)et,
                    ((unsigned char *)arp-pkt)+ARP_HDR_SIZE);
      return;
    case ARPOP_REPLY:           /* set TFTP server eth addr     */
#ifdef ET_DEBUG
      printf("Got ARP REPLY, set server/gtwy eth addr\n");
#endif
      NetCopyEther(NetServerEther, &arp->ar_data[0]);
      (*packetHandler)(0,0,0,0);    /* start TFTP */
      return;
    default:
#ifdef ET_DEBUG
      printf("Unexpected ARP opcode 0x%x\n", SWAP16(arp->ar_op));
#endif
      return;
    }
 
  case PROT_RARP:
#ifdef ET_DEBUG
    printf("Got RARP\n");
#endif
    arp = (ARP_t *)ip;
    if (len < ARP_HDR_SIZE) {
      printf("bad length %d < %d\n", len, ARP_HDR_SIZE);
      return;
    }
 
    if ((SWAP16(arp->ar_op) != RARPOP_REPLY) ||
        (SWAP16(arp->ar_hrd) != ARP_ETHER)   ||
        (SWAP16(arp->ar_pro) != PROT_IP)     ||
        (arp->ar_hln != 6) || (arp->ar_pln != 4)) {
 
      printf("invalid RARP header\n");
    } else {
      //NetOurIP = *((IPaddr_t *)&arp->ar_data[16]);
      memcpy((void*) &NetOurIP, (void*) &arp->ar_data[16],
             sizeof(IPaddr_t));
      //NetServerIP = *((IPaddr_t *)&arp->ar_data[6]);
      memcpy((void*) &NetServerIP,(void*) &arp->ar_data[6],
             sizeof(IPaddr_t));
 
      NetCopyEther(NetServerEther, &arp->ar_data[0]);
 
      (*packetHandler)(0,0,0,0);
    }
    break;
 
  case PROT_IP:
#ifdef ET_DEBUG
    printf("Got IP\n");
#endif
    if (len < IP_HDR_SIZE) {
      debug ("len bad %d < %d\n", len, IP_HDR_SIZE);
      return;
    }
    if (len < SWAP16(ip->ip_len)) {
      printf("len bad %d < %d\n", len, SWAP16(ip->ip_len));
      return;
    }
    len = SWAP16(ip->ip_len);
#ifdef ET_DEBUG
    printf("len=%d, v=%02x\n", len, ip->ip_hl_v & 0xff);
#endif
    if ((ip->ip_hl_v & 0xf0) != 0x40) {
      return;
    }
    if (ip->ip_off & SWAP16c(0x1fff)) { /* Can't deal w/ fragments */
      return;
    }
    if (!NetCksumOk((unsigned char *)ip, IP_HDR_SIZE_NO_UDP / 2)) {
      //printf("checksum bad\n");
      return;
    }
 
    memcpy((void*)&ip_to_check,(void*)&ip->ip_dst, sizeof (IPaddr_t));
 
    if (NetOurIP &&
        ip_to_check != NetOurIP &&
        ip_to_check != 0xFFFFFFFF) {
      return;
    }
    /*
     * watch for ICMP host redirects
     *
     * There is no real handler code (yet). We just watch
     * for ICMP host redirect messages. In case anybody
     * sees these messages: please contact me
     * (wd@denx.de), or - even better - send me the
     * necessary fixes :-)
     *
     * Note: in all cases where I have seen this so far
     * it was a problem with the router configuration,
     * for instance when a router was configured in the
     * BOOTP reply, but the TFTP server was on the same
     * subnet. So this is probably a warning that your
     * configuration might be wrong. But I'm not really
     * sure if there aren't any other situations.
     */
    if (ip->ip_p == IPPROTO_ICMP) {
      ICMP_t *icmph = (ICMP_t *)&(ip->udp_src);
 
      if (icmph->type != ICMP_REDIRECT)
        return;
      if (icmph->code != ICMP_REDIR_HOST)
        return;
      printf (" ICMP Host Redirect to ");
      print_IPaddr(icmph->un.gateway);
      putc(' ');
    } else if (ip->ip_p != IPPROTO_UDP) {       /* Only UDP packets */
      return;
    }
 
    /*
     *  IP header OK.  Pass the packet to the current handler.
     */
    (*packetHandler)((unsigned char *)ip +IP_HDR_SIZE,
                     SWAP16(ip->udp_dst),
                     SWAP16(ip->udp_src),
                     SWAP16(ip->udp_len) - 8);
 
    break;
  }
}
 
 
/**********************************************************************/
 
static int net_check_prereq (proto_t protocol)
{
  switch (protocol) {
  case ARP:     /* nothing to do */
    break;
 
  case TFTP:
    if (NetServerIP == 0) {
      printf     ("*** ERROR: `serverip' not set\n");
      return (1);
    }
 
    if (NetOurIP == 0) {
      printf ("*** ERROR: `ipaddr' not set\n");
      return (1);
    }
    /* Fall through */
 
  case DHCP:
  case RARP:
  case BOOTP:
    if (memcmp(NetOurEther, "\0\0\0\0\0\0", 6) == 0) {
      printf ("*** ERROR: `ethaddr' not set\n");
      return (1);
    }
    /* Fall through */
  }
  return (0);    /* OK */
}
/**********************************************************************/
 
int
NetCksumOk(unsigned char * ptr, int len)
{
  return !((NetCksum(ptr, len) + 1) & 0xfffe);
}
 
 
unsigned
NetCksum(unsigned char * ptr, int len)
{
  unsigned long xsum;
 
  xsum = 0;
  while (len-- > 0)
    {
      xsum += (*((unsigned short *)ptr));
      ptr += sizeof(short);
    }
 
  xsum = (xsum & 0xffff) + (xsum >> 16);
  xsum = (xsum & 0xffff) + (xsum >> 16);
  return (xsum & 0xffff);
}
 
 
void
NetCopyEther(volatile unsigned char * to, unsigned char * from)
{
  int   i;
 
  for (i = 0; i < 6; i++)
    *to++ = *from++;
}
 
 
void
NetSetEther(volatile unsigned char * xet, unsigned char * addr, unsigned long prot)
{
  volatile Ethernet_t *et = (Ethernet_t *)xet;
 
  NetCopyEther(et->et_dest, addr);
  NetCopyEther(et->et_src, NetOurEther);
  et->et_protlen = SWAP16(prot);
}
 
 
void
NetSetIP(volatile unsigned char * xip, IPaddr_t dest, int dport, int sport, int len)
{
  volatile IP_t *ip = (IP_t *)xip;
 
  /*
   *    If the data is an odd number of bytes, zero the
   *    byte after the last byte so that the checksum
   *    will work.
   */
  if (len & 1)
    xip[IP_HDR_SIZE + len] = 0;
 
  /*
   *    Construct an IP and UDP header.
   (need to set no fragment bit - XXX)
  */
  ip->ip_hl_v  = 0x45;          /* IP_HDR_SIZE / 4 (not including UDP) */
  ip->ip_tos   = 0;
  ip->ip_len   = SWAP16(IP_HDR_SIZE + len);
  ip->ip_id    = SWAP16(NetIPID++);
  ip->ip_off   = SWAP16c(0x4000);       /* No fragmentation */
  ip->ip_ttl   = 255;
  ip->ip_p     = 17;            /* UDP */
  ip->ip_sum   = 0;
  //ip->ip_src   = NetOurIP;
  memcpy((void*)&ip->ip_src,(void*) &NetOurIP,
        sizeof(IPaddr_t));
  //ip->ip_dst   = dest;
  memcpy((void*)&ip->ip_dst,(void*) &dest,
        sizeof(IPaddr_t));
  ip->udp_src  = SWAP16(sport);
  ip->udp_dst  = SWAP16(dport);
  ip->udp_len  = SWAP16(8 + len);
  ip->udp_xsum = 0;
  ip->ip_sum   = ~NetCksum((unsigned char *)ip, IP_HDR_SIZE_NO_UDP / 2);
}
 
void copy_filename (unsigned char *dst, unsigned char *src, int size)
{
  if (*src && (*src == '"')) {
    ++src;
    --size;
  }
 
  while ((--size > 0) && *src && (*src != '"')) {
    *dst++ = *src++;
  }
  *dst = '\0';
}
 
void ip_to_string (IPaddr_t x, char *s)
{
  char num[] = "0123456789ABCDEF";
  int i;
 
  x = SWAP32(x);
 
  for(i = 28; i >= 0; i -= 4)
    *s++ = num[((x >> i) & 0x0f)];
  *s = 0;
}
 
void print_IPaddr (IPaddr_t x)
{
  char tmp[12];
 
  ip_to_string(x, tmp);
 
  printf(tmp);
}
 
static unsigned int i2a(char* dest,unsigned int x) {
  register unsigned int tmp=x;
  register unsigned int len=0;
  if (x>=100) { *dest++=tmp/100+'0'; tmp=tmp%100; ++len; }
  if (x>=10) { *dest++=tmp/10+'0'; tmp=tmp%10; ++len; }
  *dest++=tmp+'0';
  return len+1;
}
 
char *inet_ntoa(unsigned long in) {
  static char buf[20];
  unsigned int len;
  unsigned char *ip=(unsigned char*)&in;
 
  len=i2a(buf,ip[0]); buf[len]='.'; ++len;
  len+=i2a(buf+ len,ip[1]); buf[len]='.'; ++len;
  len+=i2a(buf+ len,ip[2]); buf[len]='.'; ++len;
  len+=i2a(buf+ len,ip[3]); buf[len]=0;
  return buf;
}
 
unsigned long inet_aton(const char *cp)
{
  unsigned long a[4];
  unsigned long ret;
  char *p = (char *)cp;
  int i,d;
  if (strcmp(cp, "255.255.255.255") == 0)
    return -1;
 
  for(i = 0; i < 4; i++) {
    a[i] = strtoul(p, 0, 0);
    for(d=1; (p[d] != '.') && (i < 3); d++);
    p = &p[d+1];
  }
 
  ret = (a[0] << 24) | (a[1] << 16) | (a[2] << 8) | a[3];
  return ret;
}
 
#endif

Line No.	Rev	Author	Line
1	2	marcus.erl	`/*`
2			`* Copied from Linux Monitor (LiMon) - Networking.`
3			`*`
4			`* Copyright 1994 - 2000 Neil Russell.`
5			`* (See License)`
6			`* Copyright 2000 Roland Borde`
7			`* Copyright 2000 Paolo Scaffardi`
8			`* Copyright 2000, 2001 Wolfgang Denk`
9			`*/`
10
11			`/*`
12			`* General Desription:`
13			`*`
14			`* The user interface supports commands for BOOTP, RARP, and TFTP.`
15			`* Also, we support ARP internally. Depending on available data,`
16			`* these interact as follows:`
17			`*`
18			`* BOOTP:`
19			`*`
20			`* Prerequisites: - own ethernet address`
21			`* We want: - own IP address`
22			`* - TFTP server IP address`
23			`* - name of bootfile`
24			`* Next step: ARP`
25			`*`
26			`* RARP:`
27			`*`
28			`* Prerequisites: - own ethernet address`
29			`* We want: - own IP address`
30			`* - TFTP server IP address`
31			`* Next step: ARP`
32			`*`
33			`* ARP:`
34			`*`
35			`* Prerequisites: - own ethernet address`
36			`* - own IP address`
37			`* - TFTP server IP address`
38			`* We want: - TFTP server ethernet address`
39			`* Next step: TFTP`
40			`*`
41			`* DHCP:`
42			`*`
43			`* Prerequisites: - own ethernet address`
44			`* We want: - IP, Netmask, ServerIP, Gateway IP`
45			`* - bootfilename, lease time`
46			`* Next step: - TFTP`
47			`*`
48			`* TFTP:`
49			`*`
50			`* Prerequisites: - own ethernet address`
51			`* - own IP address`
52			`* - TFTP server IP address`
53			`* - TFTP server ethernet address`
54			`* - name of bootfile (if unknown, we use a default name`
55			`* derived from our own IP address)`
56			`* We want: - load the boot file`
57			`* Next step: none`
58			`*/`
59
60
61			`#include "common.h"`
62			`#include "support.h"`
63			`#include "net.h"`
64			`#include "bootp.h"`
65			`#include "tftp.h"`
66			`#include "rarp.h"`
67			`#include "arp.h"`
68			`#if OC_LAN==1`
69	140	julius	`#include "eth.h"`
70	246	julius	`#else`
71			`# if SMC91111_LAN==1`
72			`# include "smc91111.h"`
73			`# endif`
74	2	marcus.erl	`#endif`
75
76			`#if 0`
77			`#define ET_DEBUG`
78			`#endif`
79
80			`/ BOOTP EXTENTIONS /`
81
82			`IPaddr_t NetOurSubnetMask=0; /* Our subnet mask (0=unknown) */`
83			`IPaddr_t NetOurGatewayIP=0; /* Our gateways IP address */`
84			`IPaddr_t NetOurDNSIP=0; /* Our DNS IP address */`
85			`char NetOurNISDomain[32]={0,}; /* Our NIS domain */`
86			`char NetOurHostName[32]={0,}; /* Our hostname */`
87			`char NetOurRootPath[64]={0,}; /* Our bootpath */`
88			`unsigned short NetBootFileSize=0; /* Our bootfile size in blocks */`
89
90			`/ END OF BOOTP EXTENTIONS /`
91
92			`unsigned long NetBootFileXferSize; /* The actual transferred size of the bootfile (in bytes) */`
93			`unsigned char NetOurEther[6]; /* Our ethernet address */`
94			`unsigned char NetServerEther[6] = /* Boot server enet address */`
95	140	julius	`{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };`
96	2	marcus.erl	`IPaddr_t NetOurIP; /* Our IP addr (0 = unknown) */`
97			`IPaddr_t NetServerIP; /* Our IP addr (0 = unknown) */`
98			`volatile unsigned char NetRxPkt; / Current receive packet */`
99			`int NetRxPktLen; /* Current rx packet length */`
100			`unsigned NetIPID; /* IP packet ID */`
101			`unsigned char NetBcastAddr[6] = /* Ethernet bcast address */`
102	140	julius	`{ 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };`
103	2	marcus.erl	`int NetState; /* Network loop state */`
104
105			`char BootFile[128]; /* Boot File name */`
106
107			`volatile unsigned char PktBuf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];`
108
109			`volatile unsigned char NetRxPackets[PKTBUFSRX]; / Receive packets */`
110
111			`static rxhand_f packetHandler; / Current RX packet handler */`
112			`static thand_f timeHandler; / Current timeout handler */`
113			`static unsigned long timeValue; /* Current timeout value */`
114			`volatile unsigned char NetTxPacket = 0; / THE transmit packet */`
115
116			`static int net_check_prereq (proto_t protocol);`
117
118			`/**********************************************************************/`
119			`/*`
120			`* Main network processing loop.`
121			`*/`
122			`int`
123			`NetLoop(proto_t protocol)`
124			`{`
125			`#if 1`
126	140	julius	`if (!NetTxPacket) {`
127			`int i;`
128			`printf("NetTxPacket begin setup\n");`
129			`/*`
130			`* Setup packet buffers, aligned correctly.`
131			`*/`
132			`NetTxPacket = &PktBuf[0] + (PKTALIGN - 1);`
133			`NetTxPacket -= (unsigned long)NetTxPacket % PKTALIGN;`
134			`for (i = 0; i < PKTBUFSRX; i++) {`
135			`NetRxPackets[i] = NetTxPacket + (i+1)*PKTSIZE_ALIGN;`
136			`}`
137			`}`
138	2	marcus.erl
139	140	julius	`eth_halt();`
140			`eth_init(NetReceive);`
141	2	marcus.erl
142	140	julius	`restart:`
143	2	marcus.erl
144	140	julius	`NetCopyEther(NetOurEther, global.eth_add);`
145	2	marcus.erl
146	140	julius	`NetState = NETLOOP_CONTINUE;`
147	2	marcus.erl
148	140	julius	`/*`
149			`* Start the ball rolling with the given start function. From`
150			`* here on, this code is a state machine driven by received`
151			`* packets and timer events.`
152			`*/`
153	2	marcus.erl
154	140	julius	`if (protocol == TFTP) { /* TFTP */`
155			`NetOurIP = global.ip;`
156			`NetServerIP = global.srv_ip;`
157			`NetOurGatewayIP = global.gw_ip;`
158			`NetOurSubnetMask= global.mask;`
159	2	marcus.erl
160	140	julius	`if (net_check_prereq (protocol) != 0) {`
161			`return 0;`
162			`}`
163	2	marcus.erl
164	140	julius	`/* always use ARP to get server ethernet address */`
165			`ArpTry = 0;`
166	2	marcus.erl
167	140	julius	`ArpRequest ();`
168	2	marcus.erl
169			`#if (CONFIG_COMMANDS & CFG_CMD_DHCP)`
170	140	julius	`} else if (protocol == DHCP) {`
171			`if (net_check_prereq (protocol) != 0) {`
172			`return 0;`
173			`}`
174	2	marcus.erl
175	140	julius	`/* Start with a clean slate... */`
176			`NetOurIP = 0;`
177			`NetServerIP = 0;`
178			`DhcpRequest(); /* Basically same as BOOTP */`
179	2	marcus.erl
180			`#endif /* CFG_CMD_DHCP */`
181
182	140	julius	`} else { /* BOOTP or RARP */`
183	2	marcus.erl
184	140	julius	`/*`
185			`* initialize our IP addr to 0 in order to accept ANY`
186			`* IP addr assigned to us by the BOOTP / RARP server`
187			`*/`
188			`NetOurIP = 0;`
189			`NetServerIP = 0;`
190	2	marcus.erl
191	140	julius	`if (net_check_prereq (protocol) != 0) {`
192			`return 0;`
193			`}`
194	2	marcus.erl	`#ifdef BOOTP`
195	140	julius	`if (protocol == BOOTP) {`
196			`BootpTry = 0;`
197			`BootpRequest ();`
198			`}`
199	2	marcus.erl	`#endif`
200			`#ifdef RARP`
201			`if {`
202	140	julius	`RarpTry = 0;`
203			`RarpRequest ();`
204			`}`
205	2	marcus.erl	`#endif`
206	140	julius	`}`
207	2	marcus.erl
208	140	julius	`NetBootFileXferSize = 0;`
209	2	marcus.erl
210	140	julius	`/*`
211			`* Main packet reception loop. Loop receiving packets until`
212			* someone sets `NetQuit'.
213			`*/`
214			`for (;;) {`
215			`// WATCHDOG_RESET();`
216			`/*`
217			`* Check the ethernet for a new packet. The ethernet`
218			`* receive routine will process it.`
219			`*/`
220			`eth_rx();`
221	2	marcus.erl
222	140	julius	`/*`
223			`* Abort if ctrl-c was pressed.`
224			`*/`
225			`if (ctrlc()) {`
226			`eth_halt();`
227			`printf("\nAbort\n");`
228			`return 0;`
229			`}`
230	2	marcus.erl
231
232	140	julius	`/*`
233			`* Check for a timeout, and run the timeout handler`
234			`* if we have one.`
235			`*/`
236			`/*`
237			`if (timeHandler && (get_timer(0) > timeValue)) {`
238			`thand_f *x;`
239	2	marcus.erl
240	140	julius	`x = timeHandler;`
241			`timeHandler = (thand_f *)0;`
242			`(*x)();`
243			`}`
244			`*/`
245
246			`switch (NetState) {`
247	2	marcus.erl
248	140	julius	`case NETLOOP_RESTART:`
249			`goto restart;`
250	2	marcus.erl
251	140	julius	`case NETLOOP_SUCCESS:`
252			`if (NetBootFileXferSize > 0) {`
253			`printf("Bytes transferred = %ld (0x%lx)\n",`
254			`NetBootFileXferSize,`
255			`NetBootFileXferSize);`
256			`#ifdef TFTP_CALC_CHKSUM`
257			`printf("CHKSUM: 0x%lx\n", TFTP_CHKSUM);`
258			`#endif`
259			`}`
260			`eth_halt();`
261			`return NetBootFileXferSize;`
262	2	marcus.erl
263	140	julius	`case NETLOOP_FAIL:`
264			`return 0;`
265			`}`
266			`}`
267	2	marcus.erl	`#endif`
268			`}`
269
270			`/**********************************************************************/`
271
272
273			`#if 1`
274			`void`
275			`NetStartAgain(void)`
276			`{`
277	140	julius	`NetState = NETLOOP_RESTART;`
278	2	marcus.erl	`}`
279
280			`/**********************************************************************/`
281			`/*`
282			`* Miscelaneous bits.`
283			`*/`
284
285			`void`
286			`NetSetHandler(rxhand_f * f)`
287			`{`
288	140	julius	`packetHandler = f;`
289	2	marcus.erl	`}`
290
291
292			`void`
293			`NetSetTimeout(int iv, thand_f * f)`
294			`{`
295	140	julius	`if (iv == 0) {`
296			`timeHandler = (thand_f *)0;`
297			`} else {`
298			`timeHandler = f;`
299			`timeValue = get_timer(0) + iv;`
300			`}`
301	2	marcus.erl	`}`
302
303
304			`void`
305			`NetSendPacket(volatile unsigned char * pkt, int len)`
306			`{`
307
308			`#if OC_LAN==1`
309	140	julius	`unsigned char p = (unsigned char )0;`
310			`while (p == (unsigned char*) 0)`
311			`p = eth_get_tx_buf();`
312
313	2	marcus.erl	`memcpy(p, (void *)pkt, len);`
314			`eth_send(p, len);`
315	246	julius	`#else`
316			`# if SMC91111_LAN==1`
317	2	marcus.erl	`eth_send(pkt, len);`
318	246	julius	`# endif`
319	2	marcus.erl	`#endif`
320			`}`
321
322
323
324			`void`
325			`NetReceive(volatile unsigned char * pkt, int len)`
326			`{`
327	140	julius	`Ethernet_t *et;`
328			`IP_t *ip;`
329			`ARP_t *arp;`
330			`int x;`
331			`IPaddr_t ip_to_check; // Used as a temp variable to check IP`
332	2	marcus.erl
333	140	julius	`NetRxPkt = pkt;`
334			`NetRxPktLen = len;`
335			`et = (Ethernet_t *)pkt;`
336	2	marcus.erl
337	140	julius	`x = SWAP16(et->et_protlen);`
338	2	marcus.erl
339	140	julius	`if (x < 1514) {`
340			`/*`
341			`* Got a 802 packet. Check the other protocol field.`
342			`*/`
343			`x = SWAP16(et->et_prot);`
344			`ip = (IP_t *)(pkt + E802_HDR_SIZE);`
345			`len -= E802_HDR_SIZE;`
346			`} else {`
347			`ip = (IP_t *)(pkt + ETHER_HDR_SIZE);`
348			`len -= ETHER_HDR_SIZE;`
349			`}`
350	2	marcus.erl
351			`#ifdef ET_DEBUG`
352	140	julius	`printf("Receive from protocol 0x%x\n", x);`
353	2	marcus.erl	`#endif`
354
355	140	julius	`switch (x) {`
356	2	marcus.erl
357	140	julius	`case PROT_ARP:`
358			`/*`
359			`* We have to deal with two types of ARP packets:`
360			`* - REQUEST packets will be answered by sending our`
361			`* IP address - if we know it.`
362			`* - REPLY packates are expected only after we asked`
363			`* for the TFTP server's or the gateway's ethernet`
364			`* address; so if we receive such a packet, we set`
365			`* the server ethernet address`
366			`*/`
367	2	marcus.erl	`#ifdef ET_DEBUG`
368	140	julius	`printf("Got ARP\n");`
369	2	marcus.erl	`#endif`
370	140	julius	`arp = (ARP_t *)ip;`
371			`if (len < ARP_HDR_SIZE) {`
372			`printf("bad length %d < %d\n", len, ARP_HDR_SIZE);`
373			`return;`
374			`}`
375			`if (SWAP16(arp->ar_hrd) != ARP_ETHER) {`
376			`return;`
377			`}`
378			`if (SWAP16(arp->ar_pro) != PROT_IP) {`
379			`return;`
380			`}`
381			`if (arp->ar_hln != 6) {`
382			`return;`
383			`}`
384			`if (arp->ar_pln != 4) {`
385			`return;`
386			`}`
387
388			`memcpy((void) &ip_to_check, (void)&arp->ar_data[16],`
389			`sizeof(IPaddr_t));`
390			`if (NetOurIP == 0 \|\|`
391			`ip_to_check != NetOurIP) {`
392			`return;`
393			`}`
394	2	marcus.erl
395	140	julius	`switch (SWAP16(arp->ar_op)) {`
396			`case ARPOP_REQUEST: /* reply with our IP address */`
397	2	marcus.erl	`#ifdef ET_DEBUG`
398	140	julius	`printf("Got ARP REQUEST, return our IP\n");`
399	2	marcus.erl	`#endif`
400	140	julius	`NetSetEther((unsigned char *)et, et->et_src, PROT_ARP);`
401			`arp->ar_op = SWAP16(ARPOP_REPLY);`
402			`NetCopyEther(&arp->ar_data[10], &arp->ar_data[0]);`
403			`NetCopyEther(&arp->ar_data[0], NetOurEther);`
404			`//(IPaddr_t )(&arp->ar_data[16]) = (IPaddr_t )(&arp->ar_data[6]);`
405			`memcpy((void)&arp->ar_data[16],(void) &arp->ar_data[6],`
406			`sizeof(IPaddr_t));`
407			`//(IPaddr_t )(&arp->ar_data[6]) = NetOurIP;`
408			`memcpy((void)&arp->ar_data[6],(void) &NetOurIP,`
409			`sizeof(IPaddr_t));`
410
411			`NetSendPacket((unsigned char *)et,`
412			`((unsigned char *)arp-pkt)+ARP_HDR_SIZE);`
413			`return;`
414			`case ARPOP_REPLY: /* set TFTP server eth addr */`
415	2	marcus.erl	`#ifdef ET_DEBUG`
416	140	julius	`printf("Got ARP REPLY, set server/gtwy eth addr\n");`
417	2	marcus.erl	`#endif`
418	140	julius	`NetCopyEther(NetServerEther, &arp->ar_data[0]);`
419			`(packetHandler)(0,0,0,0); / start TFTP */`
420			`return;`
421			`default:`
422	2	marcus.erl	`#ifdef ET_DEBUG`
423	140	julius	`printf("Unexpected ARP opcode 0x%x\n", SWAP16(arp->ar_op));`
424	2	marcus.erl	`#endif`
425	140	julius	`return;`
426			`}`
427	2	marcus.erl
428	140	julius	`case PROT_RARP:`
429	2	marcus.erl	`#ifdef ET_DEBUG`
430	140	julius	`printf("Got RARP\n");`
431	2	marcus.erl	`#endif`
432	140	julius	`arp = (ARP_t *)ip;`
433			`if (len < ARP_HDR_SIZE) {`
434			`printf("bad length %d < %d\n", len, ARP_HDR_SIZE);`
435			`return;`
436			`}`
437	2	marcus.erl
438	140	julius	`if ((SWAP16(arp->ar_op) != RARPOP_REPLY) \|\|`
439			`(SWAP16(arp->ar_hrd) != ARP_ETHER) \|\|`
440			`(SWAP16(arp->ar_pro) != PROT_IP) \|\|`
441			`(arp->ar_hln != 6) \|\| (arp->ar_pln != 4)) {`
442	2	marcus.erl
443	140	julius	`printf("invalid RARP header\n");`
444			`} else {`
445			`//NetOurIP = ((IPaddr_t )&arp->ar_data[16]);`
446			`memcpy((void) &NetOurIP, (void) &arp->ar_data[16],`
447			`sizeof(IPaddr_t));`
448			`//NetServerIP = ((IPaddr_t )&arp->ar_data[6]);`
449			`memcpy((void) &NetServerIP,(void) &arp->ar_data[6],`
450			`sizeof(IPaddr_t));`
451	2	marcus.erl
452	140	julius	`NetCopyEther(NetServerEther, &arp->ar_data[0]);`
453	2	marcus.erl
454	140	julius	`(*packetHandler)(0,0,0,0);`
455			`}`
456			`break;`
457
458			`case PROT_IP:`
459	2	marcus.erl	`#ifdef ET_DEBUG`
460	140	julius	`printf("Got IP\n");`
461	2	marcus.erl	`#endif`
462	140	julius	`if (len < IP_HDR_SIZE) {`
463			`debug ("len bad %d < %d\n", len, IP_HDR_SIZE);`
464			`return;`
465			`}`
466			`if (len < SWAP16(ip->ip_len)) {`
467			`printf("len bad %d < %d\n", len, SWAP16(ip->ip_len));`
468			`return;`
469			`}`
470			`len = SWAP16(ip->ip_len);`
471	2	marcus.erl	`#ifdef ET_DEBUG`
472	140	julius	`printf("len=%d, v=%02x\n", len, ip->ip_hl_v & 0xff);`
473	2	marcus.erl	`#endif`
474	140	julius	`if ((ip->ip_hl_v & 0xf0) != 0x40) {`
475			`return;`
476			`}`
477			`if (ip->ip_off & SWAP16c(0x1fff)) { /* Can't deal w/ fragments */`
478			`return;`
479			`}`
480			`if (!NetCksumOk((unsigned char *)ip, IP_HDR_SIZE_NO_UDP / 2)) {`
481			`//printf("checksum bad\n");`
482			`return;`
483			`}`
484	2	marcus.erl
485	140	julius	`memcpy((void)&ip_to_check,(void)&ip->ip_dst, sizeof (IPaddr_t));`
486	2	marcus.erl
487	140	julius	`if (NetOurIP &&`
488			`ip_to_check != NetOurIP &&`
489			`ip_to_check != 0xFFFFFFFF) {`
490			`return;`
491			`}`
492			`/*`
493			`* watch for ICMP host redirects`
494			`*`
495			`* There is no real handler code (yet). We just watch`
496			`* for ICMP host redirect messages. In case anybody`
497			`* sees these messages: please contact me`
498			`* (wd@denx.de), or - even better - send me the`
499			`* necessary fixes :-)`
500			`*`

Browse

Tools

Subversion Repositories openrisc_2011-10-31

[/] [openrisc/] [trunk/] [bootloaders/] [orpmon/] [services/] [net.c] - Blame information for rev 343