blob: 087d399a24bab0b2200aaf030cbd42992aa44373 [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 *
75 * SNTP:
76 *
Wolfgang Denkb2f50802005-08-12 23:43:12 +020077 * Prerequisites: - own ethernet address
wdenkea287de2005-04-01 00:25:43 +000078 * - own IP address
79 * We want: - network time
80 * Next step: none
Lothar Feltend8970da2018-06-22 22:29:54 +020081 *
82 * WOL:
83 *
84 * Prerequisites: - own ethernet address
85 * We want: - magic packet or timeout
86 * Next step: none
wdenk2d966952002-10-31 22:12:35 +000087 */
88
89
90#include <common.h>
wdenk2d966952002-10-31 22:12:35 +000091#include <command.h>
Simon Glass24b852a2015-11-08 23:47:45 -070092#include <console.h>
Simon Glassc7694dd2019-08-01 09:46:46 -060093#include <env.h>
Simon Glassf3998fd2019-08-02 09:44:25 -060094#include <env_internal.h>
Joe Hershberger60304592015-03-22 17:09:24 -050095#include <errno.h>
Simon Glass8e8ccfe2019-12-28 10:45:03 -070096#include <image.h>
wdenk2d966952002-10-31 22:12:35 +000097#include <net.h>
Alex Kiernanf73a7df2018-05-29 15:30:53 +000098#include <net/fastboot.h>
Lukasz Majewski34696952015-08-24 00:21:43 +020099#include <net/tftp.h>
Ramon Fried3eaac632019-07-18 21:43:30 +0300100#if defined(CONFIG_CMD_PCAP)
101#include <net/pcap.h>
102#endif
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200103#if defined(CONFIG_LED_STATUS)
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000104#include <miiphy.h>
105#include <status_led.h>
106#endif
107#include <watchdog.h>
108#include <linux/compiler.h>
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000109#include "arp.h"
wdenk2d966952002-10-31 22:12:35 +0000110#include "bootp.h"
Joe Hershbergerf575ae12012-05-23 07:57:59 +0000111#include "cdp.h"
Robin Getz1a32bf42009-07-20 14:53:54 -0400112#if defined(CONFIG_CMD_DNS)
113#include "dns.h"
114#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +0000115#include "link_local.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000116#include "nfs.h"
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000117#include "ping.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000118#include "rarp.h"
119#if defined(CONFIG_CMD_SNTP)
120#include "sntp.h"
121#endif
Lothar Feltend8970da2018-06-22 22:29:54 +0200122#if defined(CONFIG_CMD_WOL)
123#include "wol.h"
124#endif
wdenk2d966952002-10-31 22:12:35 +0000125
wdenk2d966952002-10-31 22:12:35 +0000126/** BOOTP EXTENTIONS **/
127
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000128/* Our subnet mask (0=unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500129struct in_addr net_netmask;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000130/* Our gateways IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500131struct in_addr net_gateway;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000132/* Our DNS IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500133struct in_addr net_dns_server;
Jon Loeliger1fe80d72007-07-09 22:08:34 -0500134#if defined(CONFIG_BOOTP_DNS2)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000135/* Our 2nd DNS IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500136struct in_addr net_dns_server2;
stroesefe389a82003-08-28 14:17:32 +0000137#endif
wdenk2d966952002-10-31 22:12:35 +0000138
139/** END OF BOOTP EXTENTIONS **/
140
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000141/* Our ethernet address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500142u8 net_ethaddr[6];
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000143/* Boot server enet address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500144u8 net_server_ethaddr[6];
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000145/* Our IP addr (0 = unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500146struct in_addr net_ip;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000147/* Server IP addr (0 = unknown) */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500148struct in_addr net_server_ip;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000149/* Current receive packet */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500150uchar *net_rx_packet;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000151/* Current rx packet length */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500152int net_rx_packet_len;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000153/* IP packet ID */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500154static unsigned net_ip_id;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000155/* Ethernet bcast address */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500156const u8 net_bcast_ethaddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
157const u8 net_null_ethaddr[6];
Alexander Graf0efe1bc2016-05-06 21:01:01 +0200158#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500159void (*push_packet)(void *, int len) = 0;
Rafal Jaworowskif85b6072007-12-27 18:19:02 +0100160#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000161/* Network loop state */
Joe Hershberger22f6e992012-05-23 07:59:14 +0000162enum net_loop_state net_state;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000163/* Tried all network devices */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500164int net_restart_wrap;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000165/* Network loop restarted */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500166static int net_restarted;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000167/* At least one device configured */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500168static int net_dev_exists;
wdenk2d966952002-10-31 22:12:35 +0000169
wdenk6e592382004-04-18 17:39:38 +0000170/* XXX in both little & big endian machines 0xFFFF == ntohs(-1) */
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000171/* default is without VLAN */
Joe Hershberger4fd50552015-04-08 01:41:17 -0500172ushort net_our_vlan = 0xFFFF;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000173/* ditto */
Joe Hershberger4fd50552015-04-08 01:41:17 -0500174ushort net_native_vlan = 0xFFFF;
wdenka3d991b2004-04-15 21:48:45 +0000175
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000176/* Boot File name */
Jacob Stiffler11a69ff2015-09-30 10:12:05 -0400177char net_boot_file_name[1024];
Alexander Graf449312c2018-06-15 10:29:27 +0200178/* Indicates whether the file name was specified on the command line */
179bool net_boot_file_name_explicit;
Joe Hershberger14111572015-04-08 01:41:02 -0500180/* The actual transferred size of the bootfile (in bytes) */
181u32 net_boot_file_size;
182/* Boot file size in blocks as reported by the DHCP server */
183u32 net_boot_file_expected_size_in_blocks;
wdenk2d966952002-10-31 22:12:35 +0000184
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500185#if defined(CONFIG_CMD_SNTP)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000186/* NTP server IP address */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500187struct in_addr net_ntp_server;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000188/* offset time from UTC */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500189int net_ntp_time_offset;
wdenkea287de2005-04-01 00:25:43 +0000190#endif
191
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500192static uchar net_pkt_buf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];
Joe Hershberger2a504df2015-03-22 17:09:11 -0500193/* Receive packets */
194uchar *net_rx_packets[PKTBUFSRX];
Joe Hershbergerece223b2012-05-23 07:59:15 +0000195/* Current UDP RX packet handler */
196static rxhand_f *udp_packet_handler;
197/* Current ARP RX packet handler */
198static rxhand_f *arp_packet_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000199#ifdef CONFIG_CMD_TFTPPUT
Joe Hershbergerece223b2012-05-23 07:59:15 +0000200/* Current ICMP rx handler */
201static rxhand_icmp_f *packet_icmp_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000202#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000203/* Current timeout handler */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500204static thand_f *time_handler;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000205/* Time base value */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500206static ulong time_start;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000207/* Current timeout value */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500208static ulong time_delta;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000209/* THE transmit packet */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500210uchar *net_tx_packet;
wdenk2d966952002-10-31 22:12:35 +0000211
Simon Glasse4bf0c52011-10-24 18:00:02 +0000212static int net_check_prereq(enum proto_t protocol);
wdenk2d966952002-10-31 22:12:35 +0000213
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500214static int net_try_count;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100215
Jim Linb63056d2013-08-13 19:03:05 +0800216int __maybe_unused net_busy_flag;
217
wdenk2d966952002-10-31 22:12:35 +0000218/**********************************************************************/
wdenk73a8b272003-06-05 19:27:42 +0000219
Joe Hershbergerfd305632015-05-20 14:27:23 -0500220static int on_ipaddr(const char *name, const char *value, enum env_op op,
221 int flags)
222{
223 if (flags & H_PROGRAMMATIC)
224 return 0;
225
226 net_ip = string_to_ip(value);
227
228 return 0;
229}
230U_BOOT_ENV_CALLBACK(ipaddr, on_ipaddr);
231
232static int on_gatewayip(const char *name, const char *value, enum env_op op,
233 int flags)
234{
235 if (flags & H_PROGRAMMATIC)
236 return 0;
237
238 net_gateway = string_to_ip(value);
239
240 return 0;
241}
242U_BOOT_ENV_CALLBACK(gatewayip, on_gatewayip);
243
244static int on_netmask(const char *name, const char *value, enum env_op op,
245 int flags)
246{
247 if (flags & H_PROGRAMMATIC)
248 return 0;
249
250 net_netmask = string_to_ip(value);
251
252 return 0;
253}
254U_BOOT_ENV_CALLBACK(netmask, on_netmask);
255
256static int on_serverip(const char *name, const char *value, enum env_op op,
257 int flags)
258{
259 if (flags & H_PROGRAMMATIC)
260 return 0;
261
262 net_server_ip = string_to_ip(value);
263
264 return 0;
265}
266U_BOOT_ENV_CALLBACK(serverip, on_serverip);
267
268static int on_nvlan(const char *name, const char *value, enum env_op op,
269 int flags)
270{
271 if (flags & H_PROGRAMMATIC)
272 return 0;
273
274 net_native_vlan = string_to_vlan(value);
275
276 return 0;
277}
278U_BOOT_ENV_CALLBACK(nvlan, on_nvlan);
279
280static int on_vlan(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_our_vlan = string_to_vlan(value);
287
288 return 0;
289}
290U_BOOT_ENV_CALLBACK(vlan, on_vlan);
291
292#if defined(CONFIG_CMD_DNS)
293static int on_dnsip(const char *name, const char *value, enum env_op op,
294 int flags)
295{
296 if (flags & H_PROGRAMMATIC)
297 return 0;
298
299 net_dns_server = string_to_ip(value);
300
301 return 0;
302}
303U_BOOT_ENV_CALLBACK(dnsip, on_dnsip);
304#endif
305
Simon Glasse4a3d572011-10-27 06:24:32 +0000306/*
307 * Check if autoload is enabled. If so, use either NFS or TFTP to download
308 * the boot file.
309 */
310void net_auto_load(void)
311{
Tom Rinia6ab4b52019-12-05 19:35:07 -0500312#if defined(CONFIG_CMD_NFS) && !defined(CONFIG_SPL_BUILD)
Simon Glass00caae62017-08-03 12:22:12 -0600313 const char *s = env_get("autoload");
Simon Glasse4a3d572011-10-27 06:24:32 +0000314
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600315 if (s != NULL && strcmp(s, "NFS") == 0) {
Joe Hershberger3855cad2018-07-03 19:36:40 -0500316 if (net_check_prereq(NFS)) {
317/* We aren't expecting to get a serverip, so just accept the assigned IP */
318#ifdef CONFIG_BOOTP_SERVERIP
319 net_set_state(NETLOOP_SUCCESS);
320#else
321 printf("Cannot autoload with NFS\n");
322 net_set_state(NETLOOP_FAIL);
323#endif
324 return;
325 }
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600326 /*
327 * Use NFS to load the bootfile.
328 */
Joe Hershberger68c76a32015-04-08 01:41:10 -0500329 nfs_start();
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600330 return;
331 }
Simon Glasse4a3d572011-10-27 06:24:32 +0000332#endif
Simon Glassbfebc8c2017-08-03 12:22:13 -0600333 if (env_get_yesno("autoload") == 0) {
Joe Hershbergerec8a2522012-12-11 22:16:22 -0600334 /*
335 * Just use BOOTP/RARP to configure system;
336 * Do not use TFTP to load the bootfile.
337 */
338 net_set_state(NETLOOP_SUCCESS);
339 return;
Simon Glasse4a3d572011-10-27 06:24:32 +0000340 }
Joe Hershberger3855cad2018-07-03 19:36:40 -0500341 if (net_check_prereq(TFTPGET)) {
342/* We aren't expecting to get a serverip, so just accept the assigned IP */
343#ifdef CONFIG_BOOTP_SERVERIP
344 net_set_state(NETLOOP_SUCCESS);
345#else
346 printf("Cannot autoload with TFTPGET\n");
347 net_set_state(NETLOOP_FAIL);
348#endif
349 return;
350 }
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500351 tftp_start(TFTPGET);
Simon Glasse4a3d572011-10-27 06:24:32 +0000352}
353
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500354static void net_init_loop(void)
Heiko Schocher2f70c492009-02-10 09:38:52 +0100355{
Jim Lin7315cfd2013-05-17 17:41:03 +0800356 if (eth_get_dev())
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500357 memcpy(net_ethaddr, eth_get_ethaddr(), 6);
Michael Zaidman3c172c42009-04-04 01:43:00 +0300358
Heiko Schocherda954272009-04-28 08:36:11 +0200359 return;
Heiko Schocher2f70c492009-02-10 09:38:52 +0100360}
361
Joe Hershbergerece223b2012-05-23 07:59:15 +0000362static void net_clear_handlers(void)
363{
364 net_set_udp_handler(NULL);
365 net_set_arp_handler(NULL);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500366 net_set_timeout_handler(0, NULL);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000367}
368
369static void net_cleanup_loop(void)
370{
371 net_clear_handlers();
372}
373
Joe Hershberger46c495d2012-05-23 07:59:22 +0000374void net_init(void)
375{
376 static int first_call = 1;
377
378 if (first_call) {
379 /*
380 * Setup packet buffers, aligned correctly.
381 */
382 int i;
383
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500384 net_tx_packet = &net_pkt_buf[0] + (PKTALIGN - 1);
385 net_tx_packet -= (ulong)net_tx_packet % PKTALIGN;
Joe Hershberger2a504df2015-03-22 17:09:11 -0500386 for (i = 0; i < PKTBUFSRX; i++) {
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500387 net_rx_packets[i] = net_tx_packet +
388 (i + 1) * PKTSIZE_ALIGN;
Joe Hershberger2a504df2015-03-22 17:09:11 -0500389 }
Joe Hershberger85d25e02015-04-08 01:41:08 -0500390 arp_init();
Joe Hershberger46c495d2012-05-23 07:59:22 +0000391 net_clear_handlers();
392
393 /* Only need to setup buffer pointers once. */
394 first_call = 0;
395 }
396
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500397 net_init_loop();
Joe Hershberger46c495d2012-05-23 07:59:22 +0000398}
399
wdenk73a8b272003-06-05 19:27:42 +0000400/**********************************************************************/
wdenk2d966952002-10-31 22:12:35 +0000401/*
402 * Main network processing loop.
403 */
404
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500405int net_loop(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +0000406{
Joe Hershberger60304592015-03-22 17:09:24 -0500407 int ret = -EINVAL;
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200408 enum net_loop_state prev_net_state = net_state;
wdenk2d966952002-10-31 22:12:35 +0000409
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500410 net_restarted = 0;
411 net_dev_exists = 0;
412 net_try_count = 1;
413 debug_cond(DEBUG_INT_STATE, "--- net_loop Entry\n");
wdenk73a8b272003-06-05 19:27:42 +0000414
Simon Glass573f14f2011-12-10 11:08:06 +0000415 bootstage_mark_name(BOOTSTAGE_ID_ETH_START, "eth_start");
Joe Hershberger46c495d2012-05-23 07:59:22 +0000416 net_init();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000417 if (eth_is_on_demand_init() || protocol != NETCONS) {
wdenkb1bf6f22005-04-03 14:52:59 +0000418 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000419 eth_set_current();
Joe Hershberger60304592015-03-22 17:09:24 -0500420 ret = eth_init();
421 if (ret < 0) {
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000422 eth_halt();
Joe Hershberger60304592015-03-22 17:09:24 -0500423 return ret;
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000424 }
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500425 } else {
Joe Hershbergerd2eaec62015-03-22 17:09:06 -0500426 eth_init_state_only();
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500427 }
wdenk2d966952002-10-31 22:12:35 +0000428restart:
Jim Linb63056d2013-08-13 19:03:05 +0800429#ifdef CONFIG_USB_KEYBOARD
430 net_busy_flag = 0;
431#endif
Joe Hershberger22f6e992012-05-23 07:59:14 +0000432 net_set_state(NETLOOP_CONTINUE);
wdenk2d966952002-10-31 22:12:35 +0000433
434 /*
435 * Start the ball rolling with the given start function. From
436 * here on, this code is a state machine driven by received
437 * packets and timer events.
438 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500439 debug_cond(DEBUG_INT_STATE, "--- net_loop Init\n");
440 net_init_loop();
wdenk2d966952002-10-31 22:12:35 +0000441
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000442 switch (net_check_prereq(protocol)) {
wdenk2d966952002-10-31 22:12:35 +0000443 case 1:
444 /* network not configured */
wdenkb1bf6f22005-04-03 14:52:59 +0000445 eth_halt();
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200446 net_set_state(prev_net_state);
Joe Hershberger60304592015-03-22 17:09:24 -0500447 return -ENODEV;
wdenk2d966952002-10-31 22:12:35 +0000448
wdenk2d966952002-10-31 22:12:35 +0000449 case 2:
450 /* network device not configured */
451 break;
wdenk2d966952002-10-31 22:12:35 +0000452
453 case 0:
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500454 net_dev_exists = 1;
Joe Hershberger14111572015-04-08 01:41:02 -0500455 net_boot_file_size = 0;
wdenk2d966952002-10-31 22:12:35 +0000456 switch (protocol) {
Simon Glasse4bf0c52011-10-24 18:00:02 +0000457 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +0000458#ifdef CONFIG_CMD_TFTPPUT
459 case TFTPPUT:
460#endif
wdenk2d966952002-10-31 22:12:35 +0000461 /* always use ARP to get server ethernet address */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500462 tftp_start(protocol);
wdenk2d966952002-10-31 22:12:35 +0000463 break;
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
wdenk2d966952002-10-31 22:12:35 +0000481
482 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;
487
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
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500515#if defined(CONFIG_CMD_SNTP)
wdenkea287de2005-04-01 00:25:43 +0000516 case SNTP:
Joe Hershberger38ba2552015-04-08 01:41:12 -0500517 sntp_start();
wdenkea287de2005-04-01 00:25:43 +0000518 break;
519#endif
Robin Getz1a32bf42009-07-20 14:53:54 -0400520#if defined(CONFIG_CMD_DNS)
521 case DNS:
Joe Hershberger786eac52015-04-08 01:41:15 -0500522 dns_start();
Robin Getz1a32bf42009-07-20 14:53:54 -0400523 break;
524#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +0000525#if defined(CONFIG_CMD_LINK_LOCAL)
526 case LINKLOCAL:
527 link_local_start();
528 break;
529#endif
Lothar Feltend8970da2018-06-22 22:29:54 +0200530#if defined(CONFIG_CMD_WOL)
531 case WOL:
532 wol_start();
533 break;
534#endif
wdenk2d966952002-10-31 22:12:35 +0000535 default:
536 break;
537 }
538
wdenk2d966952002-10-31 22:12:35 +0000539 break;
540 }
541
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500542#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000543#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200544 defined(CONFIG_LED_STATUS) && \
545 defined(CONFIG_LED_STATUS_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000546 /*
wdenk42d1f032003-10-15 23:53:47 +0000547 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000548 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000549 if (miiphy_link(eth_get_dev()->name, CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200550 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_OFF);
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000551 else
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200552 status_led_set(CONFIG_LED_STATUS_RED, CONFIG_LED_STATUS_ON);
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200553#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000554#endif /* CONFIG_MII, ... */
Jim Linb63056d2013-08-13 19:03:05 +0800555#ifdef CONFIG_USB_KEYBOARD
556 net_busy_flag = 1;
557#endif
wdenk2d966952002-10-31 22:12:35 +0000558
559 /*
560 * Main packet reception loop. Loop receiving packets until
Joe Hershberger22f6e992012-05-23 07:59:14 +0000561 * someone sets `net_state' to a state that terminates.
wdenk2d966952002-10-31 22:12:35 +0000562 */
563 for (;;) {
564 WATCHDOG_RESET();
Joe Hershbergerc5a75332015-12-21 16:31:35 -0600565 if (arp_timeout_check() > 0)
566 time_start = get_timer(0);
567
wdenk2d966952002-10-31 22:12:35 +0000568 /*
569 * Check the ethernet for a new packet. The ethernet
570 * receive routine will process it.
Joe Hershberger60304592015-03-22 17:09:24 -0500571 * Most drivers return the most recent packet size, but not
572 * errors that may have happened.
wdenk2d966952002-10-31 22:12:35 +0000573 */
Guennadi Liakhovetski40cb90e2008-04-03 17:04:19 +0200574 eth_rx();
wdenk2d966952002-10-31 22:12:35 +0000575
576 /*
577 * Abort if ctrl-c was pressed.
578 */
579 if (ctrlc()) {
Joe Hershbergere94070c2012-05-23 07:59:24 +0000580 /* cancel any ARP that may not have completed */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500581 net_arp_wait_packet_ip.s_addr = 0;
Joe Hershbergere94070c2012-05-23 07:59:24 +0000582
Joe Hershbergerece223b2012-05-23 07:59:15 +0000583 net_cleanup_loop();
wdenk8bde7f72003-06-27 21:31:46 +0000584 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000585 /* Invalidate the last protocol */
586 eth_set_last_protocol(BOOTP);
587
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000588 puts("\nAbort\n");
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000589 /* include a debug print as well incase the debug
590 messages are directed to stderr */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500591 debug_cond(DEBUG_INT_STATE, "--- net_loop Abort!\n");
Michal Simek19a4fba2015-08-21 08:49:48 +0200592 ret = -EINTR;
Simon Glass4793ee62011-10-24 18:00:01 +0000593 goto done;
wdenk2d966952002-10-31 22:12:35 +0000594 }
595
wdenk2d966952002-10-31 22:12:35 +0000596 /*
597 * Check for a timeout, and run the timeout handler
598 * if we have one.
599 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500600 if (time_handler &&
601 ((get_timer(0) - time_start) > time_delta)) {
wdenk2d966952002-10-31 22:12:35 +0000602 thand_f *x;
603
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500604#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000605#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200606 defined(CONFIG_LED_STATUS) && \
607 defined(CONFIG_LED_STATUS_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000608 /*
wdenk42d1f032003-10-15 23:53:47 +0000609 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000610 */
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000611 if (miiphy_link(eth_get_dev()->name,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500612 CONFIG_SYS_FAULT_MII_ADDR))
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200613 status_led_set(CONFIG_LED_STATUS_RED,
614 CONFIG_LED_STATUS_OFF);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500615 else
Uri Mashiach2d8d1902017-01-19 10:51:45 +0200616 status_led_set(CONFIG_LED_STATUS_RED,
617 CONFIG_LED_STATUS_ON);
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000618#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000619#endif /* CONFIG_MII, ... */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500620 debug_cond(DEBUG_INT_STATE, "--- net_loop timeout\n");
621 x = time_handler;
622 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000623 (*x)();
624 }
625
Joe Hershberger5c421332015-03-22 17:09:07 -0500626 if (net_state == NETLOOP_FAIL)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500627 ret = net_start_again();
wdenk2d966952002-10-31 22:12:35 +0000628
Joe Hershberger22f6e992012-05-23 07:59:14 +0000629 switch (net_state) {
wdenk2d966952002-10-31 22:12:35 +0000630 case NETLOOP_RESTART:
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500631 net_restarted = 1;
wdenk2d966952002-10-31 22:12:35 +0000632 goto restart;
633
634 case NETLOOP_SUCCESS:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000635 net_cleanup_loop();
Joe Hershberger14111572015-04-08 01:41:02 -0500636 if (net_boot_file_size > 0) {
637 printf("Bytes transferred = %d (%x hex)\n",
638 net_boot_file_size, net_boot_file_size);
Simon Glass018f5302017-08-03 12:22:10 -0600639 env_set_hex("filesize", net_boot_file_size);
Simon Glassbb872dd2019-12-28 10:45:02 -0700640 env_set_hex("fileaddr", image_load_addr);
wdenk2d966952002-10-31 22:12:35 +0000641 }
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000642 if (protocol != NETCONS)
643 eth_halt();
644 else
645 eth_halt_state_only();
646
647 eth_set_last_protocol(protocol);
648
Joe Hershberger14111572015-04-08 01:41:02 -0500649 ret = net_boot_file_size;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500650 debug_cond(DEBUG_INT_STATE, "--- net_loop Success!\n");
Simon Glass4793ee62011-10-24 18:00:01 +0000651 goto done;
wdenk2d966952002-10-31 22:12:35 +0000652
653 case NETLOOP_FAIL:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000654 net_cleanup_loop();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000655 /* Invalidate the last protocol */
656 eth_set_last_protocol(BOOTP);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500657 debug_cond(DEBUG_INT_STATE, "--- net_loop Fail!\n");
Thomas RIENOESSLa735e6e2018-11-21 15:56:07 +0100658 ret = -ENONET;
Simon Glass4793ee62011-10-24 18:00:01 +0000659 goto done;
Joe Hershberger22f6e992012-05-23 07:59:14 +0000660
661 case NETLOOP_CONTINUE:
662 continue;
wdenk2d966952002-10-31 22:12:35 +0000663 }
664 }
Simon Glass4793ee62011-10-24 18:00:01 +0000665
666done:
Jim Linb63056d2013-08-13 19:03:05 +0800667#ifdef CONFIG_USB_KEYBOARD
668 net_busy_flag = 0;
669#endif
Simon Glass39bccd22011-10-26 14:18:38 +0000670#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000671 /* Clear out the handlers */
Joe Hershbergerece223b2012-05-23 07:59:15 +0000672 net_set_udp_handler(NULL);
Simon Glass4793ee62011-10-24 18:00:01 +0000673 net_set_icmp_handler(NULL);
Simon Glass39bccd22011-10-26 14:18:38 +0000674#endif
Leonid Iziumtsev60177b22018-05-08 15:55:50 +0200675 net_set_state(prev_net_state);
Ramon Fried3eaac632019-07-18 21:43:30 +0300676
677#if defined(CONFIG_CMD_PCAP)
678 if (pcap_active())
679 pcap_print_status();
680#endif
Simon Glass4793ee62011-10-24 18:00:01 +0000681 return ret;
wdenk2d966952002-10-31 22:12:35 +0000682}
683
684/**********************************************************************/
685
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500686static void start_again_timeout_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000687{
Joe Hershberger22f6e992012-05-23 07:59:14 +0000688 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000689}
690
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500691int net_start_again(void)
wdenk2d966952002-10-31 22:12:35 +0000692{
wdenk6e592382004-04-18 17:39:38 +0000693 char *nretry;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100694 int retry_forever = 0;
695 unsigned long retrycnt = 0;
Joe Hershberger60304592015-03-22 17:09:24 -0500696 int ret;
wdenka3d991b2004-04-15 21:48:45 +0000697
Simon Glass00caae62017-08-03 12:22:12 -0600698 nretry = env_get("netretry");
Remy Bohmer67b96e82009-10-28 22:13:39 +0100699 if (nretry) {
700 if (!strcmp(nretry, "yes"))
701 retry_forever = 1;
702 else if (!strcmp(nretry, "no"))
703 retrycnt = 0;
704 else if (!strcmp(nretry, "once"))
705 retrycnt = 1;
706 else
707 retrycnt = simple_strtoul(nretry, NULL, 0);
Joe Hershberger5c421332015-03-22 17:09:07 -0500708 } else {
709 retrycnt = 0;
710 retry_forever = 0;
711 }
Remy Bohmer67b96e82009-10-28 22:13:39 +0100712
Leonid Iziumtsev17d413b2018-03-09 15:29:06 +0100713 if ((!retry_forever) && (net_try_count > retrycnt)) {
Remy Bohmer67b96e82009-10-28 22:13:39 +0100714 eth_halt();
Joe Hershberger22f6e992012-05-23 07:59:14 +0000715 net_set_state(NETLOOP_FAIL);
Joe Hershberger60304592015-03-22 17:09:24 -0500716 /*
717 * We don't provide a way for the protocol to return an error,
718 * but this is almost always the reason.
719 */
720 return -ETIMEDOUT;
wdenka3d991b2004-04-15 21:48:45 +0000721 }
Remy Bohmer67b96e82009-10-28 22:13:39 +0100722
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500723 net_try_count++;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100724
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000725 eth_halt();
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100726#if !defined(CONFIG_NET_DO_NOT_TRY_ANOTHER)
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500727 eth_try_another(!net_restarted);
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100728#endif
Joe Hershberger60304592015-03-22 17:09:24 -0500729 ret = eth_init();
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500730 if (net_restart_wrap) {
731 net_restart_wrap = 0;
732 if (net_dev_exists) {
733 net_set_timeout_handler(10000UL,
734 start_again_timeout_handler);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000735 net_set_udp_handler(NULL);
wdenk6e592382004-04-18 17:39:38 +0000736 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000737 net_set_state(NETLOOP_FAIL);
wdenk2d966952002-10-31 22:12:35 +0000738 }
wdenk6e592382004-04-18 17:39:38 +0000739 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000740 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000741 }
Joe Hershberger60304592015-03-22 17:09:24 -0500742 return ret;
wdenk2d966952002-10-31 22:12:35 +0000743}
744
745/**********************************************************************/
746/*
747 * Miscelaneous bits.
748 */
749
Joe Hershbergerece223b2012-05-23 07:59:15 +0000750static void dummy_handler(uchar *pkt, unsigned dport,
Joe Hershberger049a95a2015-04-08 01:41:01 -0500751 struct in_addr sip, unsigned sport,
Joe Hershbergerece223b2012-05-23 07:59:15 +0000752 unsigned len)
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000753{
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000754}
755
Joe Hershbergerece223b2012-05-23 07:59:15 +0000756rxhand_f *net_get_udp_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000757{
Joe Hershbergerece223b2012-05-23 07:59:15 +0000758 return udp_packet_handler;
759}
760
761void net_set_udp_handler(rxhand_f *f)
762{
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500763 debug_cond(DEBUG_INT_STATE, "--- net_loop UDP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000764 if (f == NULL)
765 udp_packet_handler = dummy_handler;
766 else
767 udp_packet_handler = f;
768}
769
770rxhand_f *net_get_arp_handler(void)
771{
772 return arp_packet_handler;
773}
774
775void net_set_arp_handler(rxhand_f *f)
776{
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500777 debug_cond(DEBUG_INT_STATE, "--- net_loop ARP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000778 if (f == NULL)
779 arp_packet_handler = dummy_handler;
780 else
781 arp_packet_handler = f;
wdenk2d966952002-10-31 22:12:35 +0000782}
783
Simon Glass39bccd22011-10-26 14:18:38 +0000784#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000785void net_set_icmp_handler(rxhand_icmp_f *f)
786{
787 packet_icmp_handler = f;
788}
Simon Glass39bccd22011-10-26 14:18:38 +0000789#endif
wdenk2d966952002-10-31 22:12:35 +0000790
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500791void net_set_timeout_handler(ulong iv, thand_f *f)
wdenk2d966952002-10-31 22:12:35 +0000792{
793 if (iv == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000794 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500795 "--- net_loop timeout handler cancelled\n");
796 time_handler = (thand_f *)0;
wdenk2d966952002-10-31 22:12:35 +0000797 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000798 debug_cond(DEBUG_INT_STATE,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500799 "--- net_loop timeout handler set (%p)\n", f);
800 time_handler = f;
801 time_start = get_timer(0);
802 time_delta = iv * CONFIG_SYS_HZ / 1000;
wdenk2d966952002-10-31 22:12:35 +0000803 }
804}
805
Joe Hershbergerac3f26c2018-09-26 16:49:02 -0500806uchar *net_get_async_tx_pkt_buf(void)
807{
808 if (arp_is_waiting())
809 return arp_tx_packet; /* If we are waiting, we already sent */
810 else
811 return net_tx_packet;
812}
813
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500814int net_send_udp_packet(uchar *ether, struct in_addr dest, int dport, int sport,
Joe Hershberger206d07f2012-05-23 07:58:10 +0000815 int payload_len)
wdenk73a8b272003-06-05 19:27:42 +0000816{
Duncan Hare5d457ec2018-06-24 15:40:41 -0700817 return net_send_ip_packet(ether, dest, dport, sport, payload_len,
818 IPPROTO_UDP, 0, 0, 0);
819}
820
821int net_send_ip_packet(uchar *ether, struct in_addr dest, int dport, int sport,
822 int payload_len, int proto, u8 action, u32 tcp_seq_num,
823 u32 tcp_ack_num)
824{
wdenka3d991b2004-04-15 21:48:45 +0000825 uchar *pkt;
Joe Hershberger92146372012-05-23 07:59:08 +0000826 int eth_hdr_size;
827 int pkt_hdr_size;
wdenka3d991b2004-04-15 21:48:45 +0000828
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500829 /* make sure the net_tx_packet is initialized (net_init() was called) */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500830 assert(net_tx_packet != NULL);
831 if (net_tx_packet == NULL)
Joe Hershberger46c495d2012-05-23 07:59:22 +0000832 return -1;
833
wdenk73a8b272003-06-05 19:27:42 +0000834 /* convert to new style broadcast */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500835 if (dest.s_addr == 0)
836 dest.s_addr = 0xFFFFFFFF;
wdenk2d966952002-10-31 22:12:35 +0000837
wdenk73a8b272003-06-05 19:27:42 +0000838 /* if broadcast, make the ether address a broadcast and don't do ARP */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500839 if (dest.s_addr == 0xFFFFFFFF)
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500840 ether = (uchar *)net_bcast_ethaddr;
wdenk73a8b272003-06-05 19:27:42 +0000841
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500842 pkt = (uchar *)net_tx_packet;
wdenk73a8b272003-06-05 19:27:42 +0000843
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500844 eth_hdr_size = net_set_ether(pkt, ether, PROT_IP);
Duncan Hare5d457ec2018-06-24 15:40:41 -0700845
846 switch (proto) {
847 case IPPROTO_UDP:
848 net_set_udp_header(pkt + eth_hdr_size, dest, dport, sport,
849 payload_len);
850 pkt_hdr_size = eth_hdr_size + IP_UDP_HDR_SIZE;
851 break;
852 default:
853 return -EINVAL;
854 }
Robin Getz0ebf04c2009-07-23 03:01:03 -0400855
Joe Hershbergere94070c2012-05-23 07:59:24 +0000856 /* if MAC address was not discovered yet, do an ARP request */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500857 if (memcmp(ether, net_null_ethaddr, 6) == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000858 debug_cond(DEBUG_DEV_PKT, "sending ARP for %pI4\n", &dest);
Joe Hershberger92146372012-05-23 07:59:08 +0000859
860 /* save the ip and eth addr for the packet to send after arp */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500861 net_arp_wait_packet_ip = dest;
Joe Hershberger85d25e02015-04-08 01:41:08 -0500862 arp_wait_packet_ethaddr = ether;
wdenka3d991b2004-04-15 21:48:45 +0000863
wdenk73a8b272003-06-05 19:27:42 +0000864 /* size of the waiting packet */
Joe Hershberger85d25e02015-04-08 01:41:08 -0500865 arp_wait_tx_packet_size = pkt_hdr_size + payload_len;
wdenk73a8b272003-06-05 19:27:42 +0000866
867 /* and do the ARP request */
Joe Hershberger85d25e02015-04-08 01:41:08 -0500868 arp_wait_try = 1;
869 arp_wait_timer_start = get_timer(0);
870 arp_request();
wdenk73a8b272003-06-05 19:27:42 +0000871 return 1; /* waiting */
Joe Hershberger92146372012-05-23 07:59:08 +0000872 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000873 debug_cond(DEBUG_DEV_PKT, "sending UDP to %pI4/%pM\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500874 &dest, ether);
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500875 net_send_packet(net_tx_packet, pkt_hdr_size + payload_len);
Joe Hershberger92146372012-05-23 07:59:08 +0000876 return 0; /* transmitted */
wdenk73a8b272003-06-05 19:27:42 +0000877 }
wdenk73a8b272003-06-05 19:27:42 +0000878}
879
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200880#ifdef CONFIG_IP_DEFRAG
881/*
882 * This function collects fragments in a single packet, according
883 * to the algorithm in RFC815. It returns NULL or the pointer to
884 * a complete packet, in static storage
885 */
Joe Hershbergeraa7a6482016-08-15 14:42:15 -0500886#define IP_PKTSIZE (CONFIG_NET_MAXDEFRAG)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200887
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000888#define IP_MAXUDP (IP_PKTSIZE - IP_HDR_SIZE)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200889
890/*
891 * this is the packet being assembled, either data or frag control.
892 * Fragments go by 8 bytes, so this union must be 8 bytes long
893 */
894struct hole {
895 /* first_byte is address of this structure */
896 u16 last_byte; /* last byte in this hole + 1 (begin of next hole) */
897 u16 next_hole; /* index of next (in 8-b blocks), 0 == none */
898 u16 prev_hole; /* index of prev, 0 == none */
899 u16 unused;
900};
901
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500902static struct ip_udp_hdr *__net_defragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200903{
Joe Hershberger48522bb2012-05-15 08:59:08 +0000904 static uchar pkt_buff[IP_PKTSIZE] __aligned(PKTALIGN);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200905 static u16 first_hole, total_len;
906 struct hole *payload, *thisfrag, *h, *newh;
Joe Hershberger594c26f2012-05-23 07:58:04 +0000907 struct ip_udp_hdr *localip = (struct ip_udp_hdr *)pkt_buff;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200908 uchar *indata = (uchar *)ip;
909 int offset8, start, len, done = 0;
910 u16 ip_off = ntohs(ip->ip_off);
911
912 /* payload starts after IP header, this fragment is in there */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000913 payload = (struct hole *)(pkt_buff + IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200914 offset8 = (ip_off & IP_OFFS);
915 thisfrag = payload + offset8;
916 start = offset8 * 8;
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000917 len = ntohs(ip->ip_len) - IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200918
919 if (start + len > IP_MAXUDP) /* fragment extends too far */
920 return NULL;
921
922 if (!total_len || localip->ip_id != ip->ip_id) {
923 /* new (or different) packet, reset structs */
924 total_len = 0xffff;
925 payload[0].last_byte = ~0;
926 payload[0].next_hole = 0;
927 payload[0].prev_hole = 0;
928 first_hole = 0;
929 /* any IP header will work, copy the first we received */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000930 memcpy(localip, ip, IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200931 }
932
933 /*
934 * What follows is the reassembly algorithm. We use the payload
935 * array as a linked list of hole descriptors, as each hole starts
936 * at a multiple of 8 bytes. However, last byte can be whatever value,
937 * so it is represented as byte count, not as 8-byte blocks.
938 */
939
940 h = payload + first_hole;
941 while (h->last_byte < start) {
942 if (!h->next_hole) {
943 /* no hole that far away */
944 return NULL;
945 }
946 h = payload + h->next_hole;
947 }
948
Fillod Stephanee397e592010-06-11 19:26:43 +0200949 /* last fragment may be 1..7 bytes, the "+7" forces acceptance */
950 if (offset8 + ((len + 7) / 8) <= h - payload) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200951 /* no overlap with holes (dup fragment?) */
952 return NULL;
953 }
954
955 if (!(ip_off & IP_FLAGS_MFRAG)) {
956 /* no more fragmentss: truncate this (last) hole */
957 total_len = start + len;
958 h->last_byte = start + len;
959 }
960
961 /*
962 * There is some overlap: fix the hole list. This code doesn't
963 * deal with a fragment that overlaps with two different holes
964 * (thus being a superset of a previously-received fragment).
965 */
966
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000967 if ((h >= thisfrag) && (h->last_byte <= start + len)) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200968 /* complete overlap with hole: remove hole */
969 if (!h->prev_hole && !h->next_hole) {
970 /* last remaining hole */
971 done = 1;
972 } else if (!h->prev_hole) {
973 /* first hole */
974 first_hole = h->next_hole;
975 payload[h->next_hole].prev_hole = 0;
976 } else if (!h->next_hole) {
977 /* last hole */
978 payload[h->prev_hole].next_hole = 0;
979 } else {
980 /* in the middle of the list */
981 payload[h->next_hole].prev_hole = h->prev_hole;
982 payload[h->prev_hole].next_hole = h->next_hole;
983 }
984
985 } else if (h->last_byte <= start + len) {
986 /* overlaps with final part of the hole: shorten this hole */
987 h->last_byte = start;
988
989 } else if (h >= thisfrag) {
990 /* overlaps with initial part of the hole: move this hole */
991 newh = thisfrag + (len / 8);
992 *newh = *h;
993 h = newh;
994 if (h->next_hole)
995 payload[h->next_hole].prev_hole = (h - payload);
996 if (h->prev_hole)
997 payload[h->prev_hole].next_hole = (h - payload);
998 else
999 first_hole = (h - payload);
1000
1001 } else {
1002 /* fragment sits in the middle: split the hole */
1003 newh = thisfrag + (len / 8);
1004 *newh = *h;
1005 h->last_byte = start;
1006 h->next_hole = (newh - payload);
1007 newh->prev_hole = (h - payload);
1008 if (newh->next_hole)
1009 payload[newh->next_hole].prev_hole = (newh - payload);
1010 }
1011
1012 /* finally copy this fragment and possibly return whole packet */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +00001013 memcpy((uchar *)thisfrag, indata + IP_HDR_SIZE, len);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001014 if (!done)
1015 return NULL;
1016
1017 localip->ip_len = htons(total_len);
Joe Hershbergerc5c59df2012-05-23 07:58:05 +00001018 *lenp = total_len + IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001019 return localip;
1020}
1021
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001022static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1023 int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001024{
1025 u16 ip_off = ntohs(ip->ip_off);
1026 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1027 return ip; /* not a fragment */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001028 return __net_defragment(ip, lenp);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001029}
1030
1031#else /* !CONFIG_IP_DEFRAG */
1032
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001033static inline struct ip_udp_hdr *net_defragment(struct ip_udp_hdr *ip,
1034 int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001035{
1036 u16 ip_off = ntohs(ip->ip_off);
1037 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
1038 return ip; /* not a fragment */
1039 return NULL;
1040}
1041#endif
wdenka3d991b2004-04-15 21:48:45 +00001042
Simon Glass8f79bb12011-10-24 18:00:00 +00001043/**
1044 * Receive an ICMP packet. We deal with REDIRECT and PING here, and silently
1045 * drop others.
1046 *
1047 * @parma ip IP packet containing the ICMP
1048 */
Joe Hershberger594c26f2012-05-23 07:58:04 +00001049static void receive_icmp(struct ip_udp_hdr *ip, int len,
Joe Hershberger049a95a2015-04-08 01:41:01 -05001050 struct in_addr src_ip, struct ethernet_hdr *et)
Simon Glass8f79bb12011-10-24 18:00:00 +00001051{
Joe Hershbergere0a63072012-05-23 07:58:09 +00001052 struct icmp_hdr *icmph = (struct icmp_hdr *)&ip->udp_src;
Simon Glass8f79bb12011-10-24 18:00:00 +00001053
1054 switch (icmph->type) {
1055 case ICMP_REDIRECT:
1056 if (icmph->code != ICMP_REDIR_HOST)
1057 return;
1058 printf(" ICMP Host Redirect to %pI4 ",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001059 &icmph->un.gateway);
Simon Glass8f79bb12011-10-24 18:00:00 +00001060 break;
Simon Glass8f79bb12011-10-24 18:00:00 +00001061 default:
Joe Hershbergera36b12f2012-05-23 07:58:02 +00001062#if defined(CONFIG_CMD_PING)
1063 ping_receive(et, ip, len);
1064#endif
Simon Glass39bccd22011-10-26 14:18:38 +00001065#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +00001066 if (packet_icmp_handler)
1067 packet_icmp_handler(icmph->type, icmph->code,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001068 ntohs(ip->udp_dst), src_ip,
1069 ntohs(ip->udp_src), icmph->un.data,
1070 ntohs(ip->udp_len));
Simon Glass39bccd22011-10-26 14:18:38 +00001071#endif
Simon Glass8f79bb12011-10-24 18:00:00 +00001072 break;
1073 }
1074}
1075
Joe Hershberger2a504df2015-03-22 17:09:11 -05001076void net_process_received_packet(uchar *in_packet, int len)
wdenk2d966952002-10-31 22:12:35 +00001077{
Joe Hershbergercb487f52012-05-23 07:58:06 +00001078 struct ethernet_hdr *et;
Joe Hershberger594c26f2012-05-23 07:58:04 +00001079 struct ip_udp_hdr *ip;
Joe Hershberger049a95a2015-04-08 01:41:01 -05001080 struct in_addr dst_ip;
1081 struct in_addr src_ip;
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001082 int eth_proto;
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001083#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001084 int iscdp;
1085#endif
1086 ushort cti = 0, vlanid = VLAN_NONE, myvlanid, mynvlanid;
wdenk2d966952002-10-31 22:12:35 +00001087
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001088 debug_cond(DEBUG_NET_PKT, "packet received\n");
wdenka3d991b2004-04-15 21:48:45 +00001089
Ramon Fried3eaac632019-07-18 21:43:30 +03001090#if defined(CONFIG_CMD_PCAP)
1091 pcap_post(in_packet, len, false);
1092#endif
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001093 net_rx_packet = in_packet;
1094 net_rx_packet_len = len;
Joe Hershberger2a504df2015-03-22 17:09:11 -05001095 et = (struct ethernet_hdr *)in_packet;
wdenka3d991b2004-04-15 21:48:45 +00001096
1097 /* too small packet? */
1098 if (len < ETHER_HDR_SIZE)
1099 return;
1100
Alexander Graf0efe1bc2016-05-06 21:01:01 +02001101#if defined(CONFIG_API) || defined(CONFIG_EFI_LOADER)
Rafal Jaworowskif85b6072007-12-27 18:19:02 +01001102 if (push_packet) {
Joe Hershberger2a504df2015-03-22 17:09:11 -05001103 (*push_packet)(in_packet, len);
Rafal Jaworowskif85b6072007-12-27 18:19:02 +01001104 return;
1105 }
1106#endif
1107
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001108#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001109 /* keep track if packet is CDP */
Joe Hershberger17351882012-05-23 07:58:00 +00001110 iscdp = is_cdp_packet(et->et_dest);
wdenka3d991b2004-04-15 21:48:45 +00001111#endif
1112
Joe Hershberger4fd50552015-04-08 01:41:17 -05001113 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001114 if (myvlanid == (ushort)-1)
1115 myvlanid = VLAN_NONE;
Joe Hershberger4fd50552015-04-08 01:41:17 -05001116 mynvlanid = ntohs(net_native_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001117 if (mynvlanid == (ushort)-1)
1118 mynvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001119
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001120 eth_proto = ntohs(et->et_protlen);
wdenk2d966952002-10-31 22:12:35 +00001121
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001122 if (eth_proto < 1514) {
Joe Hershbergercb487f52012-05-23 07:58:06 +00001123 struct e802_hdr *et802 = (struct e802_hdr *)et;
wdenk2d966952002-10-31 22:12:35 +00001124 /*
Joe Hershbergerda5ebe22012-05-23 07:58:11 +00001125 * Got a 802.2 packet. Check the other protocol field.
1126 * XXX VLAN over 802.2+SNAP not implemented!
wdenk2d966952002-10-31 22:12:35 +00001127 */
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001128 eth_proto = ntohs(et802->et_prot);
wdenka3d991b2004-04-15 21:48:45 +00001129
Joe Hershberger2a504df2015-03-22 17:09:11 -05001130 ip = (struct ip_udp_hdr *)(in_packet + E802_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001131 len -= E802_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001132
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001133 } else if (eth_proto != PROT_VLAN) { /* normal packet */
Joe Hershberger2a504df2015-03-22 17:09:11 -05001134 ip = (struct ip_udp_hdr *)(in_packet + ETHER_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001135 len -= ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001136
1137 } else { /* VLAN packet */
Joe Hershbergerc68cca32012-05-23 07:58:07 +00001138 struct vlan_ethernet_hdr *vet =
1139 (struct vlan_ethernet_hdr *)et;
wdenka3d991b2004-04-15 21:48:45 +00001140
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001141 debug_cond(DEBUG_NET_PKT, "VLAN packet received\n");
Robin Getz0ebf04c2009-07-23 03:01:03 -04001142
wdenka3d991b2004-04-15 21:48:45 +00001143 /* too small packet? */
1144 if (len < VLAN_ETHER_HDR_SIZE)
1145 return;
1146
1147 /* if no VLAN active */
Joe Hershberger4fd50552015-04-08 01:41:17 -05001148 if ((ntohs(net_our_vlan) & VLAN_IDMASK) == VLAN_NONE
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001149#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001150 && iscdp == 0
1151#endif
1152 )
1153 return;
1154
1155 cti = ntohs(vet->vet_tag);
1156 vlanid = cti & VLAN_IDMASK;
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001157 eth_proto = ntohs(vet->vet_type);
wdenka3d991b2004-04-15 21:48:45 +00001158
Joe Hershberger2a504df2015-03-22 17:09:11 -05001159 ip = (struct ip_udp_hdr *)(in_packet + VLAN_ETHER_HDR_SIZE);
wdenka3d991b2004-04-15 21:48:45 +00001160 len -= VLAN_ETHER_HDR_SIZE;
wdenk2d966952002-10-31 22:12:35 +00001161 }
1162
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001163 debug_cond(DEBUG_NET_PKT, "Receive from protocol 0x%x\n", eth_proto);
wdenk2d966952002-10-31 22:12:35 +00001164
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001165#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001166 if (iscdp) {
Joe Hershberger0b4c5ff2012-05-23 07:58:13 +00001167 cdp_receive((uchar *)ip, len);
wdenka3d991b2004-04-15 21:48:45 +00001168 return;
1169 }
1170#endif
1171
1172 if ((myvlanid & VLAN_IDMASK) != VLAN_NONE) {
1173 if (vlanid == VLAN_NONE)
1174 vlanid = (mynvlanid & VLAN_IDMASK);
1175 /* not matched? */
1176 if (vlanid != (myvlanid & VLAN_IDMASK))
1177 return;
1178 }
1179
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001180 switch (eth_proto) {
wdenk2d966952002-10-31 22:12:35 +00001181 case PROT_ARP:
Joe Hershberger85d25e02015-04-08 01:41:08 -05001182 arp_receive(et, ip, len);
wdenk289f9322005-01-12 00:15:14 +00001183 break;
wdenk2d966952002-10-31 22:12:35 +00001184
Peter Tyserbf6cb242010-09-30 11:25:48 -05001185#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001186 case PROT_RARP:
Joe Hershberger8b9c5322012-05-23 07:58:03 +00001187 rarp_receive(ip, len);
wdenk2d966952002-10-31 22:12:35 +00001188 break;
Peter Tyserbf6cb242010-09-30 11:25:48 -05001189#endif
wdenk2d966952002-10-31 22:12:35 +00001190 case PROT_IP:
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001191 debug_cond(DEBUG_NET_PKT, "Got IP\n");
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001192 /* Before we start poking the header, make sure it is there */
Joe Hershberger594c26f2012-05-23 07:58:04 +00001193 if (len < IP_UDP_HDR_SIZE) {
1194 debug("len bad %d < %lu\n", len,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001195 (ulong)IP_UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001196 return;
1197 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001198 /* Check the packet length */
wdenk2d966952002-10-31 22:12:35 +00001199 if (len < ntohs(ip->ip_len)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001200 debug("len bad %d < %d\n", len, ntohs(ip->ip_len));
wdenk2d966952002-10-31 22:12:35 +00001201 return;
1202 }
1203 len = ntohs(ip->ip_len);
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001204 debug_cond(DEBUG_NET_PKT, "len=%d, v=%02x\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001205 len, ip->ip_hl_v & 0xff);
Robin Getz0ebf04c2009-07-23 03:01:03 -04001206
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001207 /* Can't deal with anything except IPv4 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001208 if ((ip->ip_hl_v & 0xf0) != 0x40)
wdenk2d966952002-10-31 22:12:35 +00001209 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001210 /* Can't deal with IP options (headers != 20 bytes) */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001211 if ((ip->ip_hl_v & 0x0f) > 0x05)
Remy Bohmer6b52cfe2008-06-03 15:48:17 +02001212 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001213 /* Check the Checksum of the header */
Simon Glass0da0fcd2015-01-19 22:16:08 -07001214 if (!ip_checksum_ok((uchar *)ip, IP_HDR_SIZE)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001215 debug("checksum bad\n");
wdenk2d966952002-10-31 22:12:35 +00001216 return;
1217 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001218 /* If it is not for us, ignore it */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001219 dst_ip = net_read_ip(&ip->ip_dst);
1220 if (net_ip.s_addr && dst_ip.s_addr != net_ip.s_addr &&
1221 dst_ip.s_addr != 0xFFFFFFFF) {
Luca Ceresolic819abe2011-05-04 02:40:46 +00001222 return;
wdenk2d966952002-10-31 22:12:35 +00001223 }
Luca Ceresoli03eb1292011-04-18 06:19:50 +00001224 /* Read source IP address for later use */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001225 src_ip = net_read_ip(&ip->ip_src);
wdenk2d966952002-10-31 22:12:35 +00001226 /*
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001227 * The function returns the unchanged packet if it's not
1228 * a fragment, and either the complete packet or NULL if
1229 * it is a fragment (if !CONFIG_IP_DEFRAG, it returns NULL)
1230 */
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001231 ip = net_defragment(ip, &len);
Luca Ceresoliccb9ebe2011-05-04 02:40:47 +00001232 if (!ip)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001233 return;
1234 /*
wdenk2d966952002-10-31 22:12:35 +00001235 * watch for ICMP host redirects
1236 *
wdenk8bde7f72003-06-27 21:31:46 +00001237 * There is no real handler code (yet). We just watch
1238 * for ICMP host redirect messages. In case anybody
1239 * sees these messages: please contact me
1240 * (wd@denx.de), or - even better - send me the
1241 * necessary fixes :-)
wdenk2d966952002-10-31 22:12:35 +00001242 *
wdenk8bde7f72003-06-27 21:31:46 +00001243 * Note: in all cases where I have seen this so far
1244 * it was a problem with the router configuration,
1245 * for instance when a router was configured in the
1246 * BOOTP reply, but the TFTP server was on the same
1247 * subnet. So this is probably a warning that your
1248 * configuration might be wrong. But I'm not really
1249 * sure if there aren't any other situations.
Simon Glass4793ee62011-10-24 18:00:01 +00001250 *
1251 * Simon Glass <sjg@chromium.org>: We get an ICMP when
1252 * we send a tftp packet to a dead connection, or when
1253 * there is no server at the other end.
wdenk2d966952002-10-31 22:12:35 +00001254 */
1255 if (ip->ip_p == IPPROTO_ICMP) {
Simon Glass8f79bb12011-10-24 18:00:00 +00001256 receive_icmp(ip, len, src_ip, et);
1257 return;
wdenk2d966952002-10-31 22:12:35 +00001258 } else if (ip->ip_p != IPPROTO_UDP) { /* Only UDP packets */
1259 return;
1260 }
1261
liucheng (G)fe728802019-08-29 13:47:33 +00001262 if (ntohs(ip->udp_len) < UDP_HDR_SIZE || ntohs(ip->udp_len) > ntohs(ip->ip_len))
1263 return;
1264
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001265 debug_cond(DEBUG_DEV_PKT,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001266 "received UDP (to=%pI4, from=%pI4, len=%d)\n",
1267 &dst_ip, &src_ip, len);
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001268
Stefan Roese8534bf92005-08-12 20:06:52 +02001269#ifdef CONFIG_UDP_CHECKSUM
1270 if (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 }
1303#endif
1304
Holger Dengler66c89ee2017-07-20 10:10:55 +02001305#if defined(CONFIG_NETCONSOLE) && !defined(CONFIG_SPL_BUILD)
Joe Hershberger594c26f2012-05-23 07:58:04 +00001306 nc_input_packet((uchar *)ip + IP_UDP_HDR_SIZE,
Joe Hershbergerece223b2012-05-23 07:59:15 +00001307 src_ip,
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001308 ntohs(ip->udp_dst),
Joe Hershbergerece223b2012-05-23 07:59:15 +00001309 ntohs(ip->udp_src),
1310 ntohs(ip->udp_len) - UDP_HDR_SIZE);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001311#endif
1312 /*
1313 * IP header OK. Pass the packet to the current handler.
1314 */
1315 (*udp_packet_handler)((uchar *)ip + IP_UDP_HDR_SIZE,
1316 ntohs(ip->udp_dst),
1317 src_ip,
1318 ntohs(ip->udp_src),
1319 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001320 break;
Lothar Feltend8970da2018-06-22 22:29:54 +02001321#ifdef CONFIG_CMD_WOL
1322 case PROT_WOL:
1323 wol_receive(ip, len);
1324 break;
1325#endif
wdenk2d966952002-10-31 22:12:35 +00001326 }
1327}
1328
wdenk2d966952002-10-31 22:12:35 +00001329/**********************************************************************/
1330
Simon Glasse4bf0c52011-10-24 18:00:02 +00001331static int net_check_prereq(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +00001332{
1333 switch (protocol) {
wdenk6e592382004-04-18 17:39:38 +00001334 /* Fall through */
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001335#if defined(CONFIG_CMD_PING)
wdenk73a8b272003-06-05 19:27:42 +00001336 case PING:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001337 if (net_ping_ip.s_addr == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001338 puts("*** ERROR: ping address not given\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001339 return 1;
wdenk6e592382004-04-18 17:39:38 +00001340 }
1341 goto common;
wdenk73a8b272003-06-05 19:27:42 +00001342#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001343#if defined(CONFIG_CMD_SNTP)
wdenkea287de2005-04-01 00:25:43 +00001344 case SNTP:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001345 if (net_ntp_server.s_addr == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001346 puts("*** ERROR: NTP server address not given\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001347 return 1;
wdenkea287de2005-04-01 00:25:43 +00001348 }
1349 goto common;
1350#endif
Robin Getz1a32bf42009-07-20 14:53:54 -04001351#if defined(CONFIG_CMD_DNS)
1352 case DNS:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001353 if (net_dns_server.s_addr == 0) {
Robin Getz1a32bf42009-07-20 14:53:54 -04001354 puts("*** ERROR: DNS server address not given\n");
1355 return 1;
1356 }
1357 goto common;
1358#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001359#if defined(CONFIG_CMD_NFS)
wdenkcbd8a352004-02-24 02:00:03 +00001360 case NFS:
1361#endif
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001362 /* Fall through */
Simon Glasse4bf0c52011-10-24 18:00:02 +00001363 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +00001364 case TFTPPUT:
Joe Hershberger3a66fcb2018-07-03 19:36:39 -05001365 if (net_server_ip.s_addr == 0 && !is_serverip_in_cmd()) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001366 puts("*** ERROR: `serverip' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001367 return 1;
wdenk6e592382004-04-18 17:39:38 +00001368 }
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001369#if defined(CONFIG_CMD_PING) || defined(CONFIG_CMD_SNTP) || \
1370 defined(CONFIG_CMD_DNS)
1371common:
wdenk73a8b272003-06-05 19:27:42 +00001372#endif
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001373 /* Fall through */
wdenk73a8b272003-06-05 19:27:42 +00001374
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001375 case NETCONS:
Alex Kiernanf73a7df2018-05-29 15:30:53 +00001376 case FASTBOOT:
Luca Ceresoli7a83af02011-05-17 00:03:40 +00001377 case TFTPSRV:
Joe Hershberger049a95a2015-04-08 01:41:01 -05001378 if (net_ip.s_addr == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001379 puts("*** ERROR: `ipaddr' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001380 return 1;
wdenk6e592382004-04-18 17:39:38 +00001381 }
1382 /* Fall through */
wdenk2d966952002-10-31 22:12:35 +00001383
Peter Tyserbf6cb242010-09-30 11:25:48 -05001384#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001385 case RARP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001386#endif
wdenk2d966952002-10-31 22:12:35 +00001387 case BOOTP:
wdenka3d991b2004-04-15 21:48:45 +00001388 case CDP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001389 case DHCP:
Joe Hershbergerd22c3382012-05-23 08:00:12 +00001390 case LINKLOCAL:
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001391 if (memcmp(net_ethaddr, "\0\0\0\0\0\0", 6) == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001392 int num = eth_get_dev_index();
wdenk2d966952002-10-31 22:12:35 +00001393
wdenk6e592382004-04-18 17:39:38 +00001394 switch (num) {
1395 case -1:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001396 puts("*** ERROR: No ethernet found.\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001397 return 1;
wdenk6e592382004-04-18 17:39:38 +00001398 case 0:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001399 puts("*** ERROR: `ethaddr' not set\n");
wdenk2d966952002-10-31 22:12:35 +00001400 break;
wdenk6e592382004-04-18 17:39:38 +00001401 default:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001402 printf("*** ERROR: `eth%daddr' not set\n",
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001403 num);
wdenk2d966952002-10-31 22:12:35 +00001404 break;
wdenk2d966952002-10-31 22:12:35 +00001405 }
wdenk6e592382004-04-18 17:39:38 +00001406
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001407 net_start_again();
Luca Ceresoli92895de2011-05-04 02:40:45 +00001408 return 2;
wdenk6e592382004-04-18 17:39:38 +00001409 }
1410 /* Fall through */
1411 default:
Luca Ceresoli92895de2011-05-04 02:40:45 +00001412 return 0;
wdenk2d966952002-10-31 22:12:35 +00001413 }
Luca Ceresoli92895de2011-05-04 02:40:45 +00001414 return 0; /* OK */
wdenk2d966952002-10-31 22:12:35 +00001415}
1416/**********************************************************************/
1417
1418int
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001419net_eth_hdr_size(void)
wdenka3d991b2004-04-15 21:48:45 +00001420{
1421 ushort myvlanid;
wdenk2d966952002-10-31 22:12:35 +00001422
Joe Hershberger4fd50552015-04-08 01:41:17 -05001423 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001424 if (myvlanid == (ushort)-1)
1425 myvlanid = VLAN_NONE;
1426
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001427 return ((myvlanid & VLAN_IDMASK) == VLAN_NONE) ? ETHER_HDR_SIZE :
1428 VLAN_ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001429}
1430
Joe Hershberger1203fcc2015-04-08 01:41:05 -05001431int net_set_ether(uchar *xet, const uchar *dest_ethaddr, uint prot)
wdenk2d966952002-10-31 22:12:35 +00001432{
Joe Hershbergercb487f52012-05-23 07:58:06 +00001433 struct ethernet_hdr *et = (struct ethernet_hdr *)xet;
wdenka3d991b2004-04-15 21:48:45 +00001434 ushort myvlanid;
1435
Joe Hershberger4fd50552015-04-08 01:41:17 -05001436 myvlanid = ntohs(net_our_vlan);
wdenka3d991b2004-04-15 21:48:45 +00001437 if (myvlanid == (ushort)-1)
1438 myvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001439
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001440 memcpy(et->et_dest, dest_ethaddr, 6);
1441 memcpy(et->et_src, net_ethaddr, 6);
wdenka3d991b2004-04-15 21:48:45 +00001442 if ((myvlanid & VLAN_IDMASK) == VLAN_NONE) {
Luca Ceresolic819abe2011-05-04 02:40:46 +00001443 et->et_protlen = htons(prot);
wdenka3d991b2004-04-15 21:48:45 +00001444 return ETHER_HDR_SIZE;
1445 } else {
Joe Hershbergerc68cca32012-05-23 07:58:07 +00001446 struct vlan_ethernet_hdr *vet =
1447 (struct vlan_ethernet_hdr *)xet;
wdenk2d966952002-10-31 22:12:35 +00001448
wdenka3d991b2004-04-15 21:48:45 +00001449 vet->vet_vlan_type = htons(PROT_VLAN);
1450 vet->vet_tag = htons((0 << 5) | (myvlanid & VLAN_IDMASK));
1451 vet->vet_type = htons(prot);
1452 return VLAN_ETHER_HDR_SIZE;
1453 }
1454}
wdenk2d966952002-10-31 22:12:35 +00001455
Joe Hershbergere7111012012-05-23 07:59:16 +00001456int net_update_ether(struct ethernet_hdr *et, uchar *addr, uint prot)
1457{
1458 ushort protlen;
1459
1460 memcpy(et->et_dest, addr, 6);
Joe Hershberger0adb5b72015-04-08 01:41:04 -05001461 memcpy(et->et_src, net_ethaddr, 6);
Joe Hershbergere7111012012-05-23 07:59:16 +00001462 protlen = ntohs(et->et_protlen);
1463 if (protlen == PROT_VLAN) {
1464 struct vlan_ethernet_hdr *vet =
1465 (struct vlan_ethernet_hdr *)et;
1466 vet->vet_type = htons(prot);
1467 return VLAN_ETHER_HDR_SIZE;
1468 } else if (protlen > 1514) {
1469 et->et_protlen = htons(prot);
1470 return ETHER_HDR_SIZE;
1471 } else {
1472 /* 802.2 + SNAP */
1473 struct e802_hdr *et802 = (struct e802_hdr *)et;
1474 et802->et_prot = htons(prot);
1475 return E802_HDR_SIZE;
1476 }
1477}
1478
Duncan Hare5d457ec2018-06-24 15:40:41 -07001479void net_set_ip_header(uchar *pkt, struct in_addr dest, struct in_addr source,
1480 u16 pkt_len, u8 proto)
wdenk2d966952002-10-31 22:12:35 +00001481{
Joe Hershberger4b11c912012-05-23 07:59:07 +00001482 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
1483
1484 /*
1485 * Construct an IP header.
1486 */
1487 /* IP_HDR_SIZE / 4 (not including UDP) */
1488 ip->ip_hl_v = 0x45;
1489 ip->ip_tos = 0;
Duncan Hare5d457ec2018-06-24 15:40:41 -07001490 ip->ip_len = htons(pkt_len);
1491 ip->ip_p = proto;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -05001492 ip->ip_id = htons(net_ip_id++);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001493 ip->ip_off = htons(IP_FLAGS_DFRAG); /* Don't fragment */
1494 ip->ip_ttl = 255;
1495 ip->ip_sum = 0;
1496 /* already in network byte order */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001497 net_copy_ip((void *)&ip->ip_src, &source);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001498 /* already in network byte order */
Joe Hershberger049a95a2015-04-08 01:41:01 -05001499 net_copy_ip((void *)&ip->ip_dst, &dest);
Duncan Hare5d457ec2018-06-24 15:40:41 -07001500
1501 ip->ip_sum = compute_ip_checksum(ip, IP_HDR_SIZE);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001502}
1503
Joe Hershberger049a95a2015-04-08 01:41:01 -05001504void net_set_udp_header(uchar *pkt, struct in_addr dest, int dport, int sport,
Joe Hershberger4b11c912012-05-23 07:59:07 +00001505 int len)
1506{
1507 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
wdenk2d966952002-10-31 22:12:35 +00001508
1509 /*
1510 * If the data is an odd number of bytes, zero the
1511 * byte after the last byte so that the checksum
1512 * will work.
1513 */
1514 if (len & 1)
Joe Hershberger4b11c912012-05-23 07:59:07 +00001515 pkt[IP_UDP_HDR_SIZE + len] = 0;
wdenk2d966952002-10-31 22:12:35 +00001516
Duncan Hare5d457ec2018-06-24 15:40:41 -07001517 net_set_ip_header(pkt, dest, net_ip, IP_UDP_HDR_SIZE + len,
1518 IPPROTO_UDP);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001519
wdenk2d966952002-10-31 22:12:35 +00001520 ip->udp_src = htons(sport);
1521 ip->udp_dst = htons(dport);
Joe Hershberger594c26f2012-05-23 07:58:04 +00001522 ip->udp_len = htons(UDP_HDR_SIZE + len);
wdenk2d966952002-10-31 22:12:35 +00001523 ip->udp_xsum = 0;
wdenk2d966952002-10-31 22:12:35 +00001524}
1525
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001526void copy_filename(char *dst, const char *src, int size)
wdenk2d966952002-10-31 22:12:35 +00001527{
Joe Hershberger16cf1452018-07-03 19:36:41 -05001528 if (src && *src && (*src == '"')) {
wdenk2d966952002-10-31 22:12:35 +00001529 ++src;
1530 --size;
1531 }
1532
Joe Hershberger16cf1452018-07-03 19:36:41 -05001533 while ((--size > 0) && src && *src && (*src != '"'))
wdenk2d966952002-10-31 22:12:35 +00001534 *dst++ = *src++;
wdenk2d966952002-10-31 22:12:35 +00001535 *dst = '\0';
1536}
1537
Joe Hershberger3a66fcb2018-07-03 19:36:39 -05001538int is_serverip_in_cmd(void)
1539{
1540 return !!strchr(net_boot_file_name, ':');
1541}
1542
Joe Hershberger6ab12832018-07-03 19:36:43 -05001543int net_parse_bootfile(struct in_addr *ipaddr, char *filename, int max_len)
1544{
1545 char *colon;
1546
1547 if (net_boot_file_name[0] == '\0')
1548 return 0;
1549
1550 colon = strchr(net_boot_file_name, ':');
1551 if (colon) {
1552 if (ipaddr)
1553 *ipaddr = string_to_ip(net_boot_file_name);
1554 strncpy(filename, colon + 1, max_len);
1555 } else {
1556 strncpy(filename, net_boot_file_name, max_len);
1557 }
1558 filename[max_len - 1] = '\0';
1559
1560 return 1;
1561}
1562
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001563#if defined(CONFIG_CMD_NFS) || \
1564 defined(CONFIG_CMD_SNTP) || \
1565 defined(CONFIG_CMD_DNS)
Robin Getz1a32bf42009-07-20 14:53:54 -04001566/*
Robin Getz97399462010-03-08 14:07:00 -05001567 * make port a little random (1024-17407)
1568 * This keeps the math somewhat trivial to compute, and seems to work with
1569 * all supported protocols/clients/servers
Robin Getz1a32bf42009-07-20 14:53:54 -04001570 */
1571unsigned int random_port(void)
1572{
Robin Getz97399462010-03-08 14:07:00 -05001573 return 1024 + (get_timer(0) % 0x4000);
Robin Getz1a32bf42009-07-20 14:53:54 -04001574}
1575#endif
1576
Joe Hershberger049a95a2015-04-08 01:41:01 -05001577void ip_to_string(struct in_addr x, char *s)
wdenk2d966952002-10-31 22:12:35 +00001578{
Joe Hershberger049a95a2015-04-08 01:41:01 -05001579 x.s_addr = ntohl(x.s_addr);
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001580 sprintf(s, "%d.%d.%d.%d",
Joe Hershberger049a95a2015-04-08 01:41:01 -05001581 (int) ((x.s_addr >> 24) & 0xff),
1582 (int) ((x.s_addr >> 16) & 0xff),
1583 (int) ((x.s_addr >> 8) & 0xff),
1584 (int) ((x.s_addr >> 0) & 0xff)
wdenk6e592382004-04-18 17:39:38 +00001585 );
wdenk2d966952002-10-31 22:12:35 +00001586}
1587
Joe Hershberger4fd50552015-04-08 01:41:17 -05001588void vlan_to_string(ushort x, char *s)
wdenka3d991b2004-04-15 21:48:45 +00001589{
1590 x = ntohs(x);
1591
1592 if (x == (ushort)-1)
1593 x = VLAN_NONE;
1594
1595 if (x == VLAN_NONE)
1596 strcpy(s, "none");
1597 else
1598 sprintf(s, "%d", x & VLAN_IDMASK);
1599}
1600
Joe Hershberger4fd50552015-04-08 01:41:17 -05001601ushort string_to_vlan(const char *s)
wdenka3d991b2004-04-15 21:48:45 +00001602{
1603 ushort id;
1604
1605 if (s == NULL)
wdenkb9711de2004-04-25 13:18:40 +00001606 return htons(VLAN_NONE);
wdenka3d991b2004-04-15 21:48:45 +00001607
1608 if (*s < '0' || *s > '9')
1609 id = VLAN_NONE;
1610 else
1611 id = (ushort)simple_strtoul(s, NULL, 10);
1612
wdenkb9711de2004-04-25 13:18:40 +00001613 return htons(id);
wdenka3d991b2004-04-15 21:48:45 +00001614}
1615
Simon Glass723806c2017-08-03 12:22:15 -06001616ushort env_get_vlan(char *var)
wdenka3d991b2004-04-15 21:48:45 +00001617{
Simon Glass00caae62017-08-03 12:22:12 -06001618 return string_to_vlan(env_get(var));
wdenka3d991b2004-04-15 21:48:45 +00001619}