Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 1 | /* |
| 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-2002 Wolfgang Denk, wd@denx.de |
Wolfgang Denk | 2ea9103 | 2014-09-30 10:44:01 +0200 | [diff] [blame] | 9 | * SPDX-License-Identifier: GPL-2.0 |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 10 | */ |
| 11 | |
| 12 | #include <common.h> |
| 13 | |
| 14 | #include "arp.h" |
| 15 | |
| 16 | #ifndef CONFIG_ARP_TIMEOUT |
| 17 | /* Milliseconds before trying ARP again */ |
| 18 | # define ARP_TIMEOUT 5000UL |
| 19 | #else |
| 20 | # define ARP_TIMEOUT CONFIG_ARP_TIMEOUT |
| 21 | #endif |
| 22 | |
| 23 | |
| 24 | #ifndef CONFIG_NET_RETRY_COUNT |
| 25 | # define ARP_TIMEOUT_COUNT 5 /* # of timeouts before giving up */ |
| 26 | #else |
| 27 | # define ARP_TIMEOUT_COUNT CONFIG_NET_RETRY_COUNT |
| 28 | #endif |
| 29 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 30 | struct in_addr net_arp_wait_packet_ip; |
| 31 | static struct in_addr net_arp_wait_reply_ip; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 32 | /* MAC address of waiting packet's destination */ |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 33 | uchar *arp_wait_packet_ethaddr; |
| 34 | int arp_wait_tx_packet_size; |
| 35 | ulong arp_wait_timer_start; |
| 36 | int arp_wait_try; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 37 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 38 | static uchar *arp_tx_packet; /* THE ARP transmit packet */ |
| 39 | static uchar arp_tx_packet_buf[PKTSIZE_ALIGN + PKTALIGN]; |
Joe Hershberger | e94070c | 2012-05-23 07:59:24 +0000 | [diff] [blame] | 40 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 41 | void arp_init(void) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 42 | { |
| 43 | /* XXX problem with bss workaround */ |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 44 | arp_wait_packet_ethaddr = NULL; |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 45 | net_arp_wait_packet_ip.s_addr = 0; |
| 46 | net_arp_wait_reply_ip.s_addr = 0; |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 47 | arp_wait_tx_packet_size = 0; |
| 48 | arp_tx_packet = &arp_tx_packet_buf[0] + (PKTALIGN - 1); |
| 49 | arp_tx_packet -= (ulong)arp_tx_packet % PKTALIGN; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 50 | } |
| 51 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 52 | void arp_raw_request(struct in_addr source_ip, const uchar *target_ethaddr, |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 53 | struct in_addr target_ip) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 54 | { |
| 55 | uchar *pkt; |
Joe Hershberger | 738853b | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 56 | struct arp_hdr *arp; |
Joe Hershberger | 00f3326 | 2012-05-23 07:59:09 +0000 | [diff] [blame] | 57 | int eth_hdr_size; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 58 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 59 | debug_cond(DEBUG_DEV_PKT, "ARP broadcast %d\n", arp_wait_try); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 60 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 61 | pkt = arp_tx_packet; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 62 | |
Joe Hershberger | 1203fcc | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 63 | eth_hdr_size = net_set_ether(pkt, net_bcast_ethaddr, PROT_ARP); |
Joe Hershberger | 00f3326 | 2012-05-23 07:59:09 +0000 | [diff] [blame] | 64 | pkt += eth_hdr_size; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 65 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 66 | arp = (struct arp_hdr *)pkt; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 67 | |
| 68 | arp->ar_hrd = htons(ARP_ETHER); |
| 69 | arp->ar_pro = htons(PROT_IP); |
Joe Hershberger | 674bb24 | 2012-05-23 07:58:17 +0000 | [diff] [blame] | 70 | arp->ar_hln = ARP_HLEN; |
| 71 | arp->ar_pln = ARP_PLEN; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 72 | arp->ar_op = htons(ARPOP_REQUEST); |
| 73 | |
Joe Hershberger | 0adb5b7 | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 74 | memcpy(&arp->ar_sha, net_ethaddr, ARP_HLEN); /* source ET addr */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 75 | net_write_ip(&arp->ar_spa, source_ip); /* source IP addr */ |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 76 | memcpy(&arp->ar_tha, target_ethaddr, ARP_HLEN); /* target ET addr */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 77 | net_write_ip(&arp->ar_tpa, target_ip); /* target IP addr */ |
Joe Hershberger | 2280418 | 2012-05-23 08:00:11 +0000 | [diff] [blame] | 78 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 79 | net_send_packet(arp_tx_packet, eth_hdr_size + ARP_HDR_SIZE); |
Joe Hershberger | 2280418 | 2012-05-23 08:00:11 +0000 | [diff] [blame] | 80 | } |
| 81 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 82 | void arp_request(void) |
Joe Hershberger | 2280418 | 2012-05-23 08:00:11 +0000 | [diff] [blame] | 83 | { |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 84 | if ((net_arp_wait_packet_ip.s_addr & net_netmask.s_addr) != |
| 85 | (net_ip.s_addr & net_netmask.s_addr)) { |
| 86 | if (net_gateway.s_addr == 0) { |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 87 | puts("## Warning: gatewayip needed but not set\n"); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 88 | net_arp_wait_reply_ip = net_arp_wait_packet_ip; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 89 | } else { |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 90 | net_arp_wait_reply_ip = net_gateway; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 91 | } |
| 92 | } else { |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 93 | net_arp_wait_reply_ip = net_arp_wait_packet_ip; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 94 | } |
| 95 | |
Joe Hershberger | 0adb5b7 | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 96 | arp_raw_request(net_ip, net_null_ethaddr, net_arp_wait_reply_ip); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 97 | } |
| 98 | |
Stefan Brüns | 45b4773 | 2015-08-30 17:46:54 +0200 | [diff] [blame] | 99 | int arp_timeout_check(void) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 100 | { |
| 101 | ulong t; |
| 102 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 103 | if (!net_arp_wait_packet_ip.s_addr) |
Stefan Brüns | 45b4773 | 2015-08-30 17:46:54 +0200 | [diff] [blame] | 104 | return 0; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 105 | |
| 106 | t = get_timer(0); |
| 107 | |
| 108 | /* check for arp timeout */ |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 109 | if ((t - arp_wait_timer_start) > ARP_TIMEOUT) { |
| 110 | arp_wait_try++; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 111 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 112 | if (arp_wait_try >= ARP_TIMEOUT_COUNT) { |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 113 | puts("\nARP Retry count exceeded; starting again\n"); |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 114 | arp_wait_try = 0; |
Stefan Brüns | 9432311 | 2015-08-30 17:46:43 +0200 | [diff] [blame] | 115 | net_set_state(NETLOOP_FAIL); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 116 | } else { |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 117 | arp_wait_timer_start = t; |
| 118 | arp_request(); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 119 | } |
| 120 | } |
Stefan Brüns | 45b4773 | 2015-08-30 17:46:54 +0200 | [diff] [blame] | 121 | return 1; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 122 | } |
| 123 | |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 124 | void arp_receive(struct ethernet_hdr *et, struct ip_udp_hdr *ip, int len) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 125 | { |
Joe Hershberger | 738853b | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 126 | struct arp_hdr *arp; |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 127 | struct in_addr reply_ip_addr; |
Joe Hershberger | 00f3326 | 2012-05-23 07:59:09 +0000 | [diff] [blame] | 128 | int eth_hdr_size; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 129 | |
| 130 | /* |
| 131 | * We have to deal with two types of ARP packets: |
| 132 | * - REQUEST packets will be answered by sending our |
| 133 | * IP address - if we know it. |
| 134 | * - REPLY packates are expected only after we asked |
| 135 | * for the TFTP server's or the gateway's ethernet |
| 136 | * address; so if we receive such a packet, we set |
| 137 | * the server ethernet address |
| 138 | */ |
Joe Hershberger | 4ef8d53 | 2012-05-23 08:01:04 +0000 | [diff] [blame] | 139 | debug_cond(DEBUG_NET_PKT, "Got ARP\n"); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 140 | |
Joe Hershberger | 738853b | 2012-05-23 07:58:08 +0000 | [diff] [blame] | 141 | arp = (struct arp_hdr *)ip; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 142 | if (len < ARP_HDR_SIZE) { |
| 143 | printf("bad length %d < %d\n", len, ARP_HDR_SIZE); |
| 144 | return; |
| 145 | } |
| 146 | if (ntohs(arp->ar_hrd) != ARP_ETHER) |
| 147 | return; |
| 148 | if (ntohs(arp->ar_pro) != PROT_IP) |
| 149 | return; |
Joe Hershberger | 674bb24 | 2012-05-23 07:58:17 +0000 | [diff] [blame] | 150 | if (arp->ar_hln != ARP_HLEN) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 151 | return; |
Joe Hershberger | 674bb24 | 2012-05-23 07:58:17 +0000 | [diff] [blame] | 152 | if (arp->ar_pln != ARP_PLEN) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 153 | return; |
| 154 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 155 | if (net_ip.s_addr == 0) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 156 | return; |
| 157 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 158 | if (net_read_ip(&arp->ar_tpa).s_addr != net_ip.s_addr) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 159 | return; |
| 160 | |
| 161 | switch (ntohs(arp->ar_op)) { |
| 162 | case ARPOP_REQUEST: |
| 163 | /* reply with our IP address */ |
Joe Hershberger | 4ef8d53 | 2012-05-23 08:01:04 +0000 | [diff] [blame] | 164 | debug_cond(DEBUG_DEV_PKT, "Got ARP REQUEST, return our IP\n"); |
Joe Hershberger | e711101 | 2012-05-23 07:59:16 +0000 | [diff] [blame] | 165 | eth_hdr_size = net_update_ether(et, et->et_src, PROT_ARP); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 166 | arp->ar_op = htons(ARPOP_REPLY); |
Joe Hershberger | 674bb24 | 2012-05-23 07:58:17 +0000 | [diff] [blame] | 167 | memcpy(&arp->ar_tha, &arp->ar_sha, ARP_HLEN); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 168 | net_copy_ip(&arp->ar_tpa, &arp->ar_spa); |
Joe Hershberger | 0adb5b7 | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 169 | memcpy(&arp->ar_sha, net_ethaddr, ARP_HLEN); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 170 | net_copy_ip(&arp->ar_spa, &net_ip); |
Joe Hershberger | c697576 | 2012-05-23 08:00:13 +0000 | [diff] [blame] | 171 | |
| 172 | #ifdef CONFIG_CMD_LINK_LOCAL |
| 173 | /* |
| 174 | * Work-around for brain-damaged Cisco equipment with |
| 175 | * arp-proxy enabled. |
| 176 | * |
| 177 | * If the requesting IP is not on our subnet, wait 5ms to |
| 178 | * reply to ARP request so that our reply will overwrite |
| 179 | * the arp-proxy's instead of the other way around. |
| 180 | */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 181 | if ((net_read_ip(&arp->ar_tpa).s_addr & net_netmask.s_addr) != |
| 182 | (net_read_ip(&arp->ar_spa).s_addr & net_netmask.s_addr)) |
Joe Hershberger | c697576 | 2012-05-23 08:00:13 +0000 | [diff] [blame] | 183 | udelay(5000); |
| 184 | #endif |
Joe Hershberger | 1203fcc | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 185 | net_send_packet((uchar *)et, eth_hdr_size + ARP_HDR_SIZE); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 186 | return; |
| 187 | |
| 188 | case ARPOP_REPLY: /* arp reply */ |
| 189 | /* are we waiting for a reply */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 190 | if (!net_arp_wait_packet_ip.s_addr) |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 191 | break; |
| 192 | |
| 193 | #ifdef CONFIG_KEEP_SERVERADDR |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 194 | if (net_server_ip.s_addr == net_arp_wait_packet_ip.s_addr) { |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 195 | char buf[20]; |
Mike Frysinger | a0bc44e | 2012-07-10 00:41:50 +0000 | [diff] [blame] | 196 | sprintf(buf, "%pM", &arp->ar_sha); |
Simon Glass | 382bee5 | 2017-08-03 12:22:09 -0600 | [diff] [blame] | 197 | env_set("serveraddr", buf); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 198 | } |
| 199 | #endif |
| 200 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 201 | reply_ip_addr = net_read_ip(&arp->ar_spa); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 202 | |
| 203 | /* matched waiting packet's address */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 204 | if (reply_ip_addr.s_addr == net_arp_wait_reply_ip.s_addr) { |
Joe Hershberger | 4ef8d53 | 2012-05-23 08:01:04 +0000 | [diff] [blame] | 205 | debug_cond(DEBUG_DEV_PKT, |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 206 | "Got ARP REPLY, set eth addr (%pM)\n", |
| 207 | arp->ar_data); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 208 | |
| 209 | /* save address for later use */ |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 210 | if (arp_wait_packet_ethaddr != NULL) |
| 211 | memcpy(arp_wait_packet_ethaddr, |
Joe Hershberger | f1d2d28 | 2012-05-23 07:59:20 +0000 | [diff] [blame] | 212 | &arp->ar_sha, ARP_HLEN); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 213 | |
Joe Hershberger | ece223b | 2012-05-23 07:59:15 +0000 | [diff] [blame] | 214 | net_get_arp_handler()((uchar *)arp, 0, reply_ip_addr, |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 215 | 0, len); |
Joe Hershberger | ece223b | 2012-05-23 07:59:15 +0000 | [diff] [blame] | 216 | |
Joe Hershberger | e94070c | 2012-05-23 07:59:24 +0000 | [diff] [blame] | 217 | /* set the mac address in the waiting packet's header |
| 218 | and transmit it */ |
Joe Hershberger | 1203fcc | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 219 | memcpy(((struct ethernet_hdr *)net_tx_packet)->et_dest, |
| 220 | &arp->ar_sha, ARP_HLEN); |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 221 | net_send_packet(net_tx_packet, arp_wait_tx_packet_size); |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 222 | |
| 223 | /* no arp request pending now */ |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 224 | net_arp_wait_packet_ip.s_addr = 0; |
Joe Hershberger | 85d25e0 | 2015-04-08 01:41:08 -0500 | [diff] [blame] | 225 | arp_wait_tx_packet_size = 0; |
| 226 | arp_wait_packet_ethaddr = NULL; |
Joe Hershberger | d280d3f | 2012-05-23 07:58:01 +0000 | [diff] [blame] | 227 | } |
| 228 | return; |
| 229 | default: |
| 230 | debug("Unexpected ARP opcode 0x%x\n", |
| 231 | ntohs(arp->ar_op)); |
| 232 | return; |
| 233 | } |
| 234 | } |