Blame view
net/ping.c
2.72 KB
a36b12f95 net: Move PING ou... |
1 2 3 4 5 6 7 8 |
/* * Copied from Linux Monitor (LiMon) - Networking. * * Copyright 1994 - 2000 Neil Russell. * (See License) * Copyright 2000 Roland Borde * Copyright 2000 Paolo Scaffardi * Copyright 2000-2002 Wolfgang Denk, wd@denx.de |
2ea910392 SPDX License clea... |
9 |
* SPDX-License-Identifier: GPL-2.0 |
a36b12f95 net: Move PING ou... |
10 11 12 13 |
*/ #include "ping.h" #include "arp.h" |
331db5a90 net: cosmetic: Cl... |
14 |
static ushort ping_seq_number; |
a36b12f95 net: Move PING ou... |
15 16 |
/* The ip address to ping */ |
049a95a77 net: cosmetic: Ch... |
17 |
struct in_addr net_ping_ip; |
a36b12f95 net: Move PING ou... |
18 |
|
049a95a77 net: cosmetic: Ch... |
19 |
static void set_icmp_header(uchar *pkt, struct in_addr dest) |
4b11c9166 net: Refactor IP,... |
20 21 22 23 24 25 |
{ /* * Construct an IP and ICMP header. */ struct ip_hdr *ip = (struct ip_hdr *)pkt; struct icmp_hdr *icmp = (struct icmp_hdr *)(pkt + IP_HDR_SIZE); |
049a95a77 net: cosmetic: Ch... |
26 |
net_set_ip_header(pkt, dest, net_ip); |
4b11c9166 net: Refactor IP,... |
27 28 29 |
ip->ip_len = htons(IP_ICMP_HDR_SIZE); ip->ip_p = IPPROTO_ICMP; |
0da0fcd51 net: Use new chec... |
30 |
ip->ip_sum = compute_ip_checksum(ip, IP_HDR_SIZE); |
4b11c9166 net: Refactor IP,... |
31 32 33 34 35 |
icmp->type = ICMP_ECHO_REQUEST; icmp->code = 0; icmp->checksum = 0; icmp->un.echo.id = 0; |
331db5a90 net: cosmetic: Cl... |
36 |
icmp->un.echo.sequence = htons(ping_seq_number++); |
0da0fcd51 net: Use new chec... |
37 |
icmp->checksum = compute_ip_checksum(icmp, ICMP_HDR_SIZE); |
4b11c9166 net: Refactor IP,... |
38 |
} |
a36b12f95 net: Move PING ou... |
39 40 |
static int ping_send(void) { |
a36b12f95 net: Move PING ou... |
41 |
uchar *pkt; |
00f33268a net: Refactor pac... |
42 |
int eth_hdr_size; |
a36b12f95 net: Move PING ou... |
43 44 |
/* XXX always send arp request */ |
049a95a77 net: cosmetic: Ch... |
45 46 |
debug_cond(DEBUG_DEV_PKT, "sending ARP for %pI4 ", &net_ping_ip); |
a36b12f95 net: Move PING ou... |
47 |
|
049a95a77 net: cosmetic: Ch... |
48 |
net_arp_wait_packet_ip = net_ping_ip; |
a36b12f95 net: Move PING ou... |
49 |
|
1203fccee net: cosmetic: Cl... |
50 51 |
eth_hdr_size = net_set_ether(net_tx_packet, net_null_ethaddr, PROT_IP); pkt = (uchar *)net_tx_packet + eth_hdr_size; |
a36b12f95 net: Move PING ou... |
52 |
|
049a95a77 net: cosmetic: Ch... |
53 |
set_icmp_header(pkt, net_ping_ip); |
a36b12f95 net: Move PING ou... |
54 55 |
/* size of the waiting packet */ |
85d25e0e7 net: cosmetic: Cl... |
56 |
arp_wait_tx_packet_size = eth_hdr_size + IP_ICMP_HDR_SIZE; |
a36b12f95 net: Move PING ou... |
57 58 |
/* and do the ARP request */ |
85d25e0e7 net: cosmetic: Cl... |
59 60 61 |
arp_wait_try = 1; arp_wait_timer_start = get_timer(0); arp_request(); |
a36b12f95 net: Move PING ou... |
62 63 |
return 1; /* waiting */ } |
331db5a90 net: cosmetic: Cl... |
64 |
static void ping_timeout_handler(void) |
a36b12f95 net: Move PING ou... |
65 66 |
{ eth_halt(); |
22f6e99d5 net: Refactor to ... |
67 |
net_set_state(NETLOOP_FAIL); /* we did not get the reply */ |
a36b12f95 net: Move PING ou... |
68 |
} |
a36b12f95 net: Move PING ou... |
69 70 71 72 |
void ping_start(void) { printf("Using %s device ", eth_get_name()); |
bc0571fc1 net: cosmetic: Fi... |
73 |
net_set_timeout_handler(10000UL, ping_timeout_handler); |
a36b12f95 net: Move PING ou... |
74 75 76 |
ping_send(); } |
cb487f566 net: cosmetic: Un... |
77 |
void ping_receive(struct ethernet_hdr *et, struct ip_udp_hdr *ip, int len) |
a36b12f95 net: Move PING ou... |
78 |
{ |
e0a630795 net: cosmetic: Un... |
79 |
struct icmp_hdr *icmph = (struct icmp_hdr *)&ip->udp_src; |
049a95a77 net: cosmetic: Ch... |
80 |
struct in_addr src_ip; |
e71110158 net: Add net_upda... |
81 |
int eth_hdr_size; |
a36b12f95 net: Move PING ou... |
82 83 84 |
switch (icmph->type) { case ICMP_ECHO_REPLY: |
049a95a77 net: cosmetic: Ch... |
85 86 |
src_ip = net_read_ip((void *)&ip->ip_src); if (src_ip.s_addr == net_ping_ip.s_addr) |
22f6e99d5 net: Refactor to ... |
87 |
net_set_state(NETLOOP_SUCCESS); |
a36b12f95 net: Move PING ou... |
88 89 |
return; case ICMP_ECHO_REQUEST: |
e71110158 net: Add net_upda... |
90 |
eth_hdr_size = net_update_ether(et, et->et_src, PROT_IP); |
a36b12f95 net: Move PING ou... |
91 |
|
331db5a90 net: cosmetic: Cl... |
92 93 94 95 |
debug_cond(DEBUG_DEV_PKT, "Got ICMP ECHO REQUEST, return %d bytes ", eth_hdr_size + len); |
a36b12f95 net: Move PING ou... |
96 97 98 |
ip->ip_sum = 0; ip->ip_off = 0; |
049a95a77 net: cosmetic: Ch... |
99 100 |
net_copy_ip((void *)&ip->ip_dst, &ip->ip_src); net_copy_ip((void *)&ip->ip_src, &net_ip); |
0da0fcd51 net: Use new chec... |
101 |
ip->ip_sum = compute_ip_checksum(ip, IP_HDR_SIZE); |
a36b12f95 net: Move PING ou... |
102 103 104 |
icmph->type = ICMP_ECHO_REPLY; icmph->checksum = 0; |
0da0fcd51 net: Use new chec... |
105 |
icmph->checksum = compute_ip_checksum(icmph, len - IP_HDR_SIZE); |
1203fccee net: cosmetic: Cl... |
106 |
net_send_packet((uchar *)et, eth_hdr_size + len); |
a36b12f95 net: Move PING ou... |
107 108 109 110 111 |
return; /* default: return;*/ } } |