Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2000-2002 |
| 4 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
| 8 | #include <command.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 9 | #include <log.h> |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 10 | #include <net.h> |
Lukasz Majewski | 2118592 | 2015-08-24 00:21:43 +0200 | [diff] [blame] | 11 | #include <net/tftp.h> |
wdenk | f602aa0 | 2004-03-13 23:29:43 +0000 | [diff] [blame] | 12 | #include "nfs.h" |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 13 | #include "bootp.h" |
| 14 | #include "rarp.h" |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 15 | |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 16 | #define TIMEOUT 5000UL /* Milliseconds before trying BOOTP again */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 17 | #ifndef CONFIG_NET_RETRY_COUNT |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 18 | #define TIMEOUT_COUNT 5 /* # of timeouts before giving up */ |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 19 | #else |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 20 | #define TIMEOUT_COUNT (CONFIG_NET_RETRY_COUNT) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 21 | #endif |
| 22 | |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 23 | int rarp_try; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 24 | |
| 25 | /* |
| 26 | * Handle a RARP received packet. |
| 27 | */ |
Joe Hershberger | 6fe8b45 | 2012-05-23 07:58:04 +0000 | [diff] [blame] | 28 | void rarp_receive(struct ip_udp_hdr *ip, unsigned len) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 29 | { |
Joe Hershberger | de15d093 | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 30 | struct arp_hdr *arp; |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 31 | |
Joe Hershberger | 05a377b | 2012-05-23 08:01:04 +0000 | [diff] [blame] | 32 | debug_cond(DEBUG_NET_PKT, "Got RARP\n"); |
Joe Hershberger | de15d093 | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 33 | arp = (struct arp_hdr *)ip; |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 34 | if (len < ARP_HDR_SIZE) { |
| 35 | printf("bad length %d < %d\n", len, ARP_HDR_SIZE); |
| 36 | return; |
| 37 | } |
| 38 | |
| 39 | if ((ntohs(arp->ar_op) != RARPOP_REPLY) || |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 40 | (ntohs(arp->ar_hrd) != ARP_ETHER) || |
| 41 | (ntohs(arp->ar_pro) != PROT_IP) || |
| 42 | (arp->ar_hln != 6) || (arp->ar_pln != 4)) { |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 43 | puts("invalid RARP header\n"); |
| 44 | } else { |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 45 | net_copy_ip(&net_ip, &arp->ar_data[16]); |
| 46 | if (net_server_ip.s_addr == 0) |
| 47 | net_copy_ip(&net_server_ip, &arp->ar_data[6]); |
Joe Hershberger | 8ecdbed | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 48 | memcpy(net_server_ethaddr, &arp->ar_data[0], 6); |
Joe Hershberger | 05a377b | 2012-05-23 08:01:04 +0000 | [diff] [blame] | 49 | debug_cond(DEBUG_DEV_PKT, "Got good RARP\n"); |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 50 | net_auto_load(); |
| 51 | } |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 52 | } |
| 53 | |
| 54 | |
| 55 | /* |
| 56 | * Timeout on BOOTP request. |
| 57 | */ |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 58 | static void rarp_timeout_handler(void) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 59 | { |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 60 | if (rarp_try >= TIMEOUT_COUNT) { |
Joe Hershberger | c768446 | 2012-05-15 08:59:10 +0000 | [diff] [blame] | 61 | puts("\nRetry count exceeded; starting again\n"); |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 62 | net_start_again(); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 63 | } else { |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 64 | net_set_timeout_handler(TIMEOUT, rarp_timeout_handler); |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 65 | rarp_request(); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 66 | } |
| 67 | } |
| 68 | |
| 69 | |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 70 | void rarp_request(void) |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 71 | { |
Joe Hershberger | 4b7747e | 2012-05-15 08:59:04 +0000 | [diff] [blame] | 72 | uchar *pkt; |
Joe Hershberger | de15d093 | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 73 | struct arp_hdr *rarp; |
Joe Hershberger | f7ea805 | 2012-05-23 07:59:09 +0000 | [diff] [blame] | 74 | int eth_hdr_size; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 75 | |
Joe Hershberger | 8e805bb | 2015-04-08 01:41:11 -0500 | [diff] [blame] | 76 | printf("RARP broadcast %d\n", ++rarp_try); |
Joe Hershberger | a8ca4f6 | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 77 | pkt = net_tx_packet; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 78 | |
Joe Hershberger | a8ca4f6 | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 79 | eth_hdr_size = net_set_ether(pkt, net_bcast_ethaddr, PROT_RARP); |
Joe Hershberger | f7ea805 | 2012-05-23 07:59:09 +0000 | [diff] [blame] | 80 | pkt += eth_hdr_size; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 81 | |
Joe Hershberger | de15d093 | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 82 | rarp = (struct arp_hdr *)pkt; |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 83 | |
Joe Hershberger | c768446 | 2012-05-15 08:59:10 +0000 | [diff] [blame] | 84 | rarp->ar_hrd = htons(ARP_ETHER); |
| 85 | rarp->ar_pro = htons(PROT_IP); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 86 | rarp->ar_hln = 6; |
| 87 | rarp->ar_pln = 4; |
Joe Hershberger | c768446 | 2012-05-15 08:59:10 +0000 | [diff] [blame] | 88 | rarp->ar_op = htons(RARPOP_REQUEST); |
Joe Hershberger | 8ecdbed | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 89 | memcpy(&rarp->ar_data[0], net_ethaddr, 6); /* source ET addr */ |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 90 | memcpy(&rarp->ar_data[6], &net_ip, 4); /* source IP addr */ |
Joe Hershberger | c768446 | 2012-05-15 08:59:10 +0000 | [diff] [blame] | 91 | /* dest ET addr = source ET addr ??*/ |
Joe Hershberger | 8ecdbed | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 92 | memcpy(&rarp->ar_data[10], net_ethaddr, 6); |
Joe Hershberger | 61b4de6 | 2012-05-23 07:58:03 +0000 | [diff] [blame] | 93 | /* dest IP addr set to broadcast */ |
| 94 | memset(&rarp->ar_data[16], 0xff, 4); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 95 | |
Joe Hershberger | a8ca4f6 | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 96 | net_send_packet(net_tx_packet, eth_hdr_size + ARP_HDR_SIZE); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 97 | |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 98 | net_set_timeout_handler(TIMEOUT, rarp_timeout_handler); |
wdenk | affae2b | 2002-08-17 09:36:01 +0000 | [diff] [blame] | 99 | } |