blob: 82c4cc91179a547f14887c8d1f5e1cf13f84a5af [file] [log] [blame]
wdenk2d966952002-10-31 22:12:35 +00001/*
2 * Copied from Linux Monitor (LiMon) - Networking.
3 *
4 * Copyright 1994 - 2000 Neil Russell.
5 * (See License)
6 * Copyright 2000 Roland Borde
7 * Copyright 2000 Paolo Scaffardi
8 * Copyright 2000-2002 Wolfgang Denk, wd@denx.de
9 */
10
11/*
12 * General Desription:
13 *
14 * The user interface supports commands for BOOTP, RARP, and TFTP.
15 * Also, we support ARP internally. Depending on available data,
16 * these interact as follows:
17 *
18 * BOOTP:
19 *
20 * Prerequisites: - own ethernet address
21 * We want: - own IP address
22 * - TFTP server IP address
23 * - name of bootfile
24 * Next step: ARP
25 *
Joe Hershbergerd22c3382012-05-23 08:00:12 +000026 * LINK_LOCAL:
27 *
28 * Prerequisites: - own ethernet address
29 * We want: - own IP address
30 * Next step: ARP
31 *
wdenk2d966952002-10-31 22:12:35 +000032 * RARP:
33 *
34 * Prerequisites: - own ethernet address
35 * We want: - own IP address
36 * - TFTP server IP address
37 * Next step: ARP
38 *
39 * ARP:
40 *
41 * Prerequisites: - own ethernet address
42 * - own IP address
43 * - TFTP server IP address
44 * We want: - TFTP server ethernet address
45 * Next step: TFTP
46 *
47 * DHCP:
48 *
Wolfgang Denkb2f50802005-08-12 23:43:12 +020049 * Prerequisites: - own ethernet address
50 * We want: - IP, Netmask, ServerIP, Gateway IP
51 * - bootfilename, lease time
52 * Next step: - TFTP
wdenk2d966952002-10-31 22:12:35 +000053 *
54 * TFTP:
55 *
56 * Prerequisites: - own ethernet address
57 * - own IP address
58 * - TFTP server IP address
59 * - TFTP server ethernet address
60 * - name of bootfile (if unknown, we use a default name
61 * derived from our own IP address)
62 * We want: - load the boot file
63 * Next step: none
wdenkcbd8a352004-02-24 02:00:03 +000064 *
65 * NFS:
66 *
67 * Prerequisites: - own ethernet address
68 * - own IP address
69 * - name of bootfile (if unknown, we use a default name
70 * derived from our own IP address)
71 * We want: - load the boot file
72 * Next step: none
wdenkea287de2005-04-01 00:25:43 +000073 *
74 * SNTP:
75 *
Wolfgang Denkb2f50802005-08-12 23:43:12 +020076 * Prerequisites: - own ethernet address
wdenkea287de2005-04-01 00:25:43 +000077 * - own IP address
78 * We want: - network time
79 * Next step: none
wdenk2d966952002-10-31 22:12:35 +000080 */
81
82
83#include <common.h>
wdenk2d966952002-10-31 22:12:35 +000084#include <command.h>
85#include <net.h>
Joe Hershberger4545f4e2012-05-23 07:58:15 +000086#if defined(CONFIG_STATUS_LED)
87#include <miiphy.h>
88#include <status_led.h>
89#endif
90#include <watchdog.h>
91#include <linux/compiler.h>
Joe Hershbergerd280d3f2012-05-23 07:58:01 +000092#include "arp.h"
wdenk2d966952002-10-31 22:12:35 +000093#include "bootp.h"
Joe Hershbergerf575ae12012-05-23 07:57:59 +000094#include "cdp.h"
Robin Getz1a32bf42009-07-20 14:53:54 -040095#if defined(CONFIG_CMD_DNS)
96#include "dns.h"
97#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +000098#include "link_local.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +000099#include "nfs.h"
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000100#include "ping.h"
Joe Hershberger4545f4e2012-05-23 07:58:15 +0000101#include "rarp.h"
102#if defined(CONFIG_CMD_SNTP)
103#include "sntp.h"
104#endif
105#include "tftp.h"
wdenk2d966952002-10-31 22:12:35 +0000106
Wolfgang Denkd87080b2006-03-31 18:32:53 +0200107DECLARE_GLOBAL_DATA_PTR;
108
wdenk2d966952002-10-31 22:12:35 +0000109/** BOOTP EXTENTIONS **/
110
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000111/* Our subnet mask (0=unknown) */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000112IPaddr_t NetOurSubnetMask;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000113/* Our gateways IP address */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000114IPaddr_t NetOurGatewayIP;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000115/* Our DNS IP address */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000116IPaddr_t NetOurDNSIP;
Jon Loeliger1fe80d72007-07-09 22:08:34 -0500117#if defined(CONFIG_BOOTP_DNS2)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000118/* Our 2nd DNS IP address */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000119IPaddr_t NetOurDNS2IP;
stroesefe389a82003-08-28 14:17:32 +0000120#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000121/* Our NIS domain */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000122char NetOurNISDomain[32] = {0,};
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000123/* Our hostname */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000124char NetOurHostName[32] = {0,};
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000125/* Our bootpath */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000126char NetOurRootPath[64] = {0,};
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000127/* Our bootfile size in blocks */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000128ushort NetBootFileSize;
wdenk2d966952002-10-31 22:12:35 +0000129
David Updegraff53a5c422007-06-11 10:41:07 -0500130#ifdef CONFIG_MCAST_TFTP /* Multicast TFTP */
131IPaddr_t Mcast_addr;
132#endif
133
wdenk2d966952002-10-31 22:12:35 +0000134/** END OF BOOTP EXTENTIONS **/
135
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000136/* The actual transferred size of the bootfile (in bytes) */
137ulong NetBootFileXferSize;
138/* Our ethernet address */
139uchar NetOurEther[6];
140/* Boot server enet address */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000141uchar NetServerEther[6];
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000142/* Our IP addr (0 = unknown) */
143IPaddr_t NetOurIP;
144/* Server IP addr (0 = unknown) */
145IPaddr_t NetServerIP;
146/* Current receive packet */
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000147uchar *NetRxPacket;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000148/* Current rx packet length */
149int NetRxPacketLen;
150/* IP packet ID */
151unsigned NetIPID;
152/* Ethernet bcast address */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000153uchar NetBcastAddr[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
154uchar NetEtherNullAddr[6];
Rafal Jaworowskif85b6072007-12-27 18:19:02 +0100155#ifdef CONFIG_API
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000156void (*push_packet)(void *, int len) = 0;
Rafal Jaworowskif85b6072007-12-27 18:19:02 +0100157#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000158/* Network loop state */
Joe Hershberger22f6e992012-05-23 07:59:14 +0000159enum net_loop_state net_state;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000160/* Tried all network devices */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000161int NetRestartWrap;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000162/* Network loop restarted */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000163static int NetRestarted;
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000164/* At least one device configured */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000165static int NetDevExists;
wdenk2d966952002-10-31 22:12:35 +0000166
wdenk6e592382004-04-18 17:39:38 +0000167/* XXX in both little & big endian machines 0xFFFF == ntohs(-1) */
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000168/* default is without VLAN */
169ushort NetOurVLAN = 0xFFFF;
170/* ditto */
171ushort NetOurNativeVLAN = 0xFFFF;
wdenka3d991b2004-04-15 21:48:45 +0000172
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000173/* Boot File name */
174char BootFile[128];
wdenk2d966952002-10-31 22:12:35 +0000175
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500176#if defined(CONFIG_CMD_SNTP)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000177/* NTP server IP address */
178IPaddr_t NetNtpServerIP;
179/* offset time from UTC */
Luca Ceresolic586ce62011-05-11 03:59:55 +0000180int NetTimeOffset;
wdenkea287de2005-04-01 00:25:43 +0000181#endif
182
Kim Phillips06370592012-10-29 13:34:33 +0000183static uchar PktBuf[(PKTBUFSRX+1) * PKTSIZE_ALIGN + PKTALIGN];
wdenk2d966952002-10-31 22:12:35 +0000184
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000185/* Receive packet */
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000186uchar *NetRxPackets[PKTBUFSRX];
wdenk2d966952002-10-31 22:12:35 +0000187
Joe Hershbergerece223b2012-05-23 07:59:15 +0000188/* Current UDP RX packet handler */
189static rxhand_f *udp_packet_handler;
190/* Current ARP RX packet handler */
191static rxhand_f *arp_packet_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000192#ifdef CONFIG_CMD_TFTPPUT
Joe Hershbergerece223b2012-05-23 07:59:15 +0000193/* Current ICMP rx handler */
194static rxhand_icmp_f *packet_icmp_handler;
Simon Glass39bccd22011-10-26 14:18:38 +0000195#endif
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000196/* Current timeout handler */
197static thand_f *timeHandler;
198/* Time base value */
199static ulong timeStart;
200/* Current timeout value */
201static ulong timeDelta;
202/* THE transmit packet */
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000203uchar *NetTxPacket;
wdenk2d966952002-10-31 22:12:35 +0000204
Simon Glasse4bf0c52011-10-24 18:00:02 +0000205static int net_check_prereq(enum proto_t protocol);
wdenk2d966952002-10-31 22:12:35 +0000206
Remy Bohmer67b96e82009-10-28 22:13:39 +0100207static int NetTryCount;
208
wdenk2d966952002-10-31 22:12:35 +0000209/**********************************************************************/
wdenk73a8b272003-06-05 19:27:42 +0000210
Simon Glasse4a3d572011-10-27 06:24:32 +0000211/*
212 * Check if autoload is enabled. If so, use either NFS or TFTP to download
213 * the boot file.
214 */
215void net_auto_load(void)
216{
217 const char *s = getenv("autoload");
218
219 if (s != NULL) {
220 if (*s == 'n') {
221 /*
222 * Just use BOOTP/RARP to configure system;
223 * Do not use TFTP to load the bootfile.
224 */
Joe Hershberger22f6e992012-05-23 07:59:14 +0000225 net_set_state(NETLOOP_SUCCESS);
Simon Glasse4a3d572011-10-27 06:24:32 +0000226 return;
227 }
228#if defined(CONFIG_CMD_NFS)
229 if (strcmp(s, "NFS") == 0) {
230 /*
231 * Use NFS to load the bootfile.
232 */
233 NfsStart();
234 return;
235 }
236#endif
237 }
238 TftpStart(TFTPGET);
239}
240
Joe Hershbergercb1c9912012-05-23 07:59:21 +0000241static void NetInitLoop(void)
Heiko Schocher2f70c492009-02-10 09:38:52 +0100242{
Luca Ceresolic586ce62011-05-11 03:59:55 +0000243 static int env_changed_id;
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000244 int env_id = get_env_id();
Heiko Schocher2f70c492009-02-10 09:38:52 +0100245
246 /* update only when the environment has changed */
Michael Zaidman3c172c42009-04-04 01:43:00 +0300247 if (env_changed_id != env_id) {
Enric Balletbo i Serra23a70bf2011-05-31 21:01:47 +0000248 NetOurIP = getenv_IPaddr("ipaddr");
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000249 NetOurGatewayIP = getenv_IPaddr("gatewayip");
250 NetOurSubnetMask = getenv_IPaddr("netmask");
251 NetServerIP = getenv_IPaddr("serverip");
Heiko Schocher2f70c492009-02-10 09:38:52 +0100252 NetOurNativeVLAN = getenv_VLAN("nvlan");
Michael Zaidman3c172c42009-04-04 01:43:00 +0300253 NetOurVLAN = getenv_VLAN("vlan");
Robin Getz1a32bf42009-07-20 14:53:54 -0400254#if defined(CONFIG_CMD_DNS)
255 NetOurDNSIP = getenv_IPaddr("dnsip");
256#endif
Michael Zaidman3c172c42009-04-04 01:43:00 +0300257 env_changed_id = env_id;
Heiko Schocher2f70c492009-02-10 09:38:52 +0100258 }
Joe Hershbergera03d6382012-07-23 13:11:16 +0000259 memcpy(NetOurEther, eth_get_dev()->enetaddr, 6);
Michael Zaidman3c172c42009-04-04 01:43:00 +0300260
Heiko Schocherda954272009-04-28 08:36:11 +0200261 return;
Heiko Schocher2f70c492009-02-10 09:38:52 +0100262}
263
Joe Hershbergerece223b2012-05-23 07:59:15 +0000264static void net_clear_handlers(void)
265{
266 net_set_udp_handler(NULL);
267 net_set_arp_handler(NULL);
268 NetSetTimeout(0, NULL);
269}
270
271static void net_cleanup_loop(void)
272{
273 net_clear_handlers();
274}
275
Joe Hershberger46c495d2012-05-23 07:59:22 +0000276void net_init(void)
277{
278 static int first_call = 1;
279
280 if (first_call) {
281 /*
282 * Setup packet buffers, aligned correctly.
283 */
284 int i;
285
286 NetTxPacket = &PktBuf[0] + (PKTALIGN - 1);
287 NetTxPacket -= (ulong)NetTxPacket % PKTALIGN;
288 for (i = 0; i < PKTBUFSRX; i++)
289 NetRxPackets[i] = NetTxPacket + (i + 1) * PKTSIZE_ALIGN;
290
291 ArpInit();
292 net_clear_handlers();
293
294 /* Only need to setup buffer pointers once. */
295 first_call = 0;
296 }
297
298 NetInitLoop();
299}
300
wdenk73a8b272003-06-05 19:27:42 +0000301/**********************************************************************/
wdenk2d966952002-10-31 22:12:35 +0000302/*
303 * Main network processing loop.
304 */
305
Simon Glasse4bf0c52011-10-24 18:00:02 +0000306int NetLoop(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +0000307{
wdenk2d966952002-10-31 22:12:35 +0000308 bd_t *bd = gd->bd;
Simon Glass4793ee62011-10-24 18:00:01 +0000309 int ret = -1;
wdenk2d966952002-10-31 22:12:35 +0000310
wdenk2d966952002-10-31 22:12:35 +0000311 NetRestarted = 0;
312 NetDevExists = 0;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100313 NetTryCount = 1;
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000314 debug_cond(DEBUG_INT_STATE, "--- NetLoop Entry\n");
wdenk73a8b272003-06-05 19:27:42 +0000315
Simon Glass573f14f2011-12-10 11:08:06 +0000316 bootstage_mark_name(BOOTSTAGE_ID_ETH_START, "eth_start");
Joe Hershberger46c495d2012-05-23 07:59:22 +0000317 net_init();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000318 if (eth_is_on_demand_init() || protocol != NETCONS) {
wdenkb1bf6f22005-04-03 14:52:59 +0000319 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000320 eth_set_current();
321 if (eth_init(bd) < 0) {
322 eth_halt();
323 return -1;
324 }
325 } else
326 eth_init_state_only(bd);
wdenk2d966952002-10-31 22:12:35 +0000327
328restart:
Joe Hershberger22f6e992012-05-23 07:59:14 +0000329 net_set_state(NETLOOP_CONTINUE);
wdenk2d966952002-10-31 22:12:35 +0000330
331 /*
332 * Start the ball rolling with the given start function. From
333 * here on, this code is a state machine driven by received
334 * packets and timer events.
335 */
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000336 debug_cond(DEBUG_INT_STATE, "--- NetLoop Init\n");
Joe Hershbergercb1c9912012-05-23 07:59:21 +0000337 NetInitLoop();
wdenk2d966952002-10-31 22:12:35 +0000338
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000339 switch (net_check_prereq(protocol)) {
wdenk2d966952002-10-31 22:12:35 +0000340 case 1:
341 /* network not configured */
wdenkb1bf6f22005-04-03 14:52:59 +0000342 eth_halt();
Luca Ceresoli92895de2011-05-04 02:40:45 +0000343 return -1;
wdenk2d966952002-10-31 22:12:35 +0000344
wdenk2d966952002-10-31 22:12:35 +0000345 case 2:
346 /* network device not configured */
347 break;
wdenk2d966952002-10-31 22:12:35 +0000348
349 case 0:
wdenk2d966952002-10-31 22:12:35 +0000350 NetDevExists = 1;
Simon Glasse4bf0c52011-10-24 18:00:02 +0000351 NetBootFileXferSize = 0;
wdenk2d966952002-10-31 22:12:35 +0000352 switch (protocol) {
Simon Glasse4bf0c52011-10-24 18:00:02 +0000353 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +0000354#ifdef CONFIG_CMD_TFTPPUT
355 case TFTPPUT:
356#endif
wdenk2d966952002-10-31 22:12:35 +0000357 /* always use ARP to get server ethernet address */
Simon Glasse4bf0c52011-10-24 18:00:02 +0000358 TftpStart(protocol);
wdenk2d966952002-10-31 22:12:35 +0000359 break;
Luca Ceresoli7a83af02011-05-17 00:03:40 +0000360#ifdef CONFIG_CMD_TFTPSRV
361 case TFTPSRV:
362 TftpStartServer();
363 break;
364#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500365#if defined(CONFIG_CMD_DHCP)
wdenk2d966952002-10-31 22:12:35 +0000366 case DHCP:
wdenkd407bf52004-10-11 22:51:13 +0000367 BootpTry = 0;
Michael Zaidman09133f82009-07-14 23:37:12 +0300368 NetOurIP = 0;
wdenk2d966952002-10-31 22:12:35 +0000369 DhcpRequest(); /* Basically same as BOOTP */
370 break;
Jon Loeliger610f2e92007-07-10 11:05:02 -0500371#endif
wdenk2d966952002-10-31 22:12:35 +0000372
373 case BOOTP:
374 BootpTry = 0;
Michael Zaidman09133f82009-07-14 23:37:12 +0300375 NetOurIP = 0;
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000376 BootpRequest();
wdenk2d966952002-10-31 22:12:35 +0000377 break;
378
Peter Tyserbf6cb242010-09-30 11:25:48 -0500379#if defined(CONFIG_CMD_RARP)
wdenk2d966952002-10-31 22:12:35 +0000380 case RARP:
381 RarpTry = 0;
Michael Zaidman09133f82009-07-14 23:37:12 +0300382 NetOurIP = 0;
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000383 RarpRequest();
wdenk2d966952002-10-31 22:12:35 +0000384 break;
Peter Tyserbf6cb242010-09-30 11:25:48 -0500385#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500386#if defined(CONFIG_CMD_PING)
wdenk73a8b272003-06-05 19:27:42 +0000387 case PING:
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000388 ping_start();
wdenk73a8b272003-06-05 19:27:42 +0000389 break;
390#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500391#if defined(CONFIG_CMD_NFS)
wdenkcbd8a352004-02-24 02:00:03 +0000392 case NFS:
393 NfsStart();
394 break;
395#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500396#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +0000397 case CDP:
398 CDPStart();
399 break;
400#endif
wdenk68ceb292004-08-02 21:11:11 +0000401#ifdef CONFIG_NETCONSOLE
402 case NETCONS:
403 NcStart();
404 break;
405#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500406#if defined(CONFIG_CMD_SNTP)
wdenkea287de2005-04-01 00:25:43 +0000407 case SNTP:
408 SntpStart();
409 break;
410#endif
Robin Getz1a32bf42009-07-20 14:53:54 -0400411#if defined(CONFIG_CMD_DNS)
412 case DNS:
413 DnsStart();
414 break;
415#endif
Joe Hershbergerd22c3382012-05-23 08:00:12 +0000416#if defined(CONFIG_CMD_LINK_LOCAL)
417 case LINKLOCAL:
418 link_local_start();
419 break;
420#endif
wdenk2d966952002-10-31 22:12:35 +0000421 default:
422 break;
423 }
424
wdenk2d966952002-10-31 22:12:35 +0000425 break;
426 }
427
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500428#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000429#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
430 defined(CONFIG_STATUS_LED) && \
431 defined(STATUS_LED_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000432 /*
wdenk42d1f032003-10-15 23:53:47 +0000433 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000434 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000435 if (miiphy_link(eth_get_dev()->name, CONFIG_SYS_FAULT_MII_ADDR))
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000436 status_led_set(STATUS_LED_RED, STATUS_LED_OFF);
Luca Ceresolid3c65b02011-05-04 02:40:43 +0000437 else
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000438 status_led_set(STATUS_LED_RED, STATUS_LED_ON);
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200439#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000440#endif /* CONFIG_MII, ... */
wdenk2d966952002-10-31 22:12:35 +0000441
442 /*
443 * Main packet reception loop. Loop receiving packets until
Joe Hershberger22f6e992012-05-23 07:59:14 +0000444 * someone sets `net_state' to a state that terminates.
wdenk2d966952002-10-31 22:12:35 +0000445 */
446 for (;;) {
447 WATCHDOG_RESET();
448#ifdef CONFIG_SHOW_ACTIVITY
Joe Hershberger48522bb2012-05-15 08:59:08 +0000449 show_activity(1);
wdenk2d966952002-10-31 22:12:35 +0000450#endif
451 /*
452 * Check the ethernet for a new packet. The ethernet
453 * receive routine will process it.
454 */
Guennadi Liakhovetski40cb90e2008-04-03 17:04:19 +0200455 eth_rx();
wdenk2d966952002-10-31 22:12:35 +0000456
457 /*
458 * Abort if ctrl-c was pressed.
459 */
460 if (ctrlc()) {
Joe Hershbergere94070c2012-05-23 07:59:24 +0000461 /* cancel any ARP that may not have completed */
462 NetArpWaitPacketIP = 0;
463
Joe Hershbergerece223b2012-05-23 07:59:15 +0000464 net_cleanup_loop();
wdenk8bde7f72003-06-27 21:31:46 +0000465 eth_halt();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000466 /* Invalidate the last protocol */
467 eth_set_last_protocol(BOOTP);
468
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000469 puts("\nAbort\n");
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000470 /* include a debug print as well incase the debug
471 messages are directed to stderr */
472 debug_cond(DEBUG_INT_STATE, "--- NetLoop Abort!\n");
Simon Glass4793ee62011-10-24 18:00:01 +0000473 goto done;
wdenk2d966952002-10-31 22:12:35 +0000474 }
475
wdenk73a8b272003-06-05 19:27:42 +0000476 ArpTimeoutCheck();
wdenk2d966952002-10-31 22:12:35 +0000477
478 /*
479 * Check for a timeout, and run the timeout handler
480 * if we have one.
481 */
wdenke0ac62d2003-08-17 18:55:18 +0000482 if (timeHandler && ((get_timer(0) - timeStart) > timeDelta)) {
wdenk2d966952002-10-31 22:12:35 +0000483 thand_f *x;
484
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500485#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000486#if defined(CONFIG_SYS_FAULT_ECHO_LINK_DOWN) && \
487 defined(CONFIG_STATUS_LED) && \
488 defined(STATUS_LED_RED)
wdenkfc3e2162003-10-08 22:33:00 +0000489 /*
wdenk42d1f032003-10-15 23:53:47 +0000490 * Echo the inverted link state to the fault LED.
wdenkfc3e2162003-10-08 22:33:00 +0000491 */
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000492 if (miiphy_link(eth_get_dev()->name,
Luca Ceresoli3e38e422011-05-11 03:59:54 +0000493 CONFIG_SYS_FAULT_MII_ADDR)) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000494 status_led_set(STATUS_LED_RED, STATUS_LED_OFF);
wdenkfc3e2162003-10-08 22:33:00 +0000495 } else {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000496 status_led_set(STATUS_LED_RED, STATUS_LED_ON);
wdenkfc3e2162003-10-08 22:33:00 +0000497 }
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000498#endif /* CONFIG_SYS_FAULT_ECHO_LINK_DOWN, ... */
wdenkfc3e2162003-10-08 22:33:00 +0000499#endif /* CONFIG_MII, ... */
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000500 debug_cond(DEBUG_INT_STATE, "--- NetLoop timeout\n");
wdenk2d966952002-10-31 22:12:35 +0000501 x = timeHandler;
502 timeHandler = (thand_f *)0;
503 (*x)();
504 }
505
506
Joe Hershberger22f6e992012-05-23 07:59:14 +0000507 switch (net_state) {
wdenk2d966952002-10-31 22:12:35 +0000508
509 case NETLOOP_RESTART:
wdenk2d966952002-10-31 22:12:35 +0000510 NetRestarted = 1;
wdenk2d966952002-10-31 22:12:35 +0000511 goto restart;
512
513 case NETLOOP_SUCCESS:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000514 net_cleanup_loop();
wdenk2d966952002-10-31 22:12:35 +0000515 if (NetBootFileXferSize > 0) {
Wolfgang Denkf34024d2007-09-12 00:48:57 +0200516 char buf[20];
wdenk2d966952002-10-31 22:12:35 +0000517 printf("Bytes transferred = %ld (%lx hex)\n",
518 NetBootFileXferSize,
519 NetBootFileXferSize);
Wolfgang Denkf34024d2007-09-12 00:48:57 +0200520 sprintf(buf, "%lX", NetBootFileXferSize);
wdenk2d966952002-10-31 22:12:35 +0000521 setenv("filesize", buf);
wdenka3d991b2004-04-15 21:48:45 +0000522
523 sprintf(buf, "%lX", (unsigned long)load_addr);
524 setenv("fileaddr", buf);
wdenk2d966952002-10-31 22:12:35 +0000525 }
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000526 if (protocol != NETCONS)
527 eth_halt();
528 else
529 eth_halt_state_only();
530
531 eth_set_last_protocol(protocol);
532
Simon Glass4793ee62011-10-24 18:00:01 +0000533 ret = NetBootFileXferSize;
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000534 debug_cond(DEBUG_INT_STATE, "--- NetLoop Success!\n");
Simon Glass4793ee62011-10-24 18:00:01 +0000535 goto done;
wdenk2d966952002-10-31 22:12:35 +0000536
537 case NETLOOP_FAIL:
Joe Hershbergerece223b2012-05-23 07:59:15 +0000538 net_cleanup_loop();
Joe Hershbergerf8be7d62012-08-03 10:59:08 +0000539 /* Invalidate the last protocol */
540 eth_set_last_protocol(BOOTP);
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000541 debug_cond(DEBUG_INT_STATE, "--- NetLoop Fail!\n");
Simon Glass4793ee62011-10-24 18:00:01 +0000542 goto done;
Joe Hershberger22f6e992012-05-23 07:59:14 +0000543
544 case NETLOOP_CONTINUE:
545 continue;
wdenk2d966952002-10-31 22:12:35 +0000546 }
547 }
Simon Glass4793ee62011-10-24 18:00:01 +0000548
549done:
Simon Glass39bccd22011-10-26 14:18:38 +0000550#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000551 /* Clear out the handlers */
Joe Hershbergerece223b2012-05-23 07:59:15 +0000552 net_set_udp_handler(NULL);
Simon Glass4793ee62011-10-24 18:00:01 +0000553 net_set_icmp_handler(NULL);
Simon Glass39bccd22011-10-26 14:18:38 +0000554#endif
Simon Glass4793ee62011-10-24 18:00:01 +0000555 return ret;
wdenk2d966952002-10-31 22:12:35 +0000556}
557
558/**********************************************************************/
559
560static void
561startAgainTimeout(void)
562{
Joe Hershberger22f6e992012-05-23 07:59:14 +0000563 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000564}
565
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000566void NetStartAgain(void)
wdenk2d966952002-10-31 22:12:35 +0000567{
wdenk6e592382004-04-18 17:39:38 +0000568 char *nretry;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100569 int retry_forever = 0;
570 unsigned long retrycnt = 0;
wdenka3d991b2004-04-15 21:48:45 +0000571
Remy Bohmer67b96e82009-10-28 22:13:39 +0100572 nretry = getenv("netretry");
573 if (nretry) {
574 if (!strcmp(nretry, "yes"))
575 retry_forever = 1;
576 else if (!strcmp(nretry, "no"))
577 retrycnt = 0;
578 else if (!strcmp(nretry, "once"))
579 retrycnt = 1;
580 else
581 retrycnt = simple_strtoul(nretry, NULL, 0);
582 } else
583 retry_forever = 1;
584
585 if ((!retry_forever) && (NetTryCount >= retrycnt)) {
586 eth_halt();
Joe Hershberger22f6e992012-05-23 07:59:14 +0000587 net_set_state(NETLOOP_FAIL);
wdenka3d991b2004-04-15 21:48:45 +0000588 return;
589 }
Remy Bohmer67b96e82009-10-28 22:13:39 +0100590
591 NetTryCount++;
592
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000593 eth_halt();
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100594#if !defined(CONFIG_NET_DO_NOT_TRY_ANOTHER)
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000595 eth_try_another(!NetRestarted);
Matthias Fuchs8b0c5c12007-12-27 16:58:41 +0100596#endif
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000597 eth_init(gd->bd);
wdenk6e592382004-04-18 17:39:38 +0000598 if (NetRestartWrap) {
wdenk2d966952002-10-31 22:12:35 +0000599 NetRestartWrap = 0;
Remy Bohmer67b96e82009-10-28 22:13:39 +0100600 if (NetDevExists) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000601 NetSetTimeout(10000UL, startAgainTimeout);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000602 net_set_udp_handler(NULL);
wdenk6e592382004-04-18 17:39:38 +0000603 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000604 net_set_state(NETLOOP_FAIL);
wdenk2d966952002-10-31 22:12:35 +0000605 }
wdenk6e592382004-04-18 17:39:38 +0000606 } else {
Joe Hershberger22f6e992012-05-23 07:59:14 +0000607 net_set_state(NETLOOP_RESTART);
wdenk2d966952002-10-31 22:12:35 +0000608 }
wdenk2d966952002-10-31 22:12:35 +0000609}
610
611/**********************************************************************/
612/*
613 * Miscelaneous bits.
614 */
615
Joe Hershbergerece223b2012-05-23 07:59:15 +0000616static void dummy_handler(uchar *pkt, unsigned dport,
617 IPaddr_t sip, unsigned sport,
618 unsigned len)
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000619{
Joe Hershbergerd280d3f2012-05-23 07:58:01 +0000620}
621
Joe Hershbergerece223b2012-05-23 07:59:15 +0000622rxhand_f *net_get_udp_handler(void)
wdenk2d966952002-10-31 22:12:35 +0000623{
Joe Hershbergerece223b2012-05-23 07:59:15 +0000624 return udp_packet_handler;
625}
626
627void net_set_udp_handler(rxhand_f *f)
628{
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000629 debug_cond(DEBUG_INT_STATE, "--- NetLoop UDP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000630 if (f == NULL)
631 udp_packet_handler = dummy_handler;
632 else
633 udp_packet_handler = f;
634}
635
636rxhand_f *net_get_arp_handler(void)
637{
638 return arp_packet_handler;
639}
640
641void net_set_arp_handler(rxhand_f *f)
642{
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000643 debug_cond(DEBUG_INT_STATE, "--- NetLoop ARP handler set (%p)\n", f);
Joe Hershbergerece223b2012-05-23 07:59:15 +0000644 if (f == NULL)
645 arp_packet_handler = dummy_handler;
646 else
647 arp_packet_handler = f;
wdenk2d966952002-10-31 22:12:35 +0000648}
649
Simon Glass39bccd22011-10-26 14:18:38 +0000650#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000651void net_set_icmp_handler(rxhand_icmp_f *f)
652{
653 packet_icmp_handler = f;
654}
Simon Glass39bccd22011-10-26 14:18:38 +0000655#endif
wdenk2d966952002-10-31 22:12:35 +0000656
657void
Luca Ceresoli6b147d12011-05-04 02:40:44 +0000658NetSetTimeout(ulong iv, thand_f *f)
wdenk2d966952002-10-31 22:12:35 +0000659{
660 if (iv == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000661 debug_cond(DEBUG_INT_STATE,
662 "--- NetLoop timeout handler cancelled\n");
wdenk2d966952002-10-31 22:12:35 +0000663 timeHandler = (thand_f *)0;
664 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000665 debug_cond(DEBUG_INT_STATE,
666 "--- NetLoop timeout handler set (%p)\n", f);
wdenk2d966952002-10-31 22:12:35 +0000667 timeHandler = f;
wdenke0ac62d2003-08-17 18:55:18 +0000668 timeStart = get_timer(0);
Tetsuyuki Kobayashi1389f982012-06-25 02:37:27 +0000669 timeDelta = iv * CONFIG_SYS_HZ / 1000;
wdenk2d966952002-10-31 22:12:35 +0000670 }
671}
672
Joe Hershberger206d07f2012-05-23 07:58:10 +0000673int NetSendUDPPacket(uchar *ether, IPaddr_t dest, int dport, int sport,
674 int payload_len)
wdenk73a8b272003-06-05 19:27:42 +0000675{
wdenka3d991b2004-04-15 21:48:45 +0000676 uchar *pkt;
Joe Hershberger92146372012-05-23 07:59:08 +0000677 int eth_hdr_size;
678 int pkt_hdr_size;
wdenka3d991b2004-04-15 21:48:45 +0000679
Joe Hershberger46c495d2012-05-23 07:59:22 +0000680 /* make sure the NetTxPacket is initialized (NetInit() was called) */
681 assert(NetTxPacket != NULL);
682 if (NetTxPacket == NULL)
683 return -1;
684
wdenk73a8b272003-06-05 19:27:42 +0000685 /* convert to new style broadcast */
686 if (dest == 0)
687 dest = 0xFFFFFFFF;
wdenk2d966952002-10-31 22:12:35 +0000688
wdenk73a8b272003-06-05 19:27:42 +0000689 /* if broadcast, make the ether address a broadcast and don't do ARP */
690 if (dest == 0xFFFFFFFF)
691 ether = NetBcastAddr;
692
Joe Hershbergere94070c2012-05-23 07:59:24 +0000693 pkt = (uchar *)NetTxPacket;
wdenk73a8b272003-06-05 19:27:42 +0000694
Joe Hershberger92146372012-05-23 07:59:08 +0000695 eth_hdr_size = NetSetEther(pkt, ether, PROT_IP);
696 pkt += eth_hdr_size;
697 net_set_udp_header(pkt, dest, dport, sport, payload_len);
698 pkt_hdr_size = eth_hdr_size + IP_UDP_HDR_SIZE;
Robin Getz0ebf04c2009-07-23 03:01:03 -0400699
Joe Hershbergere94070c2012-05-23 07:59:24 +0000700 /* if MAC address was not discovered yet, do an ARP request */
701 if (memcmp(ether, NetEtherNullAddr, 6) == 0) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000702 debug_cond(DEBUG_DEV_PKT, "sending ARP for %pI4\n", &dest);
Joe Hershberger92146372012-05-23 07:59:08 +0000703
704 /* save the ip and eth addr for the packet to send after arp */
wdenk73a8b272003-06-05 19:27:42 +0000705 NetArpWaitPacketIP = dest;
706 NetArpWaitPacketMAC = ether;
wdenka3d991b2004-04-15 21:48:45 +0000707
wdenk73a8b272003-06-05 19:27:42 +0000708 /* size of the waiting packet */
Joe Hershberger92146372012-05-23 07:59:08 +0000709 NetArpWaitTxPacketSize = pkt_hdr_size + payload_len;
wdenk73a8b272003-06-05 19:27:42 +0000710
711 /* and do the ARP request */
712 NetArpWaitTry = 1;
713 NetArpWaitTimerStart = get_timer(0);
714 ArpRequest();
715 return 1; /* waiting */
Joe Hershberger92146372012-05-23 07:59:08 +0000716 } else {
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000717 debug_cond(DEBUG_DEV_PKT, "sending UDP to %pI4/%pM\n",
718 &dest, ether);
Joe Hershbergeradf5d932012-05-23 07:59:13 +0000719 NetSendPacket(NetTxPacket, pkt_hdr_size + payload_len);
Joe Hershberger92146372012-05-23 07:59:08 +0000720 return 0; /* transmitted */
wdenk73a8b272003-06-05 19:27:42 +0000721 }
wdenk73a8b272003-06-05 19:27:42 +0000722}
723
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200724#ifdef CONFIG_IP_DEFRAG
725/*
726 * This function collects fragments in a single packet, according
727 * to the algorithm in RFC815. It returns NULL or the pointer to
728 * a complete packet, in static storage
729 */
730#ifndef CONFIG_NET_MAXDEFRAG
731#define CONFIG_NET_MAXDEFRAG 16384
732#endif
733/*
734 * MAXDEFRAG, above, is chosen in the config file and is real data
735 * so we need to add the NFS overhead, which is more than TFTP.
736 * To use sizeof in the internal unnamed structures, we need a real
737 * instance (can't do "sizeof(struct rpc_t.u.reply))", unfortunately).
738 * The compiler doesn't complain nor allocates the actual structure
739 */
740static struct rpc_t rpc_specimen;
741#define IP_PKTSIZE (CONFIG_NET_MAXDEFRAG + sizeof(rpc_specimen.u.reply))
742
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000743#define IP_MAXUDP (IP_PKTSIZE - IP_HDR_SIZE)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200744
745/*
746 * this is the packet being assembled, either data or frag control.
747 * Fragments go by 8 bytes, so this union must be 8 bytes long
748 */
749struct hole {
750 /* first_byte is address of this structure */
751 u16 last_byte; /* last byte in this hole + 1 (begin of next hole) */
752 u16 next_hole; /* index of next (in 8-b blocks), 0 == none */
753 u16 prev_hole; /* index of prev, 0 == none */
754 u16 unused;
755};
756
Joe Hershberger594c26f2012-05-23 07:58:04 +0000757static struct ip_udp_hdr *__NetDefragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200758{
Joe Hershberger48522bb2012-05-15 08:59:08 +0000759 static uchar pkt_buff[IP_PKTSIZE] __aligned(PKTALIGN);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200760 static u16 first_hole, total_len;
761 struct hole *payload, *thisfrag, *h, *newh;
Joe Hershberger594c26f2012-05-23 07:58:04 +0000762 struct ip_udp_hdr *localip = (struct ip_udp_hdr *)pkt_buff;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200763 uchar *indata = (uchar *)ip;
764 int offset8, start, len, done = 0;
765 u16 ip_off = ntohs(ip->ip_off);
766
767 /* payload starts after IP header, this fragment is in there */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000768 payload = (struct hole *)(pkt_buff + IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200769 offset8 = (ip_off & IP_OFFS);
770 thisfrag = payload + offset8;
771 start = offset8 * 8;
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000772 len = ntohs(ip->ip_len) - IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200773
774 if (start + len > IP_MAXUDP) /* fragment extends too far */
775 return NULL;
776
777 if (!total_len || localip->ip_id != ip->ip_id) {
778 /* new (or different) packet, reset structs */
779 total_len = 0xffff;
780 payload[0].last_byte = ~0;
781 payload[0].next_hole = 0;
782 payload[0].prev_hole = 0;
783 first_hole = 0;
784 /* any IP header will work, copy the first we received */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000785 memcpy(localip, ip, IP_HDR_SIZE);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200786 }
787
788 /*
789 * What follows is the reassembly algorithm. We use the payload
790 * array as a linked list of hole descriptors, as each hole starts
791 * at a multiple of 8 bytes. However, last byte can be whatever value,
792 * so it is represented as byte count, not as 8-byte blocks.
793 */
794
795 h = payload + first_hole;
796 while (h->last_byte < start) {
797 if (!h->next_hole) {
798 /* no hole that far away */
799 return NULL;
800 }
801 h = payload + h->next_hole;
802 }
803
Fillod Stephanee397e592010-06-11 19:26:43 +0200804 /* last fragment may be 1..7 bytes, the "+7" forces acceptance */
805 if (offset8 + ((len + 7) / 8) <= h - payload) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200806 /* no overlap with holes (dup fragment?) */
807 return NULL;
808 }
809
810 if (!(ip_off & IP_FLAGS_MFRAG)) {
811 /* no more fragmentss: truncate this (last) hole */
812 total_len = start + len;
813 h->last_byte = start + len;
814 }
815
816 /*
817 * There is some overlap: fix the hole list. This code doesn't
818 * deal with a fragment that overlaps with two different holes
819 * (thus being a superset of a previously-received fragment).
820 */
821
Luca Ceresoli4f63acd2011-05-11 03:59:56 +0000822 if ((h >= thisfrag) && (h->last_byte <= start + len)) {
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200823 /* complete overlap with hole: remove hole */
824 if (!h->prev_hole && !h->next_hole) {
825 /* last remaining hole */
826 done = 1;
827 } else if (!h->prev_hole) {
828 /* first hole */
829 first_hole = h->next_hole;
830 payload[h->next_hole].prev_hole = 0;
831 } else if (!h->next_hole) {
832 /* last hole */
833 payload[h->prev_hole].next_hole = 0;
834 } else {
835 /* in the middle of the list */
836 payload[h->next_hole].prev_hole = h->prev_hole;
837 payload[h->prev_hole].next_hole = h->next_hole;
838 }
839
840 } else if (h->last_byte <= start + len) {
841 /* overlaps with final part of the hole: shorten this hole */
842 h->last_byte = start;
843
844 } else if (h >= thisfrag) {
845 /* overlaps with initial part of the hole: move this hole */
846 newh = thisfrag + (len / 8);
847 *newh = *h;
848 h = newh;
849 if (h->next_hole)
850 payload[h->next_hole].prev_hole = (h - payload);
851 if (h->prev_hole)
852 payload[h->prev_hole].next_hole = (h - payload);
853 else
854 first_hole = (h - payload);
855
856 } else {
857 /* fragment sits in the middle: split the hole */
858 newh = thisfrag + (len / 8);
859 *newh = *h;
860 h->last_byte = start;
861 h->next_hole = (newh - payload);
862 newh->prev_hole = (h - payload);
863 if (newh->next_hole)
864 payload[newh->next_hole].prev_hole = (newh - payload);
865 }
866
867 /* finally copy this fragment and possibly return whole packet */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000868 memcpy((uchar *)thisfrag, indata + IP_HDR_SIZE, len);
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200869 if (!done)
870 return NULL;
871
872 localip->ip_len = htons(total_len);
Joe Hershbergerc5c59df2012-05-23 07:58:05 +0000873 *lenp = total_len + IP_HDR_SIZE;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200874 return localip;
875}
876
Joe Hershberger594c26f2012-05-23 07:58:04 +0000877static inline struct ip_udp_hdr *NetDefragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200878{
879 u16 ip_off = ntohs(ip->ip_off);
880 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
881 return ip; /* not a fragment */
882 return __NetDefragment(ip, lenp);
883}
884
885#else /* !CONFIG_IP_DEFRAG */
886
Joe Hershberger594c26f2012-05-23 07:58:04 +0000887static inline struct ip_udp_hdr *NetDefragment(struct ip_udp_hdr *ip, int *lenp)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +0200888{
889 u16 ip_off = ntohs(ip->ip_off);
890 if (!(ip_off & (IP_OFFS | IP_FLAGS_MFRAG)))
891 return ip; /* not a fragment */
892 return NULL;
893}
894#endif
wdenka3d991b2004-04-15 21:48:45 +0000895
Simon Glass8f79bb12011-10-24 18:00:00 +0000896/**
897 * Receive an ICMP packet. We deal with REDIRECT and PING here, and silently
898 * drop others.
899 *
900 * @parma ip IP packet containing the ICMP
901 */
Joe Hershberger594c26f2012-05-23 07:58:04 +0000902static void receive_icmp(struct ip_udp_hdr *ip, int len,
Joe Hershbergercb487f52012-05-23 07:58:06 +0000903 IPaddr_t src_ip, struct ethernet_hdr *et)
Simon Glass8f79bb12011-10-24 18:00:00 +0000904{
Joe Hershbergere0a63072012-05-23 07:58:09 +0000905 struct icmp_hdr *icmph = (struct icmp_hdr *)&ip->udp_src;
Simon Glass8f79bb12011-10-24 18:00:00 +0000906
907 switch (icmph->type) {
908 case ICMP_REDIRECT:
909 if (icmph->code != ICMP_REDIR_HOST)
910 return;
911 printf(" ICMP Host Redirect to %pI4 ",
912 &icmph->un.gateway);
913 break;
Simon Glass8f79bb12011-10-24 18:00:00 +0000914 default:
Joe Hershbergera36b12f2012-05-23 07:58:02 +0000915#if defined(CONFIG_CMD_PING)
916 ping_receive(et, ip, len);
917#endif
Simon Glass39bccd22011-10-26 14:18:38 +0000918#ifdef CONFIG_CMD_TFTPPUT
Simon Glass4793ee62011-10-24 18:00:01 +0000919 if (packet_icmp_handler)
920 packet_icmp_handler(icmph->type, icmph->code,
921 ntohs(ip->udp_dst), src_ip, ntohs(ip->udp_src),
922 icmph->un.data, ntohs(ip->udp_len));
Simon Glass39bccd22011-10-26 14:18:38 +0000923#endif
Simon Glass8f79bb12011-10-24 18:00:00 +0000924 break;
925 }
926}
927
wdenk2d966952002-10-31 22:12:35 +0000928void
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000929NetReceive(uchar *inpkt, int len)
wdenk2d966952002-10-31 22:12:35 +0000930{
Joe Hershbergercb487f52012-05-23 07:58:06 +0000931 struct ethernet_hdr *et;
Joe Hershberger594c26f2012-05-23 07:58:04 +0000932 struct ip_udp_hdr *ip;
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000933 IPaddr_t dst_ip;
Luca Ceresoli03eb1292011-04-18 06:19:50 +0000934 IPaddr_t src_ip;
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000935 int eth_proto;
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500936#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +0000937 int iscdp;
938#endif
939 ushort cti = 0, vlanid = VLAN_NONE, myvlanid, mynvlanid;
wdenk2d966952002-10-31 22:12:35 +0000940
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000941 debug_cond(DEBUG_NET_PKT, "packet received\n");
wdenka3d991b2004-04-15 21:48:45 +0000942
Mike Frysingerd9bec9f2009-07-18 21:04:08 -0400943 NetRxPacket = inpkt;
944 NetRxPacketLen = len;
Joe Hershbergercb487f52012-05-23 07:58:06 +0000945 et = (struct ethernet_hdr *)inpkt;
wdenka3d991b2004-04-15 21:48:45 +0000946
947 /* too small packet? */
948 if (len < ETHER_HDR_SIZE)
949 return;
950
Rafal Jaworowskif85b6072007-12-27 18:19:02 +0100951#ifdef CONFIG_API
952 if (push_packet) {
953 (*push_packet)(inpkt, len);
954 return;
955 }
956#endif
957
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500958#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +0000959 /* keep track if packet is CDP */
Joe Hershberger17351882012-05-23 07:58:00 +0000960 iscdp = is_cdp_packet(et->et_dest);
wdenka3d991b2004-04-15 21:48:45 +0000961#endif
962
963 myvlanid = ntohs(NetOurVLAN);
964 if (myvlanid == (ushort)-1)
965 myvlanid = VLAN_NONE;
966 mynvlanid = ntohs(NetOurNativeVLAN);
967 if (mynvlanid == (ushort)-1)
968 mynvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +0000969
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000970 eth_proto = ntohs(et->et_protlen);
wdenk2d966952002-10-31 22:12:35 +0000971
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000972 if (eth_proto < 1514) {
Joe Hershbergercb487f52012-05-23 07:58:06 +0000973 struct e802_hdr *et802 = (struct e802_hdr *)et;
wdenk2d966952002-10-31 22:12:35 +0000974 /*
Joe Hershbergerda5ebe22012-05-23 07:58:11 +0000975 * Got a 802.2 packet. Check the other protocol field.
976 * XXX VLAN over 802.2+SNAP not implemented!
wdenk2d966952002-10-31 22:12:35 +0000977 */
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000978 eth_proto = ntohs(et802->et_prot);
wdenka3d991b2004-04-15 21:48:45 +0000979
Joe Hershberger594c26f2012-05-23 07:58:04 +0000980 ip = (struct ip_udp_hdr *)(inpkt + E802_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +0000981 len -= E802_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +0000982
Joe Hershberger8d353eb2012-05-23 07:58:12 +0000983 } else if (eth_proto != PROT_VLAN) { /* normal packet */
Joe Hershberger594c26f2012-05-23 07:58:04 +0000984 ip = (struct ip_udp_hdr *)(inpkt + ETHER_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +0000985 len -= ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +0000986
987 } else { /* VLAN packet */
Joe Hershbergerc68cca32012-05-23 07:58:07 +0000988 struct vlan_ethernet_hdr *vet =
989 (struct vlan_ethernet_hdr *)et;
wdenka3d991b2004-04-15 21:48:45 +0000990
Joe Hershberger4ef8d532012-05-23 08:01:04 +0000991 debug_cond(DEBUG_NET_PKT, "VLAN packet received\n");
Robin Getz0ebf04c2009-07-23 03:01:03 -0400992
wdenka3d991b2004-04-15 21:48:45 +0000993 /* too small packet? */
994 if (len < VLAN_ETHER_HDR_SIZE)
995 return;
996
997 /* if no VLAN active */
998 if ((ntohs(NetOurVLAN) & VLAN_IDMASK) == VLAN_NONE
Jon Loeliger643d1ab2007-07-09 17:45:14 -0500999#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001000 && iscdp == 0
1001#endif
1002 )
1003 return;
1004
1005 cti = ntohs(vet->vet_tag);
1006 vlanid = cti & VLAN_IDMASK;
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001007 eth_proto = ntohs(vet->vet_type);
wdenka3d991b2004-04-15 21:48:45 +00001008
Joe Hershberger594c26f2012-05-23 07:58:04 +00001009 ip = (struct ip_udp_hdr *)(inpkt + VLAN_ETHER_HDR_SIZE);
wdenka3d991b2004-04-15 21:48:45 +00001010 len -= VLAN_ETHER_HDR_SIZE;
wdenk2d966952002-10-31 22:12:35 +00001011 }
1012
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001013 debug_cond(DEBUG_NET_PKT, "Receive from protocol 0x%x\n", eth_proto);
wdenk2d966952002-10-31 22:12:35 +00001014
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001015#if defined(CONFIG_CMD_CDP)
wdenka3d991b2004-04-15 21:48:45 +00001016 if (iscdp) {
Joe Hershberger0b4c5ff2012-05-23 07:58:13 +00001017 cdp_receive((uchar *)ip, len);
wdenka3d991b2004-04-15 21:48:45 +00001018 return;
1019 }
1020#endif
1021
1022 if ((myvlanid & VLAN_IDMASK) != VLAN_NONE) {
1023 if (vlanid == VLAN_NONE)
1024 vlanid = (mynvlanid & VLAN_IDMASK);
1025 /* not matched? */
1026 if (vlanid != (myvlanid & VLAN_IDMASK))
1027 return;
1028 }
1029
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001030 switch (eth_proto) {
wdenk2d966952002-10-31 22:12:35 +00001031
1032 case PROT_ARP:
Joe Hershbergerd280d3f2012-05-23 07:58:01 +00001033 ArpReceive(et, ip, len);
wdenk289f9322005-01-12 00:15:14 +00001034 break;
wdenk2d966952002-10-31 22:12:35 +00001035
Peter Tyserbf6cb242010-09-30 11:25:48 -05001036#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001037 case PROT_RARP:
Joe Hershberger8b9c5322012-05-23 07:58:03 +00001038 rarp_receive(ip, len);
wdenk2d966952002-10-31 22:12:35 +00001039 break;
Peter Tyserbf6cb242010-09-30 11:25:48 -05001040#endif
wdenk2d966952002-10-31 22:12:35 +00001041 case PROT_IP:
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001042 debug_cond(DEBUG_NET_PKT, "Got IP\n");
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001043 /* Before we start poking the header, make sure it is there */
Joe Hershberger594c26f2012-05-23 07:58:04 +00001044 if (len < IP_UDP_HDR_SIZE) {
1045 debug("len bad %d < %lu\n", len,
1046 (ulong)IP_UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001047 return;
1048 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001049 /* Check the packet length */
wdenk2d966952002-10-31 22:12:35 +00001050 if (len < ntohs(ip->ip_len)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001051 debug("len bad %d < %d\n", len, ntohs(ip->ip_len));
wdenk2d966952002-10-31 22:12:35 +00001052 return;
1053 }
1054 len = ntohs(ip->ip_len);
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001055 debug_cond(DEBUG_NET_PKT, "len=%d, v=%02x\n",
1056 len, ip->ip_hl_v & 0xff);
Robin Getz0ebf04c2009-07-23 03:01:03 -04001057
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001058 /* Can't deal with anything except IPv4 */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001059 if ((ip->ip_hl_v & 0xf0) != 0x40)
wdenk2d966952002-10-31 22:12:35 +00001060 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001061 /* Can't deal with IP options (headers != 20 bytes) */
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001062 if ((ip->ip_hl_v & 0x0f) > 0x05)
Remy Bohmer6b52cfe2008-06-03 15:48:17 +02001063 return;
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001064 /* Check the Checksum of the header */
Joe Hershbergerc5c59df2012-05-23 07:58:05 +00001065 if (!NetCksumOk((uchar *)ip, IP_HDR_SIZE / 2)) {
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001066 debug("checksum bad\n");
wdenk2d966952002-10-31 22:12:35 +00001067 return;
1068 }
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001069 /* If it is not for us, ignore it */
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001070 dst_ip = NetReadIP(&ip->ip_dst);
1071 if (NetOurIP && dst_ip != NetOurIP && dst_ip != 0xFFFFFFFF) {
David Updegraff53a5c422007-06-11 10:41:07 -05001072#ifdef CONFIG_MCAST_TFTP
Joe Hershberger8d353eb2012-05-23 07:58:12 +00001073 if (Mcast_addr != dst_ip)
David Updegraff53a5c422007-06-11 10:41:07 -05001074#endif
Luca Ceresolic819abe2011-05-04 02:40:46 +00001075 return;
wdenk2d966952002-10-31 22:12:35 +00001076 }
Luca Ceresoli03eb1292011-04-18 06:19:50 +00001077 /* Read source IP address for later use */
1078 src_ip = NetReadIP(&ip->ip_src);
wdenk2d966952002-10-31 22:12:35 +00001079 /*
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001080 * The function returns the unchanged packet if it's not
1081 * a fragment, and either the complete packet or NULL if
1082 * it is a fragment (if !CONFIG_IP_DEFRAG, it returns NULL)
1083 */
Luca Ceresoliccb9ebe2011-05-04 02:40:47 +00001084 ip = NetDefragment(ip, &len);
1085 if (!ip)
Alessandro Rubini5cfaa4e2009-08-07 13:58:56 +02001086 return;
1087 /*
wdenk2d966952002-10-31 22:12:35 +00001088 * watch for ICMP host redirects
1089 *
wdenk8bde7f72003-06-27 21:31:46 +00001090 * There is no real handler code (yet). We just watch
1091 * for ICMP host redirect messages. In case anybody
1092 * sees these messages: please contact me
1093 * (wd@denx.de), or - even better - send me the
1094 * necessary fixes :-)
wdenk2d966952002-10-31 22:12:35 +00001095 *
wdenk8bde7f72003-06-27 21:31:46 +00001096 * Note: in all cases where I have seen this so far
1097 * it was a problem with the router configuration,
1098 * for instance when a router was configured in the
1099 * BOOTP reply, but the TFTP server was on the same
1100 * subnet. So this is probably a warning that your
1101 * configuration might be wrong. But I'm not really
1102 * sure if there aren't any other situations.
Simon Glass4793ee62011-10-24 18:00:01 +00001103 *
1104 * Simon Glass <sjg@chromium.org>: We get an ICMP when
1105 * we send a tftp packet to a dead connection, or when
1106 * there is no server at the other end.
wdenk2d966952002-10-31 22:12:35 +00001107 */
1108 if (ip->ip_p == IPPROTO_ICMP) {
Simon Glass8f79bb12011-10-24 18:00:00 +00001109 receive_icmp(ip, len, src_ip, et);
1110 return;
wdenk2d966952002-10-31 22:12:35 +00001111 } else if (ip->ip_p != IPPROTO_UDP) { /* Only UDP packets */
1112 return;
1113 }
1114
Joe Hershberger4ef8d532012-05-23 08:01:04 +00001115 debug_cond(DEBUG_DEV_PKT,
1116 "received UDP (to=%pI4, from=%pI4, len=%d)\n",
1117 &dst_ip, &src_ip, len);
1118
Stefan Roese8534bf92005-08-12 20:06:52 +02001119#ifdef CONFIG_UDP_CHECKSUM
1120 if (ip->udp_xsum != 0) {
Wolfgang Denkb2f50802005-08-12 23:43:12 +02001121 ulong xsum;
Stefan Roese8534bf92005-08-12 20:06:52 +02001122 ushort *sumptr;
1123 ushort sumlen;
1124
1125 xsum = ip->ip_p;
1126 xsum += (ntohs(ip->udp_len));
1127 xsum += (ntohl(ip->ip_src) >> 16) & 0x0000ffff;
1128 xsum += (ntohl(ip->ip_src) >> 0) & 0x0000ffff;
1129 xsum += (ntohl(ip->ip_dst) >> 16) & 0x0000ffff;
1130 xsum += (ntohl(ip->ip_dst) >> 0) & 0x0000ffff;
1131
1132 sumlen = ntohs(ip->udp_len);
1133 sumptr = (ushort *) &(ip->udp_src);
1134
1135 while (sumlen > 1) {
Wolfgang Denkb2f50802005-08-12 23:43:12 +02001136 ushort sumdata;
Stefan Roese8534bf92005-08-12 20:06:52 +02001137
1138 sumdata = *sumptr++;
1139 xsum += ntohs(sumdata);
1140 sumlen -= 2;
1141 }
1142 if (sumlen > 0) {
Wolfgang Denkb2f50802005-08-12 23:43:12 +02001143 ushort sumdata;
Stefan Roese8534bf92005-08-12 20:06:52 +02001144
1145 sumdata = *(unsigned char *) sumptr;
Wolfgang Denkb2f50802005-08-12 23:43:12 +02001146 sumdata = (sumdata << 8) & 0xff00;
Stefan Roese8534bf92005-08-12 20:06:52 +02001147 xsum += sumdata;
1148 }
1149 while ((xsum >> 16) != 0) {
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001150 xsum = (xsum & 0x0000ffff) +
1151 ((xsum >> 16) & 0x0000ffff);
Stefan Roese8534bf92005-08-12 20:06:52 +02001152 }
1153 if ((xsum != 0x00000000) && (xsum != 0x0000ffff)) {
Wolfgang Denk9b55a252008-07-11 01:16:00 +02001154 printf(" UDP wrong checksum %08lx %08x\n",
1155 xsum, ntohs(ip->udp_xsum));
Stefan Roese8534bf92005-08-12 20:06:52 +02001156 return;
1157 }
1158 }
1159#endif
1160
David Updegraff53a5c422007-06-11 10:41:07 -05001161
wdenk68ceb292004-08-02 21:11:11 +00001162#ifdef CONFIG_NETCONSOLE
Joe Hershberger594c26f2012-05-23 07:58:04 +00001163 nc_input_packet((uchar *)ip + IP_UDP_HDR_SIZE,
Joe Hershberger8cab08e2012-10-03 09:14:03 +00001164 src_ip,
Joe Hershberger594c26f2012-05-23 07:58:04 +00001165 ntohs(ip->udp_dst),
1166 ntohs(ip->udp_src),
1167 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenk68ceb292004-08-02 21:11:11 +00001168#endif
wdenk2d966952002-10-31 22:12:35 +00001169 /*
1170 * IP header OK. Pass the packet to the current handler.
1171 */
Joe Hershbergerece223b2012-05-23 07:59:15 +00001172 (*udp_packet_handler)((uchar *)ip + IP_UDP_HDR_SIZE,
1173 ntohs(ip->udp_dst),
1174 src_ip,
1175 ntohs(ip->udp_src),
1176 ntohs(ip->udp_len) - UDP_HDR_SIZE);
wdenk2d966952002-10-31 22:12:35 +00001177 break;
1178 }
1179}
1180
1181
1182/**********************************************************************/
1183
Simon Glasse4bf0c52011-10-24 18:00:02 +00001184static int net_check_prereq(enum proto_t protocol)
wdenk2d966952002-10-31 22:12:35 +00001185{
1186 switch (protocol) {
wdenk6e592382004-04-18 17:39:38 +00001187 /* Fall through */
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001188#if defined(CONFIG_CMD_PING)
wdenk73a8b272003-06-05 19:27:42 +00001189 case PING:
wdenk6e592382004-04-18 17:39:38 +00001190 if (NetPingIP == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001191 puts("*** ERROR: ping address not given\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001192 return 1;
wdenk6e592382004-04-18 17:39:38 +00001193 }
1194 goto common;
wdenk73a8b272003-06-05 19:27:42 +00001195#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001196#if defined(CONFIG_CMD_SNTP)
wdenkea287de2005-04-01 00:25:43 +00001197 case SNTP:
1198 if (NetNtpServerIP == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001199 puts("*** ERROR: NTP server address not given\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001200 return 1;
wdenkea287de2005-04-01 00:25:43 +00001201 }
1202 goto common;
1203#endif
Robin Getz1a32bf42009-07-20 14:53:54 -04001204#if defined(CONFIG_CMD_DNS)
1205 case DNS:
1206 if (NetOurDNSIP == 0) {
1207 puts("*** ERROR: DNS server address not given\n");
1208 return 1;
1209 }
1210 goto common;
1211#endif
Jon Loeliger643d1ab2007-07-09 17:45:14 -05001212#if defined(CONFIG_CMD_NFS)
wdenkcbd8a352004-02-24 02:00:03 +00001213 case NFS:
1214#endif
Simon Glasse4bf0c52011-10-24 18:00:02 +00001215 case TFTPGET:
Simon Glass1fb7cd42011-10-24 18:00:07 +00001216 case TFTPPUT:
wdenk6e592382004-04-18 17:39:38 +00001217 if (NetServerIP == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001218 puts("*** ERROR: `serverip' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001219 return 1;
wdenk6e592382004-04-18 17:39:38 +00001220 }
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001221#if defined(CONFIG_CMD_PING) || defined(CONFIG_CMD_SNTP) || \
1222 defined(CONFIG_CMD_DNS)
1223common:
wdenk73a8b272003-06-05 19:27:42 +00001224#endif
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001225 /* Fall through */
wdenk73a8b272003-06-05 19:27:42 +00001226
Simon Guinot8b6bbe12011-05-01 23:38:40 +00001227 case NETCONS:
Luca Ceresoli7a83af02011-05-17 00:03:40 +00001228 case TFTPSRV:
wdenk6e592382004-04-18 17:39:38 +00001229 if (NetOurIP == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001230 puts("*** ERROR: `ipaddr' not set\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001231 return 1;
wdenk6e592382004-04-18 17:39:38 +00001232 }
1233 /* Fall through */
wdenk2d966952002-10-31 22:12:35 +00001234
Peter Tyserbf6cb242010-09-30 11:25:48 -05001235#ifdef CONFIG_CMD_RARP
wdenk2d966952002-10-31 22:12:35 +00001236 case RARP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001237#endif
wdenk2d966952002-10-31 22:12:35 +00001238 case BOOTP:
wdenka3d991b2004-04-15 21:48:45 +00001239 case CDP:
Peter Tyserbf6cb242010-09-30 11:25:48 -05001240 case DHCP:
Joe Hershbergerd22c3382012-05-23 08:00:12 +00001241 case LINKLOCAL:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001242 if (memcmp(NetOurEther, "\0\0\0\0\0\0", 6) == 0) {
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001243 int num = eth_get_dev_index();
wdenk2d966952002-10-31 22:12:35 +00001244
wdenk6e592382004-04-18 17:39:38 +00001245 switch (num) {
1246 case -1:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001247 puts("*** ERROR: No ethernet found.\n");
Luca Ceresoli92895de2011-05-04 02:40:45 +00001248 return 1;
wdenk6e592382004-04-18 17:39:38 +00001249 case 0:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001250 puts("*** ERROR: `ethaddr' not set\n");
wdenk2d966952002-10-31 22:12:35 +00001251 break;
wdenk6e592382004-04-18 17:39:38 +00001252 default:
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001253 printf("*** ERROR: `eth%daddr' not set\n",
wdenk2d966952002-10-31 22:12:35 +00001254 num);
1255 break;
wdenk2d966952002-10-31 22:12:35 +00001256 }
wdenk6e592382004-04-18 17:39:38 +00001257
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001258 NetStartAgain();
Luca Ceresoli92895de2011-05-04 02:40:45 +00001259 return 2;
wdenk6e592382004-04-18 17:39:38 +00001260 }
1261 /* Fall through */
1262 default:
Luca Ceresoli92895de2011-05-04 02:40:45 +00001263 return 0;
wdenk2d966952002-10-31 22:12:35 +00001264 }
Luca Ceresoli92895de2011-05-04 02:40:45 +00001265 return 0; /* OK */
wdenk2d966952002-10-31 22:12:35 +00001266}
1267/**********************************************************************/
1268
1269int
Luca Ceresoli6b147d12011-05-04 02:40:44 +00001270NetCksumOk(uchar *ptr, int len)
wdenk2d966952002-10-31 22:12:35 +00001271{
1272 return !((NetCksum(ptr, len) + 1) & 0xfffe);
1273}
1274
1275
1276unsigned
Luca Ceresoli6b147d12011-05-04 02:40:44 +00001277NetCksum(uchar *ptr, int len)
wdenk2d966952002-10-31 22:12:35 +00001278{
1279 ulong xsum;
Stefan Roese9d2a8732005-08-31 12:55:50 +02001280 ushort *p = (ushort *)ptr;
wdenk2d966952002-10-31 22:12:35 +00001281
1282 xsum = 0;
1283 while (len-- > 0)
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +02001284 xsum += *p++;
wdenk2d966952002-10-31 22:12:35 +00001285 xsum = (xsum & 0xffff) + (xsum >> 16);
1286 xsum = (xsum & 0xffff) + (xsum >> 16);
Luca Ceresoli92895de2011-05-04 02:40:45 +00001287 return xsum & 0xffff;
wdenk2d966952002-10-31 22:12:35 +00001288}
1289
wdenka3d991b2004-04-15 21:48:45 +00001290int
1291NetEthHdrSize(void)
1292{
1293 ushort myvlanid;
wdenk2d966952002-10-31 22:12:35 +00001294
wdenka3d991b2004-04-15 21:48:45 +00001295 myvlanid = ntohs(NetOurVLAN);
1296 if (myvlanid == (ushort)-1)
1297 myvlanid = VLAN_NONE;
1298
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001299 return ((myvlanid & VLAN_IDMASK) == VLAN_NONE) ? ETHER_HDR_SIZE :
1300 VLAN_ETHER_HDR_SIZE;
wdenka3d991b2004-04-15 21:48:45 +00001301}
1302
1303int
Joe Hershbergerdb288a92012-05-15 08:59:04 +00001304NetSetEther(uchar *xet, uchar * addr, uint prot)
wdenk2d966952002-10-31 22:12:35 +00001305{
Joe Hershbergercb487f52012-05-23 07:58:06 +00001306 struct ethernet_hdr *et = (struct ethernet_hdr *)xet;
wdenka3d991b2004-04-15 21:48:45 +00001307 ushort myvlanid;
1308
1309 myvlanid = ntohs(NetOurVLAN);
1310 if (myvlanid == (ushort)-1)
1311 myvlanid = VLAN_NONE;
wdenk2d966952002-10-31 22:12:35 +00001312
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001313 memcpy(et->et_dest, addr, 6);
1314 memcpy(et->et_src, NetOurEther, 6);
wdenka3d991b2004-04-15 21:48:45 +00001315 if ((myvlanid & VLAN_IDMASK) == VLAN_NONE) {
Luca Ceresolic819abe2011-05-04 02:40:46 +00001316 et->et_protlen = htons(prot);
wdenka3d991b2004-04-15 21:48:45 +00001317 return ETHER_HDR_SIZE;
1318 } else {
Joe Hershbergerc68cca32012-05-23 07:58:07 +00001319 struct vlan_ethernet_hdr *vet =
1320 (struct vlan_ethernet_hdr *)xet;
wdenk2d966952002-10-31 22:12:35 +00001321
wdenka3d991b2004-04-15 21:48:45 +00001322 vet->vet_vlan_type = htons(PROT_VLAN);
1323 vet->vet_tag = htons((0 << 5) | (myvlanid & VLAN_IDMASK));
1324 vet->vet_type = htons(prot);
1325 return VLAN_ETHER_HDR_SIZE;
1326 }
1327}
wdenk2d966952002-10-31 22:12:35 +00001328
Joe Hershbergere7111012012-05-23 07:59:16 +00001329int net_update_ether(struct ethernet_hdr *et, uchar *addr, uint prot)
1330{
1331 ushort protlen;
1332
1333 memcpy(et->et_dest, addr, 6);
1334 memcpy(et->et_src, NetOurEther, 6);
1335 protlen = ntohs(et->et_protlen);
1336 if (protlen == PROT_VLAN) {
1337 struct vlan_ethernet_hdr *vet =
1338 (struct vlan_ethernet_hdr *)et;
1339 vet->vet_type = htons(prot);
1340 return VLAN_ETHER_HDR_SIZE;
1341 } else if (protlen > 1514) {
1342 et->et_protlen = htons(prot);
1343 return ETHER_HDR_SIZE;
1344 } else {
1345 /* 802.2 + SNAP */
1346 struct e802_hdr *et802 = (struct e802_hdr *)et;
1347 et802->et_prot = htons(prot);
1348 return E802_HDR_SIZE;
1349 }
1350}
1351
Joe Hershberger4b11c912012-05-23 07:59:07 +00001352void net_set_ip_header(uchar *pkt, IPaddr_t dest, IPaddr_t source)
wdenk2d966952002-10-31 22:12:35 +00001353{
Joe Hershberger4b11c912012-05-23 07:59:07 +00001354 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
1355
1356 /*
1357 * Construct an IP header.
1358 */
1359 /* IP_HDR_SIZE / 4 (not including UDP) */
1360 ip->ip_hl_v = 0x45;
1361 ip->ip_tos = 0;
1362 ip->ip_len = htons(IP_HDR_SIZE);
1363 ip->ip_id = htons(NetIPID++);
1364 ip->ip_off = htons(IP_FLAGS_DFRAG); /* Don't fragment */
1365 ip->ip_ttl = 255;
1366 ip->ip_sum = 0;
1367 /* already in network byte order */
1368 NetCopyIP((void *)&ip->ip_src, &source);
1369 /* already in network byte order */
1370 NetCopyIP((void *)&ip->ip_dst, &dest);
1371}
1372
1373void net_set_udp_header(uchar *pkt, IPaddr_t dest, int dport, int sport,
1374 int len)
1375{
1376 struct ip_udp_hdr *ip = (struct ip_udp_hdr *)pkt;
wdenk2d966952002-10-31 22:12:35 +00001377
1378 /*
1379 * If the data is an odd number of bytes, zero the
1380 * byte after the last byte so that the checksum
1381 * will work.
1382 */
1383 if (len & 1)
Joe Hershberger4b11c912012-05-23 07:59:07 +00001384 pkt[IP_UDP_HDR_SIZE + len] = 0;
wdenk2d966952002-10-31 22:12:35 +00001385
Joe Hershberger4b11c912012-05-23 07:59:07 +00001386 net_set_ip_header(pkt, dest, NetOurIP);
Joe Hershberger594c26f2012-05-23 07:58:04 +00001387 ip->ip_len = htons(IP_UDP_HDR_SIZE + len);
Joe Hershberger4b11c912012-05-23 07:59:07 +00001388 ip->ip_p = IPPROTO_UDP;
1389 ip->ip_sum = ~NetCksum((uchar *)ip, IP_HDR_SIZE >> 1);
1390
wdenk2d966952002-10-31 22:12:35 +00001391 ip->udp_src = htons(sport);
1392 ip->udp_dst = htons(dport);
Joe Hershberger594c26f2012-05-23 07:58:04 +00001393 ip->udp_len = htons(UDP_HDR_SIZE + len);
wdenk2d966952002-10-31 22:12:35 +00001394 ip->udp_xsum = 0;
wdenk2d966952002-10-31 22:12:35 +00001395}
1396
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001397void copy_filename(char *dst, const char *src, int size)
wdenk2d966952002-10-31 22:12:35 +00001398{
1399 if (*src && (*src == '"')) {
1400 ++src;
1401 --size;
1402 }
1403
Luca Ceresolid3c65b02011-05-04 02:40:43 +00001404 while ((--size > 0) && *src && (*src != '"'))
wdenk2d966952002-10-31 22:12:35 +00001405 *dst++ = *src++;
wdenk2d966952002-10-31 22:12:35 +00001406 *dst = '\0';
1407}
1408
Luca Ceresoli3e38e422011-05-11 03:59:54 +00001409#if defined(CONFIG_CMD_NFS) || \
1410 defined(CONFIG_CMD_SNTP) || \
1411 defined(CONFIG_CMD_DNS)
Robin Getz1a32bf42009-07-20 14:53:54 -04001412/*
Robin Getz97399462010-03-08 14:07:00 -05001413 * make port a little random (1024-17407)
1414 * This keeps the math somewhat trivial to compute, and seems to work with
1415 * all supported protocols/clients/servers
Robin Getz1a32bf42009-07-20 14:53:54 -04001416 */
1417unsigned int random_port(void)
1418{
Robin Getz97399462010-03-08 14:07:00 -05001419 return 1024 + (get_timer(0) % 0x4000);
Robin Getz1a32bf42009-07-20 14:53:54 -04001420}
1421#endif
1422
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001423void ip_to_string(IPaddr_t x, char *s)
wdenk2d966952002-10-31 22:12:35 +00001424{
Luca Ceresoli4f63acd2011-05-11 03:59:56 +00001425 x = ntohl(x);
1426 sprintf(s, "%d.%d.%d.%d",
1427 (int) ((x >> 24) & 0xff),
1428 (int) ((x >> 16) & 0xff),
1429 (int) ((x >> 8) & 0xff), (int) ((x >> 0) & 0xff)
wdenk6e592382004-04-18 17:39:38 +00001430 );
wdenk2d966952002-10-31 22:12:35 +00001431}
1432
wdenka3d991b2004-04-15 21:48:45 +00001433void VLAN_to_string(ushort x, char *s)
1434{
1435 x = ntohs(x);
1436
1437 if (x == (ushort)-1)
1438 x = VLAN_NONE;
1439
1440 if (x == VLAN_NONE)
1441 strcpy(s, "none");
1442 else
1443 sprintf(s, "%d", x & VLAN_IDMASK);
1444}
1445
Mike Frysinger2e3ef6e2010-10-20 07:16:48 -04001446ushort string_to_VLAN(const char *s)
wdenka3d991b2004-04-15 21:48:45 +00001447{
1448 ushort id;
1449
1450 if (s == NULL)
wdenkb9711de2004-04-25 13:18:40 +00001451 return htons(VLAN_NONE);
wdenka3d991b2004-04-15 21:48:45 +00001452
1453 if (*s < '0' || *s > '9')
1454 id = VLAN_NONE;
1455 else
1456 id = (ushort)simple_strtoul(s, NULL, 10);
1457
wdenkb9711de2004-04-25 13:18:40 +00001458 return htons(id);
wdenka3d991b2004-04-15 21:48:45 +00001459}
1460
wdenka3d991b2004-04-15 21:48:45 +00001461ushort getenv_VLAN(char *var)
1462{
Luca Ceresoli92895de2011-05-04 02:40:45 +00001463 return string_to_VLAN(getenv(var));
wdenka3d991b2004-04-15 21:48:45 +00001464}