blob: 1c39acc4936c4669546f8936e64cf519c76008bb [file] [log] [blame]
Tom Rini70df9d62018-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 Hershbergerb35a3a62012-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 Denk30b87322005-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
wdenkbe9c1cb2004-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
wdenkb4ad9622005-04-01 00:25:43 +000074 *
Lothar Felten776fc102018-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 Glass1ea97892020-05-10 11:40:00 -060085#include <bootstage.h>
wdenk2d966952002-10-31 22:12:35 +000086#include <command.h>
Simon Glassa73bda42015-11-08 23:47:45 -070087#include <console.h>
Simon Glass313112a2019-08-01 09:46:46 -060088#include <env.h>
Simon Glass9d1f6192019-08-02 09:44:25 -060089#include <env_internal.h>
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -050090#include <errno.h>
Simon Glass85f13782019-12-28 10:45:03 -070091#include <image.h>
Simon Glass0f2af882020-05-10 11:40:05 -060092#include <log.h>
wdenk2d966952002-10-31 22:12:35 +000093#include <net.h>
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +030094#include <net6.h>
95#include <ndisc.h>
Alex Kiernand5aa57c2018-05-29 15:30:53 +000096#include <net/fastboot.h>
Lukasz Majewski21185922015-08-24 00:21:43 +020097#include <net/tftp.h>
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +093098#include <net/ncsi.h>
Ramon Friedac598c12019-07-18 21:43:30 +030099#if defined(CONFIG_CMD_PCAP)
100#include <net/pcap.h>
101#endif
Philippe Reynes6ec70bc2020-09-18 14:13:00 +0200102#include <net/udp.h>
Uri Mashiach4892d392017-01-19 10:51:45 +0200103#if defined(CONFIG_LED_STATUS)
wdenk49c3f672003-10-08 22:33:00 +0000104#include <miiphy.h>
Joe Hershbergerfee076e2012-05-23 07:58:15 +0000105#include <status_led.h>
wdenkb4ad9622005-04-01 00:25:43 +0000106#endif
Joe Hershbergerfee076e2012-05-23 07:58:15 +0000107#include <watchdog.h>
108#include <linux/compiler.h>
109#include "arp.h"
110#include "bootp.h"
Joe Hershbergera4215b02012-05-23 07:57:59 +0000111#include "cdp.h"
Robin Getz82f0d232009-07-20 14:53:54 -0400112#if defined(CONFIG_CMD_DNS)
113#include "dns.h"
114#endif
Joe Hershbergerb35a3a62012-05-23 08:00:12 +0000115#include "link_local.h"
Joe Hershbergerfee076e2012-05-23 07:58:15 +0000116#include "nfs.h"
Joe Hershbergerc21bf372012-05-23 07:58:02 +0000117#include "ping.h"
Joe Hershbergerfee076e2012-05-23 07:58:15 +0000118#include "rarp.h"
Lothar Felten776fc102018-06-22 22:29:54 +0200119#if defined(CONFIG_CMD_WOL)
120#include "wol.h"
121#endif
Ying-Chun Liu (PaulLiu)41efed12022-11-08 14:17:28 +0800122#include <net/tcp.h>
Ying-Chun Liu (PaulLiu)cc96a1d2022-11-08 14:17:29 +0800123#include <net/wget.h>
wdenk2d966952002-10-31 22:12:35 +0000124
wdenk2d966952002-10-31 22:12:35 +0000125/** BOOTP EXTENTIONS **/
126
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000127/* Our subnet mask (0=unknown) */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500128struct in_addr net_netmask;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000129/* Our gateways IP address */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500130struct in_addr net_gateway;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000131/* Our DNS IP address */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500132struct in_addr net_dns_server;
Jon Loeliger5336a762007-07-09 22:08:34 -0500133#if defined(CONFIG_BOOTP_DNS2)
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000134/* Our 2nd DNS IP address */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500135struct in_addr net_dns_server2;
stroesee0aadfb2003-08-28 14:17:32 +0000136#endif
wdenk2d966952002-10-31 22:12:35 +0000137
138/** END OF BOOTP EXTENTIONS **/
139
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000140/* Our ethernet address */
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500141u8 net_ethaddr[6];
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000142/* Boot server enet address */
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500143u8 net_server_ethaddr[6];
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000144/* Our IP addr (0 = unknown) */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500145struct in_addr net_ip;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000146/* Server IP addr (0 = unknown) */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500147struct in_addr net_server_ip;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000148/* Current receive packet */
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500149uchar *net_rx_packet;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000150/* Current rx packet length */
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500151int net_rx_packet_len;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000152/* IP packet ID */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500153static unsigned net_ip_id;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000154/* Ethernet bcast address */
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500155const u8 net_bcast_ethaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
156const u8 net_null_ethaddr[6];
Alexander Graf94c4b992016-05-06 21:01:01 +0200157#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500158void (*push_packet)(void *, int len) = 0;
Rafal Jaworowski1f2c9a42007-12-27 18:19:02 +0100159#endif
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000160/* Network loop state */
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000161enum net_loop_state net_state;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000162/* Tried all network devices */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500163int net_restart_wrap;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000164/* Network loop restarted */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500165static int net_restarted;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000166/* At least one device configured */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500167static int net_dev_exists;
wdenk2d966952002-10-31 22:12:35 +0000168
wdenk05939202004-04-18 17:39:38 +0000169/* XXX in both little & big endian machines 0xFFFF == ntohs(-1) */
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000170/* default is without VLAN */
Joe Hershberger013d3872015-04-08 01:41:17 -0500171ushort net_our_vlan = 0xFFFF;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000172/* ditto */
Joe Hershberger013d3872015-04-08 01:41:17 -0500173ushort net_native_vlan = 0xFFFF;
wdenk145d2c12004-04-15 21:48:45 +0000174
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000175/* Boot File name */
Jacob Stifflerae80c2e2015-09-30 10:12:05 -0400176char net_boot_file_name[1024];
Alexander Graff43bf5d2018-06-15 10:29:27 +0200177/* Indicates whether the file name was specified on the command line */
178bool net_boot_file_name_explicit;
Joe Hershberger290c8992015-04-08 01:41:02 -0500179/* The actual transferred size of the bootfile (in bytes) */
180u32 net_boot_file_size;
181/* Boot file size in blocks as reported by the DHCP server */
182u32 net_boot_file_expected_size_in_blocks;
wdenk2d966952002-10-31 22:12:35 +0000183
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500184static uchar net_pkt_buf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];
Joe Hershbergerf77abc52015-03-22 17:09:11 -0500185/* Receive packets */
186uchar *net_rx_packets[PKTBUFSRX];
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000187/* Current UDP RX packet handler */
188static rxhand_f *udp_packet_handler;
189/* Current ARP RX packet handler */
190static rxhand_f *arp_packet_handler;
Simon Glass2928cd82011-10-26 14:18:38 +0000191#ifdef CONFIG_CMD_TFTPPUT
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000192/* Current ICMP rx handler */
193static rxhand_icmp_f *packet_icmp_handler;
Simon Glass2928cd82011-10-26 14:18:38 +0000194#endif
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000195/* Current timeout handler */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500196static thand_f *time_handler;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000197/* Time base value */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500198static ulong time_start;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000199/* Current timeout value */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500200static ulong time_delta;
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000201/* THE transmit packet */
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500202uchar *net_tx_packet;
wdenk2d966952002-10-31 22:12:35 +0000203
Simon Glassd6c5f552011-10-24 18:00:02 +0000204static int net_check_prereq(enum proto_t protocol);
wdenk2d966952002-10-31 22:12:35 +0000205
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500206static int net_try_count;
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100207
Jim Lin6c8921f2013-08-13 19:03:05 +0800208int __maybe_unused net_busy_flag;
209
wdenk2d966952002-10-31 22:12:35 +0000210/**********************************************************************/
wdenke6466f62003-06-05 19:27:42 +0000211
Joe Hershberger875b6bf2015-05-20 14:27:23 -0500212static int on_ipaddr(const char *name, const char *value, enum env_op op,
213 int flags)
214{
215 if (flags & H_PROGRAMMATIC)
216 return 0;
217
218 net_ip = string_to_ip(value);
219
220 return 0;
221}
222U_BOOT_ENV_CALLBACK(ipaddr, on_ipaddr);
223
224static int on_gatewayip(const char *name, const char *value, enum env_op op,
225 int flags)
226{
227 if (flags & H_PROGRAMMATIC)
228 return 0;
229
230 net_gateway = string_to_ip(value);
231
232 return 0;
233}
234U_BOOT_ENV_CALLBACK(gatewayip, on_gatewayip);
235
236static int on_netmask(const char *name, const char *value, enum env_op op,
237 int flags)
238{
239 if (flags & H_PROGRAMMATIC)
240 return 0;
241
242 net_netmask = string_to_ip(value);
243
244 return 0;
245}
246U_BOOT_ENV_CALLBACK(netmask, on_netmask);
247
248static int on_serverip(const char *name, const char *value, enum env_op op,
249 int flags)
250{
251 if (flags & H_PROGRAMMATIC)
252 return 0;
253
254 net_server_ip = string_to_ip(value);
255
256 return 0;
257}
258U_BOOT_ENV_CALLBACK(serverip, on_serverip);
259
260static int on_nvlan(const char *name, const char *value, enum env_op op,
261 int flags)
262{
263 if (flags & H_PROGRAMMATIC)
264 return 0;
265
266 net_native_vlan = string_to_vlan(value);
267
268 return 0;
269}
270U_BOOT_ENV_CALLBACK(nvlan, on_nvlan);
271
272static int on_vlan(const char *name, const char *value, enum env_op op,
273 int flags)
274{
275 if (flags & H_PROGRAMMATIC)
276 return 0;
277
278 net_our_vlan = string_to_vlan(value);
279
280 return 0;
281}
282U_BOOT_ENV_CALLBACK(vlan, on_vlan);
283
284#if defined(CONFIG_CMD_DNS)
285static int on_dnsip(const char *name, const char *value, enum env_op op,
286 int flags)
287{
288 if (flags & H_PROGRAMMATIC)
289 return 0;
290
291 net_dns_server = string_to_ip(value);
292
293 return 0;
294}
295U_BOOT_ENV_CALLBACK(dnsip, on_dnsip);
296#endif
297
Simon Glass5234ad12011-10-27 06:24:32 +0000298/*
299 * Check if autoload is enabled. If so, use either NFS or TFTP to download
300 * the boot file.
301 */
302void net_auto_load(void)
303{
Tom Rini57256302019-12-05 19:35:07 -0500304#if defined(CONFIG_CMD_NFS) && !defined(CONFIG_SPL_BUILD)
Simon Glass64b723f2017-08-03 12:22:12 -0600305 const char *s = env_get("autoload");
Simon Glass5234ad12011-10-27 06:24:32 +0000306
Joe Hershberger864ec562012-12-11 22:16:22 -0600307 if (s != NULL && strcmp(s, "NFS") == 0) {
Joe Hershberger40aa2082018-07-03 19:36:40 -0500308 if (net_check_prereq(NFS)) {
309/* We aren't expecting to get a serverip, so just accept the assigned IP */
Simon Glass297fc202021-12-18 11:27:52 -0700310 if (IS_ENABLED(CONFIG_BOOTP_SERVERIP)) {
311 net_set_state(NETLOOP_SUCCESS);
312 } else {
313 printf("Cannot autoload with NFS\n");
314 net_set_state(NETLOOP_FAIL);
315 }
Joe Hershberger40aa2082018-07-03 19:36:40 -0500316 return;
317 }
Joe Hershberger864ec562012-12-11 22:16:22 -0600318 /*
319 * Use NFS to load the bootfile.
320 */
Joe Hershberger40d7ca92015-04-08 01:41:10 -0500321 nfs_start();
Joe Hershberger864ec562012-12-11 22:16:22 -0600322 return;
323 }
Simon Glass5234ad12011-10-27 06:24:32 +0000324#endif
Simon Glass22c34c22017-08-03 12:22:13 -0600325 if (env_get_yesno("autoload") == 0) {
Joe Hershberger864ec562012-12-11 22:16:22 -0600326 /*
327 * Just use BOOTP/RARP to configure system;
328 * Do not use TFTP to load the bootfile.
329 */
330 net_set_state(NETLOOP_SUCCESS);
331 return;
Simon Glass5234ad12011-10-27 06:24:32 +0000332 }
Joe Hershberger40aa2082018-07-03 19:36:40 -0500333 if (net_check_prereq(TFTPGET)) {
334/* We aren't expecting to get a serverip, so just accept the assigned IP */
Simon Glass297fc202021-12-18 11:27:52 -0700335 if (IS_ENABLED(CONFIG_BOOTP_SERVERIP)) {
336 net_set_state(NETLOOP_SUCCESS);
337 } else {
338 printf("Cannot autoload with TFTPGET\n");
339 net_set_state(NETLOOP_FAIL);
340 }
Joe Hershberger40aa2082018-07-03 19:36:40 -0500341 return;
342 }
Joe Hershberger64701592015-04-08 01:41:07 -0500343 tftp_start(TFTPGET);
Simon Glass5234ad12011-10-27 06:24:32 +0000344}
345
Sean Anderson35e82982020-09-12 17:45:43 -0400346static int net_init_loop(void)
Heiko Schocher0c303fa2009-02-10 09:38:52 +0100347{
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +0300348 if (eth_get_dev()) {
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500349 memcpy(net_ethaddr, eth_get_ethaddr(), 6);
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +0300350
351 if (IS_ENABLED(CONFIG_IPV6)) {
352 ip6_make_lladdr(&net_link_local_ip6, net_ethaddr);
353 if (!memcmp(&net_ip6, &net_null_addr_ip6,
354 sizeof(struct in6_addr)))
355 memcpy(&net_ip6, &net_link_local_ip6,
356 sizeof(struct in6_addr));
357 }
358 }
Sean Anderson35e82982020-09-12 17:45:43 -0400359 else
360 /*
361 * Not ideal, but there's no way to get the actual error, and I
362 * don't feel like fixing all the users of eth_get_dev to deal
363 * with errors.
364 */
365 return -ENONET;
Michael Zaidmanb97bfe42009-04-04 01:43:00 +0300366
Sean Anderson35e82982020-09-12 17:45:43 -0400367 return 0;
Heiko Schocher0c303fa2009-02-10 09:38:52 +0100368}
369
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000370static void net_clear_handlers(void)
371{
372 net_set_udp_handler(NULL);
373 net_set_arp_handler(NULL);
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500374 net_set_timeout_handler(0, NULL);
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000375}
376
377static void net_cleanup_loop(void)
378{
379 net_clear_handlers();
380}
381
Sean Anderson35e82982020-09-12 17:45:43 -0400382int net_init(void)
Joe Hershberger017e5c42012-05-23 07:59:22 +0000383{
384 static int first_call = 1;
385
386 if (first_call) {
387 /*
388 * Setup packet buffers, aligned correctly.
389 */
390 int i;
391
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500392 net_tx_packet = &net_pkt_buf[0] + (PKTALIGN - 1);
393 net_tx_packet -= (ulong)net_tx_packet % PKTALIGN;
Joe Hershbergerf77abc52015-03-22 17:09:11 -0500394 for (i = 0; i < PKTBUFSRX; i++) {
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500395 net_rx_packets[i] = net_tx_packet +
396 (i + 1) * PKTSIZE_ALIGN;
Joe Hershbergerf77abc52015-03-22 17:09:11 -0500397 }
Joe Hershberger85ae7762015-04-08 01:41:08 -0500398 arp_init();
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +0300399 ndisc_init();
Joe Hershberger017e5c42012-05-23 07:59:22 +0000400 net_clear_handlers();
401
402 /* Only need to setup buffer pointers once. */
403 first_call = 0;
Ying-Chun Liu (PaulLiu)41efed12022-11-08 14:17:28 +0800404 if (IS_ENABLED(CONFIG_PROT_TCP))
405 tcp_set_tcp_state(TCP_CLOSED);
Joe Hershberger017e5c42012-05-23 07:59:22 +0000406 }
407
Sean Anderson35e82982020-09-12 17:45:43 -0400408 return net_init_loop();
Joe Hershberger017e5c42012-05-23 07:59:22 +0000409}
410
wdenke6466f62003-06-05 19:27:42 +0000411/**********************************************************************/
wdenk2d966952002-10-31 22:12:35 +0000412/*
413 * Main network processing loop.
414 */
415
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500416int net_loop(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +0000417{
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500418 int ret = -EINVAL;
Leonid Iziumtsev4b58b052018-05-08 15:55:50 +0200419 enum net_loop_state prev_net_state = net_state;
wdenk2d966952002-10-31 22:12:35 +0000420
Marek Szyprowskib9df7d92020-06-15 11:15:57 +0200421#if defined(CONFIG_CMD_PING)
422 if (protocol != PING)
423 net_ping_ip.s_addr = 0;
424#endif
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500425 net_restarted = 0;
426 net_dev_exists = 0;
427 net_try_count = 1;
428 debug_cond(DEBUG_INT_STATE, "--- net_loop Entry\n");
wdenke6466f62003-06-05 19:27:42 +0000429
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +0930430#ifdef CONFIG_PHY_NCSI
431 if (phy_interface_is_ncsi() && protocol != NCSI && !ncsi_active()) {
432 printf("%s: configuring NCSI first\n", __func__);
433 if (net_loop(NCSI) < 0)
434 return ret;
435 eth_init_state_only();
436 goto restart;
437 }
438#endif
439
Simon Glass768cbf02011-12-10 11:08:06 +0000440 bootstage_mark_name(BOOTSTAGE_ID_ETH_START, "eth_start");
Joe Hershberger017e5c42012-05-23 07:59:22 +0000441 net_init();
Yang Liu7c78e2f2020-12-21 14:44:39 +1100442 if (eth_is_on_demand_init()) {
wdenkfa66e932005-04-03 14:52:59 +0000443 eth_halt();
Joe Hershberger9f374062012-08-03 10:59:08 +0000444 eth_set_current();
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500445 ret = eth_init();
446 if (ret < 0) {
Joe Hershberger9f374062012-08-03 10:59:08 +0000447 eth_halt();
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500448 return ret;
Joe Hershberger9f374062012-08-03 10:59:08 +0000449 }
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500450 } else {
Joe Hershberger3dbe17e2015-03-22 17:09:06 -0500451 eth_init_state_only();
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500452 }
Samuel Mendoza-Jonasfeebd6c2022-08-08 21:46:04 +0930453
wdenk2d966952002-10-31 22:12:35 +0000454restart:
Jim Lin6c8921f2013-08-13 19:03:05 +0800455#ifdef CONFIG_USB_KEYBOARD
456 net_busy_flag = 0;
457#endif
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000458 net_set_state(NETLOOP_CONTINUE);
wdenk2d966952002-10-31 22:12:35 +0000459
460 /*
461 * Start the ball rolling with the given start function. From
462 * here on, this code is a state machine driven by received
463 * packets and timer events.
464 */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500465 debug_cond(DEBUG_INT_STATE, "--- net_loop Init\n");
466 net_init_loop();
wdenk2d966952002-10-31 22:12:35 +0000467
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000468 switch (net_check_prereq(protocol)) {
wdenk2d966952002-10-31 22:12:35 +0000469 case 1:
470 /* network not configured */
wdenkfa66e932005-04-03 14:52:59 +0000471 eth_halt();
Leonid Iziumtsev4b58b052018-05-08 15:55:50 +0200472 net_set_state(prev_net_state);
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500473 return -ENODEV;
wdenk2d966952002-10-31 22:12:35 +0000474
wdenk2d966952002-10-31 22:12:35 +0000475 case 2:
476 /* network device not configured */
477 break;
wdenk2d966952002-10-31 22:12:35 +0000478
479 case 0:
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500480 net_dev_exists = 1;
Joe Hershberger290c8992015-04-08 01:41:02 -0500481 net_boot_file_size = 0;
wdenk2d966952002-10-31 22:12:35 +0000482 switch (protocol) {
Krebs, Olafd9249382020-03-09 14:27:55 +0000483#ifdef CONFIG_CMD_TFTPBOOT
Simon Glassd6c5f552011-10-24 18:00:02 +0000484 case TFTPGET:
Simon Glass6a398d22011-10-24 18:00:07 +0000485#ifdef CONFIG_CMD_TFTPPUT
486 case TFTPPUT:
487#endif
wdenk2d966952002-10-31 22:12:35 +0000488 /* always use ARP to get server ethernet address */
Joe Hershberger64701592015-04-08 01:41:07 -0500489 tftp_start(protocol);
wdenk2d966952002-10-31 22:12:35 +0000490 break;
Krebs, Olafd9249382020-03-09 14:27:55 +0000491#endif
Luca Ceresoli7aa81a42011-05-17 00:03:40 +0000492#ifdef CONFIG_CMD_TFTPSRV
493 case TFTPSRV:
Joe Hershberger64701592015-04-08 01:41:07 -0500494 tftp_start_server();
Luca Ceresoli7aa81a42011-05-17 00:03:40 +0000495 break;
496#endif
Alex Kiernand5aa57c2018-05-29 15:30:53 +0000497#ifdef CONFIG_UDP_FUNCTION_FASTBOOT
498 case FASTBOOT:
499 fastboot_start_server();
500 break;
501#endif
Jon Loeliger54f35c22007-07-09 17:45:14 -0500502#if defined(CONFIG_CMD_DHCP)
wdenk2d966952002-10-31 22:12:35 +0000503 case DHCP:
Joe Hershberger2fe81a52015-04-08 01:41:09 -0500504 bootp_reset();
Joe Hershberger5874dec2015-04-08 01:41:01 -0500505 net_ip.s_addr = 0;
Joe Hershberger2fe81a52015-04-08 01:41:09 -0500506 dhcp_request(); /* Basically same as BOOTP */
wdenk2d966952002-10-31 22:12:35 +0000507 break;
Jon Loeligera9807e52007-07-10 11:05:02 -0500508#endif
Krebs, Olafd9249382020-03-09 14:27:55 +0000509#if defined(CONFIG_CMD_BOOTP)
wdenk2d966952002-10-31 22:12:35 +0000510 case BOOTP:
Joe Hershberger2fe81a52015-04-08 01:41:09 -0500511 bootp_reset();
Joe Hershberger5874dec2015-04-08 01:41:01 -0500512 net_ip.s_addr = 0;
Joe Hershberger2fe81a52015-04-08 01:41:09 -0500513 bootp_request();
wdenk2d966952002-10-31 22:12:35 +0000514 break;
Krebs, Olafd9249382020-03-09 14:27:55 +0000515#endif
Peter Tyserf7a48ca2010-09-30 11:25:48 -0500516#if defined(CONFIG_CMD_RARP)
wdenk2d966952002-10-31 22:12:35 +0000517 case RARP:
Joe Hershberger8e805bb2015-04-08 01:41:11 -0500518 rarp_try = 0;
Joe Hershberger5874dec2015-04-08 01:41:01 -0500519 net_ip.s_addr = 0;
Joe Hershberger8e805bb2015-04-08 01:41:11 -0500520 rarp_request();
wdenk2d966952002-10-31 22:12:35 +0000521 break;
Peter Tyserf7a48ca2010-09-30 11:25:48 -0500522#endif
Jon Loeliger54f35c22007-07-09 17:45:14 -0500523#if defined(CONFIG_CMD_PING)
wdenke6466f62003-06-05 19:27:42 +0000524 case PING:
Joe Hershbergerc21bf372012-05-23 07:58:02 +0000525 ping_start();
wdenke6466f62003-06-05 19:27:42 +0000526 break;
527#endif
Viacheslav Mitrofanove03c8aa2022-12-02 12:18:08 +0300528#if defined(CONFIG_CMD_PING6)
529 case PING6:
530 ping6_start();
531 break;
532#endif
Tom Rini57256302019-12-05 19:35:07 -0500533#if defined(CONFIG_CMD_NFS) && !defined(CONFIG_SPL_BUILD)
wdenkbe9c1cb2004-02-24 02:00:03 +0000534 case NFS:
Joe Hershberger40d7ca92015-04-08 01:41:10 -0500535 nfs_start();
wdenkbe9c1cb2004-02-24 02:00:03 +0000536 break;
537#endif
Ying-Chun Liu (PaulLiu)cc96a1d2022-11-08 14:17:29 +0800538#if defined(CONFIG_CMD_WGET)
539 case WGET:
540 wget_start();
541 break;
542#endif
Jon Loeliger54f35c22007-07-09 17:45:14 -0500543#if defined(CONFIG_CMD_CDP)
wdenk145d2c12004-04-15 21:48:45 +0000544 case CDP:
Joe Hershberger527336f2015-04-08 01:41:14 -0500545 cdp_start();
wdenk145d2c12004-04-15 21:48:45 +0000546 break;
547#endif
Holger Denglerae85c072017-07-20 10:10:55 +0200548#if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_SPL_BUILD)
wdenkb8fb6192004-08-02 21:11:11 +0000549 case NETCONS:
Joe Hershbergerd02aa6b2015-04-08 01:41:16 -0500550 nc_start();
wdenkb8fb6192004-08-02 21:11:11 +0000551 break;
552#endif
Robin Getz82f0d232009-07-20 14:53:54 -0400553#if defined(CONFIG_CMD_DNS)
554 case DNS:
Joe Hershbergerf725e342015-04-08 01:41:15 -0500555 dns_start();
Robin Getz82f0d232009-07-20 14:53:54 -0400556 break;
557#endif
Joe Hershbergerb35a3a62012-05-23 08:00:12 +0000558#if defined(CONFIG_CMD_LINK_LOCAL)
559 case LINKLOCAL:
560 link_local_start();
561 break;
562#endif
Lothar Felten776fc102018-06-22 22:29:54 +0200563#if defined(CONFIG_CMD_WOL)
564 case WOL:
565 wol_start();
566 break;
567#endif
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +0930568#if defined(CONFIG_PHY_NCSI)
569 case NCSI:
570 ncsi_probe_packages();
571 break;
572#endif
wdenk2d966952002-10-31 22:12:35 +0000573 default:
574 break;
575 }
576
Philippe Reynes6ec70bc2020-09-18 14:13:00 +0200577 if (IS_ENABLED(CONFIG_PROT_UDP) && protocol == UDP)
578 udp_start();
579
wdenk2d966952002-10-31 22:12:35 +0000580 break;
581 }
582
Jon Loeliger54f35c22007-07-09 17:45:14 -0500583#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli5c83a962011-05-11 03:59:54 +0000584#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach4892d392017-01-19 10:51:45 +0200585 defined(CONFIG_LED_STATUS) && \
586 defined(CONFIG_LED_STATUS_RED)
wdenk49c3f672003-10-08 22:33:00 +0000587 /*
wdenk9c53f402003-10-15 23:53:47 +0000588 * Echo the inverted link state to the fault LED.
wdenk49c3f672003-10-08 22:33:00 +0000589 */
Luca Ceresolie8ccbb02011-05-04 02:40:43 +0000590 if (miiphy_link(eth_get_dev()->name, CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach4892d392017-01-19 10:51:45 +0200591 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_OFF);
Luca Ceresolie8ccbb02011-05-04 02:40:43 +0000592 else
Uri Mashiach4892d392017-01-19 10:51:45 +0200593 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_ON);
Jean-Christophe PLAGNIOL-VILLARD03836942008-10-16 15:01:15 +0200594#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenk49c3f672003-10-08 22:33:00 +0000595#endif /* CONFIG_MII, ... */
Jim Lin6c8921f2013-08-13 19:03:05 +0800596#ifdef CONFIG_USB_KEYBOARD
597 net_busy_flag = 1;
598#endif
wdenk2d966952002-10-31 22:12:35 +0000599
600 /*
601 * Main packet reception loop. Loop receiving packets until
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000602 * someone sets `net_state' to a state that terminates.
wdenk2d966952002-10-31 22:12:35 +0000603 */
604 for (;;) {
Stefan Roese80877fa2022-09-02 14:10:46 +0200605 schedule();
Joe Hershbergerd6978a42015-12-21 16:31:35 -0600606 if (arp_timeout_check() > 0)
607 time_start = get_timer(0);
608
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +0300609 if (IS_ENABLED(CONFIG_IPV6)) {
610 if (use_ip6 && (ndisc_timeout_check() > 0))
611 time_start = get_timer(0);
612 }
613
wdenk2d966952002-10-31 22:12:35 +0000614 /*
615 * Check the ethernet for a new packet. The ethernet
616 * receive routine will process it.
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500617 * Most drivers return the most recent packet size, but not
618 * errors that may have happened.
wdenk2d966952002-10-31 22:12:35 +0000619 */
Guennadi Liakhovetskib38c2b32008-04-03 17:04:19 +0200620 eth_rx();
wdenk2d966952002-10-31 22:12:35 +0000621
622 /*
623 * Abort if ctrl-c was pressed.
624 */
625 if (ctrlc()) {
Joe Hershbergerde8205a2012-05-23 07:59:24 +0000626 /* cancel any ARP that may not have completed */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500627 net_arp_wait_packet_ip.s_addr = 0;
Joe Hershbergerde8205a2012-05-23 07:59:24 +0000628
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000629 net_cleanup_loop();
wdenk57b2d802003-06-27 21:31:46 +0000630 eth_halt();
Joe Hershberger9f374062012-08-03 10:59:08 +0000631 /* Invalidate the last protocol */
632 eth_set_last_protocol(BOOTP);
633
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000634 puts("\nAbort\n");
Joe Hershberger05a377b2012-05-23 08:01:04 +0000635 /* include a debug print as well incase the debug
636 messages are directed to stderr */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500637 debug_cond(DEBUG_INT_STATE, "--- net_loop Abort!\n");
Michal Simekafd31602015-08-21 08:49:48 +0200638 ret = -EINTR;
Simon Glass230467c2011-10-24 18:00:01 +0000639 goto done;
wdenk2d966952002-10-31 22:12:35 +0000640 }
641
wdenk2d966952002-10-31 22:12:35 +0000642 /*
643 * Check for a timeout, and run the timeout handler
644 * if we have one.
645 */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500646 if (time_handler &&
647 ((get_timer(0) - time_start) > time_delta)) {
wdenk2d966952002-10-31 22:12:35 +0000648 thand_f *x;
649
Jon Loeliger54f35c22007-07-09 17:45:14 -0500650#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000651#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach4892d392017-01-19 10:51:45 +0200652 defined(CONFIG_LED_STATUS) && \
653 defined(CONFIG_LED_STATUS_RED)
wdenk49c3f672003-10-08 22:33:00 +0000654 /*
wdenk9c53f402003-10-15 23:53:47 +0000655 * Echo the inverted link state to the fault LED.
wdenk49c3f672003-10-08 22:33:00 +0000656 */
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000657 if (miiphy_link(eth_get_dev()->name,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500658 CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach4892d392017-01-19 10:51:45 +0200659 status_led_set(CONFIG_LED_STATUS_RED,
660 CONFIG_LED_STATUS_OFF);
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500661 else
Uri Mashiach4892d392017-01-19 10:51:45 +0200662 status_led_set(CONFIG_LED_STATUS_RED,
663 CONFIG_LED_STATUS_ON);
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000664#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenk49c3f672003-10-08 22:33:00 +0000665#endif /* CONFIG_MII, ... */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500666 debug_cond(DEBUG_INT_STATE, "--- net_loop timeout\n");
667 x = time_handler;
668 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000669 (*x)();
670 }
671
Joe Hershbergere44a0ea2015-03-22 17:09:07 -0500672 if (net_state == NETLOOP_FAIL)
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500673 ret = net_start_again();
wdenk2d966952002-10-31 22:12:35 +0000674
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000675 switch (net_state) {
wdenk2d966952002-10-31 22:12:35 +0000676 case NETLOOP_RESTART:
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500677 net_restarted = 1;
wdenk2d966952002-10-31 22:12:35 +0000678 goto restart;
679
680 case NETLOOP_SUCCESS:
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000681 net_cleanup_loop();
Joe Hershberger290c8992015-04-08 01:41:02 -0500682 if (net_boot_file_size > 0) {
683 printf("Bytes transferred = %d (%x hex)\n",
684 net_boot_file_size, net_boot_file_size);
Simon Glass4d949a22017-08-03 12:22:10 -0600685 env_set_hex("filesize", net_boot_file_size);
Simon Glass892265d2019-12-28 10:45:02 -0700686 env_set_hex("fileaddr", image_load_addr);
wdenk2d966952002-10-31 22:12:35 +0000687 }
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +0930688 if (protocol != NETCONS && protocol != NCSI)
Joe Hershberger9f374062012-08-03 10:59:08 +0000689 eth_halt();
690 else
691 eth_halt_state_only();
692
693 eth_set_last_protocol(protocol);
694
Joe Hershberger290c8992015-04-08 01:41:02 -0500695 ret = net_boot_file_size;
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500696 debug_cond(DEBUG_INT_STATE, "--- net_loop Success!\n");
Simon Glass230467c2011-10-24 18:00:01 +0000697 goto done;
wdenk2d966952002-10-31 22:12:35 +0000698
699 case NETLOOP_FAIL:
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000700 net_cleanup_loop();
Joe Hershberger9f374062012-08-03 10:59:08 +0000701 /* Invalidate the last protocol */
702 eth_set_last_protocol(BOOTP);
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500703 debug_cond(DEBUG_INT_STATE, "--- net_loop Fail!\n");
Thomas RIENOESSL2dee4192018-11-21 15:56:07 +0100704 ret = -ENONET;
Simon Glass230467c2011-10-24 18:00:01 +0000705 goto done;
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000706
707 case NETLOOP_CONTINUE:
708 continue;
wdenk2d966952002-10-31 22:12:35 +0000709 }
710 }
Simon Glass230467c2011-10-24 18:00:01 +0000711
712done:
Jim Lin6c8921f2013-08-13 19:03:05 +0800713#ifdef CONFIG_USB_KEYBOARD
714 net_busy_flag = 0;
715#endif
Simon Glass2928cd82011-10-26 14:18:38 +0000716#ifdef CONFIG_CMD_TFTPPUT
Simon Glass230467c2011-10-24 18:00:01 +0000717 /* Clear out the handlers */
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000718 net_set_udp_handler(NULL);
Simon Glass230467c2011-10-24 18:00:01 +0000719 net_set_icmp_handler(NULL);
Simon Glass2928cd82011-10-26 14:18:38 +0000720#endif
Leonid Iziumtsev4b58b052018-05-08 15:55:50 +0200721 net_set_state(prev_net_state);
Ramon Friedac598c12019-07-18 21:43:30 +0300722
723#if defined(CONFIG_CMD_PCAP)
724 if (pcap_active())
725 pcap_print_status();
726#endif
Simon Glass230467c2011-10-24 18:00:01 +0000727 return ret;
wdenk2d966952002-10-31 22:12:35 +0000728}
729
730/**********************************************************************/
731
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500732static void start_again_timeout_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000733{
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000734 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000735}
736
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500737int net_start_again(void)
wdenk2d966952002-10-31 22:12:35 +0000738{
wdenk05939202004-04-18 17:39:38 +0000739 char *nretry;
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100740 int retry_forever = 0;
741 unsigned long retrycnt = 0;
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500742 int ret;
wdenk145d2c12004-04-15 21:48:45 +0000743
Simon Glass64b723f2017-08-03 12:22:12 -0600744 nretry = env_get("netretry");
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100745 if (nretry) {
746 if (!strcmp(nretry, "yes"))
747 retry_forever = 1;
748 else if (!strcmp(nretry, "no"))
749 retrycnt = 0;
750 else if (!strcmp(nretry, "once"))
751 retrycnt = 1;
752 else
753 retrycnt = simple_strtoul(nretry, NULL, 0);
Joe Hershbergere44a0ea2015-03-22 17:09:07 -0500754 } else {
755 retrycnt = 0;
756 retry_forever = 0;
757 }
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100758
Leonid Iziumtsevfb7c94c2018-03-09 15:29:06 +0100759 if ((!retry_forever) && (net_try_count > retrycnt)) {
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100760 eth_halt();
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000761 net_set_state(NETLOOP_FAIL);
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500762 /*
763 * We don't provide a way for the protocol to return an error,
764 * but this is almost always the reason.
765 */
766 return -ETIMEDOUT;
wdenk145d2c12004-04-15 21:48:45 +0000767 }
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100768
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500769 net_try_count++;
Remy Bohmer0ddb8e82009-10-28 22:13:39 +0100770
Luca Ceresoli7cbd7482011-05-11 03:59:56 +0000771 eth_halt();
Matthias Fuchsa02d62b2007-12-27 16:58:41 +0100772#if !defined(CONFIG_NET_DO_NOT_TRY_ANOTHER)
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500773 eth_try_another(!net_restarted);
Matthias Fuchsa02d62b2007-12-27 16:58:41 +0100774#endif
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500775 ret = eth_init();
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500776 if (net_restart_wrap) {
777 net_restart_wrap = 0;
778 if (net_dev_exists) {
779 net_set_timeout_handler(10000UL,
780 start_again_timeout_handler);
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000781 net_set_udp_handler(NULL);
wdenk05939202004-04-18 17:39:38 +0000782 } else {
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000783 net_set_state(NETLOOP_FAIL);
wdenk2d966952002-10-31 22:12:35 +0000784 }
wdenk05939202004-04-18 17:39:38 +0000785 } else {
Joe Hershbergerd4bb76a2012-05-23 07:59:14 +0000786 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000787 }
Joe Hershbergerf4dc96a2015-03-22 17:09:24 -0500788 return ret;
wdenk2d966952002-10-31 22:12:35 +0000789}
790
791/**********************************************************************/
792/*
793 * Miscelaneous bits.
794 */
795
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000796static void dummy_handler(uchar *pkt, unsigned dport,
Joe Hershberger5874dec2015-04-08 01:41:01 -0500797 struct in_addr sip, unsigned sport,
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000798 unsigned len)
Joe Hershbergeraae05082012-05-23 07:58:01 +0000799{
Joe Hershbergeraae05082012-05-23 07:58:01 +0000800}
801
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000802rxhand_f *net_get_udp_handler(void)
803{
804 return udp_packet_handler;
805}
Joe Hershbergeraae05082012-05-23 07:58:01 +0000806
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000807void net_set_udp_handler(rxhand_f *f)
808{
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500809 debug_cond(DEBUG_INT_STATE, "--- net_loop UDP handler set (%p)\n", f);
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000810 if (f == NULL)
811 udp_packet_handler = dummy_handler;
812 else
813 udp_packet_handler = f;
814}
815
816rxhand_f *net_get_arp_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000817{
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000818 return arp_packet_handler;
wdenk2d966952002-10-31 22:12:35 +0000819}
820
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000821void net_set_arp_handler(rxhand_f *f)
822{
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500823 debug_cond(DEBUG_INT_STATE, "--- net_loop ARP handler set (%p)\n", f);
Joe Hershbergerf50357b2012-05-23 07:59:15 +0000824 if (f == NULL)
825 arp_packet_handler = dummy_handler;
826 else
827 arp_packet_handler = f;
828}
829
Simon Glass2928cd82011-10-26 14:18:38 +0000830#ifdef CONFIG_CMD_TFTPPUT
Simon Glass230467c2011-10-24 18:00:01 +0000831void net_set_icmp_handler(rxhand_icmp_f *f)
832{
833 packet_icmp_handler = f;
834}
Simon Glass2928cd82011-10-26 14:18:38 +0000835#endif
wdenk2d966952002-10-31 22:12:35 +0000836
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500837void net_set_timeout_handler(ulong iv, thand_f *f)
wdenk2d966952002-10-31 22:12:35 +0000838{
839 if (iv == 0) {
Joe Hershberger05a377b2012-05-23 08:01:04 +0000840 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500841 "--- net_loop timeout handler cancelled\n");
842 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000843 } else {
Joe Hershberger05a377b2012-05-23 08:01:04 +0000844 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500845 "--- net_loop timeout handler set (%p)\n", f);
846 time_handler = f;
847 time_start = get_timer(0);
848 time_delta = iv * CONFIG_SYS_HZ / 1000;
wdenk2d966952002-10-31 22:12:35 +0000849 }
850}
851
Joe Hershbergere79a5182018-09-26 16:49:02 -0500852uchar *net_get_async_tx_pkt_buf(void)
853{
854 if (arp_is_waiting())
855 return arp_tx_packet; /* If we are waiting, we already sent */
856 else
857 return net_tx_packet;
858}
859
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500860int net_send_udp_packet(uchar *ether, struct in_addr dest, int dport, int sport,
Joe Hershberger1a6b8d82012-05-23 07:58:10 +0000861 int payload_len)
wdenke6466f62003-06-05 19:27:42 +0000862{
Duncan Haref1447c92018-06-24 15:40:41 -0700863 return net_send_ip_packet(ether, dest, dport, sport, payload_len,
864 IPPROTO_UDP, 0, 0, 0);
865}
866
Ying-Chun Liu (PaulLiu)41efed12022-11-08 14:17:28 +0800867#if defined(CONFIG_PROT_TCP)
868int net_send_tcp_packet(int payload_len, int dport, int sport, u8 action,
869 u32 tcp_seq_num, u32 tcp_ack_num)
870{
871 return net_send_ip_packet(net_server_ethaddr, net_server_ip, dport,
872 sport, payload_len, IPPROTO_TCP, action,
873 tcp_seq_num, tcp_ack_num);
874}
875#endif
876
Duncan Haref1447c92018-06-24 15:40:41 -0700877int net_send_ip_packet(uchar *ether, struct in_addr dest, int dport, int sport,
878 int payload_len, int proto, u8 action, u32 tcp_seq_num,
879 u32 tcp_ack_num)
880{
wdenk145d2c12004-04-15 21:48:45 +0000881 uchar *pkt;
Joe Hershberger16be9cb2012-05-23 07:59:08 +0000882 int eth_hdr_size;
883 int pkt_hdr_size;
wdenk145d2c12004-04-15 21:48:45 +0000884
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500885 /* make sure the net_tx_packet is initialized (net_init() was called) */
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500886 assert(net_tx_packet != NULL);
887 if (net_tx_packet == NULL)
Joe Hershberger017e5c42012-05-23 07:59:22 +0000888 return -1;
889
wdenke6466f62003-06-05 19:27:42 +0000890 /* convert to new style broadcast */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500891 if (dest.s_addr == 0)
892 dest.s_addr = 0xFFFFFFFF;
wdenke6466f62003-06-05 19:27:42 +0000893
894 /* if broadcast, make the ether address a broadcast and don't do ARP */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500895 if (dest.s_addr == 0xFFFFFFFF)
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500896 ether = (uchar *)net_bcast_ethaddr;
wdenke6466f62003-06-05 19:27:42 +0000897
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500898 pkt = (uchar *)net_tx_packet;
Joe Hershberger16be9cb2012-05-23 07:59:08 +0000899
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500900 eth_hdr_size = net_set_ether(pkt, ether, PROT_IP);
Duncan Haref1447c92018-06-24 15:40:41 -0700901
902 switch (proto) {
903 case IPPROTO_UDP:
904 net_set_udp_header(pkt + eth_hdr_size, dest, dport, sport,
905 payload_len);
906 pkt_hdr_size = eth_hdr_size + IP_UDP_HDR_SIZE;
907 break;
Ying-Chun Liu (PaulLiu)41efed12022-11-08 14:17:28 +0800908#if defined(CONFIG_PROT_TCP)
909 case IPPROTO_TCP:
910 pkt_hdr_size = eth_hdr_size
911 + tcp_set_tcp_header(pkt + eth_hdr_size, dport, sport,
912 payload_len, action, tcp_seq_num,
913 tcp_ack_num);
914 break;
915#endif
Duncan Haref1447c92018-06-24 15:40:41 -0700916 default:
917 return -EINVAL;
918 }
wdenke6466f62003-06-05 19:27:42 +0000919
Joe Hershbergerde8205a2012-05-23 07:59:24 +0000920 /* if MAC address was not discovered yet, do an ARP request */
Joe Hershberger8ecdbed2015-04-08 01:41:04 -0500921 if (memcmp(ether, net_null_ethaddr, 6) == 0) {
Joe Hershberger05a377b2012-05-23 08:01:04 +0000922 debug_cond(DEBUG_DEV_PKT, "sending ARP for %pI4\n", &dest);
Robin Getz9e0a4d62009-07-23 03:01:03 -0400923
Joe Hershberger16be9cb2012-05-23 07:59:08 +0000924 /* save the ip and eth addr for the packet to send after arp */
Joe Hershberger5874dec2015-04-08 01:41:01 -0500925 net_arp_wait_packet_ip = dest;
Joe Hershberger85ae7762015-04-08 01:41:08 -0500926 arp_wait_packet_ethaddr = ether;
wdenk145d2c12004-04-15 21:48:45 +0000927
wdenke6466f62003-06-05 19:27:42 +0000928 /* size of the waiting packet */
Joe Hershberger85ae7762015-04-08 01:41:08 -0500929 arp_wait_tx_packet_size = pkt_hdr_size + payload_len;
wdenke6466f62003-06-05 19:27:42 +0000930
931 /* and do the ARP request */
Joe Hershberger85ae7762015-04-08 01:41:08 -0500932 arp_wait_try = 1;
933 arp_wait_timer_start = get_timer(0);
934 arp_request();
wdenke6466f62003-06-05 19:27:42 +0000935 return 1; /* waiting */
Joe Hershberger16be9cb2012-05-23 07:59:08 +0000936 } else {
Joe Hershberger05a377b2012-05-23 08:01:04 +0000937 debug_cond(DEBUG_DEV_PKT, "sending UDP to %pI4/%pM\n",
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500938 &dest, ether);
Joe Hershbergera8ca4f62015-04-08 01:41:05 -0500939 net_send_packet(net_tx_packet, pkt_hdr_size + payload_len);
Joe Hershberger16be9cb2012-05-23 07:59:08 +0000940 return 0; /* transmitted */
wdenke6466f62003-06-05 19:27:42 +0000941 }
wdenke6466f62003-06-05 19:27:42 +0000942}
wdenk145d2c12004-04-15 21:48:45 +0000943
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200944#ifdef CONFIG_IP_DEFRAG
945/*
946 * This function collects fragments in a single packet, according
947 * to the algorithm in RFC815. It returns NULL or the pointer to
948 * a complete packet, in static storage
949 */
Joe Hershberger9d390302016-08-15 14:42:15 -0500950#define IP_PKTSIZE (CONFIG_NET_MAXDEFRAG)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200951
Joe Hershbergerc686fa12012-05-23 07:58:05 +0000952#define IP_MAXUDP (IP_PKTSIZE - IP_HDR_SIZE)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200953
954/*
955 * this is the packet being assembled, either data or frag control.
956 * Fragments go by 8 bytes, so this union must be 8 bytes long
957 */
958struct hole {
959 /* first_byte is address of this structure */
960 u16 last_byte; /* last byte in this hole + 1 (begin of next hole) */
961 u16 next_hole; /* index of next (in 8-b blocks), 0 == none */
962 u16 prev_hole; /* index of prev, 0 == none */
963 u16 unused;
964};
965
Joe Hershbergerc80b41b02015-04-08 01:41:21 -0500966static struct ip_udp_hdr *__net_defragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200967{
Joe Hershberger77001b432012-05-15 08:59:08 +0000968 static uchar pkt_buff[IP_PKTSIZE] __aligned(PKTALIGN);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200969 static u16 first_hole, total_len;
970 struct hole *payload, *thisfrag, *h, *newh;
Joe Hershberger6fe8b452012-05-23 07:58:04 +0000971 struct ip_udp_hdr *localip = (struct ip_udp_hdr *)pkt_buff;
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200972 uchar *indata = (uchar *)ip;
973 int offset8, start, len, done = 0;
974 u16 ip_off = ntohs(ip->ip_off);
975
Rasmus Villemoes547e7e62022-10-14 19:43:39 +0200976 /*
977 * Calling code already rejected <, but we don't have to deal
978 * with an IP fragment with no payload.
979 */
980 if (ntohs(ip->ip_len) <= IP_HDR_SIZE)
Fabio Estevama0aaa322022-05-26 11:14:37 -0300981 return NULL;
982
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200983 /* payload starts after IP header, this fragment is in there */
Joe Hershbergerc686fa12012-05-23 07:58:05 +0000984 payload = (struct hole *)(pkt_buff + IP_HDR_SIZE);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200985 offset8 = (ip_off & IP_OFFS);
986 thisfrag = payload + offset8;
987 start = offset8 * 8;
Joe Hershbergerc686fa12012-05-23 07:58:05 +0000988 len = ntohs(ip->ip_len) - IP_HDR_SIZE;
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200989
Rasmus Villemoes547e7e62022-10-14 19:43:39 +0200990 /* All but last fragment must have a multiple-of-8 payload. */
991 if ((len & 7) && (ip_off & IP_FLAGS_MFRAG))
992 return NULL;
993
Alessandro Rubinif119e3d2009-08-07 13:58:56 +0200994 if (start + len > IP_MAXUDP) /* fragment extends too far */
995 return NULL;
996
997 if (!total_len || localip->ip_id != ip->ip_id) {
998 /* new (or different) packet, reset structs */
999 total_len = 0xffff;
1000 payload[0].last_byte = ~0;
1001 payload[0].next_hole = 0;
1002 payload[0].prev_hole = 0;
1003 first_hole = 0;
1004 /* any IP header will work, copy the first we received */
Joe Hershbergerc686fa12012-05-23 07:58:05 +00001005 memcpy(localip, ip, IP_HDR_SIZE);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001006 }
1007
1008 /*
1009 * What follows is the reassembly algorithm. We use the payload
1010 * array as a linked list of hole descriptors, as each hole starts
1011 * at a multiple of 8 bytes. However, last byte can be whatever value,
1012 * so it is represented as byte count, not as 8-byte blocks.
1013 */
1014
1015 h = payload + first_hole;
1016 while (h->last_byte < start) {
1017 if (!h->next_hole) {
1018 /* no hole that far away */
1019 return NULL;
1020 }
1021 h = payload + h->next_hole;
1022 }
1023
Fillod Stephanee7ade8b2010-06-11 19:26:43 +02001024 /* last fragment may be 1..7 bytes, the "+7" forces acceptance */
1025 if (offset8 + ((len + 7) / 8) <= h - payload) {
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001026 /* no overlap with holes (dup fragment?) */
1027 return NULL;
1028 }
1029
1030 if (!(ip_off & IP_FLAGS_MFRAG)) {
1031 /* no more fragmentss: truncate this (last) hole */
1032 total_len = start + len;
1033 h->last_byte = start + len;
1034 }
1035
1036 /*
Rasmus Villemoes366587d2022-10-17 09:52:51 +02001037 * There is some overlap: fix the hole list. This code deals
1038 * with a fragment that overlaps with two different holes
1039 * (thus being a superset of a previously-received fragment)
1040 * by only using the part of the fragment that fits in the
1041 * first hole.
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001042 */
Rasmus Villemoes366587d2022-10-17 09:52:51 +02001043 if (h->last_byte < start + len)
1044 len = h->last_byte - start;
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001045
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001046 if ((h >= thisfrag) && (h->last_byte <= start + len)) {
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001047 /* complete overlap with hole: remove hole */
1048 if (!h->prev_hole && !h->next_hole) {
1049 /* last remaining hole */
1050 done = 1;
1051 } else if (!h->prev_hole) {
1052 /* first hole */
1053 first_hole = h->next_hole;
1054 payload[h->next_hole].prev_hole = 0;
1055 } else if (!h->next_hole) {
1056 /* last hole */
1057 payload[h->prev_hole].next_hole = 0;
1058 } else {
1059 /* in the middle of the list */
1060 payload[h->next_hole].prev_hole = h->prev_hole;
1061 payload[h->prev_hole].next_hole = h->next_hole;
1062 }
1063
1064 } else if (h->last_byte <= start + len) {
1065 /* overlaps with final part of the hole: shorten this hole */
1066 h->last_byte = start;
1067
1068 } else if (h >= thisfrag) {
1069 /* overlaps with initial part of the hole: move this hole */
1070 newh = thisfrag + (len / 8);
1071 *newh = *h;
1072 h = newh;
1073 if (h->next_hole)
1074 payload[h->next_hole].prev_hole = (h - payload);
1075 if (h->prev_hole)
1076 payload[h->prev_hole].next_hole = (h - payload);
1077 else
1078 first_hole = (h - payload);
1079
1080 } else {
1081 /* fragment sits in the middle: split the hole */
1082 newh = thisfrag + (len / 8);
1083 *newh = *h;
1084 h->last_byte = start;
1085 h->next_hole = (newh - payload);
1086 newh->prev_hole = (h - payload);
1087 if (newh->next_hole)
1088 payload[newh->next_hole].prev_hole = (newh - payload);
1089 }
1090
1091 /* finally copy this fragment and possibly return whole packet */
Joe Hershbergerc686fa12012-05-23 07:58:05 +00001092 memcpy((uchar *)thisfrag, indata + IP_HDR_SIZE, len);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001093 if (!done)
1094 return NULL;
1095
Joe Hershbergerc686fa12012-05-23 07:58:05 +00001096 *lenp = total_len + IP_HDR_SIZE;
Rasmus Villemoes932d4842022-10-14 19:43:40 +02001097 localip->ip_len = htons(*lenp);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001098 return localip;
1099}
1100
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001101static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1102 int *lenp)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001103{
1104 u16 ip_off = ntohs(ip->ip_off);
1105 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1106 return ip; /* not a fragment */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001107 return __net_defragment(ip, lenp);
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001108}
1109
1110#else /* !CONFIG_IP_DEFRAG */
1111
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001112static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1113 int *lenp)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001114{
1115 u16 ip_off = ntohs(ip->ip_off);
1116 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1117 return ip; /* not a fragment */
1118 return NULL;
1119}
1120#endif
wdenk2d966952002-10-31 22:12:35 +00001121
Simon Glass43c72962011-10-24 18:00:00 +00001122/**
1123 * Receive an ICMP packet. We deal with REDIRECT and PING here, and silently
1124 * drop others.
1125 *
1126 * @parma ip IP packet containing the ICMP
1127 */
Joe Hershberger6fe8b452012-05-23 07:58:04 +00001128static void receive_icmp(struct ip_udp_hdr *ip, int len,
Joe Hershberger5874dec2015-04-08 01:41:01 -05001129 struct in_addr src_ip, struct ethernet_hdr *et)
Simon Glass43c72962011-10-24 18:00:00 +00001130{
Joe Hershberger78495612012-05-23 07:58:09 +00001131 struct icmp_hdr *icmph = (struct icmp_hdr *)&ip->udp_src;
Simon Glass43c72962011-10-24 18:00:00 +00001132
1133 switch (icmph->type) {
1134 case ICMP_REDIRECT:
1135 if (icmph->code != ICMP_REDIR_HOST)
1136 return;
1137 printf(" ICMP Host Redirect to %pI4 ",
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001138 &icmph->un.gateway);
Simon Glass43c72962011-10-24 18:00:00 +00001139 break;
Joe Hershbergerc21bf372012-05-23 07:58:02 +00001140 default:
Simon Glass43c72962011-10-24 18:00:00 +00001141#if defined(CONFIG_CMD_PING)
Joe Hershbergerc21bf372012-05-23 07:58:02 +00001142 ping_receive(et, ip, len);
Simon Glass43c72962011-10-24 18:00:00 +00001143#endif
Simon Glass2928cd82011-10-26 14:18:38 +00001144#ifdef CONFIG_CMD_TFTPPUT
Simon Glass230467c2011-10-24 18:00:01 +00001145 if (packet_icmp_handler)
1146 packet_icmp_handler(icmph->type, icmph->code,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001147 ntohs(ip->udp_dst), src_ip,
1148 ntohs(ip->udp_src), icmph->un.data,
1149 ntohs(ip->udp_len));
Simon Glass2928cd82011-10-26 14:18:38 +00001150#endif
Simon Glass43c72962011-10-24 18:00:00 +00001151 break;
1152 }
1153}
1154
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001155void net_process_received_packet(uchar *in_packet, int len)
wdenk2d966952002-10-31 22:12:35 +00001156{
Joe Hershberger1178f412012-05-23 07:58:06 +00001157 struct ethernet_hdr *et;
Joe Hershberger6fe8b452012-05-23 07:58:04 +00001158 struct ip_udp_hdr *ip;
Joe Hershberger5874dec2015-04-08 01:41:01 -05001159 struct in_addr dst_ip;
1160 struct in_addr src_ip;
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001161 int eth_proto;
Jon Loeliger54f35c22007-07-09 17:45:14 -05001162#if defined(CONFIG_CMD_CDP)
wdenk145d2c12004-04-15 21:48:45 +00001163 int iscdp;
1164#endif
1165 ushort cti = 0, vlanid = VLAN_NONE, myvlanid, mynvlanid;
wdenk2d966952002-10-31 22:12:35 +00001166
Joe Hershberger05a377b2012-05-23 08:01:04 +00001167 debug_cond(DEBUG_NET_PKT, "packet received\n");
wdenk145d2c12004-04-15 21:48:45 +00001168
Ramon Friedac598c12019-07-18 21:43:30 +03001169#if defined(CONFIG_CMD_PCAP)
1170 pcap_post(in_packet, len, false);
1171#endif
Joe Hershbergera8ca4f62015-04-08 01:41:05 -05001172 net_rx_packet = in_packet;
1173 net_rx_packet_len = len;
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001174 et = (struct ethernet_hdr *)in_packet;
wdenk145d2c12004-04-15 21:48:45 +00001175
1176 /* too small packet? */
1177 if (len < ETHER_HDR_SIZE)
1178 return;
Rafal Jaworowski1f2c9a42007-12-27 18:19:02 +01001179
Alexander Graf94c4b992016-05-06 21:01:01 +02001180#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Rafal Jaworowski1f2c9a42007-12-27 18:19:02 +01001181 if (push_packet) {
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001182 (*push_packet)(in_packet, len);
Rafal Jaworowski1f2c9a42007-12-27 18:19:02 +01001183 return;
1184 }
1185#endif
wdenk145d2c12004-04-15 21:48:45 +00001186
Jon Loeliger54f35c22007-07-09 17:45:14 -05001187#if defined(CONFIG_CMD_CDP)
wdenk145d2c12004-04-15 21:48:45 +00001188 /* keep track if packet is CDP */
Joe Hershberger00c62a82012-05-23 07:58:00 +00001189 iscdp = is_cdp_packet(et->et_dest);
wdenk145d2c12004-04-15 21:48:45 +00001190#endif
1191
Joe Hershberger013d3872015-04-08 01:41:17 -05001192 myvlanid = ntohs(net_our_vlan);
wdenk145d2c12004-04-15 21:48:45 +00001193 if (myvlanid == (ushort)-1)
1194 myvlanid = VLAN_NONE;
Joe Hershberger013d3872015-04-08 01:41:17 -05001195 mynvlanid = ntohs(net_native_vlan);
wdenk145d2c12004-04-15 21:48:45 +00001196 if (mynvlanid == (ushort)-1)
1197 mynvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001198
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001199 eth_proto = ntohs(et->et_protlen);
wdenk2d966952002-10-31 22:12:35 +00001200
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001201 if (eth_proto < 1514) {
Joe Hershberger1178f412012-05-23 07:58:06 +00001202 struct e802_hdr *et802 = (struct e802_hdr *)et;
wdenk2d966952002-10-31 22:12:35 +00001203 /*
Joe Hershbergerc17fa982012-05-23 07:58:11 +00001204 * Got a 802.2 packet. Check the other protocol field.
1205 * XXX VLAN over 802.2+SNAP not implemented!
wdenk2d966952002-10-31 22:12:35 +00001206 */
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001207 eth_proto = ntohs(et802->et_prot);
wdenk145d2c12004-04-15 21:48:45 +00001208
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001209 ip = (struct ip_udp_hdr *)(in_packet + E802_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001210 len -= E802_HDR_SIZE;
wdenk145d2c12004-04-15 21:48:45 +00001211
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001212 } else if (eth_proto != PROT_VLAN) { /* normal packet */
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001213 ip = (struct ip_udp_hdr *)(in_packet + ETHER_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001214 len -= ETHER_HDR_SIZE;
wdenk145d2c12004-04-15 21:48:45 +00001215
1216 } else { /* VLAN packet */
Joe Hershbergerb43784c2012-05-23 07:58:07 +00001217 struct vlan_ethernet_hdr *vet =
1218 (struct vlan_ethernet_hdr *)et;
wdenk145d2c12004-04-15 21:48:45 +00001219
Joe Hershberger05a377b2012-05-23 08:01:04 +00001220 debug_cond(DEBUG_NET_PKT, "VLAN packet received\n");
Robin Getz9e0a4d62009-07-23 03:01:03 -04001221
wdenk145d2c12004-04-15 21:48:45 +00001222 /* too small packet? */
1223 if (len < VLAN_ETHER_HDR_SIZE)
1224 return;
1225
1226 /* if no VLAN active */
Joe Hershberger013d3872015-04-08 01:41:17 -05001227 if ((ntohs(net_our_vlan) & VLAN_IDMASK) == VLAN_NONE
Jon Loeliger54f35c22007-07-09 17:45:14 -05001228#if defined(CONFIG_CMD_CDP)
wdenk145d2c12004-04-15 21:48:45 +00001229 && iscdp == 0
1230#endif
1231 )
1232 return;
1233
1234 cti = ntohs(vet->vet_tag);
1235 vlanid = cti & VLAN_IDMASK;
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001236 eth_proto = ntohs(vet->vet_type);
wdenk145d2c12004-04-15 21:48:45 +00001237
Joe Hershbergerf77abc52015-03-22 17:09:11 -05001238 ip = (struct ip_udp_hdr *)(in_packet + VLAN_ETHER_HDR_SIZE);
wdenk145d2c12004-04-15 21:48:45 +00001239 len -= VLAN_ETHER_HDR_SIZE;
wdenk2d966952002-10-31 22:12:35 +00001240 }
1241
Joe Hershberger05a377b2012-05-23 08:01:04 +00001242 debug_cond(DEBUG_NET_PKT, "Receive from protocol 0x%x\n", eth_proto);
wdenk2d966952002-10-31 22:12:35 +00001243
Jon Loeliger54f35c22007-07-09 17:45:14 -05001244#if defined(CONFIG_CMD_CDP)
wdenk145d2c12004-04-15 21:48:45 +00001245 if (iscdp) {
Joe Hershbergerd01a7a02012-05-23 07:58:13 +00001246 cdp_receive((uchar *)ip, len);
wdenk145d2c12004-04-15 21:48:45 +00001247 return;
1248 }
1249#endif
1250
1251 if ((myvlanid & VLAN_IDMASK) != VLAN_NONE) {
1252 if (vlanid == VLAN_NONE)
1253 vlanid = (mynvlanid & VLAN_IDMASK);
1254 /* not matched? */
1255 if (vlanid != (myvlanid & VLAN_IDMASK))
1256 return;
1257 }
1258
Joe Hershbergerfacf5352012-05-23 07:58:12 +00001259 switch (eth_proto) {
wdenk2d966952002-10-31 22:12:35 +00001260 case PROT_ARP:
Joe Hershberger85ae7762015-04-08 01:41:08 -05001261 arp_receive(et, ip, len);
wdenkcb99da52005-01-12 00:15:14 +00001262 break;
wdenk2d966952002-10-31 22:12:35 +00001263
Peter Tyserf7a48ca2010-09-30 11:25:48 -05001264#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001265 case PROT_RARP:
Joe Hershberger61b4de62012-05-23 07:58:03 +00001266 rarp_receive(ip, len);
wdenk2d966952002-10-31 22:12:35 +00001267 break;
Peter Tyserf7a48ca2010-09-30 11:25:48 -05001268#endif
Viacheslav Mitrofanovda019102022-12-02 12:18:06 +03001269#if IS_ENABLED(CONFIG_IPV6)
1270 case PROT_IP6:
1271 net_ip6_handler(et, (struct ip6_hdr *)ip, len);
1272#endif
wdenk2d966952002-10-31 22:12:35 +00001273 case PROT_IP:
Joe Hershberger05a377b2012-05-23 08:01:04 +00001274 debug_cond(DEBUG_NET_PKT, "Got IP\n");
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001275 /* Before we start poking the header, make sure it is there */
Rasmus Villemoes0007cba2022-10-14 19:43:38 +02001276 if (len < IP_HDR_SIZE) {
Joe Hershberger6fe8b452012-05-23 07:58:04 +00001277 debug("len bad %d < %lu\n", len,
Rasmus Villemoes0007cba2022-10-14 19:43:38 +02001278 (ulong)IP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001279 return;
1280 }
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001281 /* Check the packet length */
wdenk2d966952002-10-31 22:12:35 +00001282 if (len < ntohs(ip->ip_len)) {
Joe Hershberger05a377b2012-05-23 08:01:04 +00001283 debug("len bad %d < %d\n", len, ntohs(ip->ip_len));
wdenk2d966952002-10-31 22:12:35 +00001284 return;
1285 }
1286 len = ntohs(ip->ip_len);
Rasmus Villemoes0007cba2022-10-14 19:43:38 +02001287 if (len < IP_HDR_SIZE) {
1288 debug("bad ip->ip_len %d < %d\n", len, (int)IP_HDR_SIZE);
1289 return;
1290 }
Joe Hershberger05a377b2012-05-23 08:01:04 +00001291 debug_cond(DEBUG_NET_PKT, "len=%d, v=%02x\n",
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001292 len, ip->ip_hl_v & 0xff);
Robin Getz9e0a4d62009-07-23 03:01:03 -04001293
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001294 /* Can't deal with anything except IPv4 */
Luca Ceresolie8ccbb02011-05-04 02:40:43 +00001295 if ((ip->ip_hl_v & 0xf0) != 0x40)
wdenk2d966952002-10-31 22:12:35 +00001296 return;
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001297 /* Can't deal with IP options (headers != 20 bytes) */
Rasmus Villemoes9ac2c5c2022-10-14 19:43:37 +02001298 if ((ip->ip_hl_v & 0x0f) != 0x05)
Remy Bohmerb9535782008-06-03 15:48:17 +02001299 return;
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001300 /* Check the Checksum of the header */
Simon Glassdfcdcee2015-01-19 22:16:08 -07001301 if (!ip_checksum_ok((uchar *)ip, IP_HDR_SIZE)) {
Joe Hershberger05a377b2012-05-23 08:01:04 +00001302 debug("checksum bad\n");
wdenk2d966952002-10-31 22:12:35 +00001303 return;
1304 }
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001305 /* If it is not for us, ignore it */
Joe Hershberger5874dec2015-04-08 01:41:01 -05001306 dst_ip = net_read_ip(&ip->ip_dst);
1307 if (net_ip.s_addr && dst_ip.s_addr != net_ip.s_addr &&
1308 dst_ip.s_addr != 0xFFFFFFFF) {
Luca Ceresolib19d0b72011-05-04 02:40:46 +00001309 return;
wdenk2d966952002-10-31 22:12:35 +00001310 }
Luca Ceresoli428ab362011-04-18 06:19:50 +00001311 /* Read source IP address for later use */
Joe Hershberger5874dec2015-04-08 01:41:01 -05001312 src_ip = net_read_ip(&ip->ip_src);
wdenk2d966952002-10-31 22:12:35 +00001313 /*
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001314 * The function returns the unchanged packet if it's not
1315 * a fragment, and either the complete packet or NULL if
1316 * it is a fragment (if !CONFIG_IP_DEFRAG, it returns NULL)
1317 */
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001318 ip = net_defragment(ip, &len);
Luca Ceresolidb210822011-05-04 02:40:47 +00001319 if (!ip)
Alessandro Rubinif119e3d2009-08-07 13:58:56 +02001320 return;
1321 /*
wdenk2d966952002-10-31 22:12:35 +00001322 * watch for ICMP host redirects
1323 *
wdenk57b2d802003-06-27 21:31:46 +00001324 * There is no real handler code (yet). We just watch
1325 * for ICMP host redirect messages. In case anybody
1326 * sees these messages: please contact me
1327 * (wd@denx.de), or - even better - send me the
1328 * necessary fixes :-)
wdenk2d966952002-10-31 22:12:35 +00001329 *
wdenk57b2d802003-06-27 21:31:46 +00001330 * Note: in all cases where I have seen this so far
1331 * it was a problem with the router configuration,
1332 * for instance when a router was configured in the
1333 * BOOTP reply, but the TFTP server was on the same
1334 * subnet. So this is probably a warning that your
1335 * configuration might be wrong. But I'm not really
1336 * sure if there aren't any other situations.
Simon Glass230467c2011-10-24 18:00:01 +00001337 *
1338 * Simon Glass <sjg@chromium.org>: We get an ICMP when
1339 * we send a tftp packet to a dead connection, or when
1340 * there is no server at the other end.
wdenk2d966952002-10-31 22:12:35 +00001341 */
1342 if (ip->ip_p == IPPROTO_ICMP) {
Simon Glass43c72962011-10-24 18:00:00 +00001343 receive_icmp(ip, len, src_ip, et);
1344 return;
Ying-Chun Liu (PaulLiu)41efed12022-11-08 14:17:28 +08001345#if defined(CONFIG_PROT_TCP)
1346 } else if (ip->ip_p == IPPROTO_TCP) {
1347 debug_cond(DEBUG_DEV_PKT,
1348 "TCP PH (to=%pI4, from=%pI4, len=%d)\n",
1349 &dst_ip, &src_ip, len);
1350
1351 rxhand_tcp_f((union tcp_build_pkt *)ip, len);
1352 return;
1353#endif
wdenk2d966952002-10-31 22:12:35 +00001354 } else if (ip->ip_p != IPPROTO_UDP) { /* Only UDP packets */
1355 return;
1356 }
1357
Rasmus Villemoes932d4842022-10-14 19:43:40 +02001358 if (ntohs(ip->udp_len) < UDP_HDR_SIZE || ntohs(ip->udp_len) > len - IP_HDR_SIZE)
liucheng (G)c580b292019-08-29 13:47:33 +00001359 return;
1360
Joe Hershberger05a377b2012-05-23 08:01:04 +00001361 debug_cond(DEBUG_DEV_PKT,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001362 "received UDP (to=%pI4, from=%pI4, len=%d)\n",
1363 &dst_ip, &src_ip, len);
Joe Hershberger05a377b2012-05-23 08:01:04 +00001364
Simon Glasse0eb4ef2021-12-18 11:27:49 -07001365 if (IS_ENABLED(CONFIG_UDP_CHECKSUM) && ip->udp_xsum != 0) {
Wolfgang Denk30b87322005-08-12 23:43:12 +02001366 ulong xsum;
Heinrich Schuchardt16ffe472019-11-05 12:48:19 +01001367 u8 *sumptr;
Stefan Roesedfced812005-08-12 20:06:52 +02001368 ushort sumlen;
1369
1370 xsum = ip->ip_p;
1371 xsum += (ntohs(ip->udp_len));
Joe Hershberger5874dec2015-04-08 01:41:01 -05001372 xsum += (ntohl(ip->ip_src.s_addr) >> 16) & 0x0000ffff;
1373 xsum += (ntohl(ip->ip_src.s_addr) >> 0) & 0x0000ffff;
1374 xsum += (ntohl(ip->ip_dst.s_addr) >> 16) & 0x0000ffff;
1375 xsum += (ntohl(ip->ip_dst.s_addr) >> 0) & 0x0000ffff;
Stefan Roesedfced812005-08-12 20:06:52 +02001376
1377 sumlen = ntohs(ip->udp_len);
Heinrich Schuchardt16ffe472019-11-05 12:48:19 +01001378 sumptr = (u8 *)&ip->udp_src;
Stefan Roesedfced812005-08-12 20:06:52 +02001379
1380 while (sumlen > 1) {
Heinrich Schuchardt16ffe472019-11-05 12:48:19 +01001381 /* inlined ntohs() to avoid alignment errors */
1382 xsum += (sumptr[0] << 8) + sumptr[1];
1383 sumptr += 2;
Stefan Roesedfced812005-08-12 20:06:52 +02001384 sumlen -= 2;
1385 }
Heinrich Schuchardt16ffe472019-11-05 12:48:19 +01001386 if (sumlen > 0)
1387 xsum += (sumptr[0] << 8) + sumptr[0];
Stefan Roesedfced812005-08-12 20:06:52 +02001388 while ((xsum >> 16) != 0) {
Luca Ceresoli5c83a962011-05-11 03:59:54 +00001389 xsum = (xsum & 0x0000ffff) +
1390 ((xsum >> 16) & 0x0000ffff);
Stefan Roesedfced812005-08-12 20:06:52 +02001391 }
1392 if ((xsum != 0x00000000) && (xsum != 0x0000ffff)) {
Wolfgang Denk12cec0a2008-07-11 01:16:00 +02001393 printf(" UDP wrong checksum %08lx %08x\n",
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001394 xsum, ntohs(ip->udp_xsum));
Stefan Roesedfced812005-08-12 20:06:52 +02001395 return;
1396 }
1397 }
Stefan Roesedfced812005-08-12 20:06:52 +02001398
Holger Denglerae85c072017-07-20 10:10:55 +02001399#if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_SPL_BUILD)
Joe Hershberger6fe8b452012-05-23 07:58:04 +00001400 nc_input_packet((uchar *)ip + IP_UDP_HDR_SIZE,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001401 src_ip,
1402 ntohs(ip->udp_dst),
1403 ntohs(ip->udp_src),
1404 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenkb8fb6192004-08-02 21:11:11 +00001405#endif
wdenk2d966952002-10-31 22:12:35 +00001406 /*
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001407 * IP header OK. Pass the packet to the current handler.
wdenk2d966952002-10-31 22:12:35 +00001408 */
Joe Hershbergerf50357b2012-05-23 07:59:15 +00001409 (*udp_packet_handler)((uchar *)ip + IP_UDP_HDR_SIZE,
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001410 ntohs(ip->udp_dst),
1411 src_ip,
1412 ntohs(ip->udp_src),
1413 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001414 break;
Lothar Felten776fc102018-06-22 22:29:54 +02001415#ifdef CONFIG_CMD_WOL
1416 case PROT_WOL:
1417 wol_receive(ip, len);
1418 break;
1419#endif
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +09301420#ifdef CONFIG_PHY_NCSI
1421 case PROT_NCSI:
1422 ncsi_receive(et, ip, len);
1423 break;
1424#endif
wdenk2d966952002-10-31 22:12:35 +00001425 }
1426}
1427
wdenk2d966952002-10-31 22:12:35 +00001428/**********************************************************************/
1429
Simon Glassd6c5f552011-10-24 18:00:02 +00001430static int net_check_prereq(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +00001431{
1432 switch (protocol) {
wdenk05939202004-04-18 17:39:38 +00001433 /* Fall through */
Jon Loeliger54f35c22007-07-09 17:45:14 -05001434#if defined(CONFIG_CMD_PING)
wdenke6466f62003-06-05 19:27:42 +00001435 case PING:
Joe Hershberger5874dec2015-04-08 01:41:01 -05001436 if (net_ping_ip.s_addr == 0) {
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001437 puts("*** ERROR: ping address not given\n");
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001438 return 1;
wdenk05939202004-04-18 17:39:38 +00001439 }
1440 goto common;
wdenke6466f62003-06-05 19:27:42 +00001441#endif
Viacheslav Mitrofanove03c8aa2022-12-02 12:18:08 +03001442#if defined(CONFIG_CMD_PING6)
1443 case PING6:
1444 if (ip6_is_unspecified_addr(&net_ping_ip6)) {
1445 puts("*** ERROR: ping address not given\n");
1446 return 1;
1447 }
1448 goto common;
1449#endif
Robin Getz82f0d232009-07-20 14:53:54 -04001450#if defined(CONFIG_CMD_DNS)
1451 case DNS:
Joe Hershberger5874dec2015-04-08 01:41:01 -05001452 if (net_dns_server.s_addr == 0) {
Robin Getz82f0d232009-07-20 14:53:54 -04001453 puts("*** ERROR: DNS server address not given\n");
1454 return 1;
1455 }
1456 goto common;
1457#endif
Philippe Reynes6ec70bc2020-09-18 14:13:00 +02001458#if defined(CONFIG_PROT_UDP)
1459 case UDP:
1460 if (udp_prereq())
1461 return 1;
1462 goto common;
1463#endif
1464
Jon Loeliger54f35c22007-07-09 17:45:14 -05001465#if defined(CONFIG_CMD_NFS)
wdenkbe9c1cb2004-02-24 02:00:03 +00001466 case NFS:
1467#endif
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001468 /* Fall through */
Simon Glassd6c5f552011-10-24 18:00:02 +00001469 case TFTPGET:
Simon Glass6a398d22011-10-24 18:00:07 +00001470 case TFTPPUT:
Viacheslav Mitrofanov12b95ae2022-12-02 12:18:07 +03001471 if (IS_ENABLED(CONFIG_IPV6) && use_ip6) {
1472 if (!memcmp(&net_server_ip6, &net_null_addr_ip6,
1473 sizeof(struct in6_addr)) &&
1474 !strchr(net_boot_file_name, '[')) {
1475 puts("*** ERROR: `serverip6' not set\n");
1476 return 1;
1477 }
1478 } else if (net_server_ip.s_addr == 0 && !is_serverip_in_cmd()) {
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001479 puts("*** ERROR: `serverip' not set\n");
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001480 return 1;
wdenk05939202004-04-18 17:39:38 +00001481 }
Philippe Reynes2829d992020-09-18 14:13:02 +02001482#if defined(CONFIG_CMD_PING) || \
Philippe Reynes6ec70bc2020-09-18 14:13:00 +02001483 defined(CONFIG_CMD_DNS) || defined(CONFIG_PROT_UDP)
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001484common:
wdenke6466f62003-06-05 19:27:42 +00001485#endif
Simon Guinot00dceba2011-05-01 23:38:40 +00001486 /* Fall through */
wdenke6466f62003-06-05 19:27:42 +00001487
Simon Guinot00dceba2011-05-01 23:38:40 +00001488 case NETCONS:
Alex Kiernand5aa57c2018-05-29 15:30:53 +00001489 case FASTBOOT:
Luca Ceresoli7aa81a42011-05-17 00:03:40 +00001490 case TFTPSRV:
Viacheslav Mitrofanov12b95ae2022-12-02 12:18:07 +03001491 if (IS_ENABLED(CONFIG_IPV6) && use_ip6) {
1492 if (!memcmp(&net_link_local_ip6, &net_null_addr_ip6,
1493 sizeof(struct in6_addr))) {
1494 puts("*** ERROR: `ip6addr` not set\n");
1495 return 1;
1496 }
1497 } else if (net_ip.s_addr == 0) {
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001498 puts("*** ERROR: `ipaddr' not set\n");
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001499 return 1;
wdenk05939202004-04-18 17:39:38 +00001500 }
1501 /* Fall through */
wdenk2d966952002-10-31 22:12:35 +00001502
Peter Tyserf7a48ca2010-09-30 11:25:48 -05001503#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001504 case RARP:
Peter Tyserf7a48ca2010-09-30 11:25:48 -05001505#endif
Samuel Mendoza-Jonasc8f4ab02022-08-08 21:46:03 +09301506#ifdef CONFIG_PHY_NCSI
1507 case NCSI:
1508#endif
wdenk2d966952002-10-31 22:12:35 +00001509 case BOOTP:
wdenk145d2c12004-04-15 21:48:45 +00001510 case CDP:
Peter Tyserf7a48ca2010-09-30 11:25:48 -05001511 case DHCP:
Joe Hershbergerb35a3a62012-05-23 08:00:12 +00001512 case LINKLOCAL:
Joe Hershberger8ecdbed2015-04-08 01:41:04 -05001513 if (memcmp(net_ethaddr, "\0\0\0\0\0\0", 6) == 0) {
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001514 int num = eth_get_dev_index();
wdenk2d966952002-10-31 22:12:35 +00001515
wdenk05939202004-04-18 17:39:38 +00001516 switch (num) {
1517 case -1:
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001518 puts("*** ERROR: No ethernet found.\n");
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001519 return 1;
wdenk05939202004-04-18 17:39:38 +00001520 case 0:
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001521 puts("*** ERROR: `ethaddr' not set\n");
wdenk2d966952002-10-31 22:12:35 +00001522 break;
wdenk05939202004-04-18 17:39:38 +00001523 default:
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001524 printf("*** ERROR: `eth%daddr' not set\n",
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001525 num);
wdenk2d966952002-10-31 22:12:35 +00001526 break;
wdenk05939202004-04-18 17:39:38 +00001527 }
wdenk2d966952002-10-31 22:12:35 +00001528
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001529 net_start_again();
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001530 return 2;
wdenk05939202004-04-18 17:39:38 +00001531 }
1532 /* Fall through */
1533 default:
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001534 return 0;
wdenk2d966952002-10-31 22:12:35 +00001535 }
Luca Ceresoli5fe6de22011-05-04 02:40:45 +00001536 return 0; /* OK */
wdenk2d966952002-10-31 22:12:35 +00001537}
1538/**********************************************************************/
1539
1540int
Joe Hershbergera8ca4f62015-04-08 01:41:05 -05001541net_eth_hdr_size(void)
wdenk145d2c12004-04-15 21:48:45 +00001542{
1543 ushort myvlanid;
1544
Joe Hershberger013d3872015-04-08 01:41:17 -05001545 myvlanid = ntohs(net_our_vlan);
wdenk145d2c12004-04-15 21:48:45 +00001546 if (myvlanid == (ushort)-1)
1547 myvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001548
Luca Ceresoli5c83a962011-05-11 03:59:54 +00001549 return ((myvlanid & VLAN_IDMASK) == VLAN_NONE) ? ETHER_HDR_SIZE :
1550 VLAN_ETHER_HDR_SIZE;
wdenk145d2c12004-04-15 21:48:45 +00001551}
1552
Joe Hershbergera8ca4f62015-04-08 01:41:05 -05001553int net_set_ether(uchar *xet, const uchar *dest_ethaddr, uint prot)
wdenk2d966952002-10-31 22:12:35 +00001554{
Joe Hershberger1178f412012-05-23 07:58:06 +00001555 struct ethernet_hdr *et = (struct ethernet_hdr *)xet;
wdenk145d2c12004-04-15 21:48:45 +00001556 ushort myvlanid;
1557
Joe Hershberger013d3872015-04-08 01:41:17 -05001558 myvlanid = ntohs(net_our_vlan);
wdenk145d2c12004-04-15 21:48:45 +00001559 if (myvlanid == (ushort)-1)
1560 myvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001561
Joe Hershberger8ecdbed2015-04-08 01:41:04 -05001562 memcpy(et->et_dest, dest_ethaddr, 6);
1563 memcpy(et->et_src, net_ethaddr, 6);
wdenk145d2c12004-04-15 21:48:45 +00001564 if ((myvlanid & VLAN_IDMASK) == VLAN_NONE) {
Luca Ceresolib19d0b72011-05-04 02:40:46 +00001565 et->et_protlen = htons(prot);
wdenk145d2c12004-04-15 21:48:45 +00001566 return ETHER_HDR_SIZE;
1567 } else {
Joe Hershbergerb43784c2012-05-23 07:58:07 +00001568 struct vlan_ethernet_hdr *vet =
1569 (struct vlan_ethernet_hdr *)xet;
wdenk2d966952002-10-31 22:12:35 +00001570
wdenk145d2c12004-04-15 21:48:45 +00001571 vet->vet_vlan_type = htons(PROT_VLAN);
1572 vet->vet_tag = htons((0 << 5) | (myvlanid & VLAN_IDMASK));
1573 vet->vet_type = htons(prot);
1574 return VLAN_ETHER_HDR_SIZE;
1575 }
1576}
wdenk2d966952002-10-31 22:12:35 +00001577
Joe Hershberger530cd6b2012-05-23 07:59:16 +00001578int net_update_ether(struct ethernet_hdr *et, uchar *addr, uint prot)
1579{
1580 ushort protlen;
1581
1582 memcpy(et->et_dest, addr, 6);
Joe Hershberger8ecdbed2015-04-08 01:41:04 -05001583 memcpy(et->et_src, net_ethaddr, 6);
Joe Hershberger530cd6b2012-05-23 07:59:16 +00001584 protlen = ntohs(et->et_protlen);
1585 if (protlen == PROT_VLAN) {
1586 struct vlan_ethernet_hdr *vet =
1587 (struct vlan_ethernet_hdr *)et;
1588 vet->vet_type = htons(prot);
1589 return VLAN_ETHER_HDR_SIZE;
1590 } else if (protlen > 1514) {
1591 et->et_protlen = htons(prot);
1592 return ETHER_HDR_SIZE;
1593 } else {
1594 /* 802.2 + SNAP */
1595 struct e802_hdr *et802 = (struct e802_hdr *)et;
1596 et802->et_prot = htons(prot);
1597 return E802_HDR_SIZE;
1598 }
1599}
1600
Duncan Haref1447c92018-06-24 15:40:41 -07001601void net_set_ip_header(uchar *pkt, struct in_addr dest, struct in_addr source,
1602 u16 pkt_len, u8 proto)
wdenk2d966952002-10-31 22:12:35 +00001603{
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001604 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
wdenk2d966952002-10-31 22:12:35 +00001605
1606 /*
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001607 * Construct an IP header.
wdenk2d966952002-10-31 22:12:35 +00001608 */
Luca Ceresoli5c83a962011-05-11 03:59:54 +00001609 /* IP_HDR_SIZE / 4 (not including UDP) */
1610 ip->ip_hl_v = 0x45;
wdenk2d966952002-10-31 22:12:35 +00001611 ip->ip_tos = 0;
Duncan Haref1447c92018-06-24 15:40:41 -07001612 ip->ip_len = htons(pkt_len);
1613 ip->ip_p = proto;
Joe Hershbergerc80b41b02015-04-08 01:41:21 -05001614 ip->ip_id = htons(net_ip_id++);
Peter Tyser0885bf02008-12-01 16:26:20 -06001615 ip->ip_off = htons(IP_FLAGS_DFRAG); /* Don't fragment */
wdenk2d966952002-10-31 22:12:35 +00001616 ip->ip_ttl = 255;
wdenk2d966952002-10-31 22:12:35 +00001617 ip->ip_sum = 0;
Luca Ceresoli5c83a962011-05-11 03:59:54 +00001618 /* already in network byte order */
Joe Hershberger5874dec2015-04-08 01:41:01 -05001619 net_copy_ip((void *)&ip->ip_src, &source);
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001620 /* already in network byte order */
Joe Hershberger5874dec2015-04-08 01:41:01 -05001621 net_copy_ip((void *)&ip->ip_dst, &dest);
Duncan Haref1447c92018-06-24 15:40:41 -07001622
1623 ip->ip_sum = compute_ip_checksum(ip, IP_HDR_SIZE);
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001624}
1625
Joe Hershberger5874dec2015-04-08 01:41:01 -05001626void net_set_udp_header(uchar *pkt, struct in_addr dest, int dport, int sport,
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001627 int len)
1628{
1629 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
1630
1631 /*
1632 * If the data is an odd number of bytes, zero the
1633 * byte after the last byte so that the checksum
1634 * will work.
1635 */
1636 if (len & 1)
1637 pkt[IP_UDP_HDR_SIZE + len] = 0;
1638
Duncan Haref1447c92018-06-24 15:40:41 -07001639 net_set_ip_header(pkt, dest, net_ip, IP_UDP_HDR_SIZE + len,
1640 IPPROTO_UDP);
Joe Hershberger2ed5b492012-05-23 07:59:07 +00001641
wdenk2d966952002-10-31 22:12:35 +00001642 ip->udp_src = htons(sport);
1643 ip->udp_dst = htons(dport);
Joe Hershberger6fe8b452012-05-23 07:58:04 +00001644 ip->udp_len = htons(UDP_HDR_SIZE + len);
wdenk2d966952002-10-31 22:12:35 +00001645 ip->udp_xsum = 0;
wdenk2d966952002-10-31 22:12:35 +00001646}
1647
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001648void copy_filename(char *dst, const char *src, int size)
wdenk2d966952002-10-31 22:12:35 +00001649{
Joe Hershbergere20cadd2018-07-03 19:36:41 -05001650 if (src && *src && (*src == '"')) {
wdenk2d966952002-10-31 22:12:35 +00001651 ++src;
1652 --size;
1653 }
1654
Joe Hershbergere20cadd2018-07-03 19:36:41 -05001655 while ((--size > 0) && src && *src && (*src != '"'))
wdenk2d966952002-10-31 22:12:35 +00001656 *dst++ = *src++;
wdenk2d966952002-10-31 22:12:35 +00001657 *dst = '\0';
1658}
1659
Joe Hershbergerf559f1c2018-07-03 19:36:39 -05001660int is_serverip_in_cmd(void)
1661{
1662 return !!strchr(net_boot_file_name, ':');
1663}
1664
Joe Hershberger9cb7b022018-07-03 19:36:43 -05001665int net_parse_bootfile(struct in_addr *ipaddr, char *filename, int max_len)
1666{
1667 char *colon;
Lyle Franklinc1fad502022-04-16 11:36:43 -04001668 struct in_addr ip;
1669 ip.s_addr = 0;
Joe Hershberger9cb7b022018-07-03 19:36:43 -05001670
1671 if (net_boot_file_name[0] == '\0')
1672 return 0;
1673
1674 colon = strchr(net_boot_file_name, ':');
1675 if (colon) {
Lyle Franklinc1fad502022-04-16 11:36:43 -04001676 ip = string_to_ip(net_boot_file_name);
1677 if (ipaddr && ip.s_addr)
1678 *ipaddr = ip;
1679 }
1680 if (ip.s_addr) {
Joe Hershberger9cb7b022018-07-03 19:36:43 -05001681 strncpy(filename, colon + 1, max_len);
1682 } else {
1683 strncpy(filename, net_boot_file_name, max_len);
1684 }
1685 filename[max_len - 1] = '\0';
1686
1687 return 1;
1688}
1689
Joe Hershberger5874dec2015-04-08 01:41:01 -05001690void ip_to_string(struct in_addr x, char *s)
wdenk2d966952002-10-31 22:12:35 +00001691{
Joe Hershberger5874dec2015-04-08 01:41:01 -05001692 x.s_addr = ntohl(x.s_addr);
Luca Ceresoli7cbd7482011-05-11 03:59:56 +00001693 sprintf(s, "%d.%d.%d.%d",
Joe Hershberger5874dec2015-04-08 01:41:01 -05001694 (int) ((x.s_addr >> 24) & 0xff),
1695 (int) ((x.s_addr >> 16) & 0xff),
1696 (int) ((x.s_addr >> 8) & 0xff),
1697 (int) ((x.s_addr >> 0) & 0xff)
wdenk05939202004-04-18 17:39:38 +00001698 );
wdenk2d966952002-10-31 22:12:35 +00001699}
1700
Joe Hershberger013d3872015-04-08 01:41:17 -05001701void vlan_to_string(ushort x, char *s)
wdenk145d2c12004-04-15 21:48:45 +00001702{
1703 x = ntohs(x);
1704
1705 if (x == (ushort)-1)
1706 x = VLAN_NONE;
1707
1708 if (x == VLAN_NONE)
1709 strcpy(s, "none");
1710 else
1711 sprintf(s, "%d", x & VLAN_IDMASK);
1712}
1713
Joe Hershberger013d3872015-04-08 01:41:17 -05001714ushort string_to_vlan(const char *s)
wdenk145d2c12004-04-15 21:48:45 +00001715{
1716 ushort id;
1717
1718 if (s == NULL)
wdenk656140b2004-04-25 13:18:40 +00001719 return htons(VLAN_NONE);
wdenk145d2c12004-04-15 21:48:45 +00001720
1721 if (*s < '0' || *s > '9')
1722 id = VLAN_NONE;
1723 else
Simon Glassff9b9032021-07-24 09:03:30 -06001724 id = (ushort)dectoul(s, NULL);
wdenk145d2c12004-04-15 21:48:45 +00001725
wdenk656140b2004-04-25 13:18:40 +00001726 return htons(id);
wdenk145d2c12004-04-15 21:48:45 +00001727}
1728
Simon Glassda1a1342017-08-03 12:22:15 -06001729ushort env_get_vlan(char *var)
wdenk145d2c12004-04-15 21:48:45 +00001730{
Simon Glass64b723f2017-08-03 12:22:12 -06001731 return string_to_vlan(env_get(var));
wdenk145d2c12004-04-15 21:48:45 +00001732}