blob: 2e335413492b714cdaaa594c2385553f0f19eca5 [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 */
Tom Rinid678a592024-05-18 20:20:43 -06008#include <common.h>
wdenkfe8c2802002-11-03 00:38:21 +00009#include <command.h>
Simon Glass4e4bf942022-07-31 12:28:48 -060010#include <display_options.h>
Alexander Graf0efe1bc2016-05-06 21:01:01 +020011#include <efi_loader.h>
Simon Glass7b51b572019-08-01 09:46:52 -060012#include <env.h>
Simon Glass8e8ccfe2019-12-28 10:45:03 -070013#include <image.h>
Simon Glass4d72caa2020-05-10 11:40:01 -060014#include <lmb.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -060015#include <log.h>
Joe Hershberger55d5fd92015-03-22 17:09:08 -050016#include <mapmem.h>
wdenkfe8c2802002-11-03 00:38:21 +000017#include <net.h>
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +030018#include <net6.h>
Simon Glass401d1c42020-10-30 21:38:53 -060019#include <asm/global_data.h>
Lukasz Majewski34696952015-08-24 00:21:43 +020020#include <net/tftp.h>
wdenkfe8c2802002-11-03 00:38:21 +000021#include "bootp.h"
22
Simon Goldschmidta156c472019-01-14 22:38:22 +010023DECLARE_GLOBAL_DATA_PTR;
24
Luca Ceresoli2f094132011-05-14 05:49:56 +000025/* Well known TFTP port # */
26#define WELL_KNOWN_PORT 69
27/* Millisecs to timeout for lost pkt */
Bin Mengaf2ca592015-08-27 22:25:51 -070028#define TIMEOUT 5000UL
Luca Ceresoli2f094132011-05-14 05:49:56 +000029/* Number of "loading" hashes per line (for checking the image size) */
30#define HASHES_PER_LINE 65
wdenkfe8c2802002-11-03 00:38:21 +000031
32/*
33 * TFTP operations.
34 */
35#define TFTP_RRQ 1
36#define TFTP_WRQ 2
37#define TFTP_DATA 3
38#define TFTP_ACK 4
39#define TFTP_ERROR 5
wdenkfbe4b5c2003-10-06 21:55:32 +000040#define TFTP_OACK 6
wdenkfe8c2802002-11-03 00:38:21 +000041
Joe Hershberger8885c5f2015-04-08 01:41:07 -050042static ulong timeout_ms = TIMEOUT;
Tom Rini01d1b992022-03-11 09:12:02 -050043static int timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2);
Simon Glass85b19802012-10-11 13:57:36 +000044static ulong time_start; /* Record time we started tftp */
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +030045static struct in6_addr tftp_remote_ip6;
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
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300121#define TFTP_MTU_BLOCKSIZE6 (CONFIG_TFTP_BLOCKSIZE - 20)
Luca Ceresoli2f094132011-05-14 05:49:56 +0000122/* sequence number is 16 bit */
123#define TFTP_SEQUENCE_SIZE ((ulong)(1<<16))
wdenk3f85ce22004-02-23 16:11:30 +0000124
wdenkfe8c2802002-11-03 00:38:21 +0000125#define DEFAULT_NAME_LEN (8 + 4 + 1)
126static char default_filename[DEFAULT_NAME_LEN];
Jean-Christophe PLAGNIOL-VILLARDa93907c2008-01-18 01:14:03 +0100127
128#ifndef CONFIG_TFTP_FILE_NAME_MAX_LEN
129#define MAX_LEN 128
130#else
131#define MAX_LEN CONFIG_TFTP_FILE_NAME_MAX_LEN
132#endif
133
134static char tftp_filename[MAX_LEN];
wdenkfe8c2802002-11-03 00:38:21 +0000135
Wolfgang Denk85eb5ca2007-08-14 09:47:27 +0200136/* 512 is poor choice for ethernet, MTU is typically 1500.
137 * Minus eth.hdrs thats 1468. Can get 2x better throughput with
David Updegraff53a5c422007-06-11 10:41:07 -0500138 * almost-MTU block sizes. At least try... fall back to 512 if need be.
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200139 * (but those using CONFIG_IP_DEFRAG may want to set a larger block in cfg file)
David Updegraff53a5c422007-06-11 10:41:07 -0500140 */
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200141
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300142/* When windowsize is defined to 1,
143 * tftp behaves the same way as it was
144 * never declared
145 */
146#ifdef CONFIG_TFTP_WINDOWSIZE
147#define TFTP_WINDOWSIZE CONFIG_TFTP_WINDOWSIZE
148#else
149#define TFTP_WINDOWSIZE 1
150#endif
151
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500152static unsigned short tftp_block_size = TFTP_BLOCK_SIZE;
Patrick Delaunay31d275b2020-04-22 14:18:26 +0200153static unsigned short tftp_block_size_option = CONFIG_TFTP_BLOCKSIZE;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300154static unsigned short tftp_window_size_option = TFTP_WINDOWSIZE;
David Updegraff53a5c422007-06-11 10:41:07 -0500155
Simon Goldschmidta156c472019-01-14 22:38:22 +0100156static inline int store_block(int block, uchar *src, unsigned int len)
wdenkfe8c2802002-11-03 00:38:21 +0000157{
Ley Foon Tanae0bdf02020-08-25 10:26:36 +0800158 ulong offset = block * tftp_block_size + tftp_block_wrap_offset -
159 tftp_block_size;
wdenk3f85ce22004-02-23 16:11:30 +0000160 ulong newsize = offset + len;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100161 ulong store_addr = tftp_load_addr + offset;
Tom Rini52938fc2022-07-23 13:04:54 -0400162 void *ptr;
Joe Hershberger55d5fd92015-03-22 17:09:08 -0500163
Simon Goldschmidta156c472019-01-14 22:38:22 +0100164#ifdef CONFIG_LMB
Tom Rini52938fc2022-07-23 13:04:54 -0400165 ulong end_addr = tftp_load_addr + tftp_load_size;
Bin Mengca48cb42019-11-15 22:20:13 -0800166
Tom Rini52938fc2022-07-23 13:04:54 -0400167 if (!end_addr)
168 end_addr = ULONG_MAX;
Bin Mengca48cb42019-11-15 22:20:13 -0800169
Tom Rini52938fc2022-07-23 13:04:54 -0400170 if (store_addr < tftp_load_addr ||
171 store_addr + len > end_addr) {
172 puts("\nTFTP error: ");
173 puts("trying to overwrite reserved memory...\n");
174 return -1;
wdenkfe8c2802002-11-03 00:38:21 +0000175 }
Tom Rini52938fc2022-07-23 13:04:54 -0400176#endif
177 ptr = map_sysmem(store_addr, len);
178 memcpy(ptr, src, len);
179 unmap_sysmem(ptr);
wdenkfe8c2802002-11-03 00:38:21 +0000180
Joe Hershberger14111572015-04-08 01:41:02 -0500181 if (net_boot_file_size < newsize)
182 net_boot_file_size = newsize;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100183
184 return 0;
wdenkfe8c2802002-11-03 00:38:21 +0000185}
186
Simon Glasse4cde2f2011-10-24 18:00:04 +0000187/* Clear our state ready for a new transfer */
Simon Glass165099e2011-10-27 06:24:28 +0000188static void new_transfer(void)
Simon Glasse4cde2f2011-10-24 18:00:04 +0000189{
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500190 tftp_prev_block = 0;
191 tftp_block_wrap = 0;
192 tftp_block_wrap_offset = 0;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000193#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500194 tftp_put_final_block_sent = 0;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000195#endif
196}
197
Simon Glass1fb7cd42011-10-24 18:00:07 +0000198#ifdef CONFIG_CMD_TFTPPUT
199/**
200 * Load the next block from memory to be sent over tftp.
201 *
202 * @param block Block number to send
203 * @param dst Destination buffer for data
204 * @param len Number of bytes in block (this one and every other)
Heinrich Schuchardt185f8122022-01-19 18:05:50 +0100205 * Return: number of bytes loaded
Simon Glass1fb7cd42011-10-24 18:00:07 +0000206 */
207static int load_block(unsigned block, uchar *dst, unsigned len)
208{
209 /* We may want to get the final block from the previous set */
Ley Foon Tanf6a158b2020-08-25 10:26:37 +0800210 ulong offset = block * tftp_block_size + tftp_block_wrap_offset -
211 tftp_block_size;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000212 ulong tosend = len;
213
Joe Hershberger14111572015-04-08 01:41:02 -0500214 tosend = min(net_boot_file_size - offset, tosend);
Simon Glassbb872dd2019-12-28 10:45:02 -0700215 (void)memcpy(dst, (void *)(image_save_addr + offset), tosend);
Heinrich Schuchardt2bcc43b2020-02-22 08:43:40 +0100216 debug("%s: block=%u, offset=%lu, len=%u, tosend=%lu\n", __func__,
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500217 block, offset, len, tosend);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000218 return tosend;
219}
220#endif
221
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500222static void tftp_send(void);
223static void tftp_timeout_handler(void);
wdenkfe8c2802002-11-03 00:38:21 +0000224
225/**********************************************************************/
226
Simon Glassf5329bb2011-10-24 18:00:03 +0000227static void show_block_marker(void)
228{
Ravik Hasijade5468e2020-05-07 14:55:32 -0700229 ulong pos;
230
Simon Glassf5329bb2011-10-24 18:00:03 +0000231#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500232 if (tftp_tsize) {
Ravik Hasijade5468e2020-05-07 14:55:32 -0700233 pos = tftp_cur_block * tftp_block_size +
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500234 tftp_block_wrap_offset;
Max Krummenacher7628afe2015-08-05 17:17:05 +0200235 if (pos > tftp_tsize)
236 pos = tftp_tsize;
Simon Glassf5329bb2011-10-24 18:00:03 +0000237
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500238 while (tftp_tsize_num_hash < pos * 50 / tftp_tsize) {
Simon Glassf5329bb2011-10-24 18:00:03 +0000239 putc('#');
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500240 tftp_tsize_num_hash++;
Simon Glassf5329bb2011-10-24 18:00:03 +0000241 }
Simon Glass1fb7cd42011-10-24 18:00:07 +0000242 } else
Simon Glassf5329bb2011-10-24 18:00:03 +0000243#endif
Simon Glass1fb7cd42011-10-24 18:00:07 +0000244 {
Ravik Hasijade5468e2020-05-07 14:55:32 -0700245 pos = (tftp_cur_block - 1) +
246 (tftp_block_wrap * TFTP_SEQUENCE_SIZE);
247 if ((pos % 10) == 0)
Simon Glassf5329bb2011-10-24 18:00:03 +0000248 putc('#');
Ravik Hasijade5468e2020-05-07 14:55:32 -0700249 else if (((pos + 1) % (10 * HASHES_PER_LINE)) == 0)
Simon Glassf5329bb2011-10-24 18:00:03 +0000250 puts("\n\t ");
251 }
252}
253
Simon Glasse4cde2f2011-10-24 18:00:04 +0000254/**
255 * restart the current transfer due to an error
256 *
257 * @param msg Message to print for user
258 */
259static void restart(const char *msg)
260{
261 printf("\n%s; starting again\n", msg);
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500262 net_start_again();
Simon Glasse4cde2f2011-10-24 18:00:04 +0000263}
264
265/*
266 * Check if the block number has wrapped, and update progress
267 *
268 * TODO: The egregious use of global variables in this file should be tidied.
269 */
270static void update_block_number(void)
271{
272 /*
273 * RFC1350 specifies that the first data packet will
274 * have sequence number 1. If we receive a sequence
275 * number of 0 this means that there was a wrap
276 * around of the (16 bit) counter.
277 */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500278 if (tftp_cur_block == 0 && tftp_prev_block != 0) {
279 tftp_block_wrap++;
280 tftp_block_wrap_offset += tftp_block_size * TFTP_SEQUENCE_SIZE;
281 timeout_count = 0; /* we've done well, reset the timeout */
Simon Glasse4cde2f2011-10-24 18:00:04 +0000282 }
Ravik Hasijade5468e2020-05-07 14:55:32 -0700283 show_block_marker();
Simon Glasse4cde2f2011-10-24 18:00:04 +0000284}
285
Simon Glassf5329bb2011-10-24 18:00:03 +0000286/* The TFTP get or put is complete */
287static void tftp_complete(void)
288{
289#ifdef CONFIG_TFTP_TSIZE
290 /* Print hash marks for the last packet received */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500291 while (tftp_tsize && tftp_tsize_num_hash < 49) {
Simon Glassf5329bb2011-10-24 18:00:03 +0000292 putc('#');
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500293 tftp_tsize_num_hash++;
Simon Glassf5329bb2011-10-24 18:00:03 +0000294 }
Simon Glass8104f542014-10-10 07:30:21 -0600295 puts(" ");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500296 print_size(tftp_tsize, "");
Simon Glassf5329bb2011-10-24 18:00:03 +0000297#endif
Simon Glass85b19802012-10-11 13:57:36 +0000298 time_start = get_timer(time_start);
299 if (time_start > 0) {
300 puts("\n\t "); /* Line up with "Loading: " */
Joe Hershberger14111572015-04-08 01:41:02 -0500301 print_size(net_boot_file_size /
Simon Glass85b19802012-10-11 13:57:36 +0000302 time_start * 1000, "/s");
303 }
Simon Glassf5329bb2011-10-24 18:00:03 +0000304 puts("\ndone\n");
AKASHI Takahiro593607c2024-01-17 13:39:43 +0900305 if (!tftp_put_active)
306 efi_set_bootdev("Net", "", tftp_filename,
307 map_sysmem(tftp_load_addr, 0),
308 net_boot_file_size);
Joe Hershberger22f6e992012-05-23 07:59:14 +0000309 net_set_state(NETLOOP_SUCCESS);
Simon Glassf5329bb2011-10-24 18:00:03 +0000310}
311
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500312static void tftp_send(void)
wdenkfe8c2802002-11-03 00:38:21 +0000313{
Simon Glass1fb7cd42011-10-24 18:00:07 +0000314 uchar *pkt;
Joe Hershbergerdb288a92012-05-15 08:59:04 +0000315 uchar *xp;
316 int len = 0;
317 ushort *s;
Ravik Hasija08139212020-05-18 21:35:43 -0700318 bool err_pkt = false;
wdenkfe8c2802002-11-03 00:38:21 +0000319
320 /*
321 * We will always be sending some sort of packet, so
322 * cobble together the packet headers now.
323 */
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300324 if (IS_ENABLED(CONFIG_IPV6) && use_ip6)
325 pkt = net_tx_packet + net_eth_hdr_size() +
326 IP6_HDR_SIZE + UDP_HDR_SIZE;
327 else
328 pkt = net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE;
wdenkfe8c2802002-11-03 00:38:21 +0000329
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500330 switch (tftp_state) {
Luca Ceresolie3fb0ab2011-05-17 00:03:38 +0000331 case STATE_SEND_RRQ:
Simon Glass1fb7cd42011-10-24 18:00:07 +0000332 case STATE_SEND_WRQ:
wdenkfe8c2802002-11-03 00:38:21 +0000333 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200334 s = (ushort *)pkt;
Simon Glass8c6914f2011-10-27 06:24:29 +0000335#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500336 *s++ = htons(tftp_state == STATE_SEND_RRQ ? TFTP_RRQ :
Simon Glass1fb7cd42011-10-24 18:00:07 +0000337 TFTP_WRQ);
Simon Glass8c6914f2011-10-27 06:24:29 +0000338#else
339 *s++ = htons(TFTP_RRQ);
340#endif
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200341 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000342 strcpy((char *)pkt, tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000343 pkt += strlen(tftp_filename) + 1;
Luca Ceresolic718b142011-05-14 05:49:57 +0000344 strcpy((char *)pkt, "octet");
wdenkfe8c2802002-11-03 00:38:21 +0000345 pkt += 5 /*strlen("octet")*/ + 1;
Luca Ceresolic718b142011-05-14 05:49:57 +0000346 strcpy((char *)pkt, "timeout");
wdenkfbe4b5c2003-10-06 21:55:32 +0000347 pkt += 7 /*strlen("timeout")*/ + 1;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500348 sprintf((char *)pkt, "%lu", timeout_ms / 1000);
Robin Getz0ebf04c2009-07-23 03:01:03 -0400349 debug("send option \"timeout %s\"\n", (char *)pkt);
wdenkfbe4b5c2003-10-06 21:55:32 +0000350 pkt += strlen((char *)pkt) + 1;
Robin Getz4fccb812009-08-20 10:50:20 -0400351#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger14111572015-04-08 01:41:02 -0500352 pkt += sprintf((char *)pkt, "tsize%c%u%c",
353 0, net_boot_file_size, 0);
Robin Getz4fccb812009-08-20 10:50:20 -0400354#endif
David Updegraff53a5c422007-06-11 10:41:07 -0500355 /* try for more effic. blk size */
Luca Ceresolic718b142011-05-14 05:49:57 +0000356 pkt += sprintf((char *)pkt, "blksize%c%d%c",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500357 0, tftp_block_size_option, 0);
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300358
359 /* try for more effic. window size.
360 * Implemented only for tftp get.
361 * Don't bother sending if it's 1
362 */
363 if (tftp_state == STATE_SEND_RRQ && tftp_window_size_option > 1)
364 pkt += sprintf((char *)pkt, "windowsize%c%d%c",
365 0, tftp_window_size_option, 0);
wdenkfe8c2802002-11-03 00:38:21 +0000366 len = pkt - xp;
367 break;
368
wdenkfbe4b5c2003-10-06 21:55:32 +0000369 case STATE_OACK:
Luca Ceresolie59e3562011-05-17 00:03:39 +0000370
371 case STATE_RECV_WRQ:
David Updegraff53a5c422007-06-11 10:41:07 -0500372 case STATE_DATA:
wdenkfe8c2802002-11-03 00:38:21 +0000373 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200374 s = (ushort *)pkt;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000375 s[0] = htons(TFTP_ACK);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500376 s[1] = htons(tftp_cur_block);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000377 pkt = (uchar *)(s + 2);
378#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500379 if (tftp_put_active) {
380 int toload = tftp_block_size;
381 int loaded = load_block(tftp_cur_block, pkt, toload);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000382
383 s[0] = htons(TFTP_DATA);
384 pkt += loaded;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500385 tftp_put_final_block_sent = (loaded < toload);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000386 }
387#endif
wdenkfe8c2802002-11-03 00:38:21 +0000388 len = pkt - xp;
389 break;
390
391 case STATE_TOO_LARGE:
392 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200393 s = (ushort *)pkt;
394 *s++ = htons(TFTP_ERROR);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000395 *s++ = htons(3);
396
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200397 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000398 strcpy((char *)pkt, "File too large");
wdenkfe8c2802002-11-03 00:38:21 +0000399 pkt += 14 /*strlen("File too large")*/ + 1;
400 len = pkt - xp;
Ravik Hasija08139212020-05-18 21:35:43 -0700401 err_pkt = true;
wdenkfe8c2802002-11-03 00:38:21 +0000402 break;
403
404 case STATE_BAD_MAGIC:
405 xp = pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200406 s = (ushort *)pkt;
407 *s++ = htons(TFTP_ERROR);
408 *s++ = htons(2);
409 pkt = (uchar *)s;
Luca Ceresolic718b142011-05-14 05:49:57 +0000410 strcpy((char *)pkt, "File has bad magic");
wdenkfe8c2802002-11-03 00:38:21 +0000411 pkt += 18 /*strlen("File has bad magic")*/ + 1;
412 len = pkt - xp;
Ravik Hasija08139212020-05-18 21:35:43 -0700413 err_pkt = true;
414 break;
415
416 case STATE_INVALID_OPTION:
417 xp = pkt;
418 s = (ushort *)pkt;
419 *s++ = htons(TFTP_ERROR);
420 *s++ = htons(TFTP_ERR_OPTION_NEGOTIATION);
421 pkt = (uchar *)s;
422 strcpy((char *)pkt, "Option Negotiation Failed");
423 /* strlen("Option Negotiation Failed") + NULL*/
424 pkt += 25 + 1;
425 len = pkt - xp;
426 err_pkt = true;
wdenkfe8c2802002-11-03 00:38:21 +0000427 break;
428 }
429
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300430 if (IS_ENABLED(CONFIG_IPV6) && use_ip6)
431 net_send_udp_packet6(net_server_ethaddr,
432 &tftp_remote_ip6,
433 tftp_remote_port,
434 tftp_our_port, len);
435 else
436 net_send_udp_packet(net_server_ethaddr, tftp_remote_ip,
437 tftp_remote_port, tftp_our_port, len);
Ravik Hasija08139212020-05-18 21:35:43 -0700438
439 if (err_pkt)
440 net_set_state(NETLOOP_FAIL);
wdenkfe8c2802002-11-03 00:38:21 +0000441}
442
Simon Glass39bccd22011-10-26 14:18:38 +0000443#ifdef CONFIG_CMD_TFTPPUT
Simon Glass1fb7cd42011-10-24 18:00:07 +0000444static void icmp_handler(unsigned type, unsigned code, unsigned dest,
Joe Hershberger049a95a2015-04-08 01:41:01 -0500445 struct in_addr sip, unsigned src, uchar *pkt,
446 unsigned len)
Simon Glass1fb7cd42011-10-24 18:00:07 +0000447{
448 if (type == ICMP_NOT_REACH && code == ICMP_NOT_REACH_PORT) {
449 /* Oh dear the other end has gone away */
450 restart("TFTP server died");
451 }
452}
Simon Glass39bccd22011-10-26 14:18:38 +0000453#endif
Simon Glass1fb7cd42011-10-24 18:00:07 +0000454
Joe Hershberger049a95a2015-04-08 01:41:01 -0500455static void tftp_handler(uchar *pkt, unsigned dest, struct in_addr sip,
456 unsigned src, unsigned len)
wdenkfe8c2802002-11-03 00:38:21 +0000457{
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600458 __be16 proto;
459 __be16 *s;
Wolfgang Denkff13ac82007-08-30 14:42:15 +0200460 int i;
Ravik Hasija08139212020-05-18 21:35:43 -0700461 u16 timeout_val_rcvd;
wdenkfe8c2802002-11-03 00:38:21 +0000462
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500463 if (dest != tftp_our_port) {
Luca Ceresoli0bdd8ac2011-05-14 05:50:02 +0000464 return;
wdenkfe8c2802002-11-03 00:38:21 +0000465 }
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500466 if (tftp_state != STATE_SEND_RRQ && src != tftp_remote_port &&
467 tftp_state != STATE_RECV_WRQ && tftp_state != STATE_SEND_WRQ)
wdenkfe8c2802002-11-03 00:38:21 +0000468 return;
wdenkfe8c2802002-11-03 00:38:21 +0000469
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000470 if (len < 2)
wdenkfe8c2802002-11-03 00:38:21 +0000471 return;
wdenkfe8c2802002-11-03 00:38:21 +0000472 len -= 2;
473 /* warning: don't use increment (++) in ntohs() macros!! */
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600474 s = (__be16 *)pkt;
Wolfgang Denk7bc5ee02005-08-26 01:36:03 +0200475 proto = *s++;
476 pkt = (uchar *)s;
wdenkfe8c2802002-11-03 00:38:21 +0000477 switch (ntohs(proto)) {
wdenkfe8c2802002-11-03 00:38:21 +0000478 case TFTP_RRQ:
wdenkfe8c2802002-11-03 00:38:21 +0000479 break;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000480
481 case TFTP_ACK:
482#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500483 if (tftp_put_active) {
484 if (tftp_put_final_block_sent) {
Simon Glass1fb7cd42011-10-24 18:00:07 +0000485 tftp_complete();
486 } else {
487 /*
488 * Move to the next block. We want our block
489 * count to wrap just like the other end!
490 */
491 int block = ntohs(*s);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500492 int ack_ok = (tftp_cur_block == block);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000493
Ley Foon Tan6bf46362020-08-25 10:26:35 +0800494 tftp_prev_block = tftp_cur_block;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500495 tftp_cur_block = (unsigned short)(block + 1);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000496 update_block_number();
497 if (ack_ok)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500498 tftp_send(); /* Send next data block */
Simon Glass1fb7cd42011-10-24 18:00:07 +0000499 }
500 }
501#endif
502 break;
503
wdenkfe8c2802002-11-03 00:38:21 +0000504 default:
505 break;
506
Luca Ceresolie59e3562011-05-17 00:03:39 +0000507#ifdef CONFIG_CMD_TFTPSRV
508 case TFTP_WRQ:
509 debug("Got WRQ\n");
Joe Hershberger049a95a2015-04-08 01:41:01 -0500510 tftp_remote_ip = sip;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500511 tftp_remote_port = src;
512 tftp_our_port = 1024 + (get_timer(0) % 3072);
Simon Glasse4cde2f2011-10-24 18:00:04 +0000513 new_transfer();
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500514 tftp_send(); /* Send ACK(0) */
Luca Ceresolie59e3562011-05-17 00:03:39 +0000515 break;
516#endif
517
wdenkfbe4b5c2003-10-06 21:55:32 +0000518 case TFTP_OACK:
Ravik Hasija08139212020-05-18 21:35:43 -0700519 debug("Got OACK: ");
520 for (i = 0; i < len; i++) {
521 if (pkt[i] == '\0')
522 debug(" ");
523 else
524 debug("%c", pkt[i]);
525 }
526 debug("\n");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500527 tftp_state = STATE_OACK;
528 tftp_remote_port = src;
Wolfgang Denk60174742007-08-31 10:01:51 +0200529 /*
530 * Check for 'blksize' option.
531 * Careful: "i" is signed, "len" is unsigned, thus
532 * something like "len-8" may give a *huge* number
533 */
Luca Ceresolic718b142011-05-14 05:49:57 +0000534 for (i = 0; i+8 < len; i++) {
Ravik Hasija08139212020-05-18 21:35:43 -0700535 if (strcasecmp((char *)pkt + i, "blksize") == 0) {
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500536 tftp_block_size = (unsigned short)
Simon Glass0b1284e2021-07-24 09:03:30 -0600537 dectoul((char *)pkt + i + 8, NULL);
Ravik Hasija08139212020-05-18 21:35:43 -0700538 debug("Blocksize oack: %s, %d\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500539 (char *)pkt + i + 8, tftp_block_size);
Ravik Hasija08139212020-05-18 21:35:43 -0700540 if (tftp_block_size > tftp_block_size_option) {
541 printf("Invalid blk size(=%d)\n",
542 tftp_block_size);
543 tftp_state = STATE_INVALID_OPTION;
544 }
545 }
546 if (strcasecmp((char *)pkt + i, "timeout") == 0) {
547 timeout_val_rcvd = (unsigned short)
Simon Glass0b1284e2021-07-24 09:03:30 -0600548 dectoul((char *)pkt + i + 8, NULL);
Ravik Hasija08139212020-05-18 21:35:43 -0700549 debug("Timeout oack: %s, %d\n",
550 (char *)pkt + i + 8, timeout_val_rcvd);
551 if (timeout_val_rcvd != (timeout_ms / 1000)) {
552 printf("Invalid timeout val(=%d s)\n",
553 timeout_val_rcvd);
554 tftp_state = STATE_INVALID_OPTION;
555 }
Wolfgang Denkff13ac82007-08-30 14:42:15 +0200556 }
Robin Getz4fccb812009-08-20 10:50:20 -0400557#ifdef CONFIG_TFTP_TSIZE
Ravik Hasija08139212020-05-18 21:35:43 -0700558 if (strcasecmp((char *)pkt + i, "tsize") == 0) {
Simon Glass0b1284e2021-07-24 09:03:30 -0600559 tftp_tsize = dectoul((char *)pkt + i + 6,
560 NULL);
Robin Getz4fccb812009-08-20 10:50:20 -0400561 debug("size = %s, %d\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500562 (char *)pkt + i + 6, tftp_tsize);
Robin Getz4fccb812009-08-20 10:50:20 -0400563 }
564#endif
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300565 if (strcasecmp((char *)pkt + i, "windowsize") == 0) {
566 tftp_windowsize =
Simon Glass0b1284e2021-07-24 09:03:30 -0600567 dectoul((char *)pkt + i + 11, NULL);
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300568 debug("windowsize = %s, %d\n",
569 (char *)pkt + i + 11, tftp_windowsize);
570 }
David Updegraff53a5c422007-06-11 10:41:07 -0500571 }
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300572
573 tftp_next_ack = tftp_windowsize;
574
Simon Glass1fb7cd42011-10-24 18:00:07 +0000575#ifdef CONFIG_CMD_TFTPPUT
Ravik Hasija08139212020-05-18 21:35:43 -0700576 if (tftp_put_active && tftp_state == STATE_OACK) {
Simon Glass1fb7cd42011-10-24 18:00:07 +0000577 /* Get ready to send the first block */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500578 tftp_state = STATE_DATA;
579 tftp_cur_block++;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000580 }
581#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500582 tftp_send(); /* Send ACK or first data block */
wdenkfbe4b5c2003-10-06 21:55:32 +0000583 break;
wdenkfe8c2802002-11-03 00:38:21 +0000584 case TFTP_DATA:
585 if (len < 2)
586 return;
587 len -= 2;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300588
589 if (ntohs(*(__be16 *)pkt) != (ushort)(tftp_cur_block + 1)) {
590 debug("Received unexpected block: %d, expected: %d\n",
591 ntohs(*(__be16 *)pkt),
592 (ushort)(tftp_cur_block + 1));
593 /*
Sean Edmond21a265c2023-01-04 18:16:26 -0800594 * Only ACK if the block count received is greater than
595 * the expected block count, otherwise skip ACK.
596 * (required to properly handle the server retransmitting
597 * the window)
598 */
599 if ((ushort)(tftp_cur_block + 1) - (short)(ntohs(*(__be16 *)pkt)) > 0)
600 break;
601 /*
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300602 * If one packet is dropped most likely
603 * all other buffers in the window
604 * that will arrive will cause a sending NACK.
605 * This just overwellms the server, let's just send one.
606 */
607 if (tftp_last_nack != tftp_cur_block) {
608 tftp_send();
609 tftp_last_nack = tftp_cur_block;
610 tftp_next_ack = (ushort)(tftp_cur_block +
611 tftp_windowsize);
612 }
613 break;
614 }
615
616 tftp_cur_block++;
617 tftp_cur_block %= TFTP_SEQUENCE_SIZE;
wdenk3f85ce22004-02-23 16:11:30 +0000618
Harm Berntsenbeb61e12020-11-27 21:45:56 +0000619 if (tftp_state == STATE_SEND_RRQ) {
Ravik Hasija08139212020-05-18 21:35:43 -0700620 debug("Server did not acknowledge any options!\n");
Harm Berntsenbeb61e12020-11-27 21:45:56 +0000621 tftp_next_ack = tftp_windowsize;
622 }
wdenkfbe4b5c2003-10-06 21:55:32 +0000623
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500624 if (tftp_state == STATE_SEND_RRQ || tftp_state == STATE_OACK ||
625 tftp_state == STATE_RECV_WRQ) {
wdenk3f85ce22004-02-23 16:11:30 +0000626 /* first block received */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500627 tftp_state = STATE_DATA;
628 tftp_remote_port = src;
Simon Glasse4cde2f2011-10-24 18:00:04 +0000629 new_transfer();
wdenkfe8c2802002-11-03 00:38:21 +0000630
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500631 if (tftp_cur_block != 1) { /* Assertion */
632 puts("\nTFTP error: ");
633 printf("First block is not block 1 (%ld)\n",
634 tftp_cur_block);
635 puts("Starting again\n\n");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500636 net_start_again();
wdenkfe8c2802002-11-03 00:38:21 +0000637 break;
638 }
639 }
640
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500641 if (tftp_cur_block == tftp_prev_block) {
642 /* Same block again; ignore it. */
wdenkfe8c2802002-11-03 00:38:21 +0000643 break;
644 }
645
Ravik Hasijade5468e2020-05-07 14:55:32 -0700646 update_block_number();
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500647 tftp_prev_block = tftp_cur_block;
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200648 timeout_count_max = tftp_timeout_count_max;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500649 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
wdenkfe8c2802002-11-03 00:38:21 +0000650
Ley Foon Tanae0bdf02020-08-25 10:26:36 +0800651 if (store_block(tftp_cur_block, pkt + 2, len)) {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100652 eth_halt();
653 net_set_state(NETLOOP_FAIL);
654 break;
655 }
wdenkfe8c2802002-11-03 00:38:21 +0000656
Ramon Fried2dddc1b2021-02-03 21:28:59 +0200657 if (len < tftp_block_size) {
658 tftp_send();
659 tftp_complete();
660 break;
661 }
662
wdenkfe8c2802002-11-03 00:38:21 +0000663 /*
Luca Ceresoli4d69e982011-05-17 00:03:41 +0000664 * Acknowledge the block just received, which will prompt
Luca Ceresoli20478ce2011-05-17 00:03:37 +0000665 * the remote for the next one.
wdenkfe8c2802002-11-03 00:38:21 +0000666 */
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300667 if (tftp_cur_block == tftp_next_ack) {
668 tftp_send();
669 tftp_next_ack += tftp_windowsize;
670 }
wdenkfe8c2802002-11-03 00:38:21 +0000671 break;
672
673 case TFTP_ERROR:
Luca Ceresolic718b142011-05-14 05:49:57 +0000674 printf("\nTFTP error: '%s' (%d)\n",
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600675 pkt + 2, ntohs(*(__be16 *)pkt));
Remy Bohmeraafda382009-10-28 22:13:40 +0100676
Kim Phillips61fdd4f2013-01-16 18:09:19 -0600677 switch (ntohs(*(__be16 *)pkt)) {
Remy Bohmeraafda382009-10-28 22:13:40 +0100678 case TFTP_ERR_FILE_NOT_FOUND:
679 case TFTP_ERR_ACCESS_DENIED:
680 puts("Not retrying...\n");
681 eth_halt();
Joe Hershberger22f6e992012-05-23 07:59:14 +0000682 net_set_state(NETLOOP_FAIL);
Remy Bohmeraafda382009-10-28 22:13:40 +0100683 break;
684 case TFTP_ERR_UNDEFINED:
685 case TFTP_ERR_DISK_FULL:
686 case TFTP_ERR_UNEXPECTED_OPCODE:
687 case TFTP_ERR_UNKNOWN_TRANSFER_ID:
688 case TFTP_ERR_FILE_ALREADY_EXISTS:
689 default:
690 puts("Starting again\n\n");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500691 net_start_again();
Remy Bohmeraafda382009-10-28 22:13:40 +0100692 break;
693 }
wdenkfe8c2802002-11-03 00:38:21 +0000694 break;
695 }
696}
697
698
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500699static void tftp_timeout_handler(void)
wdenkfe8c2802002-11-03 00:38:21 +0000700{
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500701 if (++timeout_count > timeout_count_max) {
Simon Glasse4cde2f2011-10-24 18:00:04 +0000702 restart("Retry count exceeded");
wdenkfe8c2802002-11-03 00:38:21 +0000703 } else {
Luca Ceresolic718b142011-05-14 05:49:57 +0000704 puts("T ");
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500705 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500706 if (tftp_state != STATE_RECV_WRQ)
707 tftp_send();
wdenkfe8c2802002-11-03 00:38:21 +0000708 }
709}
710
Simon Glassbb872dd2019-12-28 10:45:02 -0700711/* Initialize tftp_load_addr and tftp_load_size from image_load_addr and lmb */
Simon Goldschmidta156c472019-01-14 22:38:22 +0100712static int tftp_init_load_addr(void)
713{
714#ifdef CONFIG_LMB
715 struct lmb lmb;
716 phys_size_t max_size;
717
Simon Goldschmidt9cc23232019-01-26 22:13:04 +0100718 lmb_init_and_reserve(&lmb, gd->bd, (void *)gd->fdt_blob);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100719
Simon Glassbb872dd2019-12-28 10:45:02 -0700720 max_size = lmb_get_free_size(&lmb, image_load_addr);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100721 if (!max_size)
722 return -1;
723
724 tftp_load_size = max_size;
725#endif
Simon Glassbb872dd2019-12-28 10:45:02 -0700726 tftp_load_addr = image_load_addr;
Simon Goldschmidta156c472019-01-14 22:38:22 +0100727 return 0;
728}
wdenkfe8c2802002-11-03 00:38:21 +0000729
Rasmus Villemoes087648b2022-10-14 19:43:42 +0200730static int saved_tftp_block_size_option;
731static void sanitize_tftp_block_size_option(enum proto_t protocol)
732{
733 int cap, max_defrag;
734
735 switch (protocol) {
736 case TFTPGET:
737 max_defrag = config_opt_enabled(CONFIG_IP_DEFRAG, CONFIG_NET_MAXDEFRAG, 0);
738 if (max_defrag) {
739 /* Account for IP, UDP and TFTP headers. */
740 cap = max_defrag - (20 + 8 + 4);
741 /* RFC2348 sets a hard upper limit. */
742 cap = min(cap, 65464);
743 break;
744 }
745 /*
746 * If not CONFIG_IP_DEFRAG, cap at the same value as
747 * for tftp put, namely normal MTU minus protocol
748 * overhead.
749 */
750 fallthrough;
751 case TFTPPUT:
752 default:
753 /*
754 * U-Boot does not support IP fragmentation on TX, so
755 * this must be small enough that it fits normal MTU
756 * (and small enough that it fits net_tx_packet which
757 * has room for PKTSIZE_ALIGN bytes).
758 */
759 cap = 1468;
760 }
761 if (tftp_block_size_option > cap) {
762 printf("Capping tftp block size option to %d (was %d)\n",
763 cap, tftp_block_size_option);
764 saved_tftp_block_size_option = tftp_block_size_option;
765 tftp_block_size_option = cap;
766 }
767}
768
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500769void tftp_start(enum proto_t protocol)
wdenkfe8c2802002-11-03 00:38:21 +0000770{
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200771 __maybe_unused char *ep; /* Environment pointer */
Rasmus Villemoes087648b2022-10-14 19:43:42 +0200772
773 if (saved_tftp_block_size_option) {
774 tftp_block_size_option = saved_tftp_block_size_option;
775 saved_tftp_block_size_option = 0;
776 }
777
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200778 if (IS_ENABLED(CONFIG_NET_TFTP_VARS)) {
Alessandro Rubini89ba81d2009-08-07 13:59:06 +0200779
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200780 /*
781 * Allow the user to choose TFTP blocksize and timeout.
782 * TFTP protocol has a minimal timeout of 1 second.
783 */
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200784
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200785 ep = env_get("tftpblocksize");
786 if (ep != NULL)
787 tftp_block_size_option = simple_strtol(ep, NULL, 10);
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100788
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200789 ep = env_get("tftpwindowsize");
790 if (ep != NULL)
791 tftp_window_size_option = simple_strtol(ep, NULL, 10);
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300792
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200793 ep = env_get("tftptimeout");
794 if (ep != NULL)
795 timeout_ms = simple_strtol(ep, NULL, 10);
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100796
Rasmus Villemoes4b8c44e2022-10-14 19:43:41 +0200797 if (timeout_ms < 1000) {
798 printf("TFTP timeout (%ld ms) too low, set min = 1000 ms\n",
799 timeout_ms);
800 timeout_ms = 1000;
801 }
802
803 ep = env_get("tftptimeoutcountmax");
804 if (ep != NULL)
805 tftp_timeout_count_max = simple_strtol(ep, NULL, 10);
806
807 if (tftp_timeout_count_max < 0) {
808 printf("TFTP timeout count max (%d ms) negative, set to 0\n",
809 tftp_timeout_count_max);
810 tftp_timeout_count_max = 0;
811 }
Wolfgang Denkc96f86e2010-01-17 23:55:53 +0100812 }
813
Rasmus Villemoes087648b2022-10-14 19:43:42 +0200814 sanitize_tftp_block_size_option(protocol);
815
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300816 debug("TFTP blocksize = %i, TFTP windowsize = %d timeout = %ld ms\n",
817 tftp_block_size_option, tftp_window_size_option, timeout_ms);
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200818
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300819 if (IS_ENABLED(CONFIG_IPV6))
820 tftp_remote_ip6 = net_server_ip6;
821
Joe Hershberger049a95a2015-04-08 01:41:01 -0500822 tftp_remote_ip = net_server_ip;
Joe Hershberger6ab12832018-07-03 19:36:43 -0500823 if (!net_parse_bootfile(&tftp_remote_ip, tftp_filename, MAX_LEN)) {
Matthias Weisserea45cb02011-12-03 03:29:44 +0000824 sprintf(default_filename, "%02X%02X%02X%02X.img",
Joe Hershberger049a95a2015-04-08 01:41:01 -0500825 net_ip.s_addr & 0xFF,
826 (net_ip.s_addr >> 8) & 0xFF,
827 (net_ip.s_addr >> 16) & 0xFF,
828 (net_ip.s_addr >> 24) & 0xFF);
Jean-Christophe PLAGNIOL-VILLARDa93907c2008-01-18 01:14:03 +0100829
Vladimir Zapolskiy0c17b1b2017-06-28 22:56:07 +0300830 strncpy(tftp_filename, default_filename, DEFAULT_NAME_LEN);
831 tftp_filename[DEFAULT_NAME_LEN - 1] = 0;
wdenkfe8c2802002-11-03 00:38:21 +0000832
Luca Ceresolic718b142011-05-14 05:49:57 +0000833 printf("*** Warning: no boot file name; using '%s'\n",
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500834 tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000835 }
836
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300837 if (IS_ENABLED(CONFIG_IPV6)) {
838 if (use_ip6) {
839 char *s, *e;
840 size_t len;
841
842 s = strchr(net_boot_file_name, '[');
843 e = strchr(net_boot_file_name, ']');
844 len = e - s;
845 if (s && e) {
Ehsan Mohandesi7db25d92023-01-13 09:27:41 -0800846 string_to_ip6(s + 1, len - 1, &tftp_remote_ip6);
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300847 strlcpy(tftp_filename, e + 2, MAX_LEN);
848 } else {
849 strlcpy(tftp_filename, net_boot_file_name, MAX_LEN);
850 tftp_filename[MAX_LEN - 1] = 0;
851 }
852 }
853 }
854
Luca Ceresolic718b142011-05-14 05:49:57 +0000855 printf("Using %s device\n", eth_get_name());
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300856
857 if (IS_ENABLED(CONFIG_IPV6) && use_ip6) {
858 printf("TFTP from server %pI6c; our IP address is %pI6c",
859 &tftp_remote_ip6, &net_ip6);
860
861 if (tftp_block_size_option > TFTP_MTU_BLOCKSIZE6)
862 tftp_block_size_option = TFTP_MTU_BLOCKSIZE6;
863 } else {
864 printf("TFTP %s server %pI4; our IP address is %pI4",
Simon Glass8c6914f2011-10-27 06:24:29 +0000865#ifdef CONFIG_CMD_TFTPPUT
866 protocol == TFTPPUT ? "to" : "from",
867#else
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500868 "from",
Simon Glass8c6914f2011-10-27 06:24:29 +0000869#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500870 &tftp_remote_ip, &net_ip);
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300871 }
wdenkfe8c2802002-11-03 00:38:21 +0000872
873 /* Check if we need to send across this subnet */
Viacheslav Mitrofanov7fbf2302022-12-02 12:18:07 +0300874 if (IS_ENABLED(CONFIG_IPV6) && use_ip6) {
875 if (!ip6_addr_in_subnet(&net_ip6, &tftp_remote_ip6,
876 net_prefix_length))
877 printf("; sending through gateway %pI6c",
878 &net_gateway6);
879 } else if (net_gateway.s_addr && net_netmask.s_addr) {
Joe Hershberger049a95a2015-04-08 01:41:01 -0500880 struct in_addr our_net;
881 struct in_addr remote_net;
wdenkfe8c2802002-11-03 00:38:21 +0000882
Joe Hershberger049a95a2015-04-08 01:41:01 -0500883 our_net.s_addr = net_ip.s_addr & net_netmask.s_addr;
884 remote_net.s_addr = tftp_remote_ip.s_addr & net_netmask.s_addr;
885 if (our_net.s_addr != remote_net.s_addr)
886 printf("; sending through gateway %pI4", &net_gateway);
wdenkfe8c2802002-11-03 00:38:21 +0000887 }
Luca Ceresolic718b142011-05-14 05:49:57 +0000888 putc('\n');
wdenkfe8c2802002-11-03 00:38:21 +0000889
Luca Ceresolic718b142011-05-14 05:49:57 +0000890 printf("Filename '%s'.", tftp_filename);
wdenkfe8c2802002-11-03 00:38:21 +0000891
Joe Hershberger14111572015-04-08 01:41:02 -0500892 if (net_boot_file_expected_size_in_blocks) {
893 printf(" Size is 0x%x Bytes = ",
894 net_boot_file_expected_size_in_blocks << 9);
895 print_size(net_boot_file_expected_size_in_blocks << 9, "");
wdenkfe8c2802002-11-03 00:38:21 +0000896 }
897
Luca Ceresolic718b142011-05-14 05:49:57 +0000898 putc('\n');
Simon Glass1fb7cd42011-10-24 18:00:07 +0000899#ifdef CONFIG_CMD_TFTPPUT
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500900 tftp_put_active = (protocol == TFTPPUT);
901 if (tftp_put_active) {
Simon Glassbb872dd2019-12-28 10:45:02 -0700902 printf("Save address: 0x%lx\n", image_save_addr);
903 printf("Save size: 0x%lx\n", image_save_size);
904 net_boot_file_size = image_save_size;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000905 puts("Saving: *\b");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500906 tftp_state = STATE_SEND_WRQ;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000907 new_transfer();
908 } else
909#endif
910 {
Simon Goldschmidta156c472019-01-14 22:38:22 +0100911 if (tftp_init_load_addr()) {
912 eth_halt();
913 net_set_state(NETLOOP_FAIL);
914 puts("\nTFTP error: ");
915 puts("trying to overwrite reserved memory...\n");
916 return;
917 }
918 printf("Load address: 0x%lx\n", tftp_load_addr);
Simon Glass1fb7cd42011-10-24 18:00:07 +0000919 puts("Loading: *\b");
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500920 tftp_state = STATE_SEND_RRQ;
Simon Glass1fb7cd42011-10-24 18:00:07 +0000921 }
wdenkfe8c2802002-11-03 00:38:21 +0000922
Simon Glass85b19802012-10-11 13:57:36 +0000923 time_start = get_timer(0);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500924 timeout_count_max = tftp_timeout_count_max;
Bartlomiej Siekae83cc062008-10-01 15:26:29 +0200925
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500926 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Joe Hershberger049a95a2015-04-08 01:41:01 -0500927 net_set_udp_handler(tftp_handler);
Simon Glass39bccd22011-10-26 14:18:38 +0000928#ifdef CONFIG_CMD_TFTPPUT
Simon Glass1fb7cd42011-10-24 18:00:07 +0000929 net_set_icmp_handler(icmp_handler);
Simon Glass39bccd22011-10-26 14:18:38 +0000930#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500931 tftp_remote_port = WELL_KNOWN_PORT;
932 timeout_count = 0;
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200933 /* Use a pseudo-random port unless a specific port is set */
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500934 tftp_our_port = 1024 + (get_timer(0) % 3072);
David Updegraff53a5c422007-06-11 10:41:07 -0500935
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200936#ifdef CONFIG_TFTP_PORT
Simon Glass00caae62017-08-03 12:22:12 -0600937 ep = env_get("tftpdstp");
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000938 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500939 tftp_remote_port = simple_strtol(ep, NULL, 10);
Simon Glass00caae62017-08-03 12:22:12 -0600940 ep = env_get("tftpsrcp");
Luca Ceresoli7bc325a2011-05-14 05:50:00 +0000941 if (ep != NULL)
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500942 tftp_our_port = simple_strtol(ep, NULL, 10);
Wolfgang Denkecb0ccd2005-09-24 22:37:32 +0200943#endif
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500944 tftp_cur_block = 0;
Ramon Friedcc6b87e2020-07-18 23:31:46 +0300945 tftp_windowsize = 1;
946 tftp_last_nack = 0;
wdenk73a8b272003-06-05 19:27:42 +0000947 /* zero out server ether in case the server ip has changed */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500948 memset(net_server_ethaddr, 0, 6);
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500949 /* Revert tftp_block_size to dflt */
950 tftp_block_size = TFTP_BLOCK_SIZE;
Robin Getz4fccb812009-08-20 10:50:20 -0400951#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500952 tftp_tsize = 0;
953 tftp_tsize_num_hash = 0;
Robin Getz4fccb812009-08-20 10:50:20 -0400954#endif
wdenk73a8b272003-06-05 19:27:42 +0000955
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500956 tftp_send();
wdenkfe8c2802002-11-03 00:38:21 +0000957}
958
Luca Ceresolie59e3562011-05-17 00:03:39 +0000959#ifdef CONFIG_CMD_TFTPSRV
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500960void tftp_start_server(void)
Luca Ceresolie59e3562011-05-17 00:03:39 +0000961{
962 tftp_filename[0] = 0;
963
Simon Goldschmidta156c472019-01-14 22:38:22 +0100964 if (tftp_init_load_addr()) {
965 eth_halt();
966 net_set_state(NETLOOP_FAIL);
967 puts("\nTFTP error: trying to overwrite reserved memory...\n");
968 return;
969 }
Luca Ceresolie59e3562011-05-17 00:03:39 +0000970 printf("Using %s device\n", eth_get_name());
Joe Hershberger049a95a2015-04-08 01:41:01 -0500971 printf("Listening for TFTP transfer on %pI4\n", &net_ip);
Simon Goldschmidta156c472019-01-14 22:38:22 +0100972 printf("Load address: 0x%lx\n", tftp_load_addr);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000973
974 puts("Loading: *\b");
975
Albert ARIBAUD \(3ADEV\)f5fb7342015-10-12 00:02:57 +0200976 timeout_count_max = tftp_timeout_count_max;
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500977 timeout_count = 0;
978 timeout_ms = TIMEOUT;
Joe Hershbergerbc0571f2015-04-08 01:41:21 -0500979 net_set_timeout_handler(timeout_ms, tftp_timeout_handler);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000980
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500981 /* Revert tftp_block_size to dflt */
982 tftp_block_size = TFTP_BLOCK_SIZE;
983 tftp_cur_block = 0;
984 tftp_our_port = WELL_KNOWN_PORT;
Arjan Minzinga Zijlstra1ffe3662022-03-31 08:03:16 +0000985 tftp_windowsize = 1;
986 tftp_next_ack = tftp_windowsize;
Luca Ceresolie59e3562011-05-17 00:03:39 +0000987
988#ifdef CONFIG_TFTP_TSIZE
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500989 tftp_tsize = 0;
990 tftp_tsize_num_hash = 0;
Luca Ceresolie59e3562011-05-17 00:03:39 +0000991#endif
992
Joe Hershberger8885c5f2015-04-08 01:41:07 -0500993 tftp_state = STATE_RECV_WRQ;
Joe Hershberger049a95a2015-04-08 01:41:01 -0500994 net_set_udp_handler(tftp_handler);
Andrew Ruder8e525332013-10-22 19:10:28 -0500995
996 /* zero out server ether in case the server ip has changed */
Joe Hershberger0adb5b72015-04-08 01:41:04 -0500997 memset(net_server_ethaddr, 0, 6);
Luca Ceresolie59e3562011-05-17 00:03:39 +0000998}
999#endif /* CONFIG_CMD_TFTPSRV */