wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1 | /* |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 2 | * Copyright 1994, 1995, 2000 Neil Russell. |
| 3 | * (See License) |
| 4 | * Copyright 2000, 2001 DENX Software Engineering, Wolfgang Denk, wd@denx.de |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 5 | * Copyright 2011 Comelit Group SpA, |
| 6 | * Luca Ceresoli <luca.ceresoli@comelit.it> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 7 | */ |
Tom Rini | d678a59 | 2024-05-18 20:20:43 -0600 | [diff] [blame] | 8 | #include <common.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 9 | #include <command.h> |
Simon Glass | 4e4bf94 | 2022-07-31 12:28:48 -0600 | [diff] [blame] | 10 | #include <display_options.h> |
Alexander Graf | 0efe1bc | 2016-05-06 21:01:01 +0200 | [diff] [blame] | 11 | #include <efi_loader.h> |
Simon Glass | 7b51b57 | 2019-08-01 09:46:52 -0600 | [diff] [blame] | 12 | #include <env.h> |
Simon Glass | 8e8ccfe | 2019-12-28 10:45:03 -0700 | [diff] [blame] | 13 | #include <image.h> |
Simon Glass | 4d72caa | 2020-05-10 11:40:01 -0600 | [diff] [blame] | 14 | #include <lmb.h> |
Simon Glass | f7ae49f | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 15 | #include <log.h> |
Joe Hershberger | 55d5fd9 | 2015-03-22 17:09:08 -0500 | [diff] [blame] | 16 | #include <mapmem.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 17 | #include <net.h> |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 18 | #include <net6.h> |
Simon Glass | 401d1c4 | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 19 | #include <asm/global_data.h> |
Lukasz Majewski | 3469695 | 2015-08-24 00:21:43 +0200 | [diff] [blame] | 20 | #include <net/tftp.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 21 | #include "bootp.h" |
| 22 | |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 23 | DECLARE_GLOBAL_DATA_PTR; |
| 24 | |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 25 | /* Well known TFTP port # */ |
| 26 | #define WELL_KNOWN_PORT 69 |
| 27 | /* Millisecs to timeout for lost pkt */ |
Bin Meng | af2ca59 | 2015-08-27 22:25:51 -0700 | [diff] [blame] | 28 | #define TIMEOUT 5000UL |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 29 | /* Number of "loading" hashes per line (for checking the image size) */ |
| 30 | #define HASHES_PER_LINE 65 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 31 | |
| 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 |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 40 | #define TFTP_OACK 6 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 41 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 42 | static ulong timeout_ms = TIMEOUT; |
Tom Rini | 01d1b99 | 2022-03-11 09:12:02 -0500 | [diff] [blame] | 43 | static int timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2); |
Simon Glass | 85b1980 | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 44 | static ulong time_start; /* Record time we started tftp */ |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 45 | static struct in6_addr tftp_remote_ip6; |
Bartlomiej Sieka | e83cc06 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 46 | |
| 47 | /* |
| 48 | * These globals govern the timeout behavior when attempting a connection to a |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 49 | * TFTP server. tftp_timeout_ms specifies the number of milliseconds to |
Bartlomiej Sieka | e83cc06 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 50 | * wait for the server to respond to initial connection. Second global, |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 51 | * 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 Sieka | e83cc06 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 53 | * 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 56 | ulong tftp_timeout_ms = TIMEOUT; |
Tom Rini | 01d1b99 | 2022-03-11 09:12:02 -0500 | [diff] [blame] | 57 | int tftp_timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2); |
Bartlomiej Sieka | e83cc06 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 58 | |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 59 | enum { |
| 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 Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 67 | TFTP_ERR_OPTION_NEGOTIATION = 8, |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 68 | }; |
| 69 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 70 | static struct in_addr tftp_remote_ip; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 71 | /* The UDP port at their end */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 72 | static int tftp_remote_port; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 73 | /* The UDP port at our end */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 74 | static int tftp_our_port; |
| 75 | static int timeout_count; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 76 | /* packet sequence number */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 77 | static ulong tftp_cur_block; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 78 | /* last packet sequence number received */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 79 | static ulong tftp_prev_block; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 80 | /* count of sequence number wraparounds */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 81 | static ulong tftp_block_wrap; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 82 | /* memory offset due to wrapping */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 83 | static ulong tftp_block_wrap_offset; |
| 84 | static int tftp_state; |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 85 | static ulong tftp_load_addr; |
| 86 | #ifdef CONFIG_LMB |
| 87 | static ulong tftp_load_size; |
| 88 | #endif |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 89 | #ifdef CONFIG_TFTP_TSIZE |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 90 | /* The file size reported by the server */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 91 | static int tftp_tsize; |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 92 | /* The number of hashes we printed */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 93 | static short tftp_tsize_num_hash; |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 94 | #endif |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 95 | /* The window size negotiated */ |
| 96 | static ushort tftp_windowsize; |
| 97 | /* Next block to send ack to */ |
| 98 | static ushort tftp_next_ack; |
| 99 | /* Last nack block we send */ |
| 100 | static ushort tftp_last_nack; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 101 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 102 | /* 1 if writing, else 0 */ |
| 103 | static int tftp_put_active; |
| 104 | /* 1 if we have sent the last block */ |
| 105 | static int tftp_put_final_block_sent; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 106 | #else |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 107 | #define tftp_put_active 0 |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 108 | #endif |
wdenk | 3f85ce2 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 109 | |
Luca Ceresoli | e3fb0ab | 2011-05-17 00:03:38 +0000 | [diff] [blame] | 110 | #define STATE_SEND_RRQ 1 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 111 | #define STATE_DATA 2 |
| 112 | #define STATE_TOO_LARGE 3 |
| 113 | #define STATE_BAD_MAGIC 4 |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 114 | #define STATE_OACK 5 |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 115 | #define STATE_RECV_WRQ 6 |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 116 | #define STATE_SEND_WRQ 7 |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 117 | #define STATE_INVALID_OPTION 8 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 118 | |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 119 | /* default TFTP block size */ |
| 120 | #define TFTP_BLOCK_SIZE 512 |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 121 | #define TFTP_MTU_BLOCKSIZE6 (CONFIG_TFTP_BLOCKSIZE - 20) |
Luca Ceresoli | 2f09413 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 122 | /* sequence number is 16 bit */ |
| 123 | #define TFTP_SEQUENCE_SIZE ((ulong)(1<<16)) |
wdenk | 3f85ce2 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 124 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 125 | #define DEFAULT_NAME_LEN (8 + 4 + 1) |
| 126 | static char default_filename[DEFAULT_NAME_LEN]; |
Jean-Christophe PLAGNIOL-VILLARD | a93907c | 2008-01-18 01:14:03 +0100 | [diff] [blame] | 127 | |
| 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 | |
| 134 | static char tftp_filename[MAX_LEN]; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 135 | |
Wolfgang Denk | 85eb5ca | 2007-08-14 09:47:27 +0200 | [diff] [blame] | 136 | /* 512 is poor choice for ethernet, MTU is typically 1500. |
| 137 | * Minus eth.hdrs thats 1468. Can get 2x better throughput with |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 138 | * almost-MTU block sizes. At least try... fall back to 512 if need be. |
Alessandro Rubini | 89ba81d | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 139 | * (but those using CONFIG_IP_DEFRAG may want to set a larger block in cfg file) |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 140 | */ |
Alessandro Rubini | 89ba81d | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 141 | |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 142 | /* 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 152 | static unsigned short tftp_block_size = TFTP_BLOCK_SIZE; |
Patrick Delaunay | 31d275b | 2020-04-22 14:18:26 +0200 | [diff] [blame] | 153 | static unsigned short tftp_block_size_option = CONFIG_TFTP_BLOCKSIZE; |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 154 | static unsigned short tftp_window_size_option = TFTP_WINDOWSIZE; |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 155 | |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 156 | static inline int store_block(int block, uchar *src, unsigned int len) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 157 | { |
Ley Foon Tan | ae0bdf0 | 2020-08-25 10:26:36 +0800 | [diff] [blame] | 158 | ulong offset = block * tftp_block_size + tftp_block_wrap_offset - |
| 159 | tftp_block_size; |
wdenk | 3f85ce2 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 160 | ulong newsize = offset + len; |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 161 | ulong store_addr = tftp_load_addr + offset; |
Tom Rini | 52938fc | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 162 | void *ptr; |
Joe Hershberger | 55d5fd9 | 2015-03-22 17:09:08 -0500 | [diff] [blame] | 163 | |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 164 | #ifdef CONFIG_LMB |
Tom Rini | 52938fc | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 165 | ulong end_addr = tftp_load_addr + tftp_load_size; |
Bin Meng | ca48cb4 | 2019-11-15 22:20:13 -0800 | [diff] [blame] | 166 | |
Tom Rini | 52938fc | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 167 | if (!end_addr) |
| 168 | end_addr = ULONG_MAX; |
Bin Meng | ca48cb4 | 2019-11-15 22:20:13 -0800 | [diff] [blame] | 169 | |
Tom Rini | 52938fc | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 170 | 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; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 175 | } |
Tom Rini | 52938fc | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 176 | #endif |
| 177 | ptr = map_sysmem(store_addr, len); |
| 178 | memcpy(ptr, src, len); |
| 179 | unmap_sysmem(ptr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 180 | |
Joe Hershberger | 1411157 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 181 | if (net_boot_file_size < newsize) |
| 182 | net_boot_file_size = newsize; |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 183 | |
| 184 | return 0; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 185 | } |
| 186 | |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 187 | /* Clear our state ready for a new transfer */ |
Simon Glass | 165099e | 2011-10-27 06:24:28 +0000 | [diff] [blame] | 188 | static void new_transfer(void) |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 189 | { |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 190 | tftp_prev_block = 0; |
| 191 | tftp_block_wrap = 0; |
| 192 | tftp_block_wrap_offset = 0; |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 193 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 194 | tftp_put_final_block_sent = 0; |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 195 | #endif |
| 196 | } |
| 197 | |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 198 | #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 Schuchardt | 185f812 | 2022-01-19 18:05:50 +0100 | [diff] [blame] | 205 | * Return: number of bytes loaded |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 206 | */ |
| 207 | static 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 Tan | f6a158b | 2020-08-25 10:26:37 +0800 | [diff] [blame] | 210 | ulong offset = block * tftp_block_size + tftp_block_wrap_offset - |
| 211 | tftp_block_size; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 212 | ulong tosend = len; |
| 213 | |
Joe Hershberger | 1411157 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 214 | tosend = min(net_boot_file_size - offset, tosend); |
Simon Glass | bb872dd | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 215 | (void)memcpy(dst, (void *)(image_save_addr + offset), tosend); |
Heinrich Schuchardt | 2bcc43b | 2020-02-22 08:43:40 +0100 | [diff] [blame] | 216 | debug("%s: block=%u, offset=%lu, len=%u, tosend=%lu\n", __func__, |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 217 | block, offset, len, tosend); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 218 | return tosend; |
| 219 | } |
| 220 | #endif |
| 221 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 222 | static void tftp_send(void); |
| 223 | static void tftp_timeout_handler(void); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 224 | |
| 225 | /**********************************************************************/ |
| 226 | |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 227 | static void show_block_marker(void) |
| 228 | { |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 229 | ulong pos; |
| 230 | |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 231 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 232 | if (tftp_tsize) { |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 233 | pos = tftp_cur_block * tftp_block_size + |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 234 | tftp_block_wrap_offset; |
Max Krummenacher | 7628afe | 2015-08-05 17:17:05 +0200 | [diff] [blame] | 235 | if (pos > tftp_tsize) |
| 236 | pos = tftp_tsize; |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 237 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 238 | while (tftp_tsize_num_hash < pos * 50 / tftp_tsize) { |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 239 | putc('#'); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 240 | tftp_tsize_num_hash++; |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 241 | } |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 242 | } else |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 243 | #endif |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 244 | { |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 245 | pos = (tftp_cur_block - 1) + |
| 246 | (tftp_block_wrap * TFTP_SEQUENCE_SIZE); |
| 247 | if ((pos % 10) == 0) |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 248 | putc('#'); |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 249 | else if (((pos + 1) % (10 * HASHES_PER_LINE)) == 0) |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 250 | puts("\n\t "); |
| 251 | } |
| 252 | } |
| 253 | |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 254 | /** |
| 255 | * restart the current transfer due to an error |
| 256 | * |
| 257 | * @param msg Message to print for user |
| 258 | */ |
| 259 | static void restart(const char *msg) |
| 260 | { |
| 261 | printf("\n%s; starting again\n", msg); |
Joe Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 262 | net_start_again(); |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 263 | } |
| 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 | */ |
| 270 | static 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 278 | 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 Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 282 | } |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 283 | show_block_marker(); |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 284 | } |
| 285 | |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 286 | /* The TFTP get or put is complete */ |
| 287 | static void tftp_complete(void) |
| 288 | { |
| 289 | #ifdef CONFIG_TFTP_TSIZE |
| 290 | /* Print hash marks for the last packet received */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 291 | while (tftp_tsize && tftp_tsize_num_hash < 49) { |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 292 | putc('#'); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 293 | tftp_tsize_num_hash++; |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 294 | } |
Simon Glass | 8104f54 | 2014-10-10 07:30:21 -0600 | [diff] [blame] | 295 | puts(" "); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 296 | print_size(tftp_tsize, ""); |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 297 | #endif |
Simon Glass | 85b1980 | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 298 | time_start = get_timer(time_start); |
| 299 | if (time_start > 0) { |
| 300 | puts("\n\t "); /* Line up with "Loading: " */ |
Joe Hershberger | 1411157 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 301 | print_size(net_boot_file_size / |
Simon Glass | 85b1980 | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 302 | time_start * 1000, "/s"); |
| 303 | } |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 304 | puts("\ndone\n"); |
AKASHI Takahiro | 593607c | 2024-01-17 13:39:43 +0900 | [diff] [blame] | 305 | if (!tftp_put_active) |
| 306 | efi_set_bootdev("Net", "", tftp_filename, |
| 307 | map_sysmem(tftp_load_addr, 0), |
| 308 | net_boot_file_size); |
Joe Hershberger | 22f6e99 | 2012-05-23 07:59:14 +0000 | [diff] [blame] | 309 | net_set_state(NETLOOP_SUCCESS); |
Simon Glass | f5329bb | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 310 | } |
| 311 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 312 | static void tftp_send(void) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 313 | { |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 314 | uchar *pkt; |
Joe Hershberger | db288a9 | 2012-05-15 08:59:04 +0000 | [diff] [blame] | 315 | uchar *xp; |
| 316 | int len = 0; |
| 317 | ushort *s; |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 318 | bool err_pkt = false; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 319 | |
| 320 | /* |
| 321 | * We will always be sending some sort of packet, so |
| 322 | * cobble together the packet headers now. |
| 323 | */ |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 324 | 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; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 329 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 330 | switch (tftp_state) { |
Luca Ceresoli | e3fb0ab | 2011-05-17 00:03:38 +0000 | [diff] [blame] | 331 | case STATE_SEND_RRQ: |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 332 | case STATE_SEND_WRQ: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 333 | xp = pkt; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 334 | s = (ushort *)pkt; |
Simon Glass | 8c6914f | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 335 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 336 | *s++ = htons(tftp_state == STATE_SEND_RRQ ? TFTP_RRQ : |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 337 | TFTP_WRQ); |
Simon Glass | 8c6914f | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 338 | #else |
| 339 | *s++ = htons(TFTP_RRQ); |
| 340 | #endif |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 341 | pkt = (uchar *)s; |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 342 | strcpy((char *)pkt, tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 343 | pkt += strlen(tftp_filename) + 1; |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 344 | strcpy((char *)pkt, "octet"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 345 | pkt += 5 /*strlen("octet")*/ + 1; |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 346 | strcpy((char *)pkt, "timeout"); |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 347 | pkt += 7 /*strlen("timeout")*/ + 1; |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 348 | sprintf((char *)pkt, "%lu", timeout_ms / 1000); |
Robin Getz | 0ebf04c | 2009-07-23 03:01:03 -0400 | [diff] [blame] | 349 | debug("send option \"timeout %s\"\n", (char *)pkt); |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 350 | pkt += strlen((char *)pkt) + 1; |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 351 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 1411157 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 352 | pkt += sprintf((char *)pkt, "tsize%c%u%c", |
| 353 | 0, net_boot_file_size, 0); |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 354 | #endif |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 355 | /* try for more effic. blk size */ |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 356 | pkt += sprintf((char *)pkt, "blksize%c%d%c", |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 357 | 0, tftp_block_size_option, 0); |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 358 | |
| 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); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 366 | len = pkt - xp; |
| 367 | break; |
| 368 | |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 369 | case STATE_OACK: |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 370 | |
| 371 | case STATE_RECV_WRQ: |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 372 | case STATE_DATA: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 373 | xp = pkt; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 374 | s = (ushort *)pkt; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 375 | s[0] = htons(TFTP_ACK); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 376 | s[1] = htons(tftp_cur_block); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 377 | pkt = (uchar *)(s + 2); |
| 378 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 379 | if (tftp_put_active) { |
| 380 | int toload = tftp_block_size; |
| 381 | int loaded = load_block(tftp_cur_block, pkt, toload); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 382 | |
| 383 | s[0] = htons(TFTP_DATA); |
| 384 | pkt += loaded; |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 385 | tftp_put_final_block_sent = (loaded < toload); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 386 | } |
| 387 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 388 | len = pkt - xp; |
| 389 | break; |
| 390 | |
| 391 | case STATE_TOO_LARGE: |
| 392 | xp = pkt; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 393 | s = (ushort *)pkt; |
| 394 | *s++ = htons(TFTP_ERROR); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 395 | *s++ = htons(3); |
| 396 | |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 397 | pkt = (uchar *)s; |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 398 | strcpy((char *)pkt, "File too large"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 399 | pkt += 14 /*strlen("File too large")*/ + 1; |
| 400 | len = pkt - xp; |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 401 | err_pkt = true; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 402 | break; |
| 403 | |
| 404 | case STATE_BAD_MAGIC: |
| 405 | xp = pkt; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 406 | s = (ushort *)pkt; |
| 407 | *s++ = htons(TFTP_ERROR); |
| 408 | *s++ = htons(2); |
| 409 | pkt = (uchar *)s; |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 410 | strcpy((char *)pkt, "File has bad magic"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 411 | pkt += 18 /*strlen("File has bad magic")*/ + 1; |
| 412 | len = pkt - xp; |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 413 | 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; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 427 | break; |
| 428 | } |
| 429 | |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 430 | 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 Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 438 | |
| 439 | if (err_pkt) |
| 440 | net_set_state(NETLOOP_FAIL); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 441 | } |
| 442 | |
Simon Glass | 39bccd2 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 443 | #ifdef CONFIG_CMD_TFTPPUT |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 444 | static void icmp_handler(unsigned type, unsigned code, unsigned dest, |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 445 | struct in_addr sip, unsigned src, uchar *pkt, |
| 446 | unsigned len) |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 447 | { |
| 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 Glass | 39bccd2 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 453 | #endif |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 454 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 455 | static void tftp_handler(uchar *pkt, unsigned dest, struct in_addr sip, |
| 456 | unsigned src, unsigned len) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 457 | { |
Kim Phillips | 61fdd4f | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 458 | __be16 proto; |
| 459 | __be16 *s; |
Wolfgang Denk | ff13ac8 | 2007-08-30 14:42:15 +0200 | [diff] [blame] | 460 | int i; |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 461 | u16 timeout_val_rcvd; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 462 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 463 | if (dest != tftp_our_port) { |
Luca Ceresoli | 0bdd8ac | 2011-05-14 05:50:02 +0000 | [diff] [blame] | 464 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 465 | } |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 466 | if (tftp_state != STATE_SEND_RRQ && src != tftp_remote_port && |
| 467 | tftp_state != STATE_RECV_WRQ && tftp_state != STATE_SEND_WRQ) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 468 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 469 | |
Luca Ceresoli | 7bc325a | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 470 | if (len < 2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 471 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 472 | len -= 2; |
| 473 | /* warning: don't use increment (++) in ntohs() macros!! */ |
Kim Phillips | 61fdd4f | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 474 | s = (__be16 *)pkt; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 475 | proto = *s++; |
| 476 | pkt = (uchar *)s; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 477 | switch (ntohs(proto)) { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 478 | case TFTP_RRQ: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 479 | break; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 480 | |
| 481 | case TFTP_ACK: |
| 482 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 483 | if (tftp_put_active) { |
| 484 | if (tftp_put_final_block_sent) { |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 485 | 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 492 | int ack_ok = (tftp_cur_block == block); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 493 | |
Ley Foon Tan | 6bf4636 | 2020-08-25 10:26:35 +0800 | [diff] [blame] | 494 | tftp_prev_block = tftp_cur_block; |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 495 | tftp_cur_block = (unsigned short)(block + 1); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 496 | update_block_number(); |
| 497 | if (ack_ok) |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 498 | tftp_send(); /* Send next data block */ |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 499 | } |
| 500 | } |
| 501 | #endif |
| 502 | break; |
| 503 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 504 | default: |
| 505 | break; |
| 506 | |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 507 | #ifdef CONFIG_CMD_TFTPSRV |
| 508 | case TFTP_WRQ: |
| 509 | debug("Got WRQ\n"); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 510 | tftp_remote_ip = sip; |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 511 | tftp_remote_port = src; |
| 512 | tftp_our_port = 1024 + (get_timer(0) % 3072); |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 513 | new_transfer(); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 514 | tftp_send(); /* Send ACK(0) */ |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 515 | break; |
| 516 | #endif |
| 517 | |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 518 | case TFTP_OACK: |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 519 | 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 527 | tftp_state = STATE_OACK; |
| 528 | tftp_remote_port = src; |
Wolfgang Denk | 6017474 | 2007-08-31 10:01:51 +0200 | [diff] [blame] | 529 | /* |
| 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 Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 534 | for (i = 0; i+8 < len; i++) { |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 535 | if (strcasecmp((char *)pkt + i, "blksize") == 0) { |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 536 | tftp_block_size = (unsigned short) |
Simon Glass | 0b1284e | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 537 | dectoul((char *)pkt + i + 8, NULL); |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 538 | debug("Blocksize oack: %s, %d\n", |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 539 | (char *)pkt + i + 8, tftp_block_size); |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 540 | 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 Glass | 0b1284e | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 548 | dectoul((char *)pkt + i + 8, NULL); |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 549 | 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 Denk | ff13ac8 | 2007-08-30 14:42:15 +0200 | [diff] [blame] | 556 | } |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 557 | #ifdef CONFIG_TFTP_TSIZE |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 558 | if (strcasecmp((char *)pkt + i, "tsize") == 0) { |
Simon Glass | 0b1284e | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 559 | tftp_tsize = dectoul((char *)pkt + i + 6, |
| 560 | NULL); |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 561 | debug("size = %s, %d\n", |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 562 | (char *)pkt + i + 6, tftp_tsize); |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 563 | } |
| 564 | #endif |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 565 | if (strcasecmp((char *)pkt + i, "windowsize") == 0) { |
| 566 | tftp_windowsize = |
Simon Glass | 0b1284e | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 567 | dectoul((char *)pkt + i + 11, NULL); |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 568 | debug("windowsize = %s, %d\n", |
| 569 | (char *)pkt + i + 11, tftp_windowsize); |
| 570 | } |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 571 | } |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 572 | |
| 573 | tftp_next_ack = tftp_windowsize; |
| 574 | |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 575 | #ifdef CONFIG_CMD_TFTPPUT |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 576 | if (tftp_put_active && tftp_state == STATE_OACK) { |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 577 | /* Get ready to send the first block */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 578 | tftp_state = STATE_DATA; |
| 579 | tftp_cur_block++; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 580 | } |
| 581 | #endif |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 582 | tftp_send(); /* Send ACK or first data block */ |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 583 | break; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 584 | case TFTP_DATA: |
| 585 | if (len < 2) |
| 586 | return; |
| 587 | len -= 2; |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 588 | |
| 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 Edmond | 21a265c | 2023-01-04 18:16:26 -0800 | [diff] [blame] | 594 | * 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 Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 602 | * 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; |
wdenk | 3f85ce2 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 618 | |
Harm Berntsen | beb61e1 | 2020-11-27 21:45:56 +0000 | [diff] [blame] | 619 | if (tftp_state == STATE_SEND_RRQ) { |
Ravik Hasija | 0813921 | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 620 | debug("Server did not acknowledge any options!\n"); |
Harm Berntsen | beb61e1 | 2020-11-27 21:45:56 +0000 | [diff] [blame] | 621 | tftp_next_ack = tftp_windowsize; |
| 622 | } |
wdenk | fbe4b5c | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 623 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 624 | if (tftp_state == STATE_SEND_RRQ || tftp_state == STATE_OACK || |
| 625 | tftp_state == STATE_RECV_WRQ) { |
wdenk | 3f85ce2 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 626 | /* first block received */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 627 | tftp_state = STATE_DATA; |
| 628 | tftp_remote_port = src; |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 629 | new_transfer(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 630 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 631 | 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 Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 636 | net_start_again(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 637 | break; |
| 638 | } |
| 639 | } |
| 640 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 641 | if (tftp_cur_block == tftp_prev_block) { |
| 642 | /* Same block again; ignore it. */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 643 | break; |
| 644 | } |
| 645 | |
Ravik Hasija | de5468e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 646 | update_block_number(); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 647 | tftp_prev_block = tftp_cur_block; |
Albert ARIBAUD \(3ADEV\) | f5fb734 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 648 | timeout_count_max = tftp_timeout_count_max; |
Joe Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 649 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 650 | |
Ley Foon Tan | ae0bdf0 | 2020-08-25 10:26:36 +0800 | [diff] [blame] | 651 | if (store_block(tftp_cur_block, pkt + 2, len)) { |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 652 | eth_halt(); |
| 653 | net_set_state(NETLOOP_FAIL); |
| 654 | break; |
| 655 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 656 | |
Ramon Fried | 2dddc1b | 2021-02-03 21:28:59 +0200 | [diff] [blame] | 657 | if (len < tftp_block_size) { |
| 658 | tftp_send(); |
| 659 | tftp_complete(); |
| 660 | break; |
| 661 | } |
| 662 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 663 | /* |
Luca Ceresoli | 4d69e98 | 2011-05-17 00:03:41 +0000 | [diff] [blame] | 664 | * Acknowledge the block just received, which will prompt |
Luca Ceresoli | 20478ce | 2011-05-17 00:03:37 +0000 | [diff] [blame] | 665 | * the remote for the next one. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 666 | */ |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 667 | if (tftp_cur_block == tftp_next_ack) { |
| 668 | tftp_send(); |
| 669 | tftp_next_ack += tftp_windowsize; |
| 670 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 671 | break; |
| 672 | |
| 673 | case TFTP_ERROR: |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 674 | printf("\nTFTP error: '%s' (%d)\n", |
Kim Phillips | 61fdd4f | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 675 | pkt + 2, ntohs(*(__be16 *)pkt)); |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 676 | |
Kim Phillips | 61fdd4f | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 677 | switch (ntohs(*(__be16 *)pkt)) { |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 678 | case TFTP_ERR_FILE_NOT_FOUND: |
| 679 | case TFTP_ERR_ACCESS_DENIED: |
| 680 | puts("Not retrying...\n"); |
| 681 | eth_halt(); |
Joe Hershberger | 22f6e99 | 2012-05-23 07:59:14 +0000 | [diff] [blame] | 682 | net_set_state(NETLOOP_FAIL); |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 683 | 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 Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 691 | net_start_again(); |
Remy Bohmer | aafda38 | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 692 | break; |
| 693 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 694 | break; |
| 695 | } |
| 696 | } |
| 697 | |
| 698 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 699 | static void tftp_timeout_handler(void) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 700 | { |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 701 | if (++timeout_count > timeout_count_max) { |
Simon Glass | e4cde2f | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 702 | restart("Retry count exceeded"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 703 | } else { |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 704 | puts("T "); |
Joe Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 705 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 706 | if (tftp_state != STATE_RECV_WRQ) |
| 707 | tftp_send(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 708 | } |
| 709 | } |
| 710 | |
Simon Glass | bb872dd | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 711 | /* Initialize tftp_load_addr and tftp_load_size from image_load_addr and lmb */ |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 712 | static int tftp_init_load_addr(void) |
| 713 | { |
| 714 | #ifdef CONFIG_LMB |
| 715 | struct lmb lmb; |
| 716 | phys_size_t max_size; |
| 717 | |
Simon Goldschmidt | 9cc2323 | 2019-01-26 22:13:04 +0100 | [diff] [blame] | 718 | lmb_init_and_reserve(&lmb, gd->bd, (void *)gd->fdt_blob); |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 719 | |
Simon Glass | bb872dd | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 720 | max_size = lmb_get_free_size(&lmb, image_load_addr); |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 721 | if (!max_size) |
| 722 | return -1; |
| 723 | |
| 724 | tftp_load_size = max_size; |
| 725 | #endif |
Simon Glass | bb872dd | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 726 | tftp_load_addr = image_load_addr; |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 727 | return 0; |
| 728 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 729 | |
Rasmus Villemoes | 087648b | 2022-10-14 19:43:42 +0200 | [diff] [blame] | 730 | static int saved_tftp_block_size_option; |
| 731 | static 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 Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 769 | void tftp_start(enum proto_t protocol) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 770 | { |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 771 | __maybe_unused char *ep; /* Environment pointer */ |
Rasmus Villemoes | 087648b | 2022-10-14 19:43:42 +0200 | [diff] [blame] | 772 | |
| 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 Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 778 | if (IS_ENABLED(CONFIG_NET_TFTP_VARS)) { |
Alessandro Rubini | 89ba81d | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 779 | |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 780 | /* |
| 781 | * Allow the user to choose TFTP blocksize and timeout. |
| 782 | * TFTP protocol has a minimal timeout of 1 second. |
| 783 | */ |
Albert ARIBAUD \(3ADEV\) | f5fb734 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 784 | |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 785 | ep = env_get("tftpblocksize"); |
| 786 | if (ep != NULL) |
| 787 | tftp_block_size_option = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | c96f86e | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 788 | |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 789 | ep = env_get("tftpwindowsize"); |
| 790 | if (ep != NULL) |
| 791 | tftp_window_size_option = simple_strtol(ep, NULL, 10); |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 792 | |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 793 | ep = env_get("tftptimeout"); |
| 794 | if (ep != NULL) |
| 795 | timeout_ms = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | c96f86e | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 796 | |
Rasmus Villemoes | 4b8c44e | 2022-10-14 19:43:41 +0200 | [diff] [blame] | 797 | 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 Denk | c96f86e | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 812 | } |
| 813 | |
Rasmus Villemoes | 087648b | 2022-10-14 19:43:42 +0200 | [diff] [blame] | 814 | sanitize_tftp_block_size_option(protocol); |
| 815 | |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 816 | debug("TFTP blocksize = %i, TFTP windowsize = %d timeout = %ld ms\n", |
| 817 | tftp_block_size_option, tftp_window_size_option, timeout_ms); |
Wolfgang Denk | ecb0ccd | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 818 | |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 819 | if (IS_ENABLED(CONFIG_IPV6)) |
| 820 | tftp_remote_ip6 = net_server_ip6; |
| 821 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 822 | tftp_remote_ip = net_server_ip; |
Joe Hershberger | 6ab1283 | 2018-07-03 19:36:43 -0500 | [diff] [blame] | 823 | if (!net_parse_bootfile(&tftp_remote_ip, tftp_filename, MAX_LEN)) { |
Matthias Weisser | ea45cb0 | 2011-12-03 03:29:44 +0000 | [diff] [blame] | 824 | sprintf(default_filename, "%02X%02X%02X%02X.img", |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 825 | 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-VILLARD | a93907c | 2008-01-18 01:14:03 +0100 | [diff] [blame] | 829 | |
Vladimir Zapolskiy | 0c17b1b | 2017-06-28 22:56:07 +0300 | [diff] [blame] | 830 | strncpy(tftp_filename, default_filename, DEFAULT_NAME_LEN); |
| 831 | tftp_filename[DEFAULT_NAME_LEN - 1] = 0; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 832 | |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 833 | printf("*** Warning: no boot file name; using '%s'\n", |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 834 | tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 835 | } |
| 836 | |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 837 | 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 Mohandesi | 7db25d9 | 2023-01-13 09:27:41 -0800 | [diff] [blame] | 846 | string_to_ip6(s + 1, len - 1, &tftp_remote_ip6); |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 847 | 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 Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 855 | printf("Using %s device\n", eth_get_name()); |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 856 | |
| 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 Glass | 8c6914f | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 865 | #ifdef CONFIG_CMD_TFTPPUT |
| 866 | protocol == TFTPPUT ? "to" : "from", |
| 867 | #else |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 868 | "from", |
Simon Glass | 8c6914f | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 869 | #endif |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 870 | &tftp_remote_ip, &net_ip); |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 871 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 872 | |
| 873 | /* Check if we need to send across this subnet */ |
Viacheslav Mitrofanov | 7fbf230 | 2022-12-02 12:18:07 +0300 | [diff] [blame] | 874 | 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 Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 880 | struct in_addr our_net; |
| 881 | struct in_addr remote_net; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 882 | |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 883 | 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); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 887 | } |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 888 | putc('\n'); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 889 | |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 890 | printf("Filename '%s'.", tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 891 | |
Joe Hershberger | 1411157 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 892 | 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, ""); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 896 | } |
| 897 | |
Luca Ceresoli | c718b14 | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 898 | putc('\n'); |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 899 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 900 | tftp_put_active = (protocol == TFTPPUT); |
| 901 | if (tftp_put_active) { |
Simon Glass | bb872dd | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 902 | 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 Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 905 | puts("Saving: *\b"); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 906 | tftp_state = STATE_SEND_WRQ; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 907 | new_transfer(); |
| 908 | } else |
| 909 | #endif |
| 910 | { |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 911 | 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 Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 919 | puts("Loading: *\b"); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 920 | tftp_state = STATE_SEND_RRQ; |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 921 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 922 | |
Simon Glass | 85b1980 | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 923 | time_start = get_timer(0); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 924 | timeout_count_max = tftp_timeout_count_max; |
Bartlomiej Sieka | e83cc06 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 925 | |
Joe Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 926 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 927 | net_set_udp_handler(tftp_handler); |
Simon Glass | 39bccd2 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 928 | #ifdef CONFIG_CMD_TFTPPUT |
Simon Glass | 1fb7cd4 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 929 | net_set_icmp_handler(icmp_handler); |
Simon Glass | 39bccd2 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 930 | #endif |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 931 | tftp_remote_port = WELL_KNOWN_PORT; |
| 932 | timeout_count = 0; |
Wolfgang Denk | ecb0ccd | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 933 | /* Use a pseudo-random port unless a specific port is set */ |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 934 | tftp_our_port = 1024 + (get_timer(0) % 3072); |
David Updegraff | 53a5c42 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 935 | |
Wolfgang Denk | ecb0ccd | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 936 | #ifdef CONFIG_TFTP_PORT |
Simon Glass | 00caae6 | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 937 | ep = env_get("tftpdstp"); |
Luca Ceresoli | 7bc325a | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 938 | if (ep != NULL) |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 939 | tftp_remote_port = simple_strtol(ep, NULL, 10); |
Simon Glass | 00caae6 | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 940 | ep = env_get("tftpsrcp"); |
Luca Ceresoli | 7bc325a | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 941 | if (ep != NULL) |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 942 | tftp_our_port = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | ecb0ccd | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 943 | #endif |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 944 | tftp_cur_block = 0; |
Ramon Fried | cc6b87e | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 945 | tftp_windowsize = 1; |
| 946 | tftp_last_nack = 0; |
wdenk | 73a8b27 | 2003-06-05 19:27:42 +0000 | [diff] [blame] | 947 | /* zero out server ether in case the server ip has changed */ |
Joe Hershberger | 0adb5b7 | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 948 | memset(net_server_ethaddr, 0, 6); |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 949 | /* Revert tftp_block_size to dflt */ |
| 950 | tftp_block_size = TFTP_BLOCK_SIZE; |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 951 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 952 | tftp_tsize = 0; |
| 953 | tftp_tsize_num_hash = 0; |
Robin Getz | 4fccb81 | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 954 | #endif |
wdenk | 73a8b27 | 2003-06-05 19:27:42 +0000 | [diff] [blame] | 955 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 956 | tftp_send(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 957 | } |
| 958 | |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 959 | #ifdef CONFIG_CMD_TFTPSRV |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 960 | void tftp_start_server(void) |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 961 | { |
| 962 | tftp_filename[0] = 0; |
| 963 | |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 964 | 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 Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 970 | printf("Using %s device\n", eth_get_name()); |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 971 | printf("Listening for TFTP transfer on %pI4\n", &net_ip); |
Simon Goldschmidt | a156c47 | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 972 | printf("Load address: 0x%lx\n", tftp_load_addr); |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 973 | |
| 974 | puts("Loading: *\b"); |
| 975 | |
Albert ARIBAUD \(3ADEV\) | f5fb734 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 976 | timeout_count_max = tftp_timeout_count_max; |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 977 | timeout_count = 0; |
| 978 | timeout_ms = TIMEOUT; |
Joe Hershberger | bc0571f | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 979 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 980 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 981 | /* 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 Zijlstra | 1ffe366 | 2022-03-31 08:03:16 +0000 | [diff] [blame] | 985 | tftp_windowsize = 1; |
| 986 | tftp_next_ack = tftp_windowsize; |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 987 | |
| 988 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 989 | tftp_tsize = 0; |
| 990 | tftp_tsize_num_hash = 0; |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 991 | #endif |
| 992 | |
Joe Hershberger | 8885c5f | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 993 | tftp_state = STATE_RECV_WRQ; |
Joe Hershberger | 049a95a | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 994 | net_set_udp_handler(tftp_handler); |
Andrew Ruder | 8e52533 | 2013-10-22 19:10:28 -0500 | [diff] [blame] | 995 | |
| 996 | /* zero out server ether in case the server ip has changed */ |
Joe Hershberger | 0adb5b7 | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 997 | memset(net_server_ethaddr, 0, 6); |
Luca Ceresoli | e59e356 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 998 | } |
| 999 | #endif /* CONFIG_CMD_TFTPSRV */ |