]>
Commit | Line | Data |
---|---|---|
1 | // SPDX-License-Identifier: GPL-2.0+ | |
2 | /* | |
3 | * (C) Copyright 2000-2002 | |
4 | * Wolfgang Denk, DENX Software Engineering, [email protected]. | |
5 | */ | |
6 | ||
7 | #include <command.h> | |
8 | #include <log.h> | |
9 | #include <net.h> | |
10 | #include <net/tftp.h> | |
11 | #include "nfs.h" | |
12 | #include "bootp.h" | |
13 | #include "rarp.h" | |
14 | ||
15 | #define TIMEOUT 5000UL /* Milliseconds before trying BOOTP again */ | |
16 | ||
17 | int rarp_try; | |
18 | ||
19 | /* | |
20 | * Handle a RARP received packet. | |
21 | */ | |
22 | void rarp_receive(struct ip_udp_hdr *ip, unsigned len) | |
23 | { | |
24 | struct arp_hdr *arp; | |
25 | ||
26 | debug_cond(DEBUG_NET_PKT, "Got RARP\n"); | |
27 | arp = (struct arp_hdr *)ip; | |
28 | if (len < ARP_HDR_SIZE) { | |
29 | printf("bad length %d < %d\n", len, ARP_HDR_SIZE); | |
30 | return; | |
31 | } | |
32 | ||
33 | if ((ntohs(arp->ar_op) != RARPOP_REPLY) || | |
34 | (ntohs(arp->ar_hrd) != ARP_ETHER) || | |
35 | (ntohs(arp->ar_pro) != PROT_IP) || | |
36 | (arp->ar_hln != 6) || (arp->ar_pln != 4)) { | |
37 | puts("invalid RARP header\n"); | |
38 | } else { | |
39 | net_copy_ip(&net_ip, &arp->ar_data[16]); | |
40 | if (net_server_ip.s_addr == 0) | |
41 | net_copy_ip(&net_server_ip, &arp->ar_data[6]); | |
42 | memcpy(net_server_ethaddr, &arp->ar_data[0], 6); | |
43 | debug_cond(DEBUG_DEV_PKT, "Got good RARP\n"); | |
44 | net_auto_load(); | |
45 | } | |
46 | } | |
47 | ||
48 | ||
49 | /* | |
50 | * Timeout on BOOTP request. | |
51 | */ | |
52 | static void rarp_timeout_handler(void) | |
53 | { | |
54 | if (rarp_try >= CONFIG_NET_RETRY_COUNT) { | |
55 | puts("\nRetry count exceeded; starting again\n"); | |
56 | net_start_again(); | |
57 | } else { | |
58 | net_set_timeout_handler(TIMEOUT, rarp_timeout_handler); | |
59 | rarp_request(); | |
60 | } | |
61 | } | |
62 | ||
63 | ||
64 | void rarp_request(void) | |
65 | { | |
66 | uchar *pkt; | |
67 | struct arp_hdr *rarp; | |
68 | int eth_hdr_size; | |
69 | ||
70 | printf("RARP broadcast %d\n", ++rarp_try); | |
71 | pkt = net_tx_packet; | |
72 | ||
73 | eth_hdr_size = net_set_ether(pkt, net_bcast_ethaddr, PROT_RARP); | |
74 | pkt += eth_hdr_size; | |
75 | ||
76 | rarp = (struct arp_hdr *)pkt; | |
77 | ||
78 | rarp->ar_hrd = htons(ARP_ETHER); | |
79 | rarp->ar_pro = htons(PROT_IP); | |
80 | rarp->ar_hln = 6; | |
81 | rarp->ar_pln = 4; | |
82 | rarp->ar_op = htons(RARPOP_REQUEST); | |
83 | memcpy(&rarp->ar_data[0], net_ethaddr, 6); /* source ET addr */ | |
84 | memcpy(&rarp->ar_data[6], &net_ip, 4); /* source IP addr */ | |
85 | /* dest ET addr = source ET addr ??*/ | |
86 | memcpy(&rarp->ar_data[10], net_ethaddr, 6); | |
87 | /* dest IP addr set to broadcast */ | |
88 | memset(&rarp->ar_data[16], 0xff, 4); | |
89 | ||
90 | net_send_packet(net_tx_packet, eth_hdr_size + ARP_HDR_SIZE); | |
91 | ||
92 | net_set_timeout_handler(TIMEOUT, rarp_timeout_handler); | |
93 | } |