blob: bfc4c9bde9cb965484afe0c8188b2226d4bf1a6c [file] [log] [blame]
wdenkfe8c2802002-11-03 00:38:21 +00001/*
Luca Ceresoli2f094132011-05-14 05:49:56 +00002 * Copyright 1994, 1995, 2000 Neil Russell.
3 * (See License)
4 * Copyright 2000, 2001 DENX Software Engineering, Wolfgang Denk, wd@denx.de
Luca Ceresolie59e3562011-05-17 00:03:39 +00005 * Copyright 2011 Comelit Group SpA,
6 * Luca Ceresoli <luca.ceresoli@comelit.it>
wdenkfe8c2802002-11-03 00:38:21 +00007 */
wdenkfe8c2802002-11-03 00:38:21 +00008#include <common.h>
9#include <command.h>
Alexander Graf0efe1bc2016-05-06 21:01:01 +020010#include <efi_loader.h>
Simon Glass7b51b572019-08-01 09:46:52 -060011#include <env.h>
Simon Glass8e8ccfe2019-12-28 10:45:03 -070012#include <image.h>
Simon Glass4d72caa2020-05-10 11:40:01 -060013#include <lmb.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060014#include <log.h>
Joe Hershberger55d5fd92015-03-22 17:09:08 -050015#include <mapmem.h>
wdenkfe8c2802002-11-03 00:38:21 +000016#include <net.h>
Simon Glass401d1c42020-10-30 21:38:53 -060017#include <asm/global_data.h>
Lukasz Majewski34696952015-08-24 00:21:43 +020018#include <net/tftp.h>
wdenkfe8c2802002-11-03 00:38:21 +000019#include "bootp.h"
Joe Hershberger13dfe942012-05-15 08:59:12 +000020#ifdef CONFIG_SYS_DIRECT_FLASH_TFTP
21#include <flash.h>
22#endif
wdenkfe8c2802002-11-03 00:38:21 +000023
Simon Goldschmidta156c472019-01-14 22:38:22 +010024DECLARE_GLOBAL_DATA_PTR;
25
Luca Ceresoli2f094132011-05-14 05:49:56 +000026/* Well known TFTP port # */
27#define WELL_KNOWN_PORT 69
28/* Millisecs to timeout for lost pkt */
Bin Mengaf2ca592015-08-27 22:25:51 -070029#define TIMEOUT 5000UL
Luca Ceresoli2f094132011-05-14 05:49:56 +000030/* Number of "loading" hashes per line (for checking the image size) */
31#define HASHES_PER_LINE 65
wdenkfe8c2802002-11-03 00:38:21 +000032
33/*
34 * TFTP operations.
35 */
36#define TFTP_RRQ 1
37#define TFTP_WRQ 2
38#define TFTP_DATA 3
39#define TFTP_ACK 4
40#define TFTP_ERROR 5
wdenkfbe4b5c2003-10-06 21:55:32 +000041#define TFTP_OACK 6
wdenkfe8c2802002-11-03 00:38:21 +000042
Joe Hershberger8885c5f2015-04-08 01:41:07 -050043static ulong timeout_ms = TIMEOUT;
Tom Rini01d1b992022-03-11 09:12:02 -050044static int timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2);
Simon Glass85b19802012-10-11 13:57:36 +000045static ulong time_start; /* Record time we started tftp */
Bartlomiej Siekae83cc062008-10-01 15:26:29 +020046
47/*
48 * These globals govern the timeout behavior when attempting a connection to a
Joe Hershberger8885c5f2015-04-08 01:41:07 -050049 * TFTP server. tftp_timeout_ms specifies the number of milliseconds to
Bartlomiej Siekae83cc062008-10-01 15:26:29 +020050 * wait for the server to respond to initial connection. Second global,
Joe Hershberger8885c5f2015-04-08 01:41:07 -050051 * tftp_timeout_count_max, gives the number of such connection retries.
52 * tftp_timeout_count_max must be non-negative and tftp_timeout_ms must be
Bartlomiej Siekae83cc062008-10-01 15:26:29 +020053 * positive. The globals are meant to be set (and restored) by code needing
54 * non-standard timeout behavior when initiating a TFTP transfer.
55 */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050056ulong tftp_timeout_ms = TIMEOUT;
Tom Rini01d1b992022-03-11 09:12:02 -050057int tftp_timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2);
Bartlomiej Siekae83cc062008-10-01 15:26:29 +020058
Remy Bohmeraafda382009-10-28 22:13:40 +010059enum {
60 TFTP_ERR_UNDEFINED = 0,
61 TFTP_ERR_FILE_NOT_FOUND = 1,
62 TFTP_ERR_ACCESS_DENIED = 2,
63 TFTP_ERR_DISK_FULL = 3,
64 TFTP_ERR_UNEXPECTED_OPCODE = 4,
65 TFTP_ERR_UNKNOWN_TRANSFER_ID = 5,
66 TFTP_ERR_FILE_ALREADY_EXISTS = 6,
Ravik Hasija08139212020-05-18 21:35:43 -070067 TFTP_ERR_OPTION_NEGOTIATION = 8,
Remy Bohmeraafda382009-10-28 22:13:40 +010068};
69
Joe Hershberger049a95a2015-04-08 01:41:01 -050070static struct in_addr tftp_remote_ip;
Luca Ceresoli2f094132011-05-14 05:49:56 +000071/* The UDP port at their end */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050072static int tftp_remote_port;
Luca Ceresoli2f094132011-05-14 05:49:56 +000073/* The UDP port at our end */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050074static int tftp_our_port;
75static int timeout_count;
Luca Ceresoli2f094132011-05-14 05:49:56 +000076/* packet sequence number */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050077static ulong tftp_cur_block;
Luca Ceresoli2f094132011-05-14 05:49:56 +000078/* last packet sequence number received */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050079static ulong tftp_prev_block;
Luca Ceresoli2f094132011-05-14 05:49:56 +000080/* count of sequence number wraparounds */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050081static ulong tftp_block_wrap;
Luca Ceresoli2f094132011-05-14 05:49:56 +000082/* memory offset due to wrapping */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050083static ulong tftp_block_wrap_offset;
84static int tftp_state;
Simon Goldschmidta156c472019-01-14 22:38:22 +010085static ulong tftp_load_addr;
86#ifdef CONFIG_LMB
87static ulong tftp_load_size;
88#endif
Robin Getz4fccb812009-08-20 10:50:20 -040089#ifdef CONFIG_TFTP_TSIZE
Luca Ceresoli2f094132011-05-14 05:49:56 +000090/* The file size reported by the server */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050091static int tftp_tsize;
Luca Ceresoli2f094132011-05-14 05:49:56 +000092/* The number of hashes we printed */
Joe Hershberger8885c5f2015-04-08 01:41:07 -050093static short tftp_tsize_num_hash;
Robin Getz4fccb812009-08-20 10:50:20 -040094#endif
Ramon Friedcc6b87e2020-07-18 23:31:46 +030095/* The window size negotiated */
96static ushort tftp_windowsize;
97/* Next block to send ack to */
98static ushort tftp_next_ack;
99/* Last nack block we send */
100static ushort tftp_last_nack;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000101#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500102/* 1 if writing, else 0 */
103static int tftp_put_active;
104/* 1 if we have sent the last block */
105static int tftp_put_final_block_sent;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000106#else
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500107#define tftp_put_active 0
Simon Glass1fb7cd42011-10-24 18:00:07 +0000108#endif
wdenk3f85ce22004-02-23 16:11:30 +0000109
Luca Ceresolie3fb0ab2011-05-17 00:03:38 +0000110#define STATE_SEND_RRQ 1
wdenkfe8c2802002-11-03 00:38:21 +0000111#define STATE_DATA 2
112#define STATE_TOO_LARGE 3
113#define STATE_BAD_MAGIC 4
wdenkfbe4b5c2003-10-06 21:55:32 +0000114#define STATE_OACK 5
Luca Ceresolie59e3562011-05-17 00:03:39 +0000115#define STATE_RECV_WRQ 6
Simon Glass1fb7cd42011-10-24 18:00:07 +0000116#define STATE_SEND_WRQ 7
Ravik Hasija08139212020-05-18 21:35:43 -0700117#define STATE_INVALID_OPTION 8
wdenkfe8c2802002-11-03 00:38:21 +0000118
Luca Ceresoli2f094132011-05-14 05:49:56 +0000119/* default TFTP block size */
120#define TFTP_BLOCK_SIZE 512
121/* sequence number is 16 bit */
122#define TFTP_SEQUENCE_SIZE ((ulong)(1<<16))
wdenk3f85ce22004-02-23 16:11:30 +0000123
wdenkfe8c2802002-11-03 00:38:21 +0000124#define DEFAULT_NAME_LEN (8 + 4 + 1)
125static char default_filename[DEFAULT_NAME_LEN];
Jean-Christophe PLAGNIOL-VILLARDa93907c2008-01-18 01:14:03 +0100126
127#ifndef CONFIG_TFTP_FILE_NAME_MAX_LEN
128#define MAX_LEN 128
129#else
130#define MAX_LEN CONFIG_TFTP_FILE_NAME_MAX_LEN
131#endif
132
133static char tftp_filename[MAX_LEN];
wdenkfe8c2802002-11-03 00:38:21 +0000134
Wolfgang Denk85eb5ca2007-08-14 09:47:27 +0200135/* 512 is poor choice for ethernet, MTU is typically 1500.
136 * Minus eth.hdrs thats 1468. Can get 2x better throughput with
David Updegraff53a5c422007-06-11 10:41:07 -0500137 * almost-MTU block sizes. At least try... fall back to 512 if need be.
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200138 * (but those using CONFIG_IP_DEFRAG may want to set a larger block in cfg file)
David Updegraff53a5c422007-06-11 10:41:07 -0500139 */
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200140
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300141/* When windowsize is defined to 1,
142 * tftp behaves the same way as it was
143 * never declared
144 */
145#ifdef CONFIG_TFTP_WINDOWSIZE
146#define TFTP_WINDOWSIZE CONFIG_TFTP_WINDOWSIZE
147#else
148#define TFTP_WINDOWSIZE 1
149#endif
150
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500151static unsigned short tftp_block_size = TFTP_BLOCK_SIZE;
Patrick Delaunay31d275b2020-04-22 14:18:26 +0200152static unsigned short tftp_block_size_option = CONFIG_TFTP_BLOCKSIZE;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300153static unsigned short tftp_window_size_option = TFTP_WINDOWSIZE;
David Updegraff53a5c422007-06-11 10:41:07 -0500154
Simon Goldschmidta156c472019-01-14 22:38:22 +0100155static inline int store_block(int block, uchar *src, unsigned int len)
wdenkfe8c2802002-11-03 00:38:21 +0000156{
Ley Foon Tanae0bdf02020-08-25 10:26:36 +0800157 ulong offset = block * tftp_block_size + tftp_block_wrap_offset -
158 tftp_block_size;
wdenk3f85ce22004-02-23 16:11:30 +0000159 ulong newsize = offset + len;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100160 ulong store_addr = tftp_load_addr + offset;
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200161#ifdef CONFIG_SYS_DIRECT_FLASH_TFTP
wdenkfe8c2802002-11-03 00:38:21 +0000162 int i, rc = 0;
163
Luca Ceresolic718b142011-05-14 05:49:57 +0000164 for (i = 0; i < CONFIG_SYS_MAX_FLASH_BANKS; i++) {
wdenkfe8c2802002-11-03 00:38:21 +0000165 /* start address in flash? */
Jochen Friedrichbe1b0d22008-09-02 11:24:59 +0200166 if (flash_info[i].flash_id == FLASH_UNKNOWN)
167 continue;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100168 if (store_addr >= flash_info[i].start[0]) {
wdenkfe8c2802002-11-03 00:38:21 +0000169 rc = 1;
170 break;
171 }
172 }
173
174 if (rc) { /* Flash is destination for this packet */
Simon Goldschmidta156c472019-01-14 22:38:22 +0100175 rc = flash_write((char *)src, store_addr, len);
wdenkfe8c2802002-11-03 00:38:21 +0000176 if (rc) {
Luca Ceresolic718b142011-05-14 05:49:57 +0000177 flash_perror(rc);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100178 return rc;
wdenkfe8c2802002-11-03 00:38:21 +0000179 }
Joe Hershberger13dfe942012-05-15 08:59:12 +0000180 } else
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200181#endif /* CONFIG_SYS_DIRECT_FLASH_TFTP */
wdenkfe8c2802002-11-03 00:38:21 +0000182 {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100183 void *ptr;
Joe Hershberger55d5fd92015-03-22 17:09:08 -0500184
Simon Goldschmidta156c472019-01-14 22:38:22 +0100185#ifdef CONFIG_LMB
Bin Mengca48cb42019-11-15 22:20:13 -0800186 ulong end_addr = tftp_load_addr + tftp_load_size;
187
188 if (!end_addr)
189 end_addr = ULONG_MAX;
190
Simon Goldschmidta156c472019-01-14 22:38:22 +0100191 if (store_addr < tftp_load_addr ||
Bin Mengca48cb42019-11-15 22:20:13 -0800192 store_addr + len > end_addr) {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100193 puts("\nTFTP error: ");
194 puts("trying to overwrite reserved memory...\n");
195 return -1;
196 }
197#endif
198 ptr = map_sysmem(store_addr, len);
Joe Hershberger55d5fd92015-03-22 17:09:08 -0500199 memcpy(ptr, src, len);
200 unmap_sysmem(ptr);
wdenkfe8c2802002-11-03 00:38:21 +0000201 }
202
Joe Hershberger14111572015-04-08 01:41:02 -0500203 if (net_boot_file_size < newsize)
204 net_boot_file_size = newsize;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100205
206 return 0;
wdenkfe8c2802002-11-03 00:38:21 +0000207}
208
Simon Glasse4cde2f2011-10-24 18:00:04 +0000209/* Clear our state ready for a new transfer */
Simon Glass165099e2011-10-27 06:24:28 +0000210static void new_transfer(void)
Simon Glasse4cde2f2011-10-24 18:00:04 +0000211{
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500212 tftp_prev_block = 0;
213 tftp_block_wrap = 0;
214 tftp_block_wrap_offset = 0;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000215#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500216 tftp_put_final_block_sent = 0;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000217#endif
218}
219
Simon Glass1fb7cd42011-10-24 18:00:07 +0000220#ifdef CONFIG_CMD_TFTPPUT
221/**
222 * Load the next block from memory to be sent over tftp.
223 *
224 * @param block Block number to send
225 * @param dst Destination buffer for data
226 * @param len Number of bytes in block (this one and every other)
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100227 * Return: number of bytes loaded
Simon Glass1fb7cd42011-10-24 18:00:07 +0000228 */
229static int load_block(unsigned block, uchar *dst, unsigned len)
230{
231 /* We may want to get the final block from the previous set */
Ley Foon Tanf6a158b2020-08-25 10:26:37 +0800232 ulong offset = block * tftp_block_size + tftp_block_wrap_offset -
233 tftp_block_size;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000234 ulong tosend = len;
235
Joe Hershberger14111572015-04-08 01:41:02 -0500236 tosend = min(net_boot_file_size - offset, tosend);
Simon Glassbb872dd2019-12-28 10:45:02 -0700237 (void)memcpy(dst, (void *)(image_save_addr + offset), tosend);
Heinrich Schuchardt2bcc43b2020-02-22 08:43:40 +0100238 debug("%s: block=%u, offset=%lu, len=%u, tosend=%lu\n", __func__,
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500239 block, offset, len, tosend);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000240 return tosend;
241}
242#endif
243
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500244static void tftp_send(void);
245static void tftp_timeout_handler(void);
wdenkfe8c2802002-11-03 00:38:21 +0000246
247/**********************************************************************/
248
Simon Glassf5329bb2011-10-24 18:00:03 +0000249static void show_block_marker(void)
250{
Ravik Hasijade5468e2020-05-07 14:55:32 -0700251 ulong pos;
252
Simon Glassf5329bb2011-10-24 18:00:03 +0000253#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500254 if (tftp_tsize) {
Ravik Hasijade5468e2020-05-07 14:55:32 -0700255 pos = tftp_cur_block * tftp_block_size +
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500256 tftp_block_wrap_offset;
Max Krummenacher7628afe2015-08-05 17:17:05 +0200257 if (pos > tftp_tsize)
258 pos = tftp_tsize;
Simon Glassf5329bb2011-10-24 18:00:03 +0000259
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500260 while (tftp_tsize_num_hash < pos * 50 / tftp_tsize) {
Simon Glassf5329bb2011-10-24 18:00:03 +0000261 putc('#');
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500262 tftp_tsize_num_hash++;
Simon Glassf5329bb2011-10-24 18:00:03 +0000263 }
Simon Glass1fb7cd42011-10-24 18:00:07 +0000264 } else
Simon Glassf5329bb2011-10-24 18:00:03 +0000265#endif
Simon Glass1fb7cd42011-10-24 18:00:07 +0000266 {
Ravik Hasijade5468e2020-05-07 14:55:32 -0700267 pos = (tftp_cur_block - 1) +
268 (tftp_block_wrap * TFTP_SEQUENCE_SIZE);
269 if ((pos % 10) == 0)
Simon Glassf5329bb2011-10-24 18:00:03 +0000270 putc('#');
Ravik Hasijade5468e2020-05-07 14:55:32 -0700271 else if (((pos + 1) % (10 * HASHES_PER_LINE)) == 0)
Simon Glassf5329bb2011-10-24 18:00:03 +0000272 puts("\n\t ");
273 }
274}
275
Simon Glasse4cde2f2011-10-24 18:00:04 +0000276/**
277 * restart the current transfer due to an error
278 *
279 * @param msg Message to print for user
280 */
281static void restart(const char *msg)
282{
283 printf("\n%s; starting again\n", msg);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500284 net_start_again();
Simon Glasse4cde2f2011-10-24 18:00:04 +0000285}
286
287/*
288 * Check if the block number has wrapped, and update progress
289 *
290 * TODO: The egregious use of global variables in this file should be tidied.
291 */
292static void update_block_number(void)
293{
294 /*
295 * RFC1350 specifies that the first data packet will
296 * have sequence number 1. If we receive a sequence
297 * number of 0 this means that there was a wrap
298 * around of the (16 bit) counter.
299 */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500300 if (tftp_cur_block == 0 && tftp_prev_block != 0) {
301 tftp_block_wrap++;
302 tftp_block_wrap_offset += tftp_block_size * TFTP_SEQUENCE_SIZE;
303 timeout_count = 0; /* we've done well, reset the timeout */
Simon Glasse4cde2f2011-10-24 18:00:04 +0000304 }
Ravik Hasijade5468e2020-05-07 14:55:32 -0700305 show_block_marker();
Simon Glasse4cde2f2011-10-24 18:00:04 +0000306}
307
Simon Glassf5329bb2011-10-24 18:00:03 +0000308/* The TFTP get or put is complete */
309static void tftp_complete(void)
310{
311#ifdef CONFIG_TFTP_TSIZE
312 /* Print hash marks for the last packet received */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500313 while (tftp_tsize && tftp_tsize_num_hash < 49) {
Simon Glassf5329bb2011-10-24 18:00:03 +0000314 putc('#');
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500315 tftp_tsize_num_hash++;
Simon Glassf5329bb2011-10-24 18:00:03 +0000316 }
Simon Glass8104f542014-10-10 07:30:21 -0600317 puts(" ");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500318 print_size(tftp_tsize, "");
Simon Glassf5329bb2011-10-24 18:00:03 +0000319#endif
Simon Glass85b19802012-10-11 13:57:36 +0000320 time_start = get_timer(time_start);
321 if (time_start > 0) {
322 puts("\n\t "); /* Line up with "Loading: " */
Joe Hershberger14111572015-04-08 01:41:02 -0500323 print_size(net_boot_file_size /
Simon Glass85b19802012-10-11 13:57:36 +0000324 time_start * 1000, "/s");
325 }
Simon Glassf5329bb2011-10-24 18:00:03 +0000326 puts("\ndone\n");
Heinrich Schuchardt5f595182021-01-12 12:46:24 +0100327 if (IS_ENABLED(CONFIG_CMD_BOOTEFI)) {
328 if (!tftp_put_active)
329 efi_set_bootdev("Net", "", tftp_filename,
330 map_sysmem(tftp_load_addr, 0),
331 net_boot_file_size);
332 }
Joe Hershberger22f6e992012-05-23 07:59:14 +0000333 net_set_state(NETLOOP_SUCCESS);
Simon Glassf5329bb2011-10-24 18:00:03 +0000334}
335
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500336static void tftp_send(void)
wdenkfe8c2802002-11-03 00:38:21 +0000337{
Simon Glass1fb7cd42011-10-24 18:00:07 +0000338 uchar *pkt;
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000339 uchar *xp;
340 int len = 0;
341 ushort *s;
Ravik Hasija08139212020-05-18 21:35:43 -0700342 bool err_pkt = false;
wdenkfe8c2802002-11-03 00:38:21 +0000343
344 /*
345 * We will always be sending some sort of packet, so
346 * cobble together the packet headers now.
347 */
Joe Hershberger1203fcc2015-04-08 01:41:05 -0500348 pkt = net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE;
wdenkfe8c2802002-11-03 00:38:21 +0000349
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500350 switch (tftp_state) {
Luca Ceresolie3fb0ab2011-05-17 00:03:38 +0000351 case STATE_SEND_RRQ:
Simon Glass1fb7cd42011-10-24 18:00:07 +0000352 case STATE_SEND_WRQ:
wdenkfe8c2802002-11-03 00:38:21 +0000353 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200354 s = (ushort *)pkt;
Simon Glass8c6914f2011-10-27 06:24:29 +0000355#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500356 *s++ = htons(tftp_state == STATE_SEND_RRQ ? TFTP_RRQ :
Simon Glass1fb7cd42011-10-24 18:00:07 +0000357 TFTP_WRQ);
Simon Glass8c6914f2011-10-27 06:24:29 +0000358#else
359 *s++ = htons(TFTP_RRQ);
360#endif
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200361 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000362 strcpy((char *)pkt, tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000363 pkt += strlen(tftp_filename) + 1;
Luca Ceresolic718b142011-05-14 05:49:57 +0000364 strcpy((char *)pkt, "octet");
wdenkfe8c2802002-11-03 00:38:21 +0000365 pkt += 5 /*strlen("octet")*/ + 1;
Luca Ceresolic718b142011-05-14 05:49:57 +0000366 strcpy((char *)pkt, "timeout");
wdenkfbe4b5c2003-10-06 21:55:32 +0000367 pkt += 7 /*strlen("timeout")*/ + 1;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500368 sprintf((char *)pkt, "%lu", timeout_ms / 1000);
Robin Getz0ebf04c2009-07-23 03:01:03 -0400369 debug("send option \"timeout %s\"\n", (char *)pkt);
wdenkfbe4b5c2003-10-06 21:55:32 +0000370 pkt += strlen((char *)pkt) + 1;
Robin Getz4fccb812009-08-20 10:50:20 -0400371#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger14111572015-04-08 01:41:02 -0500372 pkt += sprintf((char *)pkt, "tsize%c%u%c",
373 0, net_boot_file_size, 0);
Robin Getz4fccb812009-08-20 10:50:20 -0400374#endif
David Updegraff53a5c422007-06-11 10:41:07 -0500375 /* try for more effic. blk size */
Luca Ceresolic718b142011-05-14 05:49:57 +0000376 pkt += sprintf((char *)pkt, "blksize%c%d%c",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500377 0, tftp_block_size_option, 0);
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300378
379 /* try for more effic. window size.
380 * Implemented only for tftp get.
381 * Don't bother sending if it's 1
382 */
383 if (tftp_state == STATE_SEND_RRQ && tftp_window_size_option > 1)
384 pkt += sprintf((char *)pkt, "windowsize%c%d%c",
385 0, tftp_window_size_option, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000386 len = pkt - xp;
387 break;
388
wdenkfbe4b5c2003-10-06 21:55:32 +0000389 case STATE_OACK:
Luca Ceresolie59e3562011-05-17 00:03:39 +0000390
391 case STATE_RECV_WRQ:
David Updegraff53a5c422007-06-11 10:41:07 -0500392 case STATE_DATA:
wdenkfe8c2802002-11-03 00:38:21 +0000393 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200394 s = (ushort *)pkt;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000395 s[0] = htons(TFTP_ACK);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500396 s[1] = htons(tftp_cur_block);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000397 pkt = (uchar *)(s + 2);
398#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500399 if (tftp_put_active) {
400 int toload = tftp_block_size;
401 int loaded = load_block(tftp_cur_block, pkt, toload);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000402
403 s[0] = htons(TFTP_DATA);
404 pkt += loaded;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500405 tftp_put_final_block_sent = (loaded < toload);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000406 }
407#endif
wdenkfe8c2802002-11-03 00:38:21 +0000408 len = pkt - xp;
409 break;
410
411 case STATE_TOO_LARGE:
412 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200413 s = (ushort *)pkt;
414 *s++ = htons(TFTP_ERROR);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000415 *s++ = htons(3);
416
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200417 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000418 strcpy((char *)pkt, "File too large");
wdenkfe8c2802002-11-03 00:38:21 +0000419 pkt += 14 /*strlen("File too large")*/ + 1;
420 len = pkt - xp;
Ravik Hasija08139212020-05-18 21:35:43 -0700421 err_pkt = true;
wdenkfe8c2802002-11-03 00:38:21 +0000422 break;
423
424 case STATE_BAD_MAGIC:
425 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200426 s = (ushort *)pkt;
427 *s++ = htons(TFTP_ERROR);
428 *s++ = htons(2);
429 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000430 strcpy((char *)pkt, "File has bad magic");
wdenkfe8c2802002-11-03 00:38:21 +0000431 pkt += 18 /*strlen("File has bad magic")*/ + 1;
432 len = pkt - xp;
Ravik Hasija08139212020-05-18 21:35:43 -0700433 err_pkt = true;
434 break;
435
436 case STATE_INVALID_OPTION:
437 xp = pkt;
438 s = (ushort *)pkt;
439 *s++ = htons(TFTP_ERROR);
440 *s++ = htons(TFTP_ERR_OPTION_NEGOTIATION);
441 pkt = (uchar *)s;
442 strcpy((char *)pkt, "Option Negotiation Failed");
443 /* strlen("Option Negotiation Failed") + NULL*/
444 pkt += 25 + 1;
445 len = pkt - xp;
446 err_pkt = true;
wdenkfe8c2802002-11-03 00:38:21 +0000447 break;
448 }
449
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500450 net_send_udp_packet(net_server_ethaddr, tftp_remote_ip,
451 tftp_remote_port, tftp_our_port, len);
Ravik Hasija08139212020-05-18 21:35:43 -0700452
453 if (err_pkt)
454 net_set_state(NETLOOP_FAIL);
wdenkfe8c2802002-11-03 00:38:21 +0000455}
456
Simon Glass39bccd22011-10-26 14:18:38 +0000457#ifdef CONFIG_CMD_TFTPPUT
Simon Glass1fb7cd42011-10-24 18:00:07 +0000458static void icmp_handler(unsigned type, unsigned code, unsigned dest,
Joe Hershberger049a95a2015-04-08 01:41:01 -0500459 struct in_addr sip, unsigned src, uchar *pkt,
460 unsigned len)
Simon Glass1fb7cd42011-10-24 18:00:07 +0000461{
462 if (type == ICMP_NOT_REACH && code == ICMP_NOT_REACH_PORT) {
463 /* Oh dear the other end has gone away */
464 restart("TFTP server died");
465 }
466}
Simon Glass39bccd22011-10-26 14:18:38 +0000467#endif
Simon Glass1fb7cd42011-10-24 18:00:07 +0000468
Joe Hershberger049a95a2015-04-08 01:41:01 -0500469static void tftp_handler(uchar *pkt, unsigned dest, struct in_addr sip,
470 unsigned src, unsigned len)
wdenkfe8c2802002-11-03 00:38:21 +0000471{
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600472 __be16 proto;
473 __be16 *s;
Wolfgang Denkff13ac82007-08-30 14:42:15 +0200474 int i;
Ravik Hasija08139212020-05-18 21:35:43 -0700475 u16 timeout_val_rcvd;
wdenkfe8c2802002-11-03 00:38:21 +0000476
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500477 if (dest != tftp_our_port) {
Luca Ceresoli0bdd8ac2011-05-14 05:50:02 +0000478 return;
wdenkfe8c2802002-11-03 00:38:21 +0000479 }
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500480 if (tftp_state != STATE_SEND_RRQ && src != tftp_remote_port &&
481 tftp_state != STATE_RECV_WRQ && tftp_state != STATE_SEND_WRQ)
wdenkfe8c2802002-11-03 00:38:21 +0000482 return;
wdenkfe8c2802002-11-03 00:38:21 +0000483
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000484 if (len < 2)
wdenkfe8c2802002-11-03 00:38:21 +0000485 return;
wdenkfe8c2802002-11-03 00:38:21 +0000486 len -= 2;
487 /* warning: don't use increment (++) in ntohs() macros!! */
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600488 s = (__be16 *)pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200489 proto = *s++;
490 pkt = (uchar *)s;
wdenkfe8c2802002-11-03 00:38:21 +0000491 switch (ntohs(proto)) {
wdenkfe8c2802002-11-03 00:38:21 +0000492 case TFTP_RRQ:
wdenkfe8c2802002-11-03 00:38:21 +0000493 break;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000494
495 case TFTP_ACK:
496#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500497 if (tftp_put_active) {
498 if (tftp_put_final_block_sent) {
Simon Glass1fb7cd42011-10-24 18:00:07 +0000499 tftp_complete();
500 } else {
501 /*
502 * Move to the next block. We want our block
503 * count to wrap just like the other end!
504 */
505 int block = ntohs(*s);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500506 int ack_ok = (tftp_cur_block == block);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000507
Ley Foon Tan6bf46362020-08-25 10:26:35 +0800508 tftp_prev_block = tftp_cur_block;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500509 tftp_cur_block = (unsigned short)(block + 1);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000510 update_block_number();
511 if (ack_ok)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500512 tftp_send(); /* Send next data block */
Simon Glass1fb7cd42011-10-24 18:00:07 +0000513 }
514 }
515#endif
516 break;
517
wdenkfe8c2802002-11-03 00:38:21 +0000518 default:
519 break;
520
Luca Ceresolie59e3562011-05-17 00:03:39 +0000521#ifdef CONFIG_CMD_TFTPSRV
522 case TFTP_WRQ:
523 debug("Got WRQ\n");
Joe Hershberger049a95a2015-04-08 01:41:01 -0500524 tftp_remote_ip = sip;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500525 tftp_remote_port = src;
526 tftp_our_port = 1024 + (get_timer(0) % 3072);
Simon Glasse4cde2f2011-10-24 18:00:04 +0000527 new_transfer();
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500528 tftp_send(); /* Send ACK(0) */
Luca Ceresolie59e3562011-05-17 00:03:39 +0000529 break;
530#endif
531
wdenkfbe4b5c2003-10-06 21:55:32 +0000532 case TFTP_OACK:
Ravik Hasija08139212020-05-18 21:35:43 -0700533 debug("Got OACK: ");
534 for (i = 0; i < len; i++) {
535 if (pkt[i] == '\0')
536 debug(" ");
537 else
538 debug("%c", pkt[i]);
539 }
540 debug("\n");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500541 tftp_state = STATE_OACK;
542 tftp_remote_port = src;
Wolfgang Denk60174742007-08-31 10:01:51 +0200543 /*
544 * Check for 'blksize' option.
545 * Careful: "i" is signed, "len" is unsigned, thus
546 * something like "len-8" may give a *huge* number
547 */
Luca Ceresolic718b142011-05-14 05:49:57 +0000548 for (i = 0; i+8 < len; i++) {
Ravik Hasija08139212020-05-18 21:35:43 -0700549 if (strcasecmp((char *)pkt + i, "blksize") == 0) {
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500550 tftp_block_size = (unsigned short)
Simon Glass0b1284e2021-07-24 09:03:30 -0600551 dectoul((char *)pkt + i + 8, NULL);
Ravik Hasija08139212020-05-18 21:35:43 -0700552 debug("Blocksize oack: %s, %d\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500553 (char *)pkt + i + 8, tftp_block_size);
Ravik Hasija08139212020-05-18 21:35:43 -0700554 if (tftp_block_size > tftp_block_size_option) {
555 printf("Invalid blk size(=%d)\n",
556 tftp_block_size);
557 tftp_state = STATE_INVALID_OPTION;
558 }
559 }
560 if (strcasecmp((char *)pkt + i, "timeout") == 0) {
561 timeout_val_rcvd = (unsigned short)
Simon Glass0b1284e2021-07-24 09:03:30 -0600562 dectoul((char *)pkt + i + 8, NULL);
Ravik Hasija08139212020-05-18 21:35:43 -0700563 debug("Timeout oack: %s, %d\n",
564 (char *)pkt + i + 8, timeout_val_rcvd);
565 if (timeout_val_rcvd != (timeout_ms / 1000)) {
566 printf("Invalid timeout val(=%d s)\n",
567 timeout_val_rcvd);
568 tftp_state = STATE_INVALID_OPTION;
569 }
Wolfgang Denkff13ac82007-08-30 14:42:15 +0200570 }
Robin Getz4fccb812009-08-20 10:50:20 -0400571#ifdef CONFIG_TFTP_TSIZE
Ravik Hasija08139212020-05-18 21:35:43 -0700572 if (strcasecmp((char *)pkt + i, "tsize") == 0) {
Simon Glass0b1284e2021-07-24 09:03:30 -0600573 tftp_tsize = dectoul((char *)pkt + i + 6,
574 NULL);
Robin Getz4fccb812009-08-20 10:50:20 -0400575 debug("size = %s, %d\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500576 (char *)pkt + i + 6, tftp_tsize);
Robin Getz4fccb812009-08-20 10:50:20 -0400577 }
578#endif
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300579 if (strcasecmp((char *)pkt + i, "windowsize") == 0) {
580 tftp_windowsize =
Simon Glass0b1284e2021-07-24 09:03:30 -0600581 dectoul((char *)pkt + i + 11, NULL);
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300582 debug("windowsize = %s, %d\n",
583 (char *)pkt + i + 11, tftp_windowsize);
584 }
David Updegraff53a5c422007-06-11 10:41:07 -0500585 }
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300586
587 tftp_next_ack = tftp_windowsize;
588
Simon Glass1fb7cd42011-10-24 18:00:07 +0000589#ifdef CONFIG_CMD_TFTPPUT
Ravik Hasija08139212020-05-18 21:35:43 -0700590 if (tftp_put_active && tftp_state == STATE_OACK) {
Simon Glass1fb7cd42011-10-24 18:00:07 +0000591 /* Get ready to send the first block */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500592 tftp_state = STATE_DATA;
593 tftp_cur_block++;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000594 }
595#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500596 tftp_send(); /* Send ACK or first data block */
wdenkfbe4b5c2003-10-06 21:55:32 +0000597 break;
wdenkfe8c2802002-11-03 00:38:21 +0000598 case TFTP_DATA:
599 if (len < 2)
600 return;
601 len -= 2;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300602
603 if (ntohs(*(__be16 *)pkt) != (ushort)(tftp_cur_block + 1)) {
604 debug("Received unexpected block: %d, expected: %d\n",
605 ntohs(*(__be16 *)pkt),
606 (ushort)(tftp_cur_block + 1));
607 /*
608 * If one packet is dropped most likely
609 * all other buffers in the window
610 * that will arrive will cause a sending NACK.
611 * This just overwellms the server, let's just send one.
612 */
613 if (tftp_last_nack != tftp_cur_block) {
614 tftp_send();
615 tftp_last_nack = tftp_cur_block;
616 tftp_next_ack = (ushort)(tftp_cur_block +
617 tftp_windowsize);
618 }
619 break;
620 }
621
622 tftp_cur_block++;
623 tftp_cur_block %= TFTP_SEQUENCE_SIZE;
wdenk3f85ce22004-02-23 16:11:30 +0000624
Harm Berntsenbeb61e12020-11-27 21:45:56 +0000625 if (tftp_state == STATE_SEND_RRQ) {
Ravik Hasija08139212020-05-18 21:35:43 -0700626 debug("Server did not acknowledge any options!\n");
Harm Berntsenbeb61e12020-11-27 21:45:56 +0000627 tftp_next_ack = tftp_windowsize;
628 }
wdenkfbe4b5c2003-10-06 21:55:32 +0000629
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500630 if (tftp_state == STATE_SEND_RRQ || tftp_state == STATE_OACK ||
631 tftp_state == STATE_RECV_WRQ) {
wdenk3f85ce22004-02-23 16:11:30 +0000632 /* first block received */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500633 tftp_state = STATE_DATA;
634 tftp_remote_port = src;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000635 new_transfer();
wdenkfe8c2802002-11-03 00:38:21 +0000636
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500637 if (tftp_cur_block != 1) { /* Assertion */
638 puts("\nTFTP error: ");
639 printf("First block is not block 1 (%ld)\n",
640 tftp_cur_block);
641 puts("Starting again\n\n");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500642 net_start_again();
wdenkfe8c2802002-11-03 00:38:21 +0000643 break;
644 }
645 }
646
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500647 if (tftp_cur_block == tftp_prev_block) {
648 /* Same block again; ignore it. */
wdenkfe8c2802002-11-03 00:38:21 +0000649 break;
650 }
651
Ravik Hasijade5468e2020-05-07 14:55:32 -0700652 update_block_number();
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500653 tftp_prev_block = tftp_cur_block;
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200654 timeout_count_max = tftp_timeout_count_max;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500655 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
wdenkfe8c2802002-11-03 00:38:21 +0000656
Ley Foon Tanae0bdf02020-08-25 10:26:36 +0800657 if (store_block(tftp_cur_block, pkt + 2, len)) {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100658 eth_halt();
659 net_set_state(NETLOOP_FAIL);
660 break;
661 }
wdenkfe8c2802002-11-03 00:38:21 +0000662
Ramon Fried2dddc1b2021-02-03 21:28:59 +0200663 if (len < tftp_block_size) {
664 tftp_send();
665 tftp_complete();
666 break;
667 }
668
wdenkfe8c2802002-11-03 00:38:21 +0000669 /*
Luca Ceresoli4d69e982011-05-17 00:03:41 +0000670 * Acknowledge the block just received, which will prompt
Luca Ceresoli20478ce2011-05-17 00:03:37 +0000671 * the remote for the next one.
wdenkfe8c2802002-11-03 00:38:21 +0000672 */
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300673 if (tftp_cur_block == tftp_next_ack) {
674 tftp_send();
675 tftp_next_ack += tftp_windowsize;
676 }
wdenkfe8c2802002-11-03 00:38:21 +0000677 break;
678
679 case TFTP_ERROR:
Luca Ceresolic718b142011-05-14 05:49:57 +0000680 printf("\nTFTP error: '%s' (%d)\n",
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600681 pkt + 2, ntohs(*(__be16 *)pkt));
Remy Bohmeraafda382009-10-28 22:13:40 +0100682
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600683 switch (ntohs(*(__be16 *)pkt)) {
Remy Bohmeraafda382009-10-28 22:13:40 +0100684 case TFTP_ERR_FILE_NOT_FOUND:
685 case TFTP_ERR_ACCESS_DENIED:
686 puts("Not retrying...\n");
687 eth_halt();
Joe Hershberger22f6e992012-05-23 07:59:14 +0000688 net_set_state(NETLOOP_FAIL);
Remy Bohmeraafda382009-10-28 22:13:40 +0100689 break;
690 case TFTP_ERR_UNDEFINED:
691 case TFTP_ERR_DISK_FULL:
692 case TFTP_ERR_UNEXPECTED_OPCODE:
693 case TFTP_ERR_UNKNOWN_TRANSFER_ID:
694 case TFTP_ERR_FILE_ALREADY_EXISTS:
695 default:
696 puts("Starting again\n\n");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500697 net_start_again();
Remy Bohmeraafda382009-10-28 22:13:40 +0100698 break;
699 }
wdenkfe8c2802002-11-03 00:38:21 +0000700 break;
701 }
702}
703
704
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500705static void tftp_timeout_handler(void)
wdenkfe8c2802002-11-03 00:38:21 +0000706{
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500707 if (++timeout_count > timeout_count_max) {
Simon Glasse4cde2f2011-10-24 18:00:04 +0000708 restart("Retry count exceeded");
wdenkfe8c2802002-11-03 00:38:21 +0000709 } else {
Luca Ceresolic718b142011-05-14 05:49:57 +0000710 puts("T ");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500711 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500712 if (tftp_state != STATE_RECV_WRQ)
713 tftp_send();
wdenkfe8c2802002-11-03 00:38:21 +0000714 }
715}
716
Simon Glassbb872dd2019-12-28 10:45:02 -0700717/* Initialize tftp_load_addr and tftp_load_size from image_load_addr and lmb */
Simon Goldschmidta156c472019-01-14 22:38:22 +0100718static int tftp_init_load_addr(void)
719{
720#ifdef CONFIG_LMB
721 struct lmb lmb;
722 phys_size_t max_size;
723
Simon Goldschmidt9cc23232019-01-26 22:13:04 +0100724 lmb_init_and_reserve(&lmb, gd->bd, (void *)gd->fdt_blob);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100725
Simon Glassbb872dd2019-12-28 10:45:02 -0700726 max_size = lmb_get_free_size(&lmb, image_load_addr);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100727 if (!max_size)
728 return -1;
729
730 tftp_load_size = max_size;
731#endif
Simon Glassbb872dd2019-12-28 10:45:02 -0700732 tftp_load_addr = image_load_addr;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100733 return 0;
734}
wdenkfe8c2802002-11-03 00:38:21 +0000735
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500736void tftp_start(enum proto_t protocol)
wdenkfe8c2802002-11-03 00:38:21 +0000737{
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200738#if CONFIG_NET_TFTP_VARS
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200739 char *ep; /* Environment pointer */
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200740
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100741 /*
742 * Allow the user to choose TFTP blocksize and timeout.
743 * TFTP protocol has a minimal timeout of 1 second.
744 */
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200745
Simon Glass00caae62017-08-03 12:22:12 -0600746 ep = env_get("tftpblocksize");
Luca Ceresoli2cb53602011-05-14 05:49:59 +0000747 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500748 tftp_block_size_option = simple_strtol(ep, NULL, 10);
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100749
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300750 ep = env_get("tftpwindowsize");
751 if (ep != NULL)
752 tftp_window_size_option = simple_strtol(ep, NULL, 10);
753
Simon Glass00caae62017-08-03 12:22:12 -0600754 ep = env_get("tftptimeout");
Luca Ceresoli2cb53602011-05-14 05:49:59 +0000755 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500756 timeout_ms = simple_strtol(ep, NULL, 10);
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100757
Bin Mengaf2ca592015-08-27 22:25:51 -0700758 if (timeout_ms < 1000) {
759 printf("TFTP timeout (%ld ms) too low, set min = 1000 ms\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500760 timeout_ms);
Bin Mengaf2ca592015-08-27 22:25:51 -0700761 timeout_ms = 1000;
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100762 }
763
Simon Glass00caae62017-08-03 12:22:12 -0600764 ep = env_get("tftptimeoutcountmax");
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200765 if (ep != NULL)
766 tftp_timeout_count_max = simple_strtol(ep, NULL, 10);
767
768 if (tftp_timeout_count_max < 0) {
769 printf("TFTP timeout count max (%d ms) negative, set to 0\n",
770 tftp_timeout_count_max);
771 tftp_timeout_count_max = 0;
772 }
773#endif
774
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300775 debug("TFTP blocksize = %i, TFTP windowsize = %d timeout = %ld ms\n",
776 tftp_block_size_option, tftp_window_size_option, timeout_ms);
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200777
Joe Hershberger049a95a2015-04-08 01:41:01 -0500778 tftp_remote_ip = net_server_ip;
Joe Hershberger6ab12832018-07-03 19:36:43 -0500779 if (!net_parse_bootfile(&tftp_remote_ip, tftp_filename, MAX_LEN)) {
Matthias Weisserea45cb02011-12-03 03:29:44 +0000780 sprintf(default_filename, "%02X%02X%02X%02X.img",
Joe Hershberger049a95a2015-04-08 01:41:01 -0500781 net_ip.s_addr & 0xFF,
782 (net_ip.s_addr >> 8) & 0xFF,
783 (net_ip.s_addr >> 16) & 0xFF,
784 (net_ip.s_addr >> 24) & 0xFF);
Jean-Christophe PLAGNIOL-VILLARDa93907c2008-01-18 01:14:03 +0100785
Vladimir Zapolskiy0c17b1b2017-06-28 22:56:07 +0300786 strncpy(tftp_filename, default_filename, DEFAULT_NAME_LEN);
787 tftp_filename[DEFAULT_NAME_LEN - 1] = 0;
wdenkfe8c2802002-11-03 00:38:21 +0000788
Luca Ceresolic718b142011-05-14 05:49:57 +0000789 printf("*** Warning: no boot file name; using '%s'\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500790 tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000791 }
792
Luca Ceresolic718b142011-05-14 05:49:57 +0000793 printf("Using %s device\n", eth_get_name());
Simon Glass1fb7cd42011-10-24 18:00:07 +0000794 printf("TFTP %s server %pI4; our IP address is %pI4",
Simon Glass8c6914f2011-10-27 06:24:29 +0000795#ifdef CONFIG_CMD_TFTPPUT
796 protocol == TFTPPUT ? "to" : "from",
797#else
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500798 "from",
Simon Glass8c6914f2011-10-27 06:24:29 +0000799#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500800 &tftp_remote_ip, &net_ip);
wdenkfe8c2802002-11-03 00:38:21 +0000801
802 /* Check if we need to send across this subnet */
Joe Hershberger049a95a2015-04-08 01:41:01 -0500803 if (net_gateway.s_addr && net_netmask.s_addr) {
804 struct in_addr our_net;
805 struct in_addr remote_net;
wdenkfe8c2802002-11-03 00:38:21 +0000806
Joe Hershberger049a95a2015-04-08 01:41:01 -0500807 our_net.s_addr = net_ip.s_addr & net_netmask.s_addr;
808 remote_net.s_addr = tftp_remote_ip.s_addr & net_netmask.s_addr;
809 if (our_net.s_addr != remote_net.s_addr)
810 printf("; sending through gateway %pI4", &net_gateway);
wdenkfe8c2802002-11-03 00:38:21 +0000811 }
Luca Ceresolic718b142011-05-14 05:49:57 +0000812 putc('\n');
wdenkfe8c2802002-11-03 00:38:21 +0000813
Luca Ceresolic718b142011-05-14 05:49:57 +0000814 printf("Filename '%s'.", tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000815
Joe Hershberger14111572015-04-08 01:41:02 -0500816 if (net_boot_file_expected_size_in_blocks) {
817 printf(" Size is 0x%x Bytes = ",
818 net_boot_file_expected_size_in_blocks << 9);
819 print_size(net_boot_file_expected_size_in_blocks << 9, "");
wdenkfe8c2802002-11-03 00:38:21 +0000820 }
821
Luca Ceresolic718b142011-05-14 05:49:57 +0000822 putc('\n');
Simon Glass1fb7cd42011-10-24 18:00:07 +0000823#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500824 tftp_put_active = (protocol == TFTPPUT);
825 if (tftp_put_active) {
Simon Glassbb872dd2019-12-28 10:45:02 -0700826 printf("Save address: 0x%lx\n", image_save_addr);
827 printf("Save size: 0x%lx\n", image_save_size);
828 net_boot_file_size = image_save_size;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000829 puts("Saving: *\b");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500830 tftp_state = STATE_SEND_WRQ;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000831 new_transfer();
832 } else
833#endif
834 {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100835 if (tftp_init_load_addr()) {
836 eth_halt();
837 net_set_state(NETLOOP_FAIL);
838 puts("\nTFTP error: ");
839 puts("trying to overwrite reserved memory...\n");
840 return;
841 }
842 printf("Load address: 0x%lx\n", tftp_load_addr);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000843 puts("Loading: *\b");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500844 tftp_state = STATE_SEND_RRQ;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000845 }
wdenkfe8c2802002-11-03 00:38:21 +0000846
Simon Glass85b19802012-10-11 13:57:36 +0000847 time_start = get_timer(0);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500848 timeout_count_max = tftp_timeout_count_max;
Bartlomiej Siekae83cc062008-10-01 15:26:29 +0200849
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500850 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Joe Hershberger049a95a2015-04-08 01:41:01 -0500851 net_set_udp_handler(tftp_handler);
Simon Glass39bccd22011-10-26 14:18:38 +0000852#ifdef CONFIG_CMD_TFTPPUT
Simon Glass1fb7cd42011-10-24 18:00:07 +0000853 net_set_icmp_handler(icmp_handler);
Simon Glass39bccd22011-10-26 14:18:38 +0000854#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500855 tftp_remote_port = WELL_KNOWN_PORT;
856 timeout_count = 0;
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200857 /* Use a pseudo-random port unless a specific port is set */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500858 tftp_our_port = 1024 + (get_timer(0) % 3072);
David Updegraff53a5c422007-06-11 10:41:07 -0500859
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200860#ifdef CONFIG_TFTP_PORT
Simon Glass00caae62017-08-03 12:22:12 -0600861 ep = env_get("tftpdstp");
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000862 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500863 tftp_remote_port = simple_strtol(ep, NULL, 10);
Simon Glass00caae62017-08-03 12:22:12 -0600864 ep = env_get("tftpsrcp");
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000865 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500866 tftp_our_port = simple_strtol(ep, NULL, 10);
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200867#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500868 tftp_cur_block = 0;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300869 tftp_windowsize = 1;
870 tftp_last_nack = 0;
wdenk73a8b272003-06-05 19:27:42 +0000871 /* zero out server ether in case the server ip has changed */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500872 memset(net_server_ethaddr, 0, 6);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500873 /* Revert tftp_block_size to dflt */
874 tftp_block_size = TFTP_BLOCK_SIZE;
Robin Getz4fccb812009-08-20 10:50:20 -0400875#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500876 tftp_tsize = 0;
877 tftp_tsize_num_hash = 0;
Robin Getz4fccb812009-08-20 10:50:20 -0400878#endif
wdenk73a8b272003-06-05 19:27:42 +0000879
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500880 tftp_send();
wdenkfe8c2802002-11-03 00:38:21 +0000881}
882
Luca Ceresolie59e3562011-05-17 00:03:39 +0000883#ifdef CONFIG_CMD_TFTPSRV
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500884void tftp_start_server(void)
Luca Ceresolie59e3562011-05-17 00:03:39 +0000885{
886 tftp_filename[0] = 0;
887
Simon Goldschmidta156c472019-01-14 22:38:22 +0100888 if (tftp_init_load_addr()) {
889 eth_halt();
890 net_set_state(NETLOOP_FAIL);
891 puts("\nTFTP error: trying to overwrite reserved memory...\n");
892 return;
893 }
Luca Ceresolie59e3562011-05-17 00:03:39 +0000894 printf("Using %s device\n", eth_get_name());
Joe Hershberger049a95a2015-04-08 01:41:01 -0500895 printf("Listening for TFTP transfer on %pI4\n", &net_ip);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100896 printf("Load address: 0x%lx\n", tftp_load_addr);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000897
898 puts("Loading: *\b");
899
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200900 timeout_count_max = tftp_timeout_count_max;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500901 timeout_count = 0;
902 timeout_ms = TIMEOUT;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500903 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000904
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500905 /* Revert tftp_block_size to dflt */
906 tftp_block_size = TFTP_BLOCK_SIZE;
907 tftp_cur_block = 0;
908 tftp_our_port = WELL_KNOWN_PORT;
Arjan Minzinga Zijlstra1ffe3662022-03-31 08:03:16 +0000909 tftp_windowsize = 1;
910 tftp_next_ack = tftp_windowsize;
Luca Ceresolie59e3562011-05-17 00:03:39 +0000911
912#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500913 tftp_tsize = 0;
914 tftp_tsize_num_hash = 0;
Luca Ceresolie59e3562011-05-17 00:03:39 +0000915#endif
916
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500917 tftp_state = STATE_RECV_WRQ;
Joe Hershberger049a95a2015-04-08 01:41:01 -0500918 net_set_udp_handler(tftp_handler);
Andrew Ruder8e525332013-10-22 19:10:28 -0500919
920 /* zero out server ether in case the server ip has changed */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500921 memset(net_server_ethaddr, 0, 6);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000922}
923#endif /* CONFIG_CMD_TFTPSRV */