blob: 81905f631592ae8f97fd34927185a53aa07251bc [file] [log] [blame]
Tom Rinif739fcd2018-05-07 17:02:21 -04001// SPDX-License-Identifier: GPL-2.0
wdenk2d966952002-10-31 22:12:35 +00002/*
3 * Copied from Linux Monitor (LiMon) - Networking.
4 *
5 * Copyright 1994 - 2000 Neil Russell.
6 * (See License)
7 * Copyright 2000 Roland Borde
8 * Copyright 2000 Paolo Scaffardi
9 * Copyright 2000-2002 Wolfgang Denk, wd@denx.de
10 */
11
12/*
13 * General Desription:
14 *
15 * The user interface supports commands for BOOTP, RARP, and TFTP.
16 * Also, we support ARP internally. Depending on available data,
17 * these interact as follows:
18 *
19 * BOOTP:
20 *
21 * Prerequisites: - own ethernet address
22 * We want: - own IP address
23 * - TFTP server IP address
24 * - name of bootfile
25 * Next step: ARP
26 *
Joe Hershbergerd22c3382012-05-23 08:00:12 +000027 * LINK_LOCAL:
28 *
29 * Prerequisites: - own ethernet address
30 * We want: - own IP address
31 * Next step: ARP
32 *
wdenk2d966952002-10-31 22:12:35 +000033 * RARP:
34 *
35 * Prerequisites: - own ethernet address
36 * We want: - own IP address
37 * - TFTP server IP address
38 * Next step: ARP
39 *
40 * ARP:
41 *
42 * Prerequisites: - own ethernet address
43 * - own IP address
44 * - TFTP server IP address
45 * We want: - TFTP server ethernet address
46 * Next step: TFTP
47 *
48 * DHCP:
49 *
Wolfgang Denkb2f50802005-08-12 23:43:12 +020050 * Prerequisites: - own ethernet address
51 * We want: - IP, Netmask, ServerIP, Gateway IP
52 * - bootfilename, lease time
53 * Next step: - TFTP
wdenk2d966952002-10-31 22:12:35 +000054 *
55 * TFTP:
56 *
57 * Prerequisites: - own ethernet address
58 * - own IP address
59 * - TFTP server IP address
60 * - TFTP server ethernet address
61 * - name of bootfile (if unknown, we use a default name
62 * derived from our own IP address)
63 * We want: - load the boot file
64 * Next step: none
wdenkcbd8a352004-02-24 02:00:03 +000065 *
66 * NFS:
67 *
68 * Prerequisites: - own ethernet address
69 * - own IP address
70 * - name of bootfile (if unknown, we use a default name
71 * derived from our own IP address)
72 * We want: - load the boot file
73 * Next step: none
wdenkea287de2005-04-01 00:25:43 +000074 *
Lothar Feltend8970da2018-06-22 22:29:54 +020075 *
76 * WOL:
77 *
78 * Prerequisites: - own ethernet address
79 * We want: - magic packet or timeout
80 * Next step: none
wdenk2d966952002-10-31 22:12:35 +000081 */
82
83
84#include <common.h>
Simon Glass52f24232020-05-10 11:40:00 -060085#include <bootstage.h>
wdenk2d966952002-10-31 22:12:35 +000086#include <command.h>
Simon Glass24b852a2015-11-08 23:47:45 -070087#include <console.h>
Simon Glassc7694dd2019-08-01 09:46:46 -060088#include <env.h>
Simon Glassf3998fd2019-08-02 09:44:25 -060089#include <env_internal.h>
Joe Hershberger60304592015-03-22 17:09:24 -050090#include <errno.h>
Simon Glass8e8ccfe2019-12-28 10:45:03 -070091#include <image.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060092#include <log.h>
wdenk2d966952002-10-31 22:12:35 +000093#include <net.h>
Alex Kiernanf73a7df2018-05-29 15:30:53 +000094#include <net/fastboot.h>
Lukasz Majewski34696952015-08-24 00:21:43 +020095#include <net/tftp.h>
Ramon Fried3eaac632019-07-18 21:43:30 +030096#if defined(CONFIG_CMD_PCAP)
97#include <net/pcap.h>
98#endif
Philippe Reynesb43ea1b2020-09-18 14:13:00 +020099#include <net/udp.h>
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200100#if defined(CONFIG_LED_STATUS)
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000101#include <miiphy.h>
102#include <status_led.h>
103#endif
104#include <watchdog.h>
105#include <linux/compiler.h>
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000106#include "arp.h"
wdenk2d966952002-10-31 22:12:35 +0000107#include "bootp.h"
Joe Hershbergerf575ae12012-05-23 07:57:59 +0000108#include "cdp.h"
Robin Getz1a32bf42009-07-20 14:53:54 -0400109#if defined(CONFIG_CMD_DNS)
110#include "dns.h"
111#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +0000112#include "link_local.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000113#include "nfs.h"
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000114#include "ping.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000115#include "rarp.h"
Lothar Feltend8970da2018-06-22 22:29:54 +0200116#if defined(CONFIG_CMD_WOL)
117#include "wol.h"
118#endif
wdenk2d966952002-10-31 22:12:35 +0000119
wdenk2d966952002-10-31 22:12:35 +0000120/** BOOTP EXTENTIONS **/
121
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000122/* Our subnet mask (0=unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500123struct in_addr net_netmask;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000124/* Our gateways IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500125struct in_addr net_gateway;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000126/* Our DNS IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500127struct in_addr net_dns_server;
Jon Loeliger1fe80d72007-07-09 22:08:34 -0500128#if defined(CONFIG_BOOTP_DNS2)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000129/* Our 2nd DNS IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500130struct in_addr net_dns_server2;
stroesefe389a82003-08-28 14:17:32 +0000131#endif
wdenk2d966952002-10-31 22:12:35 +0000132
133/** END OF BOOTP EXTENTIONS **/
134
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000135/* Our ethernet address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500136u8 net_ethaddr[6];
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000137/* Boot server enet address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500138u8 net_server_ethaddr[6];
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000139/* Our IP addr (0 = unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500140struct in_addr net_ip;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000141/* Server IP addr (0 = unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500142struct in_addr net_server_ip;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000143/* Current receive packet */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500144uchar *net_rx_packet;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000145/* Current rx packet length */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500146int net_rx_packet_len;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000147/* IP packet ID */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500148static unsigned net_ip_id;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000149/* Ethernet bcast address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500150const u8 net_bcast_ethaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
151const u8 net_null_ethaddr[6];
Alexander Graf0efe1bc2016-05-06 21:01:01 +0200152#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500153void (*push_packet)(void *, int len) = 0;
Rafal Jaworowskif85b6072007-12-27 18:19:02 +0100154#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000155/* Network loop state */
Joe Hershberger22f6e992012-05-23 07:59:14 +0000156enum net_loop_state net_state;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000157/* Tried all network devices */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500158int net_restart_wrap;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000159/* Network loop restarted */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500160static int net_restarted;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000161/* At least one device configured */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500162static int net_dev_exists;
wdenk2d966952002-10-31 22:12:35 +0000163
wdenk6e592382004-04-18 17:39:38 +0000164/* XXX in both little & big endian machines 0xFFFF == ntohs(-1) */
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000165/* default is without VLAN */
Joe Hershberger4fd50552015-04-08 01:41:17 -0500166ushort net_our_vlan = 0xFFFF;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000167/* ditto */
Joe Hershberger4fd50552015-04-08 01:41:17 -0500168ushort net_native_vlan = 0xFFFF;
wdenka3d991b2004-04-15 21:48:45 +0000169
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000170/* Boot File name */
Jacob Stiffler11a69ff2015-09-30 10:12:05 -0400171char net_boot_file_name[1024];
Alexander Graf449312c2018-06-15 10:29:27 +0200172/* Indicates whether the file name was specified on the command line */
173bool net_boot_file_name_explicit;
Joe Hershberger14111572015-04-08 01:41:02 -0500174/* The actual transferred size of the bootfile (in bytes) */
175u32 net_boot_file_size;
176/* Boot file size in blocks as reported by the DHCP server */
177u32 net_boot_file_expected_size_in_blocks;
wdenk2d966952002-10-31 22:12:35 +0000178
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500179static uchar net_pkt_buf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];
Joe Hershberger2a504df2015-03-22 17:09:11 -0500180/* Receive packets */
181uchar *net_rx_packets[PKTBUFSRX];
Joe Hershbergerece223b2012-05-23 07:59:15 +0000182/* Current UDP RX packet handler */
183static rxhand_f *udp_packet_handler;
184/* Current ARP RX packet handler */
185static rxhand_f *arp_packet_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000186#ifdef CONFIG_CMD_TFTPPUT
Joe Hershbergerece223b2012-05-23 07:59:15 +0000187/* Current ICMP rx handler */
188static rxhand_icmp_f *packet_icmp_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000189#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000190/* Current timeout handler */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500191static thand_f *time_handler;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000192/* Time base value */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500193static ulong time_start;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000194/* Current timeout value */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500195static ulong time_delta;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000196/* THE transmit packet */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500197uchar *net_tx_packet;
wdenk2d966952002-10-31 22:12:35 +0000198
Simon Glasse4bf0c52011-10-24 18:00:02 +0000199static int net_check_prereq(enum proto_t protocol);
wdenk2d966952002-10-31 22:12:35 +0000200
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500201static int net_try_count;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100202
Jim Linb63056d2013-08-13 19:03:05 +0800203int __maybe_unused net_busy_flag;
204
wdenk2d966952002-10-31 22:12:35 +0000205/**********************************************************************/
wdenk73a8b272003-06-05 19:27:42 +0000206
Joe Hershbergerfd305632015-05-20 14:27:23 -0500207static int on_ipaddr(const char *name, const char *value, enum env_op op,
208 int flags)
209{
210 if (flags & H_PROGRAMMATIC)
211 return 0;
212
213 net_ip = string_to_ip(value);
214
215 return 0;
216}
217U_BOOT_ENV_CALLBACK(ipaddr, on_ipaddr);
218
219static int on_gatewayip(const char *name, const char *value, enum env_op op,
220 int flags)
221{
222 if (flags & H_PROGRAMMATIC)
223 return 0;
224
225 net_gateway = string_to_ip(value);
226
227 return 0;
228}
229U_BOOT_ENV_CALLBACK(gatewayip, on_gatewayip);
230
231static int on_netmask(const char *name, const char *value, enum env_op op,
232 int flags)
233{
234 if (flags & H_PROGRAMMATIC)
235 return 0;
236
237 net_netmask = string_to_ip(value);
238
239 return 0;
240}
241U_BOOT_ENV_CALLBACK(netmask, on_netmask);
242
243static int on_serverip(const char *name, const char *value, enum env_op op,
244 int flags)
245{
246 if (flags & H_PROGRAMMATIC)
247 return 0;
248
249 net_server_ip = string_to_ip(value);
250
251 return 0;
252}
253U_BOOT_ENV_CALLBACK(serverip, on_serverip);
254
255static int on_nvlan(const char *name, const char *value, enum env_op op,
256 int flags)
257{
258 if (flags & H_PROGRAMMATIC)
259 return 0;
260
261 net_native_vlan = string_to_vlan(value);
262
263 return 0;
264}
265U_BOOT_ENV_CALLBACK(nvlan, on_nvlan);
266
267static int on_vlan(const char *name, const char *value, enum env_op op,
268 int flags)
269{
270 if (flags & H_PROGRAMMATIC)
271 return 0;
272
273 net_our_vlan = string_to_vlan(value);
274
275 return 0;
276}
277U_BOOT_ENV_CALLBACK(vlan, on_vlan);
278
279#if defined(CONFIG_CMD_DNS)
280static int on_dnsip(const char *name, const char *value, enum env_op op,
281 int flags)
282{
283 if (flags & H_PROGRAMMATIC)
284 return 0;
285
286 net_dns_server = string_to_ip(value);
287
288 return 0;
289}
290U_BOOT_ENV_CALLBACK(dnsip, on_dnsip);
291#endif
292
Simon Glasse4a3d572011-10-27 06:24:32 +0000293/*
294 * Check if autoload is enabled. If so, use either NFS or TFTP to download
295 * the boot file.
296 */
297void net_auto_load(void)
298{
Tom Rinia6ab4b52019-12-05 19:35:07 -0500299#if defined(CONFIG_CMD_NFS) && !defined(CONFIG_SPL_BUILD)
Simon Glass00caae62017-08-03 12:22:12 -0600300 const char *s = env_get("autoload");
Simon Glasse4a3d572011-10-27 06:24:32 +0000301
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600302 if (s != NULL && strcmp(s, "NFS") == 0) {
Joe Hershberger3855cad2018-07-03 19:36:40 -0500303 if (net_check_prereq(NFS)) {
304/* We aren't expecting to get a serverip, so just accept the assigned IP */
Simon Glass43407532021-12-18 11:27:52 -0700305 if (IS_ENABLED(CONFIG_BOOTP_SERVERIP)) {
306 net_set_state(NETLOOP_SUCCESS);
307 } else {
308 printf("Cannot autoload with NFS\n");
309 net_set_state(NETLOOP_FAIL);
310 }
Joe Hershberger3855cad2018-07-03 19:36:40 -0500311 return;
312 }
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600313 /*
314 * Use NFS to load the bootfile.
315 */
Joe Hershberger68c76a32015-04-08 01:41:10 -0500316 nfs_start();
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600317 return;
318 }
Simon Glasse4a3d572011-10-27 06:24:32 +0000319#endif
Simon Glassbfebc8c2017-08-03 12:22:13 -0600320 if (env_get_yesno("autoload") == 0) {
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600321 /*
322 * Just use BOOTP/RARP to configure system;
323 * Do not use TFTP to load the bootfile.
324 */
325 net_set_state(NETLOOP_SUCCESS);
326 return;
Simon Glasse4a3d572011-10-27 06:24:32 +0000327 }
Joe Hershberger3855cad2018-07-03 19:36:40 -0500328 if (net_check_prereq(TFTPGET)) {
329/* We aren't expecting to get a serverip, so just accept the assigned IP */
Simon Glass43407532021-12-18 11:27:52 -0700330 if (IS_ENABLED(CONFIG_BOOTP_SERVERIP)) {
331 net_set_state(NETLOOP_SUCCESS);
332 } else {
333 printf("Cannot autoload with TFTPGET\n");
334 net_set_state(NETLOOP_FAIL);
335 }
Joe Hershberger3855cad2018-07-03 19:36:40 -0500336 return;
337 }
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500338 tftp_start(TFTPGET);
Simon Glasse4a3d572011-10-27 06:24:32 +0000339}
340
Sean Andersonc3f02782020-09-12 17:45:43 -0400341static int net_init_loop(void)
Heiko Schocher2f70c492009-02-10 09:38:52 +0100342{
Jim Lin7315cfd2013-05-17 17:41:03 +0800343 if (eth_get_dev())
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500344 memcpy(net_ethaddr, eth_get_ethaddr(), 6);
Sean Andersonc3f02782020-09-12 17:45:43 -0400345 else
346 /*
347 * Not ideal, but there's no way to get the actual error, and I
348 * don't feel like fixing all the users of eth_get_dev to deal
349 * with errors.
350 */
351 return -ENONET;
Michael Zaidman3c172c42009-04-04 01:43:00 +0300352
Sean Andersonc3f02782020-09-12 17:45:43 -0400353 return 0;
Heiko Schocher2f70c492009-02-10 09:38:52 +0100354}
355
Joe Hershbergerece223b2012-05-23 07:59:15 +0000356static void net_clear_handlers(void)
357{
358 net_set_udp_handler(NULL);
359 net_set_arp_handler(NULL);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500360 net_set_timeout_handler(0, NULL);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000361}
362
363static void net_cleanup_loop(void)
364{
365 net_clear_handlers();
366}
367
Sean Andersonc3f02782020-09-12 17:45:43 -0400368int net_init(void)
Joe Hershberger46c495d2012-05-23 07:59:22 +0000369{
370 static int first_call = 1;
371
372 if (first_call) {
373 /*
374 * Setup packet buffers, aligned correctly.
375 */
376 int i;
377
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500378 net_tx_packet = &net_pkt_buf[0] + (PKTALIGN - 1);
379 net_tx_packet -= (ulong)net_tx_packet % PKTALIGN;
Joe Hershberger2a504df2015-03-22 17:09:11 -0500380 for (i = 0; i < PKTBUFSRX; i++) {
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500381 net_rx_packets[i] = net_tx_packet +
382 (i + 1) * PKTSIZE_ALIGN;
Joe Hershberger2a504df2015-03-22 17:09:11 -0500383 }
Joe Hershberger85d25e02015-04-08 01:41:08 -0500384 arp_init();
Joe Hershberger46c495d2012-05-23 07:59:22 +0000385 net_clear_handlers();
386
387 /* Only need to setup buffer pointers once. */
388 first_call = 0;
389 }
390
Sean Andersonc3f02782020-09-12 17:45:43 -0400391 return net_init_loop();
Joe Hershberger46c495d2012-05-23 07:59:22 +0000392}
393
wdenk73a8b272003-06-05 19:27:42 +0000394/**********************************************************************/
wdenk2d966952002-10-31 22:12:35 +0000395/*
396 * Main network processing loop.
397 */
398
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500399int net_loop(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +0000400{
Joe Hershberger60304592015-03-22 17:09:24 -0500401 int ret = -EINVAL;
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200402 enum net_loop_state prev_net_state = net_state;
wdenk2d966952002-10-31 22:12:35 +0000403
Marek Szyprowskidef7a5c2020-06-15 11:15:57 +0200404#if defined(CONFIG_CMD_PING)
405 if (protocol != PING)
406 net_ping_ip.s_addr = 0;
407#endif
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500408 net_restarted = 0;
409 net_dev_exists = 0;
410 net_try_count = 1;
411 debug_cond(DEBUG_INT_STATE, "--- net_loop Entry\n");
wdenk73a8b272003-06-05 19:27:42 +0000412
Simon Glass573f14f2011-12-10 11:08:06 +0000413 bootstage_mark_name(BOOTSTAGE_ID_ETH_START, "eth_start");
Joe Hershberger46c495d2012-05-23 07:59:22 +0000414 net_init();
Yang Liud9506cd2020-12-21 14:44:39 +1100415 if (eth_is_on_demand_init()) {
wdenkb1bf6f22005-04-03 14:52:59 +0000416 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000417 eth_set_current();
Joe Hershberger60304592015-03-22 17:09:24 -0500418 ret = eth_init();
419 if (ret < 0) {
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000420 eth_halt();
Joe Hershberger60304592015-03-22 17:09:24 -0500421 return ret;
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000422 }
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500423 } else {
Joe Hershbergerd2eaec62015-03-22 17:09:06 -0500424 eth_init_state_only();
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500425 }
wdenk2d966952002-10-31 22:12:35 +0000426restart:
Jim Linb63056d2013-08-13 19:03:05 +0800427#ifdef CONFIG_USB_KEYBOARD
428 net_busy_flag = 0;
429#endif
Joe Hershberger22f6e992012-05-23 07:59:14 +0000430 net_set_state(NETLOOP_CONTINUE);
wdenk2d966952002-10-31 22:12:35 +0000431
432 /*
433 * Start the ball rolling with the given start function. From
434 * here on, this code is a state machine driven by received
435 * packets and timer events.
436 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500437 debug_cond(DEBUG_INT_STATE, "--- net_loop Init\n");
438 net_init_loop();
wdenk2d966952002-10-31 22:12:35 +0000439
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000440 switch (net_check_prereq(protocol)) {
wdenk2d966952002-10-31 22:12:35 +0000441 case 1:
442 /* network not configured */
wdenkb1bf6f22005-04-03 14:52:59 +0000443 eth_halt();
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200444 net_set_state(prev_net_state);
Joe Hershberger60304592015-03-22 17:09:24 -0500445 return -ENODEV;
wdenk2d966952002-10-31 22:12:35 +0000446
wdenk2d966952002-10-31 22:12:35 +0000447 case 2:
448 /* network device not configured */
449 break;
wdenk2d966952002-10-31 22:12:35 +0000450
451 case 0:
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500452 net_dev_exists = 1;
Joe Hershberger14111572015-04-08 01:41:02 -0500453 net_boot_file_size = 0;
wdenk2d966952002-10-31 22:12:35 +0000454 switch (protocol) {
Krebs, Olaf808f13d2020-03-09 14:27:55 +0000455#ifdef CONFIG_CMD_TFTPBOOT
Simon Glasse4bf0c52011-10-24 18:00:02 +0000456 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +0000457#ifdef CONFIG_CMD_TFTPPUT
458 case TFTPPUT:
459#endif
wdenk2d966952002-10-31 22:12:35 +0000460 /* always use ARP to get server ethernet address */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500461 tftp_start(protocol);
wdenk2d966952002-10-31 22:12:35 +0000462 break;
Krebs, Olaf808f13d2020-03-09 14:27:55 +0000463#endif
Luca Ceresoli7a83af02011-05-17 00:03:40 +0000464#ifdef CONFIG_CMD_TFTPSRV
465 case TFTPSRV:
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500466 tftp_start_server();
Luca Ceresoli7a83af02011-05-17 00:03:40 +0000467 break;
468#endif
Alex Kiernanf73a7df2018-05-29 15:30:53 +0000469#ifdef CONFIG_UDP_FUNCTION_FASTBOOT
470 case FASTBOOT:
471 fastboot_start_server();
472 break;
473#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500474#if defined(CONFIG_CMD_DHCP)
wdenk2d966952002-10-31 22:12:35 +0000475 case DHCP:
Joe Hershberger7044c6b2015-04-08 01:41:09 -0500476 bootp_reset();
Joe Hershberger049a95a2015-04-08 01:41:01 -0500477 net_ip.s_addr = 0;
Joe Hershberger7044c6b2015-04-08 01:41:09 -0500478 dhcp_request(); /* Basically same as BOOTP */
wdenk2d966952002-10-31 22:12:35 +0000479 break;
Jon Loeliger610f2e92007-07-10 11:05:02 -0500480#endif
Krebs, Olaf808f13d2020-03-09 14:27:55 +0000481#if defined(CONFIG_CMD_BOOTP)
wdenk2d966952002-10-31 22:12:35 +0000482 case BOOTP:
Joe Hershberger7044c6b2015-04-08 01:41:09 -0500483 bootp_reset();
Joe Hershberger049a95a2015-04-08 01:41:01 -0500484 net_ip.s_addr = 0;
Joe Hershberger7044c6b2015-04-08 01:41:09 -0500485 bootp_request();
wdenk2d966952002-10-31 22:12:35 +0000486 break;
Krebs, Olaf808f13d2020-03-09 14:27:55 +0000487#endif
Peter Tyserbf6cb242010-09-30 11:25:48 -0500488#if defined(CONFIG_CMD_RARP)
wdenk2d966952002-10-31 22:12:35 +0000489 case RARP:
Joe Hershberger698d78e2015-04-08 01:41:11 -0500490 rarp_try = 0;
Joe Hershberger049a95a2015-04-08 01:41:01 -0500491 net_ip.s_addr = 0;
Joe Hershberger698d78e2015-04-08 01:41:11 -0500492 rarp_request();
wdenk2d966952002-10-31 22:12:35 +0000493 break;
Peter Tyserbf6cb242010-09-30 11:25:48 -0500494#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500495#if defined(CONFIG_CMD_PING)
wdenk73a8b272003-06-05 19:27:42 +0000496 case PING:
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000497 ping_start();
wdenk73a8b272003-06-05 19:27:42 +0000498 break;
499#endif
Tom Rinia6ab4b52019-12-05 19:35:07 -0500500#if defined(CONFIG_CMD_NFS) && !defined(CONFIG_SPL_BUILD)
wdenkcbd8a352004-02-24 02:00:03 +0000501 case NFS:
Joe Hershberger68c76a32015-04-08 01:41:10 -0500502 nfs_start();
wdenkcbd8a352004-02-24 02:00:03 +0000503 break;
504#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500505#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +0000506 case CDP:
Joe Hershberger6aede5b2015-04-08 01:41:14 -0500507 cdp_start();
wdenka3d991b2004-04-15 21:48:45 +0000508 break;
509#endif
Holger Dengler66c89ee2017-07-20 10:10:55 +0200510#if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_SPL_BUILD)
wdenk68ceb292004-08-02 21:11:11 +0000511 case NETCONS:
Joe Hershberger6a38a5f2015-04-08 01:41:16 -0500512 nc_start();
wdenk68ceb292004-08-02 21:11:11 +0000513 break;
514#endif
Robin Getz1a32bf42009-07-20 14:53:54 -0400515#if defined(CONFIG_CMD_DNS)
516 case DNS:
Joe Hershberger786eac52015-04-08 01:41:15 -0500517 dns_start();
Robin Getz1a32bf42009-07-20 14:53:54 -0400518 break;
519#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +0000520#if defined(CONFIG_CMD_LINK_LOCAL)
521 case LINKLOCAL:
522 link_local_start();
523 break;
524#endif
Lothar Feltend8970da2018-06-22 22:29:54 +0200525#if defined(CONFIG_CMD_WOL)
526 case WOL:
527 wol_start();
528 break;
529#endif
wdenk2d966952002-10-31 22:12:35 +0000530 default:
531 break;
532 }
533
Philippe Reynesb43ea1b2020-09-18 14:13:00 +0200534 if (IS_ENABLED(CONFIG_PROT_UDP) && protocol == UDP)
535 udp_start();
536
wdenk2d966952002-10-31 22:12:35 +0000537 break;
538 }
539
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500540#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000541#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200542 defined(CONFIG_LED_STATUS) && \
543 defined(CONFIG_LED_STATUS_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000544 /*
wdenk42d1f032003-10-15 23:53:47 +0000545 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000546 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000547 if (miiphy_link(eth_get_dev()->name, CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200548 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_OFF);
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000549 else
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200550 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_ON);
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200551#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000552#endif /* CONFIG_MII, ... */
Jim Linb63056d2013-08-13 19:03:05 +0800553#ifdef CONFIG_USB_KEYBOARD
554 net_busy_flag = 1;
555#endif
wdenk2d966952002-10-31 22:12:35 +0000556
557 /*
558 * Main packet reception loop. Loop receiving packets until
Joe Hershberger22f6e992012-05-23 07:59:14 +0000559 * someone sets `net_state' to a state that terminates.
wdenk2d966952002-10-31 22:12:35 +0000560 */
561 for (;;) {
562 WATCHDOG_RESET();
Joe Hershbergerc5a75332015-12-21 16:31:35 -0600563 if (arp_timeout_check() > 0)
564 time_start = get_timer(0);
565
wdenk2d966952002-10-31 22:12:35 +0000566 /*
567 * Check the ethernet for a new packet. The ethernet
568 * receive routine will process it.
Joe Hershberger60304592015-03-22 17:09:24 -0500569 * Most drivers return the most recent packet size, but not
570 * errors that may have happened.
wdenk2d966952002-10-31 22:12:35 +0000571 */
Guennadi Liakhovetski40cb90e2008-04-03 17:04:19 +0200572 eth_rx();
wdenk2d966952002-10-31 22:12:35 +0000573
574 /*
575 * Abort if ctrl-c was pressed.
576 */
577 if (ctrlc()) {
Joe Hershbergere94070c2012-05-23 07:59:24 +0000578 /* cancel any ARP that may not have completed */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500579 net_arp_wait_packet_ip.s_addr = 0;
Joe Hershbergere94070c2012-05-23 07:59:24 +0000580
Joe Hershbergerece223b2012-05-23 07:59:15 +0000581 net_cleanup_loop();
wdenk8bde7f72003-06-27 21:31:46 +0000582 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000583 /* Invalidate the last protocol */
584 eth_set_last_protocol(BOOTP);
585
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000586 puts("\nAbort\n");
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000587 /* include a debug print as well incase the debug
588 messages are directed to stderr */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500589 debug_cond(DEBUG_INT_STATE, "--- net_loop Abort!\n");
Michal Simek19a4fba2015-08-21 08:49:48 +0200590 ret = -EINTR;
Simon Glass4793ee62011-10-24 18:00:01 +0000591 goto done;
wdenk2d966952002-10-31 22:12:35 +0000592 }
593
wdenk2d966952002-10-31 22:12:35 +0000594 /*
595 * Check for a timeout, and run the timeout handler
596 * if we have one.
597 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500598 if (time_handler &&
599 ((get_timer(0) - time_start) > time_delta)) {
wdenk2d966952002-10-31 22:12:35 +0000600 thand_f *x;
601
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500602#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000603#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200604 defined(CONFIG_LED_STATUS) && \
605 defined(CONFIG_LED_STATUS_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000606 /*
wdenk42d1f032003-10-15 23:53:47 +0000607 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000608 */
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000609 if (miiphy_link(eth_get_dev()->name,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500610 CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200611 status_led_set(CONFIG_LED_STATUS_RED,
612 CONFIG_LED_STATUS_OFF);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500613 else
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200614 status_led_set(CONFIG_LED_STATUS_RED,
615 CONFIG_LED_STATUS_ON);
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000616#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000617#endif /* CONFIG_MII, ... */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500618 debug_cond(DEBUG_INT_STATE, "--- net_loop timeout\n");
619 x = time_handler;
620 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000621 (*x)();
622 }
623
Joe Hershberger5c421332015-03-22 17:09:07 -0500624 if (net_state == NETLOOP_FAIL)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500625 ret = net_start_again();
wdenk2d966952002-10-31 22:12:35 +0000626
Joe Hershberger22f6e992012-05-23 07:59:14 +0000627 switch (net_state) {
wdenk2d966952002-10-31 22:12:35 +0000628 case NETLOOP_RESTART:
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500629 net_restarted = 1;
wdenk2d966952002-10-31 22:12:35 +0000630 goto restart;
631
632 case NETLOOP_SUCCESS:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000633 net_cleanup_loop();
Joe Hershberger14111572015-04-08 01:41:02 -0500634 if (net_boot_file_size > 0) {
635 printf("Bytes transferred = %d (%x hex)\n",
636 net_boot_file_size, net_boot_file_size);
Simon Glass018f5302017-08-03 12:22:10 -0600637 env_set_hex("filesize", net_boot_file_size);
Simon Glassbb872dd2019-12-28 10:45:02 -0700638 env_set_hex("fileaddr", image_load_addr);
wdenk2d966952002-10-31 22:12:35 +0000639 }
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000640 if (protocol != NETCONS)
641 eth_halt();
642 else
643 eth_halt_state_only();
644
645 eth_set_last_protocol(protocol);
646
Joe Hershberger14111572015-04-08 01:41:02 -0500647 ret = net_boot_file_size;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500648 debug_cond(DEBUG_INT_STATE, "--- net_loop Success!\n");
Simon Glass4793ee62011-10-24 18:00:01 +0000649 goto done;
wdenk2d966952002-10-31 22:12:35 +0000650
651 case NETLOOP_FAIL:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000652 net_cleanup_loop();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000653 /* Invalidate the last protocol */
654 eth_set_last_protocol(BOOTP);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500655 debug_cond(DEBUG_INT_STATE, "--- net_loop Fail!\n");
Thomas RIENOESSLa735e6e2018-11-21 15:56:07 +0100656 ret = -ENONET;
Simon Glass4793ee62011-10-24 18:00:01 +0000657 goto done;
Joe Hershberger22f6e992012-05-23 07:59:14 +0000658
659 case NETLOOP_CONTINUE:
660 continue;
wdenk2d966952002-10-31 22:12:35 +0000661 }
662 }
Simon Glass4793ee62011-10-24 18:00:01 +0000663
664done:
Jim Linb63056d2013-08-13 19:03:05 +0800665#ifdef CONFIG_USB_KEYBOARD
666 net_busy_flag = 0;
667#endif
Simon Glass39bccd22011-10-26 14:18:38 +0000668#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000669 /* Clear out the handlers */
Joe Hershbergerece223b2012-05-23 07:59:15 +0000670 net_set_udp_handler(NULL);
Simon Glass4793ee62011-10-24 18:00:01 +0000671 net_set_icmp_handler(NULL);
Simon Glass39bccd22011-10-26 14:18:38 +0000672#endif
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200673 net_set_state(prev_net_state);
Ramon Fried3eaac632019-07-18 21:43:30 +0300674
675#if defined(CONFIG_CMD_PCAP)
676 if (pcap_active())
677 pcap_print_status();
678#endif
Simon Glass4793ee62011-10-24 18:00:01 +0000679 return ret;
wdenk2d966952002-10-31 22:12:35 +0000680}
681
682/**********************************************************************/
683
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500684static void start_again_timeout_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000685{
Joe Hershberger22f6e992012-05-23 07:59:14 +0000686 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000687}
688
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500689int net_start_again(void)
wdenk2d966952002-10-31 22:12:35 +0000690{
wdenk6e592382004-04-18 17:39:38 +0000691 char *nretry;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100692 int retry_forever = 0;
693 unsigned long retrycnt = 0;
Joe Hershberger60304592015-03-22 17:09:24 -0500694 int ret;
wdenka3d991b2004-04-15 21:48:45 +0000695
Simon Glass00caae62017-08-03 12:22:12 -0600696 nretry = env_get("netretry");
Remy Bohmer67b96e82009-10-28 22:13:39 +0100697 if (nretry) {
698 if (!strcmp(nretry, "yes"))
699 retry_forever = 1;
700 else if (!strcmp(nretry, "no"))
701 retrycnt = 0;
702 else if (!strcmp(nretry, "once"))
703 retrycnt = 1;
704 else
705 retrycnt = simple_strtoul(nretry, NULL, 0);
Joe Hershberger5c421332015-03-22 17:09:07 -0500706 } else {
707 retrycnt = 0;
708 retry_forever = 0;
709 }
Remy Bohmer67b96e82009-10-28 22:13:39 +0100710
Leonid Iziumtsev17d413b2018-03-09 15:29:06 +0100711 if ((!retry_forever) && (net_try_count > retrycnt)) {
Remy Bohmer67b96e82009-10-28 22:13:39 +0100712 eth_halt();
Joe Hershberger22f6e992012-05-23 07:59:14 +0000713 net_set_state(NETLOOP_FAIL);
Joe Hershberger60304592015-03-22 17:09:24 -0500714 /*
715 * We don't provide a way for the protocol to return an error,
716 * but this is almost always the reason.
717 */
718 return -ETIMEDOUT;
wdenka3d991b2004-04-15 21:48:45 +0000719 }
Remy Bohmer67b96e82009-10-28 22:13:39 +0100720
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500721 net_try_count++;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100722
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000723 eth_halt();
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100724#if !defined(CONFIG_NET_DO_NOT_TRY_ANOTHER)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500725 eth_try_another(!net_restarted);
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100726#endif
Joe Hershberger60304592015-03-22 17:09:24 -0500727 ret = eth_init();
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500728 if (net_restart_wrap) {
729 net_restart_wrap = 0;
730 if (net_dev_exists) {
731 net_set_timeout_handler(10000UL,
732 start_again_timeout_handler);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000733 net_set_udp_handler(NULL);
wdenk6e592382004-04-18 17:39:38 +0000734 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000735 net_set_state(NETLOOP_FAIL);
wdenk2d966952002-10-31 22:12:35 +0000736 }
wdenk6e592382004-04-18 17:39:38 +0000737 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000738 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000739 }
Joe Hershberger60304592015-03-22 17:09:24 -0500740 return ret;
wdenk2d966952002-10-31 22:12:35 +0000741}
742
743/**********************************************************************/
744/*
745 * Miscelaneous bits.
746 */
747
Joe Hershbergerece223b2012-05-23 07:59:15 +0000748static void dummy_handler(uchar *pkt, unsigned dport,
Joe Hershberger049a95a2015-04-08 01:41:01 -0500749 struct in_addr sip, unsigned sport,
Joe Hershbergerece223b2012-05-23 07:59:15 +0000750 unsigned len)
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000751{
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000752}
753
Joe Hershbergerece223b2012-05-23 07:59:15 +0000754rxhand_f *net_get_udp_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000755{
Joe Hershbergerece223b2012-05-23 07:59:15 +0000756 return udp_packet_handler;
757}
758
759void net_set_udp_handler(rxhand_f *f)
760{
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500761 debug_cond(DEBUG_INT_STATE, "--- net_loop UDP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000762 if (f == NULL)
763 udp_packet_handler = dummy_handler;
764 else
765 udp_packet_handler = f;
766}
767
768rxhand_f *net_get_arp_handler(void)
769{
770 return arp_packet_handler;
771}
772
773void net_set_arp_handler(rxhand_f *f)
774{
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500775 debug_cond(DEBUG_INT_STATE, "--- net_loop ARP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000776 if (f == NULL)
777 arp_packet_handler = dummy_handler;
778 else
779 arp_packet_handler = f;
wdenk2d966952002-10-31 22:12:35 +0000780}
781
Simon Glass39bccd22011-10-26 14:18:38 +0000782#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000783void net_set_icmp_handler(rxhand_icmp_f *f)
784{
785 packet_icmp_handler = f;
786}
Simon Glass39bccd22011-10-26 14:18:38 +0000787#endif
wdenk2d966952002-10-31 22:12:35 +0000788
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500789void net_set_timeout_handler(ulong iv, thand_f *f)
wdenk2d966952002-10-31 22:12:35 +0000790{
791 if (iv == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000792 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500793 "--- net_loop timeout handler cancelled\n");
794 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000795 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000796 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500797 "--- net_loop timeout handler set (%p)\n", f);
798 time_handler = f;
799 time_start = get_timer(0);
800 time_delta = iv * CONFIG_SYS_HZ / 1000;
wdenk2d966952002-10-31 22:12:35 +0000801 }
802}
803
Joe Hershbergerac3f26c2018-09-26 16:49:02 -0500804uchar *net_get_async_tx_pkt_buf(void)
805{
806 if (arp_is_waiting())
807 return arp_tx_packet; /* If we are waiting, we already sent */
808 else
809 return net_tx_packet;
810}
811
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500812int net_send_udp_packet(uchar *ether, struct in_addr dest, int dport, int sport,
Joe Hershberger206d07f2012-05-23 07:58:10 +0000813 int payload_len)
wdenk73a8b272003-06-05 19:27:42 +0000814{
Duncan Hare5d457ec2018-06-24 15:40:41 -0700815 return net_send_ip_packet(ether, dest, dport, sport, payload_len,
816 IPPROTO_UDP, 0, 0, 0);
817}
818
819int net_send_ip_packet(uchar *ether, struct in_addr dest, int dport, int sport,
820 int payload_len, int proto, u8 action, u32 tcp_seq_num,
821 u32 tcp_ack_num)
822{
wdenka3d991b2004-04-15 21:48:45 +0000823 uchar *pkt;
Joe Hershberger92146372012-05-23 07:59:08 +0000824 int eth_hdr_size;
825 int pkt_hdr_size;
wdenka3d991b2004-04-15 21:48:45 +0000826
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500827 /* make sure the net_tx_packet is initialized (net_init() was called) */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500828 assert(net_tx_packet != NULL);
829 if (net_tx_packet == NULL)
Joe Hershberger46c495d2012-05-23 07:59:22 +0000830 return -1;
831
wdenk73a8b272003-06-05 19:27:42 +0000832 /* convert to new style broadcast */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500833 if (dest.s_addr == 0)
834 dest.s_addr = 0xFFFFFFFF;
wdenk2d966952002-10-31 22:12:35 +0000835
wdenk73a8b272003-06-05 19:27:42 +0000836 /* if broadcast, make the ether address a broadcast and don't do ARP */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500837 if (dest.s_addr == 0xFFFFFFFF)
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500838 ether = (uchar *)net_bcast_ethaddr;
wdenk73a8b272003-06-05 19:27:42 +0000839
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500840 pkt = (uchar *)net_tx_packet;
wdenk73a8b272003-06-05 19:27:42 +0000841
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500842 eth_hdr_size = net_set_ether(pkt, ether, PROT_IP);
Duncan Hare5d457ec2018-06-24 15:40:41 -0700843
844 switch (proto) {
845 case IPPROTO_UDP:
846 net_set_udp_header(pkt + eth_hdr_size, dest, dport, sport,
847 payload_len);
848 pkt_hdr_size = eth_hdr_size + IP_UDP_HDR_SIZE;
849 break;
850 default:
851 return -EINVAL;
852 }
Robin Getz0ebf04c2009-07-23 03:01:03 -0400853
Joe Hershbergere94070c2012-05-23 07:59:24 +0000854 /* if MAC address was not discovered yet, do an ARP request */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500855 if (memcmp(ether, net_null_ethaddr, 6) == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000856 debug_cond(DEBUG_DEV_PKT, "sending ARP for %pI4\n", &dest);
Joe Hershberger92146372012-05-23 07:59:08 +0000857
858 /* save the ip and eth addr for the packet to send after arp */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500859 net_arp_wait_packet_ip = dest;
Joe Hershberger85d25e02015-04-08 01:41:08 -0500860 arp_wait_packet_ethaddr = ether;
wdenka3d991b2004-04-15 21:48:45 +0000861
wdenk73a8b272003-06-05 19:27:42 +0000862 /* size of the waiting packet */
Joe Hershberger85d25e02015-04-08 01:41:08 -0500863 arp_wait_tx_packet_size = pkt_hdr_size + payload_len;
wdenk73a8b272003-06-05 19:27:42 +0000864
865 /* and do the ARP request */
Joe Hershberger85d25e02015-04-08 01:41:08 -0500866 arp_wait_try = 1;
867 arp_wait_timer_start = get_timer(0);
868 arp_request();
wdenk73a8b272003-06-05 19:27:42 +0000869 return 1; /* waiting */
Joe Hershberger92146372012-05-23 07:59:08 +0000870 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000871 debug_cond(DEBUG_DEV_PKT, "sending UDP to %pI4/%pM\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500872 &dest, ether);
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500873 net_send_packet(net_tx_packet, pkt_hdr_size + payload_len);
Joe Hershberger92146372012-05-23 07:59:08 +0000874 return 0; /* transmitted */
wdenk73a8b272003-06-05 19:27:42 +0000875 }
wdenk73a8b272003-06-05 19:27:42 +0000876}
877
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200878#ifdef CONFIG_IP_DEFRAG
879/*
880 * This function collects fragments in a single packet, according
881 * to the algorithm in RFC815. It returns NULL or the pointer to
882 * a complete packet, in static storage
883 */
Joe Hershbergeraa7a6482016-08-15 14:42:15 -0500884#define IP_PKTSIZE (CONFIG_NET_MAXDEFRAG)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200885
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000886#define IP_MAXUDP (IP_PKTSIZE - IP_HDR_SIZE)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200887
888/*
889 * this is the packet being assembled, either data or frag control.
890 * Fragments go by 8 bytes, so this union must be 8 bytes long
891 */
892struct hole {
893 /* first_byte is address of this structure */
894 u16 last_byte; /* last byte in this hole + 1 (begin of next hole) */
895 u16 next_hole; /* index of next (in 8-b blocks), 0 == none */
896 u16 prev_hole; /* index of prev, 0 == none */
897 u16 unused;
898};
899
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500900static struct ip_udp_hdr *__net_defragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200901{
Joe Hershberger48522bb2012-05-15 08:59:08 +0000902 static uchar pkt_buff[IP_PKTSIZE] __aligned(PKTALIGN);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200903 static u16 first_hole, total_len;
904 struct hole *payload, *thisfrag, *h, *newh;
Joe Hershberger594c26f2012-05-23 07:58:04 +0000905 struct ip_udp_hdr *localip = (struct ip_udp_hdr *)pkt_buff;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200906 uchar *indata = (uchar *)ip;
907 int offset8, start, len, done = 0;
908 u16 ip_off = ntohs(ip->ip_off);
909
Fabio Estevamb85d1302022-05-26 11:14:37 -0300910 if (ip->ip_len < IP_MIN_FRAG_DATAGRAM_SIZE)
911 return NULL;
912
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200913 /* payload starts after IP header, this fragment is in there */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000914 payload = (struct hole *)(pkt_buff + IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200915 offset8 = (ip_off & IP_OFFS);
916 thisfrag = payload + offset8;
917 start = offset8 * 8;
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000918 len = ntohs(ip->ip_len) - IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200919
920 if (start + len > IP_MAXUDP) /* fragment extends too far */
921 return NULL;
922
923 if (!total_len || localip->ip_id != ip->ip_id) {
924 /* new (or different) packet, reset structs */
925 total_len = 0xffff;
926 payload[0].last_byte = ~0;
927 payload[0].next_hole = 0;
928 payload[0].prev_hole = 0;
929 first_hole = 0;
930 /* any IP header will work, copy the first we received */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000931 memcpy(localip, ip, IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200932 }
933
934 /*
935 * What follows is the reassembly algorithm. We use the payload
936 * array as a linked list of hole descriptors, as each hole starts
937 * at a multiple of 8 bytes. However, last byte can be whatever value,
938 * so it is represented as byte count, not as 8-byte blocks.
939 */
940
941 h = payload + first_hole;
942 while (h->last_byte < start) {
943 if (!h->next_hole) {
944 /* no hole that far away */
945 return NULL;
946 }
947 h = payload + h->next_hole;
948 }
949
Fillod Stephanee397e592010-06-11 19:26:43 +0200950 /* last fragment may be 1..7 bytes, the "+7" forces acceptance */
951 if (offset8 + ((len + 7) / 8) <= h - payload) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200952 /* no overlap with holes (dup fragment?) */
953 return NULL;
954 }
955
956 if (!(ip_off & IP_FLAGS_MFRAG)) {
957 /* no more fragmentss: truncate this (last) hole */
958 total_len = start + len;
959 h->last_byte = start + len;
960 }
961
962 /*
963 * There is some overlap: fix the hole list. This code doesn't
964 * deal with a fragment that overlaps with two different holes
965 * (thus being a superset of a previously-received fragment).
966 */
967
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000968 if ((h >= thisfrag) && (h->last_byte <= start + len)) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200969 /* complete overlap with hole: remove hole */
970 if (!h->prev_hole && !h->next_hole) {
971 /* last remaining hole */
972 done = 1;
973 } else if (!h->prev_hole) {
974 /* first hole */
975 first_hole = h->next_hole;
976 payload[h->next_hole].prev_hole = 0;
977 } else if (!h->next_hole) {
978 /* last hole */
979 payload[h->prev_hole].next_hole = 0;
980 } else {
981 /* in the middle of the list */
982 payload[h->next_hole].prev_hole = h->prev_hole;
983 payload[h->prev_hole].next_hole = h->next_hole;
984 }
985
986 } else if (h->last_byte <= start + len) {
987 /* overlaps with final part of the hole: shorten this hole */
988 h->last_byte = start;
989
990 } else if (h >= thisfrag) {
991 /* overlaps with initial part of the hole: move this hole */
992 newh = thisfrag + (len / 8);
993 *newh = *h;
994 h = newh;
995 if (h->next_hole)
996 payload[h->next_hole].prev_hole = (h - payload);
997 if (h->prev_hole)
998 payload[h->prev_hole].next_hole = (h - payload);
999 else
1000 first_hole = (h - payload);
1001
1002 } else {
1003 /* fragment sits in the middle: split the hole */
1004 newh = thisfrag + (len / 8);
1005 *newh = *h;
1006 h->last_byte = start;
1007 h->next_hole = (newh - payload);
1008 newh->prev_hole = (h - payload);
1009 if (newh->next_hole)
1010 payload[newh->next_hole].prev_hole = (newh - payload);
1011 }
1012
1013 /* finally copy this fragment and possibly return whole packet */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +00001014 memcpy((uchar *)thisfrag, indata + IP_HDR_SIZE, len);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001015 if (!done)
1016 return NULL;
1017
1018 localip->ip_len = htons(total_len);
Joe Hershbergerc5c59df2012-05-23 07:58:05 +00001019 *lenp = total_len + IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001020 return localip;
1021}
1022
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001023static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1024 int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001025{
1026 u16 ip_off = ntohs(ip->ip_off);
1027 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1028 return ip; /* not a fragment */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001029 return __net_defragment(ip, lenp);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001030}
1031
1032#else /* !CONFIG_IP_DEFRAG */
1033
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001034static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1035 int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001036{
1037 u16 ip_off = ntohs(ip->ip_off);
1038 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1039 return ip; /* not a fragment */
1040 return NULL;
1041}
1042#endif
wdenka3d991b2004-04-15 21:48:45 +00001043
Simon Glass8f79bb12011-10-24 18:00:00 +00001044/**
1045 * Receive an ICMP packet. We deal with REDIRECT and PING here, and silently
1046 * drop others.
1047 *
1048 * @parma ip IP packet containing the ICMP
1049 */
Joe Hershberger594c26f2012-05-23 07:58:04 +00001050static void receive_icmp(struct ip_udp_hdr *ip, int len,
Joe Hershberger049a95a2015-04-08 01:41:01 -05001051 struct in_addr src_ip, struct ethernet_hdr *et)
Simon Glass8f79bb12011-10-24 18:00:00 +00001052{
Joe Hershbergere0a63072012-05-23 07:58:09 +00001053 struct icmp_hdr *icmph = (struct icmp_hdr *)&ip->udp_src;
Simon Glass8f79bb12011-10-24 18:00:00 +00001054
1055 switch (icmph->type) {
1056 case ICMP_REDIRECT:
1057 if (icmph->code != ICMP_REDIR_HOST)
1058 return;
1059 printf(" ICMP Host Redirect to %pI4 ",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001060 &icmph->un.gateway);
Simon Glass8f79bb12011-10-24 18:00:00 +00001061 break;
Simon Glass8f79bb12011-10-24 18:00:00 +00001062 default:
Joe Hershbergera36b12f2012-05-23 07:58:02 +00001063#if defined(CONFIG_CMD_PING)
1064 ping_receive(et, ip, len);
1065#endif
Simon Glass39bccd22011-10-26 14:18:38 +00001066#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +00001067 if (packet_icmp_handler)
1068 packet_icmp_handler(icmph->type, icmph->code,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001069 ntohs(ip->udp_dst), src_ip,
1070 ntohs(ip->udp_src), icmph->un.data,
1071 ntohs(ip->udp_len));
Simon Glass39bccd22011-10-26 14:18:38 +00001072#endif
Simon Glass8f79bb12011-10-24 18:00:00 +00001073 break;
1074 }
1075}
1076
Joe Hershberger2a504df2015-03-22 17:09:11 -05001077void net_process_received_packet(uchar *in_packet, int len)
wdenk2d966952002-10-31 22:12:35 +00001078{
Joe Hershbergercb487f52012-05-23 07:58:06 +00001079 struct ethernet_hdr *et;
Joe Hershberger594c26f2012-05-23 07:58:04 +00001080 struct ip_udp_hdr *ip;
Joe Hershberger049a95a2015-04-08 01:41:01 -05001081 struct in_addr dst_ip;
1082 struct in_addr src_ip;
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001083 int eth_proto;
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001084#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001085 int iscdp;
1086#endif
1087 ushort cti = 0, vlanid = VLAN_NONE, myvlanid, mynvlanid;
wdenk2d966952002-10-31 22:12:35 +00001088
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001089 debug_cond(DEBUG_NET_PKT, "packet received\n");
wdenka3d991b2004-04-15 21:48:45 +00001090
Ramon Fried3eaac632019-07-18 21:43:30 +03001091#if defined(CONFIG_CMD_PCAP)
1092 pcap_post(in_packet, len, false);
1093#endif
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001094 net_rx_packet = in_packet;
1095 net_rx_packet_len = len;
Joe Hershberger2a504df2015-03-22 17:09:11 -05001096 et = (struct ethernet_hdr *)in_packet;
wdenka3d991b2004-04-15 21:48:45 +00001097
1098 /* too small packet? */
1099 if (len < ETHER_HDR_SIZE)
1100 return;
1101
Alexander Graf0efe1bc2016-05-06 21:01:01 +02001102#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Rafal Jaworowskif85b6072007-12-27 18:19:02 +01001103 if (push_packet) {
Joe Hershberger2a504df2015-03-22 17:09:11 -05001104 (*push_packet)(in_packet, len);
Rafal Jaworowskif85b6072007-12-27 18:19:02 +01001105 return;
1106 }
1107#endif
1108
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001109#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001110 /* keep track if packet is CDP */
Joe Hershberger17351882012-05-23 07:58:00 +00001111 iscdp = is_cdp_packet(et->et_dest);
wdenka3d991b2004-04-15 21:48:45 +00001112#endif
1113
Joe Hershberger4fd50552015-04-08 01:41:17 -05001114 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001115 if (myvlanid == (ushort)-1)
1116 myvlanid = VLAN_NONE;
Joe Hershberger4fd50552015-04-08 01:41:17 -05001117 mynvlanid = ntohs(net_native_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001118 if (mynvlanid == (ushort)-1)
1119 mynvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001120
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001121 eth_proto = ntohs(et->et_protlen);
wdenk2d966952002-10-31 22:12:35 +00001122
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001123 if (eth_proto < 1514) {
Joe Hershbergercb487f52012-05-23 07:58:06 +00001124 struct e802_hdr *et802 = (struct e802_hdr *)et;
wdenk2d966952002-10-31 22:12:35 +00001125 /*
Joe Hershbergerda5ebe22012-05-23 07:58:11 +00001126 * Got a 802.2 packet. Check the other protocol field.
1127 * XXX VLAN over 802.2+SNAP not implemented!
wdenk2d966952002-10-31 22:12:35 +00001128 */
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001129 eth_proto = ntohs(et802->et_prot);
wdenka3d991b2004-04-15 21:48:45 +00001130
Joe Hershberger2a504df2015-03-22 17:09:11 -05001131 ip = (struct ip_udp_hdr *)(in_packet + E802_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001132 len -= E802_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001133
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001134 } else if (eth_proto != PROT_VLAN) { /* normal packet */
Joe Hershberger2a504df2015-03-22 17:09:11 -05001135 ip = (struct ip_udp_hdr *)(in_packet + ETHER_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001136 len -= ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001137
1138 } else { /* VLAN packet */
Joe Hershbergerc68cca32012-05-23 07:58:07 +00001139 struct vlan_ethernet_hdr *vet =
1140 (struct vlan_ethernet_hdr *)et;
wdenka3d991b2004-04-15 21:48:45 +00001141
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001142 debug_cond(DEBUG_NET_PKT, "VLAN packet received\n");
Robin Getz0ebf04c2009-07-23 03:01:03 -04001143
wdenka3d991b2004-04-15 21:48:45 +00001144 /* too small packet? */
1145 if (len < VLAN_ETHER_HDR_SIZE)
1146 return;
1147
1148 /* if no VLAN active */
Joe Hershberger4fd50552015-04-08 01:41:17 -05001149 if ((ntohs(net_our_vlan) & VLAN_IDMASK) == VLAN_NONE
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001150#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001151 && iscdp == 0
1152#endif
1153 )
1154 return;
1155
1156 cti = ntohs(vet->vet_tag);
1157 vlanid = cti & VLAN_IDMASK;
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001158 eth_proto = ntohs(vet->vet_type);
wdenka3d991b2004-04-15 21:48:45 +00001159
Joe Hershberger2a504df2015-03-22 17:09:11 -05001160 ip = (struct ip_udp_hdr *)(in_packet + VLAN_ETHER_HDR_SIZE);
wdenka3d991b2004-04-15 21:48:45 +00001161 len -= VLAN_ETHER_HDR_SIZE;
wdenk2d966952002-10-31 22:12:35 +00001162 }
1163
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001164 debug_cond(DEBUG_NET_PKT, "Receive from protocol 0x%x\n", eth_proto);
wdenk2d966952002-10-31 22:12:35 +00001165
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001166#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001167 if (iscdp) {
Joe Hershberger0b4c5ff2012-05-23 07:58:13 +00001168 cdp_receive((uchar *)ip, len);
wdenka3d991b2004-04-15 21:48:45 +00001169 return;
1170 }
1171#endif
1172
1173 if ((myvlanid & VLAN_IDMASK) != VLAN_NONE) {
1174 if (vlanid == VLAN_NONE)
1175 vlanid = (mynvlanid & VLAN_IDMASK);
1176 /* not matched? */
1177 if (vlanid != (myvlanid & VLAN_IDMASK))
1178 return;
1179 }
1180
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001181 switch (eth_proto) {
wdenk2d966952002-10-31 22:12:35 +00001182 case PROT_ARP:
Joe Hershberger85d25e02015-04-08 01:41:08 -05001183 arp_receive(et, ip, len);
wdenk289f9322005-01-12 00:15:14 +00001184 break;
wdenk2d966952002-10-31 22:12:35 +00001185
Peter Tyserbf6cb242010-09-30 11:25:48 -05001186#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001187 case PROT_RARP:
Joe Hershberger8b9c5322012-05-23 07:58:03 +00001188 rarp_receive(ip, len);
wdenk2d966952002-10-31 22:12:35 +00001189 break;
Peter Tyserbf6cb242010-09-30 11:25:48 -05001190#endif
wdenk2d966952002-10-31 22:12:35 +00001191 case PROT_IP:
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001192 debug_cond(DEBUG_NET_PKT, "Got IP\n");
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001193 /* Before we start poking the header, make sure it is there */
Joe Hershberger594c26f2012-05-23 07:58:04 +00001194 if (len < IP_UDP_HDR_SIZE) {
1195 debug("len bad %d < %lu\n", len,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001196 (ulong)IP_UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001197 return;
1198 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001199 /* Check the packet length */
wdenk2d966952002-10-31 22:12:35 +00001200 if (len < ntohs(ip->ip_len)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001201 debug("len bad %d < %d\n", len, ntohs(ip->ip_len));
wdenk2d966952002-10-31 22:12:35 +00001202 return;
1203 }
1204 len = ntohs(ip->ip_len);
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001205 debug_cond(DEBUG_NET_PKT, "len=%d, v=%02x\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001206 len, ip->ip_hl_v & 0xff);
Robin Getz0ebf04c2009-07-23 03:01:03 -04001207
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001208 /* Can't deal with anything except IPv4 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001209 if ((ip->ip_hl_v & 0xf0) != 0x40)
wdenk2d966952002-10-31 22:12:35 +00001210 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001211 /* Can't deal with IP options (headers != 20 bytes) */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001212 if ((ip->ip_hl_v & 0x0f) > 0x05)
Remy Bohmer6b52cfe2008-06-03 15:48:17 +02001213 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001214 /* Check the Checksum of the header */
Simon Glass0da0fcd2015-01-19 22:16:08 -07001215 if (!ip_checksum_ok((uchar *)ip, IP_HDR_SIZE)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001216 debug("checksum bad\n");
wdenk2d966952002-10-31 22:12:35 +00001217 return;
1218 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001219 /* If it is not for us, ignore it */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001220 dst_ip = net_read_ip(&ip->ip_dst);
1221 if (net_ip.s_addr && dst_ip.s_addr != net_ip.s_addr &&
1222 dst_ip.s_addr != 0xFFFFFFFF) {
Luca Ceresolic819abe2011-05-04 02:40:46 +00001223 return;
wdenk2d966952002-10-31 22:12:35 +00001224 }
Luca Ceresoli03eb1292011-04-18 06:19:50 +00001225 /* Read source IP address for later use */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001226 src_ip = net_read_ip(&ip->ip_src);
wdenk2d966952002-10-31 22:12:35 +00001227 /*
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001228 * The function returns the unchanged packet if it's not
1229 * a fragment, and either the complete packet or NULL if
1230 * it is a fragment (if !CONFIG_IP_DEFRAG, it returns NULL)
1231 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001232 ip = net_defragment(ip, &len);
Luca Ceresoliccb9ebe2011-05-04 02:40:47 +00001233 if (!ip)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001234 return;
1235 /*
wdenk2d966952002-10-31 22:12:35 +00001236 * watch for ICMP host redirects
1237 *
wdenk8bde7f72003-06-27 21:31:46 +00001238 * There is no real handler code (yet). We just watch
1239 * for ICMP host redirect messages. In case anybody
1240 * sees these messages: please contact me
1241 * (wd@denx.de), or - even better - send me the
1242 * necessary fixes :-)
wdenk2d966952002-10-31 22:12:35 +00001243 *
wdenk8bde7f72003-06-27 21:31:46 +00001244 * Note: in all cases where I have seen this so far
1245 * it was a problem with the router configuration,
1246 * for instance when a router was configured in the
1247 * BOOTP reply, but the TFTP server was on the same
1248 * subnet. So this is probably a warning that your
1249 * configuration might be wrong. But I'm not really
1250 * sure if there aren't any other situations.
Simon Glass4793ee62011-10-24 18:00:01 +00001251 *
1252 * Simon Glass <sjg@chromium.org>: We get an ICMP when
1253 * we send a tftp packet to a dead connection, or when
1254 * there is no server at the other end.
wdenk2d966952002-10-31 22:12:35 +00001255 */
1256 if (ip->ip_p == IPPROTO_ICMP) {
Simon Glass8f79bb12011-10-24 18:00:00 +00001257 receive_icmp(ip, len, src_ip, et);
1258 return;
wdenk2d966952002-10-31 22:12:35 +00001259 } else if (ip->ip_p != IPPROTO_UDP) { /* Only UDP packets */
1260 return;
1261 }
1262
liucheng (G)fe728802019-08-29 13:47:33 +00001263 if (ntohs(ip->udp_len) < UDP_HDR_SIZE || ntohs(ip->udp_len) > ntohs(ip->ip_len))
1264 return;
1265
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001266 debug_cond(DEBUG_DEV_PKT,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001267 "received UDP (to=%pI4, from=%pI4, len=%d)\n",
1268 &dst_ip, &src_ip, len);
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001269
Simon Glass4b37fd12021-12-18 11:27:49 -07001270 if (IS_ENABLED(CONFIG_UDP_CHECKSUM) && ip->udp_xsum != 0) {
Wolfgang Denkb2f50802005-08-12 23:43:12 +02001271 ulong xsum;
Heinrich Schuchardt85244232019-11-05 12:48:19 +01001272 u8 *sumptr;
Stefan Roese8534bf92005-08-12 20:06:52 +02001273 ushort sumlen;
1274
1275 xsum = ip->ip_p;
1276 xsum += (ntohs(ip->udp_len));
Joe Hershberger049a95a2015-04-08 01:41:01 -05001277 xsum += (ntohl(ip->ip_src.s_addr) >> 16) & 0x0000ffff;
1278 xsum += (ntohl(ip->ip_src.s_addr) >> 0) & 0x0000ffff;
1279 xsum += (ntohl(ip->ip_dst.s_addr) >> 16) & 0x0000ffff;
1280 xsum += (ntohl(ip->ip_dst.s_addr) >> 0) & 0x0000ffff;
Stefan Roese8534bf92005-08-12 20:06:52 +02001281
1282 sumlen = ntohs(ip->udp_len);
Heinrich Schuchardt85244232019-11-05 12:48:19 +01001283 sumptr = (u8 *)&ip->udp_src;
Stefan Roese8534bf92005-08-12 20:06:52 +02001284
1285 while (sumlen > 1) {
Heinrich Schuchardt85244232019-11-05 12:48:19 +01001286 /* inlined ntohs() to avoid alignment errors */
1287 xsum += (sumptr[0] << 8) + sumptr[1];
1288 sumptr += 2;
Stefan Roese8534bf92005-08-12 20:06:52 +02001289 sumlen -= 2;
1290 }
Heinrich Schuchardt85244232019-11-05 12:48:19 +01001291 if (sumlen > 0)
1292 xsum += (sumptr[0] << 8) + sumptr[0];
Stefan Roese8534bf92005-08-12 20:06:52 +02001293 while ((xsum >> 16) != 0) {
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001294 xsum = (xsum & 0x0000ffff) +
1295 ((xsum >> 16) & 0x0000ffff);
Stefan Roese8534bf92005-08-12 20:06:52 +02001296 }
1297 if ((xsum != 0x00000000) && (xsum != 0x0000ffff)) {
Wolfgang Denk9b55a252008-07-11 01:16:00 +02001298 printf(" UDP wrong checksum %08lx %08x\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001299 xsum, ntohs(ip->udp_xsum));
Stefan Roese8534bf92005-08-12 20:06:52 +02001300 return;
1301 }
1302 }
Stefan Roese8534bf92005-08-12 20:06:52 +02001303
Holger Dengler66c89ee2017-07-20 10:10:55 +02001304#if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_SPL_BUILD)
Joe Hershberger594c26f2012-05-23 07:58:04 +00001305 nc_input_packet((uchar *)ip + IP_UDP_HDR_SIZE,
Joe Hershbergerece223b2012-05-23 07:59:15 +00001306 src_ip,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001307 ntohs(ip->udp_dst),
Joe Hershbergerece223b2012-05-23 07:59:15 +00001308 ntohs(ip->udp_src),
1309 ntohs(ip->udp_len) - UDP_HDR_SIZE);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001310#endif
1311 /*
1312 * IP header OK. Pass the packet to the current handler.
1313 */
1314 (*udp_packet_handler)((uchar *)ip + IP_UDP_HDR_SIZE,
1315 ntohs(ip->udp_dst),
1316 src_ip,
1317 ntohs(ip->udp_src),
1318 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001319 break;
Lothar Feltend8970da2018-06-22 22:29:54 +02001320#ifdef CONFIG_CMD_WOL
1321 case PROT_WOL:
1322 wol_receive(ip, len);
1323 break;
1324#endif
wdenk2d966952002-10-31 22:12:35 +00001325 }
1326}
1327
wdenk2d966952002-10-31 22:12:35 +00001328/**********************************************************************/
1329
Simon Glasse4bf0c52011-10-24 18:00:02 +00001330static int net_check_prereq(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +00001331{
1332 switch (protocol) {
wdenk6e592382004-04-18 17:39:38 +00001333 /* Fall through */
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001334#if defined(CONFIG_CMD_PING)
wdenk73a8b272003-06-05 19:27:42 +00001335 case PING:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001336 if (net_ping_ip.s_addr == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001337 puts("*** ERROR: ping address not given\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001338 return 1;
wdenk6e592382004-04-18 17:39:38 +00001339 }
1340 goto common;
wdenk73a8b272003-06-05 19:27:42 +00001341#endif
Robin Getz1a32bf42009-07-20 14:53:54 -04001342#if defined(CONFIG_CMD_DNS)
1343 case DNS:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001344 if (net_dns_server.s_addr == 0) {
Robin Getz1a32bf42009-07-20 14:53:54 -04001345 puts("*** ERROR: DNS server address not given\n");
1346 return 1;
1347 }
1348 goto common;
1349#endif
Philippe Reynesb43ea1b2020-09-18 14:13:00 +02001350#if defined(CONFIG_PROT_UDP)
1351 case UDP:
1352 if (udp_prereq())
1353 return 1;
1354 goto common;
1355#endif
1356
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001357#if defined(CONFIG_CMD_NFS)
wdenkcbd8a352004-02-24 02:00:03 +00001358 case NFS:
1359#endif
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001360 /* Fall through */
Simon Glasse4bf0c52011-10-24 18:00:02 +00001361 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +00001362 case TFTPPUT:
Joe Hershberger3a66fcb2018-07-03 19:36:39 -05001363 if (net_server_ip.s_addr == 0 && !is_serverip_in_cmd()) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001364 puts("*** ERROR: `serverip' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001365 return 1;
wdenk6e592382004-04-18 17:39:38 +00001366 }
Philippe Reynes912ece42020-09-18 14:13:02 +02001367#if defined(CONFIG_CMD_PING) || \
Philippe Reynesb43ea1b2020-09-18 14:13:00 +02001368 defined(CONFIG_CMD_DNS) || defined(CONFIG_PROT_UDP)
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001369common:
wdenk73a8b272003-06-05 19:27:42 +00001370#endif
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001371 /* Fall through */
wdenk73a8b272003-06-05 19:27:42 +00001372
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001373 case NETCONS:
Alex Kiernanf73a7df2018-05-29 15:30:53 +00001374 case FASTBOOT:
Luca Ceresoli7a83af02011-05-17 00:03:40 +00001375 case TFTPSRV:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001376 if (net_ip.s_addr == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001377 puts("*** ERROR: `ipaddr' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001378 return 1;
wdenk6e592382004-04-18 17:39:38 +00001379 }
1380 /* Fall through */
wdenk2d966952002-10-31 22:12:35 +00001381
Peter Tyserbf6cb242010-09-30 11:25:48 -05001382#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001383 case RARP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001384#endif
wdenk2d966952002-10-31 22:12:35 +00001385 case BOOTP:
wdenka3d991b2004-04-15 21:48:45 +00001386 case CDP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001387 case DHCP:
Joe Hershbergerd22c3382012-05-23 08:00:12 +00001388 case LINKLOCAL:
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001389 if (memcmp(net_ethaddr, "\0\0\0\0\0\0", 6) == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001390 int num = eth_get_dev_index();
wdenk2d966952002-10-31 22:12:35 +00001391
wdenk6e592382004-04-18 17:39:38 +00001392 switch (num) {
1393 case -1:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001394 puts("*** ERROR: No ethernet found.\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001395 return 1;
wdenk6e592382004-04-18 17:39:38 +00001396 case 0:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001397 puts("*** ERROR: `ethaddr' not set\n");
wdenk2d966952002-10-31 22:12:35 +00001398 break;
wdenk6e592382004-04-18 17:39:38 +00001399 default:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001400 printf("*** ERROR: `eth%daddr' not set\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001401 num);
wdenk2d966952002-10-31 22:12:35 +00001402 break;
wdenk2d966952002-10-31 22:12:35 +00001403 }
wdenk6e592382004-04-18 17:39:38 +00001404
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001405 net_start_again();
Luca Ceresoli92895de2011-05-04 02:40:45 +00001406 return 2;
wdenk6e592382004-04-18 17:39:38 +00001407 }
1408 /* Fall through */
1409 default:
Luca Ceresoli92895de2011-05-04 02:40:45 +00001410 return 0;
wdenk2d966952002-10-31 22:12:35 +00001411 }
Luca Ceresoli92895de2011-05-04 02:40:45 +00001412 return 0; /* OK */
wdenk2d966952002-10-31 22:12:35 +00001413}
1414/**********************************************************************/
1415
1416int
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001417net_eth_hdr_size(void)
wdenka3d991b2004-04-15 21:48:45 +00001418{
1419 ushort myvlanid;
wdenk2d966952002-10-31 22:12:35 +00001420
Joe Hershberger4fd50552015-04-08 01:41:17 -05001421 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001422 if (myvlanid == (ushort)-1)
1423 myvlanid = VLAN_NONE;
1424
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001425 return ((myvlanid & VLAN_IDMASK) == VLAN_NONE) ? ETHER_HDR_SIZE :
1426 VLAN_ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001427}
1428
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001429int net_set_ether(uchar *xet, const uchar *dest_ethaddr, uint prot)
wdenk2d966952002-10-31 22:12:35 +00001430{
Joe Hershbergercb487f52012-05-23 07:58:06 +00001431 struct ethernet_hdr *et = (struct ethernet_hdr *)xet;
wdenka3d991b2004-04-15 21:48:45 +00001432 ushort myvlanid;
1433
Joe Hershberger4fd50552015-04-08 01:41:17 -05001434 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001435 if (myvlanid == (ushort)-1)
1436 myvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001437
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001438 memcpy(et->et_dest, dest_ethaddr, 6);
1439 memcpy(et->et_src, net_ethaddr, 6);
wdenka3d991b2004-04-15 21:48:45 +00001440 if ((myvlanid & VLAN_IDMASK) == VLAN_NONE) {
Luca Ceresolic819abe2011-05-04 02:40:46 +00001441 et->et_protlen = htons(prot);
wdenka3d991b2004-04-15 21:48:45 +00001442 return ETHER_HDR_SIZE;
1443 } else {
Joe Hershbergerc68cca32012-05-23 07:58:07 +00001444 struct vlan_ethernet_hdr *vet =
1445 (struct vlan_ethernet_hdr *)xet;
wdenk2d966952002-10-31 22:12:35 +00001446
wdenka3d991b2004-04-15 21:48:45 +00001447 vet->vet_vlan_type = htons(PROT_VLAN);
1448 vet->vet_tag = htons((0 << 5) | (myvlanid & VLAN_IDMASK));
1449 vet->vet_type = htons(prot);
1450 return VLAN_ETHER_HDR_SIZE;
1451 }
1452}
wdenk2d966952002-10-31 22:12:35 +00001453
Joe Hershbergere7111012012-05-23 07:59:16 +00001454int net_update_ether(struct ethernet_hdr *et, uchar *addr, uint prot)
1455{
1456 ushort protlen;
1457
1458 memcpy(et->et_dest, addr, 6);
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001459 memcpy(et->et_src, net_ethaddr, 6);
Joe Hershbergere7111012012-05-23 07:59:16 +00001460 protlen = ntohs(et->et_protlen);
1461 if (protlen == PROT_VLAN) {
1462 struct vlan_ethernet_hdr *vet =
1463 (struct vlan_ethernet_hdr *)et;
1464 vet->vet_type = htons(prot);
1465 return VLAN_ETHER_HDR_SIZE;
1466 } else if (protlen > 1514) {
1467 et->et_protlen = htons(prot);
1468 return ETHER_HDR_SIZE;
1469 } else {
1470 /* 802.2 + SNAP */
1471 struct e802_hdr *et802 = (struct e802_hdr *)et;
1472 et802->et_prot = htons(prot);
1473 return E802_HDR_SIZE;
1474 }
1475}
1476
Duncan Hare5d457ec2018-06-24 15:40:41 -07001477void net_set_ip_header(uchar *pkt, struct in_addr dest, struct in_addr source,
1478 u16 pkt_len, u8 proto)
wdenk2d966952002-10-31 22:12:35 +00001479{
Joe Hershberger4b11c912012-05-23 07:59:07 +00001480 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
1481
1482 /*
1483 * Construct an IP header.
1484 */
1485 /* IP_HDR_SIZE / 4 (not including UDP) */
1486 ip->ip_hl_v = 0x45;
1487 ip->ip_tos = 0;
Duncan Hare5d457ec2018-06-24 15:40:41 -07001488 ip->ip_len = htons(pkt_len);
1489 ip->ip_p = proto;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001490 ip->ip_id = htons(net_ip_id++);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001491 ip->ip_off = htons(IP_FLAGS_DFRAG); /* Don't fragment */
1492 ip->ip_ttl = 255;
1493 ip->ip_sum = 0;
1494 /* already in network byte order */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001495 net_copy_ip((void *)&ip->ip_src, &source);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001496 /* already in network byte order */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001497 net_copy_ip((void *)&ip->ip_dst, &dest);
Duncan Hare5d457ec2018-06-24 15:40:41 -07001498
1499 ip->ip_sum = compute_ip_checksum(ip, IP_HDR_SIZE);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001500}
1501
Joe Hershberger049a95a2015-04-08 01:41:01 -05001502void net_set_udp_header(uchar *pkt, struct in_addr dest, int dport, int sport,
Joe Hershberger4b11c912012-05-23 07:59:07 +00001503 int len)
1504{
1505 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
wdenk2d966952002-10-31 22:12:35 +00001506
1507 /*
1508 * If the data is an odd number of bytes, zero the
1509 * byte after the last byte so that the checksum
1510 * will work.
1511 */
1512 if (len & 1)
Joe Hershberger4b11c912012-05-23 07:59:07 +00001513 pkt[IP_UDP_HDR_SIZE + len] = 0;
wdenk2d966952002-10-31 22:12:35 +00001514
Duncan Hare5d457ec2018-06-24 15:40:41 -07001515 net_set_ip_header(pkt, dest, net_ip, IP_UDP_HDR_SIZE + len,
1516 IPPROTO_UDP);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001517
wdenk2d966952002-10-31 22:12:35 +00001518 ip->udp_src = htons(sport);
1519 ip->udp_dst = htons(dport);
Joe Hershberger594c26f2012-05-23 07:58:04 +00001520 ip->udp_len = htons(UDP_HDR_SIZE + len);
wdenk2d966952002-10-31 22:12:35 +00001521 ip->udp_xsum = 0;
wdenk2d966952002-10-31 22:12:35 +00001522}
1523
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001524void copy_filename(char *dst, const char *src, int size)
wdenk2d966952002-10-31 22:12:35 +00001525{
Joe Hershberger16cf1452018-07-03 19:36:41 -05001526 if (src && *src && (*src == '"')) {
wdenk2d966952002-10-31 22:12:35 +00001527 ++src;
1528 --size;
1529 }
1530
Joe Hershberger16cf1452018-07-03 19:36:41 -05001531 while ((--size > 0) && src && *src && (*src != '"'))
wdenk2d966952002-10-31 22:12:35 +00001532 *dst++ = *src++;
wdenk2d966952002-10-31 22:12:35 +00001533 *dst = '\0';
1534}
1535
Joe Hershberger3a66fcb2018-07-03 19:36:39 -05001536int is_serverip_in_cmd(void)
1537{
1538 return !!strchr(net_boot_file_name, ':');
1539}
1540
Joe Hershberger6ab12832018-07-03 19:36:43 -05001541int net_parse_bootfile(struct in_addr *ipaddr, char *filename, int max_len)
1542{
1543 char *colon;
Lyle Franklin85f8e032022-04-16 11:36:43 -04001544 struct in_addr ip;
1545 ip.s_addr = 0;
Joe Hershberger6ab12832018-07-03 19:36:43 -05001546
1547 if (net_boot_file_name[0] == '\0')
1548 return 0;
1549
1550 colon = strchr(net_boot_file_name, ':');
1551 if (colon) {
Lyle Franklin85f8e032022-04-16 11:36:43 -04001552 ip = string_to_ip(net_boot_file_name);
1553 if (ipaddr && ip.s_addr)
1554 *ipaddr = ip;
1555 }
1556 if (ip.s_addr) {
Joe Hershberger6ab12832018-07-03 19:36:43 -05001557 strncpy(filename, colon + 1, max_len);
1558 } else {
1559 strncpy(filename, net_boot_file_name, max_len);
1560 }
1561 filename[max_len - 1] = '\0';
1562
1563 return 1;
1564}
1565
Joe Hershberger049a95a2015-04-08 01:41:01 -05001566void ip_to_string(struct in_addr x, char *s)
wdenk2d966952002-10-31 22:12:35 +00001567{
Joe Hershberger049a95a2015-04-08 01:41:01 -05001568 x.s_addr = ntohl(x.s_addr);
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001569 sprintf(s, "%d.%d.%d.%d",
Joe Hershberger049a95a2015-04-08 01:41:01 -05001570 (int) ((x.s_addr >> 24) & 0xff),
1571 (int) ((x.s_addr >> 16) & 0xff),
1572 (int) ((x.s_addr >> 8) & 0xff),
1573 (int) ((x.s_addr >> 0) & 0xff)
wdenk6e592382004-04-18 17:39:38 +00001574 );
wdenk2d966952002-10-31 22:12:35 +00001575}
1576
Joe Hershberger4fd50552015-04-08 01:41:17 -05001577void vlan_to_string(ushort x, char *s)
wdenka3d991b2004-04-15 21:48:45 +00001578{
1579 x = ntohs(x);
1580
1581 if (x == (ushort)-1)
1582 x = VLAN_NONE;
1583
1584 if (x == VLAN_NONE)
1585 strcpy(s, "none");
1586 else
1587 sprintf(s, "%d", x & VLAN_IDMASK);
1588}
1589
Joe Hershberger4fd50552015-04-08 01:41:17 -05001590ushort string_to_vlan(const char *s)
wdenka3d991b2004-04-15 21:48:45 +00001591{
1592 ushort id;
1593
1594 if (s == NULL)
wdenkb9711de2004-04-25 13:18:40 +00001595 return htons(VLAN_NONE);
wdenka3d991b2004-04-15 21:48:45 +00001596
1597 if (*s < '0' || *s > '9')
1598 id = VLAN_NONE;
1599 else
Simon Glass0b1284e2021-07-24 09:03:30 -06001600 id = (ushort)dectoul(s, NULL);
wdenka3d991b2004-04-15 21:48:45 +00001601
wdenkb9711de2004-04-25 13:18:40 +00001602 return htons(id);
wdenka3d991b2004-04-15 21:48:45 +00001603}
1604
Simon Glass723806c2017-08-03 12:22:15 -06001605ushort env_get_vlan(char *var)
wdenka3d991b2004-04-15 21:48:45 +00001606{
Simon Glass00caae62017-08-03 12:22:12 -06001607 return string_to_vlan(env_get(var));
wdenka3d991b2004-04-15 21:48:45 +00001608}