wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1 | /* |
Luca Ceresoli | c42fc27 | 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 | b640ed3 | 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 | */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 8 | #include <common.h> |
| 9 | #include <command.h> |
Simon Glass | 1ab1692 | 2022-07-31 12:28:48 -0600 | [diff] [blame] | 10 | #include <display_options.h> |
Alexander Graf | 94c4b99 | 2016-05-06 21:01:01 +0200 | [diff] [blame] | 11 | #include <efi_loader.h> |
Simon Glass | 0af6e2d | 2019-08-01 09:46:52 -0600 | [diff] [blame] | 12 | #include <env.h> |
Simon Glass | 85f1378 | 2019-12-28 10:45:03 -0700 | [diff] [blame] | 13 | #include <image.h> |
Simon Glass | 2dc9c34 | 2020-05-10 11:40:01 -0600 | [diff] [blame] | 14 | #include <lmb.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 15 | #include <log.h> |
Joe Hershberger | ed19185 | 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> |
Simon Glass | 3ba929a | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 18 | #include <asm/global_data.h> |
Lukasz Majewski | 2118592 | 2015-08-24 00:21:43 +0200 | [diff] [blame] | 19 | #include <net/tftp.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 20 | #include "bootp.h" |
| 21 | |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 22 | DECLARE_GLOBAL_DATA_PTR; |
| 23 | |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 24 | /* Well known TFTP port # */ |
| 25 | #define WELL_KNOWN_PORT 69 |
| 26 | /* Millisecs to timeout for lost pkt */ |
Bin Meng | e67eaa8 | 2015-08-27 22:25:51 -0700 | [diff] [blame] | 27 | #define TIMEOUT 5000UL |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 28 | /* Number of "loading" hashes per line (for checking the image size) */ |
| 29 | #define HASHES_PER_LINE 65 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 30 | |
| 31 | /* |
| 32 | * TFTP operations. |
| 33 | */ |
| 34 | #define TFTP_RRQ 1 |
| 35 | #define TFTP_WRQ 2 |
| 36 | #define TFTP_DATA 3 |
| 37 | #define TFTP_ACK 4 |
| 38 | #define TFTP_ERROR 5 |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 39 | #define TFTP_OACK 6 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 40 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 41 | static ulong timeout_ms = TIMEOUT; |
Tom Rini | 26011a3 | 2022-03-11 09:12:02 -0500 | [diff] [blame] | 42 | static int timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2); |
Simon Glass | cab9a8d | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 43 | static ulong time_start; /* Record time we started tftp */ |
Bartlomiej Sieka | 371cde7 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 44 | |
| 45 | /* |
| 46 | * These globals govern the timeout behavior when attempting a connection to a |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 47 | * TFTP server. tftp_timeout_ms specifies the number of milliseconds to |
Bartlomiej Sieka | 371cde7 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 48 | * wait for the server to respond to initial connection. Second global, |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 49 | * tftp_timeout_count_max, gives the number of such connection retries. |
| 50 | * tftp_timeout_count_max must be non-negative and tftp_timeout_ms must be |
Bartlomiej Sieka | 371cde7 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 51 | * positive. The globals are meant to be set (and restored) by code needing |
| 52 | * non-standard timeout behavior when initiating a TFTP transfer. |
| 53 | */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 54 | ulong tftp_timeout_ms = TIMEOUT; |
Tom Rini | 26011a3 | 2022-03-11 09:12:02 -0500 | [diff] [blame] | 55 | int tftp_timeout_count_max = (CONFIG_NET_RETRY_COUNT * 2); |
Bartlomiej Sieka | 371cde7 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 56 | |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 57 | enum { |
| 58 | TFTP_ERR_UNDEFINED = 0, |
| 59 | TFTP_ERR_FILE_NOT_FOUND = 1, |
| 60 | TFTP_ERR_ACCESS_DENIED = 2, |
| 61 | TFTP_ERR_DISK_FULL = 3, |
| 62 | TFTP_ERR_UNEXPECTED_OPCODE = 4, |
| 63 | TFTP_ERR_UNKNOWN_TRANSFER_ID = 5, |
| 64 | TFTP_ERR_FILE_ALREADY_EXISTS = 6, |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 65 | TFTP_ERR_OPTION_NEGOTIATION = 8, |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 66 | }; |
| 67 | |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 68 | static struct in_addr tftp_remote_ip; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 69 | /* The UDP port at their end */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 70 | static int tftp_remote_port; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 71 | /* The UDP port at our end */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 72 | static int tftp_our_port; |
| 73 | static int timeout_count; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 74 | /* packet sequence number */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 75 | static ulong tftp_cur_block; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 76 | /* last packet sequence number received */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 77 | static ulong tftp_prev_block; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 78 | /* count of sequence number wraparounds */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 79 | static ulong tftp_block_wrap; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 80 | /* memory offset due to wrapping */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 81 | static ulong tftp_block_wrap_offset; |
| 82 | static int tftp_state; |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 83 | static ulong tftp_load_addr; |
| 84 | #ifdef CONFIG_LMB |
| 85 | static ulong tftp_load_size; |
| 86 | #endif |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 87 | #ifdef CONFIG_TFTP_TSIZE |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 88 | /* The file size reported by the server */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 89 | static int tftp_tsize; |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 90 | /* The number of hashes we printed */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 91 | static short tftp_tsize_num_hash; |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 92 | #endif |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 93 | /* The window size negotiated */ |
| 94 | static ushort tftp_windowsize; |
| 95 | /* Next block to send ack to */ |
| 96 | static ushort tftp_next_ack; |
| 97 | /* Last nack block we send */ |
| 98 | static ushort tftp_last_nack; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 99 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 100 | /* 1 if writing, else 0 */ |
| 101 | static int tftp_put_active; |
| 102 | /* 1 if we have sent the last block */ |
| 103 | static int tftp_put_final_block_sent; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 104 | #else |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 105 | #define tftp_put_active 0 |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 106 | #endif |
wdenk | ef89394 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 107 | |
Luca Ceresoli | 562dfe5 | 2011-05-17 00:03:38 +0000 | [diff] [blame] | 108 | #define STATE_SEND_RRQ 1 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 109 | #define STATE_DATA 2 |
| 110 | #define STATE_TOO_LARGE 3 |
| 111 | #define STATE_BAD_MAGIC 4 |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 112 | #define STATE_OACK 5 |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 113 | #define STATE_RECV_WRQ 6 |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 114 | #define STATE_SEND_WRQ 7 |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 115 | #define STATE_INVALID_OPTION 8 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 116 | |
Luca Ceresoli | c42fc27 | 2011-05-14 05:49:56 +0000 | [diff] [blame] | 117 | /* default TFTP block size */ |
| 118 | #define TFTP_BLOCK_SIZE 512 |
| 119 | /* sequence number is 16 bit */ |
| 120 | #define TFTP_SEQUENCE_SIZE ((ulong)(1<<16)) |
wdenk | ef89394 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 121 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 122 | #define DEFAULT_NAME_LEN (8 + 4 + 1) |
| 123 | static char default_filename[DEFAULT_NAME_LEN]; |
Jean-Christophe PLAGNIOL-VILLARD | 5855541 | 2008-01-18 01:14:03 +0100 | [diff] [blame] | 124 | |
| 125 | #ifndef CONFIG_TFTP_FILE_NAME_MAX_LEN |
| 126 | #define MAX_LEN 128 |
| 127 | #else |
| 128 | #define MAX_LEN CONFIG_TFTP_FILE_NAME_MAX_LEN |
| 129 | #endif |
| 130 | |
| 131 | static char tftp_filename[MAX_LEN]; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 132 | |
Wolfgang Denk | 627f5c3 | 2007-08-14 09:47:27 +0200 | [diff] [blame] | 133 | /* 512 is poor choice for ethernet, MTU is typically 1500. |
| 134 | * Minus eth.hdrs thats 1468. Can get 2x better throughput with |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 135 | * almost-MTU block sizes. At least try... fall back to 512 if need be. |
Alessandro Rubini | 8832f6e | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 136 | * (but those using CONFIG_IP_DEFRAG may want to set a larger block in cfg file) |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 137 | */ |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 138 | |
| 139 | /* When windowsize is defined to 1, |
| 140 | * tftp behaves the same way as it was |
| 141 | * never declared |
| 142 | */ |
| 143 | #ifdef CONFIG_TFTP_WINDOWSIZE |
| 144 | #define TFTP_WINDOWSIZE CONFIG_TFTP_WINDOWSIZE |
| 145 | #else |
| 146 | #define TFTP_WINDOWSIZE 1 |
| 147 | #endif |
Alessandro Rubini | 8832f6e | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 148 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 149 | static unsigned short tftp_block_size = TFTP_BLOCK_SIZE; |
Patrick Delaunay | 6c3a447 | 2020-04-22 14:18:26 +0200 | [diff] [blame] | 150 | static unsigned short tftp_block_size_option = CONFIG_TFTP_BLOCKSIZE; |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 151 | static unsigned short tftp_window_size_option = TFTP_WINDOWSIZE; |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 152 | |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 153 | static inline int store_block(int block, uchar *src, unsigned int len) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 154 | { |
Ley Foon Tan | 81bb324 | 2020-08-25 10:26:36 +0800 | [diff] [blame] | 155 | ulong offset = block * tftp_block_size + tftp_block_wrap_offset - |
| 156 | tftp_block_size; |
wdenk | ef89394 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 157 | ulong newsize = offset + len; |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 158 | ulong store_addr = tftp_load_addr + offset; |
Tom Rini | db295e8 | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 159 | void *ptr; |
Joe Hershberger | ed19185 | 2015-03-22 17:09:08 -0500 | [diff] [blame] | 160 | |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 161 | #ifdef CONFIG_LMB |
Tom Rini | db295e8 | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 162 | ulong end_addr = tftp_load_addr + tftp_load_size; |
Bin Meng | af54963 | 2019-11-15 22:20:13 -0800 | [diff] [blame] | 163 | |
Tom Rini | db295e8 | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 164 | if (!end_addr) |
| 165 | end_addr = ULONG_MAX; |
Bin Meng | af54963 | 2019-11-15 22:20:13 -0800 | [diff] [blame] | 166 | |
Tom Rini | db295e8 | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 167 | if (store_addr < tftp_load_addr || |
| 168 | store_addr + len > end_addr) { |
| 169 | puts("\nTFTP error: "); |
| 170 | puts("trying to overwrite reserved memory...\n"); |
| 171 | return -1; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 172 | } |
Tom Rini | db295e8 | 2022-07-23 13:04:54 -0400 | [diff] [blame] | 173 | #endif |
| 174 | ptr = map_sysmem(store_addr, len); |
| 175 | memcpy(ptr, src, len); |
| 176 | unmap_sysmem(ptr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 177 | |
Joe Hershberger | 290c899 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 178 | if (net_boot_file_size < newsize) |
| 179 | net_boot_file_size = newsize; |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 180 | |
| 181 | return 0; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 182 | } |
| 183 | |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 184 | /* Clear our state ready for a new transfer */ |
Simon Glass | 8431332 | 2011-10-27 06:24:28 +0000 | [diff] [blame] | 185 | static void new_transfer(void) |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 186 | { |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 187 | tftp_prev_block = 0; |
| 188 | tftp_block_wrap = 0; |
| 189 | tftp_block_wrap_offset = 0; |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 190 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 191 | tftp_put_final_block_sent = 0; |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 192 | #endif |
| 193 | } |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 194 | |
| 195 | #ifdef CONFIG_CMD_TFTPPUT |
| 196 | /** |
| 197 | * Load the next block from memory to be sent over tftp. |
| 198 | * |
| 199 | * @param block Block number to send |
| 200 | * @param dst Destination buffer for data |
| 201 | * @param len Number of bytes in block (this one and every other) |
Heinrich Schuchardt | 47b4c02 | 2022-01-19 18:05:50 +0100 | [diff] [blame] | 202 | * Return: number of bytes loaded |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 203 | */ |
| 204 | static int load_block(unsigned block, uchar *dst, unsigned len) |
| 205 | { |
| 206 | /* We may want to get the final block from the previous set */ |
Ley Foon Tan | 5babe56 | 2020-08-25 10:26:37 +0800 | [diff] [blame] | 207 | ulong offset = block * tftp_block_size + tftp_block_wrap_offset - |
| 208 | tftp_block_size; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 209 | ulong tosend = len; |
| 210 | |
Joe Hershberger | 290c899 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 211 | tosend = min(net_boot_file_size - offset, tosend); |
Simon Glass | 892265d | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 212 | (void)memcpy(dst, (void *)(image_save_addr + offset), tosend); |
Heinrich Schuchardt | c81ab83 | 2020-02-22 08:43:40 +0100 | [diff] [blame] | 213 | debug("%s: block=%u, offset=%lu, len=%u, tosend=%lu\n", __func__, |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 214 | block, offset, len, tosend); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 215 | return tosend; |
| 216 | } |
| 217 | #endif |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 218 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 219 | static void tftp_send(void); |
| 220 | static void tftp_timeout_handler(void); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 221 | |
| 222 | /**********************************************************************/ |
| 223 | |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 224 | static void show_block_marker(void) |
| 225 | { |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 226 | ulong pos; |
| 227 | |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 228 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 229 | if (tftp_tsize) { |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 230 | pos = tftp_cur_block * tftp_block_size + |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 231 | tftp_block_wrap_offset; |
Max Krummenacher | dd081cc | 2015-08-05 17:17:05 +0200 | [diff] [blame] | 232 | if (pos > tftp_tsize) |
| 233 | pos = tftp_tsize; |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 234 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 235 | while (tftp_tsize_num_hash < pos * 50 / tftp_tsize) { |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 236 | putc('#'); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 237 | tftp_tsize_num_hash++; |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 238 | } |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 239 | } else |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 240 | #endif |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 241 | { |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 242 | pos = (tftp_cur_block - 1) + |
| 243 | (tftp_block_wrap * TFTP_SEQUENCE_SIZE); |
| 244 | if ((pos % 10) == 0) |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 245 | putc('#'); |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 246 | else if (((pos + 1) % (10 * HASHES_PER_LINE)) == 0) |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 247 | puts("\n\t "); |
| 248 | } |
| 249 | } |
| 250 | |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 251 | /** |
| 252 | * restart the current transfer due to an error |
| 253 | * |
| 254 | * @param msg Message to print for user |
| 255 | */ |
| 256 | static void restart(const char *msg) |
| 257 | { |
| 258 | printf("\n%s; starting again\n", msg); |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 259 | net_start_again(); |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 260 | } |
| 261 | |
| 262 | /* |
| 263 | * Check if the block number has wrapped, and update progress |
| 264 | * |
| 265 | * TODO: The egregious use of global variables in this file should be tidied. |
| 266 | */ |
| 267 | static void update_block_number(void) |
| 268 | { |
| 269 | /* |
| 270 | * RFC1350 specifies that the first data packet will |
| 271 | * have sequence number 1. If we receive a sequence |
| 272 | * number of 0 this means that there was a wrap |
| 273 | * around of the (16 bit) counter. |
| 274 | */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 275 | if (tftp_cur_block == 0 && tftp_prev_block != 0) { |
| 276 | tftp_block_wrap++; |
| 277 | tftp_block_wrap_offset += tftp_block_size * TFTP_SEQUENCE_SIZE; |
| 278 | timeout_count = 0; /* we've done well, reset the timeout */ |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 279 | } |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 280 | show_block_marker(); |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 281 | } |
| 282 | |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 283 | /* The TFTP get or put is complete */ |
| 284 | static void tftp_complete(void) |
| 285 | { |
| 286 | #ifdef CONFIG_TFTP_TSIZE |
| 287 | /* Print hash marks for the last packet received */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 288 | while (tftp_tsize && tftp_tsize_num_hash < 49) { |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 289 | putc('#'); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 290 | tftp_tsize_num_hash++; |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 291 | } |
Simon Glass | c8f0a5c | 2014-10-10 07:30:21 -0600 | [diff] [blame] | 292 | puts(" "); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 293 | print_size(tftp_tsize, ""); |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 294 | #endif |
Simon Glass | cab9a8d | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 295 | time_start = get_timer(time_start); |
| 296 | if (time_start > 0) { |
| 297 | puts("\n\t "); /* Line up with "Loading: " */ |
Joe Hershberger | 290c899 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 298 | print_size(net_boot_file_size / |
Simon Glass | cab9a8d | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 299 | time_start * 1000, "/s"); |
| 300 | } |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 301 | puts("\ndone\n"); |
Heinrich Schuchardt | 6b82159 | 2021-01-12 12:46:24 +0100 | [diff] [blame] | 302 | if (IS_ENABLED(CONFIG_CMD_BOOTEFI)) { |
| 303 | if (!tftp_put_active) |
| 304 | efi_set_bootdev("Net", "", tftp_filename, |
| 305 | map_sysmem(tftp_load_addr, 0), |
| 306 | net_boot_file_size); |
| 307 | } |
Joe Hershberger | d4bb76a | 2012-05-23 07:59:14 +0000 | [diff] [blame] | 308 | net_set_state(NETLOOP_SUCCESS); |
Simon Glass | b437aad | 2011-10-24 18:00:03 +0000 | [diff] [blame] | 309 | } |
| 310 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 311 | static void tftp_send(void) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 312 | { |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 313 | uchar *pkt; |
Joe Hershberger | 4b7747e | 2012-05-15 08:59:04 +0000 | [diff] [blame] | 314 | uchar *xp; |
| 315 | int len = 0; |
| 316 | ushort *s; |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 317 | bool err_pkt = false; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 318 | |
| 319 | /* |
| 320 | * We will always be sending some sort of packet, so |
| 321 | * cobble together the packet headers now. |
| 322 | */ |
Joe Hershberger | a8ca4f6 | 2015-04-08 01:41:05 -0500 | [diff] [blame] | 323 | pkt = net_tx_packet + net_eth_hdr_size() + IP_UDP_HDR_SIZE; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 324 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 325 | switch (tftp_state) { |
Luca Ceresoli | 562dfe5 | 2011-05-17 00:03:38 +0000 | [diff] [blame] | 326 | case STATE_SEND_RRQ: |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 327 | case STATE_SEND_WRQ: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 328 | xp = pkt; |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 329 | s = (ushort *)pkt; |
Simon Glass | 4abd0e2 | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 330 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 331 | *s++ = htons(tftp_state == STATE_SEND_RRQ ? TFTP_RRQ : |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 332 | TFTP_WRQ); |
Simon Glass | 4abd0e2 | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 333 | #else |
| 334 | *s++ = htons(TFTP_RRQ); |
| 335 | #endif |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 336 | pkt = (uchar *)s; |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 337 | strcpy((char *)pkt, tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 338 | pkt += strlen(tftp_filename) + 1; |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 339 | strcpy((char *)pkt, "octet"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 340 | pkt += 5 /*strlen("octet")*/ + 1; |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 341 | strcpy((char *)pkt, "timeout"); |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 342 | pkt += 7 /*strlen("timeout")*/ + 1; |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 343 | sprintf((char *)pkt, "%lu", timeout_ms / 1000); |
Robin Getz | 9e0a4d6 | 2009-07-23 03:01:03 -0400 | [diff] [blame] | 344 | debug("send option \"timeout %s\"\n", (char *)pkt); |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 345 | pkt += strlen((char *)pkt) + 1; |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 346 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 290c899 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 347 | pkt += sprintf((char *)pkt, "tsize%c%u%c", |
| 348 | 0, net_boot_file_size, 0); |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 349 | #endif |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 350 | /* try for more effic. blk size */ |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 351 | pkt += sprintf((char *)pkt, "blksize%c%d%c", |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 352 | 0, tftp_block_size_option, 0); |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 353 | |
| 354 | /* try for more effic. window size. |
| 355 | * Implemented only for tftp get. |
| 356 | * Don't bother sending if it's 1 |
| 357 | */ |
| 358 | if (tftp_state == STATE_SEND_RRQ && tftp_window_size_option > 1) |
| 359 | pkt += sprintf((char *)pkt, "windowsize%c%d%c", |
| 360 | 0, tftp_window_size_option, 0); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 361 | len = pkt - xp; |
| 362 | break; |
| 363 | |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 364 | case STATE_OACK: |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 365 | |
| 366 | case STATE_RECV_WRQ: |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 367 | case STATE_DATA: |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 368 | xp = pkt; |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 369 | s = (ushort *)pkt; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 370 | s[0] = htons(TFTP_ACK); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 371 | s[1] = htons(tftp_cur_block); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 372 | pkt = (uchar *)(s + 2); |
| 373 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 374 | if (tftp_put_active) { |
| 375 | int toload = tftp_block_size; |
| 376 | int loaded = load_block(tftp_cur_block, pkt, toload); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 377 | |
| 378 | s[0] = htons(TFTP_DATA); |
| 379 | pkt += loaded; |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 380 | tftp_put_final_block_sent = (loaded < toload); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 381 | } |
| 382 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 383 | len = pkt - xp; |
| 384 | break; |
| 385 | |
| 386 | case STATE_TOO_LARGE: |
| 387 | xp = pkt; |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 388 | s = (ushort *)pkt; |
| 389 | *s++ = htons(TFTP_ERROR); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 390 | *s++ = htons(3); |
| 391 | |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 392 | pkt = (uchar *)s; |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 393 | strcpy((char *)pkt, "File too large"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 394 | pkt += 14 /*strlen("File too large")*/ + 1; |
| 395 | len = pkt - xp; |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 396 | err_pkt = true; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 397 | break; |
| 398 | |
| 399 | case STATE_BAD_MAGIC: |
| 400 | xp = pkt; |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 401 | s = (ushort *)pkt; |
| 402 | *s++ = htons(TFTP_ERROR); |
| 403 | *s++ = htons(2); |
| 404 | pkt = (uchar *)s; |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 405 | strcpy((char *)pkt, "File has bad magic"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 406 | pkt += 18 /*strlen("File has bad magic")*/ + 1; |
| 407 | len = pkt - xp; |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 408 | err_pkt = true; |
| 409 | break; |
| 410 | |
| 411 | case STATE_INVALID_OPTION: |
| 412 | xp = pkt; |
| 413 | s = (ushort *)pkt; |
| 414 | *s++ = htons(TFTP_ERROR); |
| 415 | *s++ = htons(TFTP_ERR_OPTION_NEGOTIATION); |
| 416 | pkt = (uchar *)s; |
| 417 | strcpy((char *)pkt, "Option Negotiation Failed"); |
| 418 | /* strlen("Option Negotiation Failed") + NULL*/ |
| 419 | pkt += 25 + 1; |
| 420 | len = pkt - xp; |
| 421 | err_pkt = true; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 422 | break; |
| 423 | } |
| 424 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 425 | net_send_udp_packet(net_server_ethaddr, tftp_remote_ip, |
| 426 | tftp_remote_port, tftp_our_port, len); |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 427 | |
| 428 | if (err_pkt) |
| 429 | net_set_state(NETLOOP_FAIL); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 430 | } |
| 431 | |
Simon Glass | 2928cd8 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 432 | #ifdef CONFIG_CMD_TFTPPUT |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 433 | static void icmp_handler(unsigned type, unsigned code, unsigned dest, |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 434 | struct in_addr sip, unsigned src, uchar *pkt, |
| 435 | unsigned len) |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 436 | { |
| 437 | if (type == ICMP_NOT_REACH && code == ICMP_NOT_REACH_PORT) { |
| 438 | /* Oh dear the other end has gone away */ |
| 439 | restart("TFTP server died"); |
| 440 | } |
| 441 | } |
Simon Glass | 2928cd8 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 442 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 443 | |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 444 | static void tftp_handler(uchar *pkt, unsigned dest, struct in_addr sip, |
| 445 | unsigned src, unsigned len) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 446 | { |
Kim Phillips | 878dad0 | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 447 | __be16 proto; |
| 448 | __be16 *s; |
Wolfgang Denk | 83e8e47 | 2007-08-30 14:42:15 +0200 | [diff] [blame] | 449 | int i; |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 450 | u16 timeout_val_rcvd; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 451 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 452 | if (dest != tftp_our_port) { |
Luca Ceresoli | 09b1823 | 2011-05-14 05:50:02 +0000 | [diff] [blame] | 453 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 454 | } |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 455 | if (tftp_state != STATE_SEND_RRQ && src != tftp_remote_port && |
| 456 | tftp_state != STATE_RECV_WRQ && tftp_state != STATE_SEND_WRQ) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 457 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 458 | |
Luca Ceresoli | 35dfb18 | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 459 | if (len < 2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 460 | return; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 461 | len -= 2; |
| 462 | /* warning: don't use increment (++) in ntohs() macros!! */ |
Kim Phillips | 878dad0 | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 463 | s = (__be16 *)pkt; |
Wolfgang Denk | 3135c54 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 464 | proto = *s++; |
| 465 | pkt = (uchar *)s; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 466 | switch (ntohs(proto)) { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 467 | case TFTP_RRQ: |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 468 | break; |
| 469 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 470 | case TFTP_ACK: |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 471 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 472 | if (tftp_put_active) { |
| 473 | if (tftp_put_final_block_sent) { |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 474 | tftp_complete(); |
| 475 | } else { |
| 476 | /* |
| 477 | * Move to the next block. We want our block |
| 478 | * count to wrap just like the other end! |
| 479 | */ |
| 480 | int block = ntohs(*s); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 481 | int ack_ok = (tftp_cur_block == block); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 482 | |
Ley Foon Tan | 8de767a | 2020-08-25 10:26:35 +0800 | [diff] [blame] | 483 | tftp_prev_block = tftp_cur_block; |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 484 | tftp_cur_block = (unsigned short)(block + 1); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 485 | update_block_number(); |
| 486 | if (ack_ok) |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 487 | tftp_send(); /* Send next data block */ |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 488 | } |
| 489 | } |
| 490 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 491 | break; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 492 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 493 | default: |
| 494 | break; |
| 495 | |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 496 | #ifdef CONFIG_CMD_TFTPSRV |
| 497 | case TFTP_WRQ: |
| 498 | debug("Got WRQ\n"); |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 499 | tftp_remote_ip = sip; |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 500 | tftp_remote_port = src; |
| 501 | tftp_our_port = 1024 + (get_timer(0) % 3072); |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 502 | new_transfer(); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 503 | tftp_send(); /* Send ACK(0) */ |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 504 | break; |
| 505 | #endif |
| 506 | |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 507 | case TFTP_OACK: |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 508 | debug("Got OACK: "); |
| 509 | for (i = 0; i < len; i++) { |
| 510 | if (pkt[i] == '\0') |
| 511 | debug(" "); |
| 512 | else |
| 513 | debug("%c", pkt[i]); |
| 514 | } |
| 515 | debug("\n"); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 516 | tftp_state = STATE_OACK; |
| 517 | tftp_remote_port = src; |
Wolfgang Denk | 8b70f34 | 2007-08-31 10:01:51 +0200 | [diff] [blame] | 518 | /* |
| 519 | * Check for 'blksize' option. |
| 520 | * Careful: "i" is signed, "len" is unsigned, thus |
| 521 | * something like "len-8" may give a *huge* number |
| 522 | */ |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 523 | for (i = 0; i+8 < len; i++) { |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 524 | if (strcasecmp((char *)pkt + i, "blksize") == 0) { |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 525 | tftp_block_size = (unsigned short) |
Simon Glass | ff9b903 | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 526 | dectoul((char *)pkt + i + 8, NULL); |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 527 | debug("Blocksize oack: %s, %d\n", |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 528 | (char *)pkt + i + 8, tftp_block_size); |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 529 | if (tftp_block_size > tftp_block_size_option) { |
| 530 | printf("Invalid blk size(=%d)\n", |
| 531 | tftp_block_size); |
| 532 | tftp_state = STATE_INVALID_OPTION; |
| 533 | } |
| 534 | } |
| 535 | if (strcasecmp((char *)pkt + i, "timeout") == 0) { |
| 536 | timeout_val_rcvd = (unsigned short) |
Simon Glass | ff9b903 | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 537 | dectoul((char *)pkt + i + 8, NULL); |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 538 | debug("Timeout oack: %s, %d\n", |
| 539 | (char *)pkt + i + 8, timeout_val_rcvd); |
| 540 | if (timeout_val_rcvd != (timeout_ms / 1000)) { |
| 541 | printf("Invalid timeout val(=%d s)\n", |
| 542 | timeout_val_rcvd); |
| 543 | tftp_state = STATE_INVALID_OPTION; |
| 544 | } |
Wolfgang Denk | 83e8e47 | 2007-08-30 14:42:15 +0200 | [diff] [blame] | 545 | } |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 546 | #ifdef CONFIG_TFTP_TSIZE |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 547 | if (strcasecmp((char *)pkt + i, "tsize") == 0) { |
Simon Glass | ff9b903 | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 548 | tftp_tsize = dectoul((char *)pkt + i + 6, |
| 549 | NULL); |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 550 | debug("size = %s, %d\n", |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 551 | (char *)pkt + i + 6, tftp_tsize); |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 552 | } |
| 553 | #endif |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 554 | if (strcasecmp((char *)pkt + i, "windowsize") == 0) { |
| 555 | tftp_windowsize = |
Simon Glass | ff9b903 | 2021-07-24 09:03:30 -0600 | [diff] [blame] | 556 | dectoul((char *)pkt + i + 11, NULL); |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 557 | debug("windowsize = %s, %d\n", |
| 558 | (char *)pkt + i + 11, tftp_windowsize); |
| 559 | } |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 560 | } |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 561 | |
| 562 | tftp_next_ack = tftp_windowsize; |
| 563 | |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 564 | #ifdef CONFIG_CMD_TFTPPUT |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 565 | if (tftp_put_active && tftp_state == STATE_OACK) { |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 566 | /* Get ready to send the first block */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 567 | tftp_state = STATE_DATA; |
| 568 | tftp_cur_block++; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 569 | } |
| 570 | #endif |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 571 | tftp_send(); /* Send ACK or first data block */ |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 572 | break; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 573 | case TFTP_DATA: |
| 574 | if (len < 2) |
| 575 | return; |
| 576 | len -= 2; |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 577 | |
| 578 | if (ntohs(*(__be16 *)pkt) != (ushort)(tftp_cur_block + 1)) { |
| 579 | debug("Received unexpected block: %d, expected: %d\n", |
| 580 | ntohs(*(__be16 *)pkt), |
| 581 | (ushort)(tftp_cur_block + 1)); |
| 582 | /* |
| 583 | * If one packet is dropped most likely |
| 584 | * all other buffers in the window |
| 585 | * that will arrive will cause a sending NACK. |
| 586 | * This just overwellms the server, let's just send one. |
| 587 | */ |
| 588 | if (tftp_last_nack != tftp_cur_block) { |
| 589 | tftp_send(); |
| 590 | tftp_last_nack = tftp_cur_block; |
| 591 | tftp_next_ack = (ushort)(tftp_cur_block + |
| 592 | tftp_windowsize); |
| 593 | } |
| 594 | break; |
| 595 | } |
| 596 | |
| 597 | tftp_cur_block++; |
| 598 | tftp_cur_block %= TFTP_SEQUENCE_SIZE; |
wdenk | ef89394 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 599 | |
Harm Berntsen | d097b1a | 2020-11-27 21:45:56 +0000 | [diff] [blame] | 600 | if (tftp_state == STATE_SEND_RRQ) { |
Ravik Hasija | e387e9a | 2020-05-18 21:35:43 -0700 | [diff] [blame] | 601 | debug("Server did not acknowledge any options!\n"); |
Harm Berntsen | d097b1a | 2020-11-27 21:45:56 +0000 | [diff] [blame] | 602 | tftp_next_ack = tftp_windowsize; |
| 603 | } |
wdenk | 7182b0f | 2003-10-06 21:55:32 +0000 | [diff] [blame] | 604 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 605 | if (tftp_state == STATE_SEND_RRQ || tftp_state == STATE_OACK || |
| 606 | tftp_state == STATE_RECV_WRQ) { |
wdenk | ef89394 | 2004-02-23 16:11:30 +0000 | [diff] [blame] | 607 | /* first block received */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 608 | tftp_state = STATE_DATA; |
| 609 | tftp_remote_port = src; |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 610 | new_transfer(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 611 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 612 | if (tftp_cur_block != 1) { /* Assertion */ |
| 613 | puts("\nTFTP error: "); |
| 614 | printf("First block is not block 1 (%ld)\n", |
| 615 | tftp_cur_block); |
| 616 | puts("Starting again\n\n"); |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 617 | net_start_again(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 618 | break; |
| 619 | } |
| 620 | } |
| 621 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 622 | if (tftp_cur_block == tftp_prev_block) { |
| 623 | /* Same block again; ignore it. */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 624 | break; |
| 625 | } |
| 626 | |
Ravik Hasija | d42686e | 2020-05-07 14:55:32 -0700 | [diff] [blame] | 627 | update_block_number(); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 628 | tftp_prev_block = tftp_cur_block; |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 629 | timeout_count_max = tftp_timeout_count_max; |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 630 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 631 | |
Ley Foon Tan | 81bb324 | 2020-08-25 10:26:36 +0800 | [diff] [blame] | 632 | if (store_block(tftp_cur_block, pkt + 2, len)) { |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 633 | eth_halt(); |
| 634 | net_set_state(NETLOOP_FAIL); |
| 635 | break; |
| 636 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 637 | |
Ramon Fried | b891c79 | 2021-02-03 21:28:59 +0200 | [diff] [blame] | 638 | if (len < tftp_block_size) { |
| 639 | tftp_send(); |
| 640 | tftp_complete(); |
| 641 | break; |
| 642 | } |
| 643 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 644 | /* |
Luca Ceresoli | 2f3dc0a | 2011-05-17 00:03:41 +0000 | [diff] [blame] | 645 | * Acknowledge the block just received, which will prompt |
Luca Ceresoli | 5079c76 | 2011-05-17 00:03:37 +0000 | [diff] [blame] | 646 | * the remote for the next one. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 647 | */ |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 648 | if (tftp_cur_block == tftp_next_ack) { |
| 649 | tftp_send(); |
| 650 | tftp_next_ack += tftp_windowsize; |
| 651 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 652 | break; |
| 653 | |
| 654 | case TFTP_ERROR: |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 655 | printf("\nTFTP error: '%s' (%d)\n", |
Kim Phillips | 878dad0 | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 656 | pkt + 2, ntohs(*(__be16 *)pkt)); |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 657 | |
Kim Phillips | 878dad0 | 2013-01-16 18:09:19 -0600 | [diff] [blame] | 658 | switch (ntohs(*(__be16 *)pkt)) { |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 659 | case TFTP_ERR_FILE_NOT_FOUND: |
| 660 | case TFTP_ERR_ACCESS_DENIED: |
| 661 | puts("Not retrying...\n"); |
| 662 | eth_halt(); |
Joe Hershberger | d4bb76a | 2012-05-23 07:59:14 +0000 | [diff] [blame] | 663 | net_set_state(NETLOOP_FAIL); |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 664 | break; |
| 665 | case TFTP_ERR_UNDEFINED: |
| 666 | case TFTP_ERR_DISK_FULL: |
| 667 | case TFTP_ERR_UNEXPECTED_OPCODE: |
| 668 | case TFTP_ERR_UNKNOWN_TRANSFER_ID: |
| 669 | case TFTP_ERR_FILE_ALREADY_EXISTS: |
| 670 | default: |
| 671 | puts("Starting again\n\n"); |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 672 | net_start_again(); |
Remy Bohmer | b46293f | 2009-10-28 22:13:40 +0100 | [diff] [blame] | 673 | break; |
| 674 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 675 | break; |
| 676 | } |
| 677 | } |
| 678 | |
| 679 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 680 | static void tftp_timeout_handler(void) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 681 | { |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 682 | if (++timeout_count > timeout_count_max) { |
Simon Glass | bd8a0e0 | 2011-10-24 18:00:04 +0000 | [diff] [blame] | 683 | restart("Retry count exceeded"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 684 | } else { |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 685 | puts("T "); |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 686 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 687 | if (tftp_state != STATE_RECV_WRQ) |
| 688 | tftp_send(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 689 | } |
| 690 | } |
| 691 | |
Simon Glass | 892265d | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 692 | /* Initialize tftp_load_addr and tftp_load_size from image_load_addr and lmb */ |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 693 | static int tftp_init_load_addr(void) |
| 694 | { |
| 695 | #ifdef CONFIG_LMB |
| 696 | struct lmb lmb; |
| 697 | phys_size_t max_size; |
| 698 | |
Simon Goldschmidt | 8890e7d | 2019-01-26 22:13:04 +0100 | [diff] [blame] | 699 | lmb_init_and_reserve(&lmb, gd->bd, (void *)gd->fdt_blob); |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 700 | |
Simon Glass | 892265d | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 701 | max_size = lmb_get_free_size(&lmb, image_load_addr); |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 702 | if (!max_size) |
| 703 | return -1; |
| 704 | |
| 705 | tftp_load_size = max_size; |
| 706 | #endif |
Simon Glass | 892265d | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 707 | tftp_load_addr = image_load_addr; |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 708 | return 0; |
| 709 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 710 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 711 | void tftp_start(enum proto_t protocol) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 712 | { |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 713 | __maybe_unused char *ep; /* Environment pointer */ |
| 714 | if (IS_ENABLED(CONFIG_NET_TFTP_VARS)) { |
Alessandro Rubini | 8832f6e | 2009-08-07 13:59:06 +0200 | [diff] [blame] | 715 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 716 | /* |
| 717 | * Allow the user to choose TFTP blocksize and timeout. |
| 718 | * TFTP protocol has a minimal timeout of 1 second. |
| 719 | */ |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 720 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 721 | ep = env_get("tftpblocksize"); |
| 722 | if (ep != NULL) |
| 723 | tftp_block_size_option = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | b233bd7 | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 724 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 725 | ep = env_get("tftpwindowsize"); |
| 726 | if (ep != NULL) |
| 727 | tftp_window_size_option = simple_strtol(ep, NULL, 10); |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 728 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 729 | ep = env_get("tftptimeout"); |
| 730 | if (ep != NULL) |
| 731 | timeout_ms = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | b233bd7 | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 732 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 733 | if (timeout_ms < 1000) { |
| 734 | printf("TFTP timeout (%ld ms) too low, set min = 1000 ms\n", |
| 735 | timeout_ms); |
| 736 | timeout_ms = 1000; |
| 737 | } |
Wolfgang Denk | b233bd7 | 2010-01-17 23:55:53 +0100 | [diff] [blame] | 738 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 739 | ep = env_get("tftptimeoutcountmax"); |
| 740 | if (ep != NULL) |
| 741 | tftp_timeout_count_max = simple_strtol(ep, NULL, 10); |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 742 | |
Rasmus Villemoes | 82ff5b0 | 2022-10-14 19:43:41 +0200 | [diff] [blame^] | 743 | if (tftp_timeout_count_max < 0) { |
| 744 | printf("TFTP timeout count max (%d ms) negative, set to 0\n", |
| 745 | tftp_timeout_count_max); |
| 746 | tftp_timeout_count_max = 0; |
| 747 | } |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 748 | } |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 749 | |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 750 | debug("TFTP blocksize = %i, TFTP windowsize = %d timeout = %ld ms\n", |
| 751 | tftp_block_size_option, tftp_window_size_option, timeout_ms); |
Wolfgang Denk | e3cfce5 | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 752 | |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 753 | tftp_remote_ip = net_server_ip; |
Joe Hershberger | 9cb7b02 | 2018-07-03 19:36:43 -0500 | [diff] [blame] | 754 | if (!net_parse_bootfile(&tftp_remote_ip, tftp_filename, MAX_LEN)) { |
Matthias Weisser | 6cc6326 | 2011-12-03 03:29:44 +0000 | [diff] [blame] | 755 | sprintf(default_filename, "%02X%02X%02X%02X.img", |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 756 | net_ip.s_addr & 0xFF, |
| 757 | (net_ip.s_addr >> 8) & 0xFF, |
| 758 | (net_ip.s_addr >> 16) & 0xFF, |
| 759 | (net_ip.s_addr >> 24) & 0xFF); |
Jean-Christophe PLAGNIOL-VILLARD | 5855541 | 2008-01-18 01:14:03 +0100 | [diff] [blame] | 760 | |
Vladimir Zapolskiy | 04cc290 | 2017-06-28 22:56:07 +0300 | [diff] [blame] | 761 | strncpy(tftp_filename, default_filename, DEFAULT_NAME_LEN); |
| 762 | tftp_filename[DEFAULT_NAME_LEN - 1] = 0; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 763 | |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 764 | printf("*** Warning: no boot file name; using '%s'\n", |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 765 | tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 766 | } |
| 767 | |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 768 | printf("Using %s device\n", eth_get_name()); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 769 | printf("TFTP %s server %pI4; our IP address is %pI4", |
Simon Glass | 4abd0e2 | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 770 | #ifdef CONFIG_CMD_TFTPPUT |
| 771 | protocol == TFTPPUT ? "to" : "from", |
| 772 | #else |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 773 | "from", |
Simon Glass | 4abd0e2 | 2011-10-27 06:24:29 +0000 | [diff] [blame] | 774 | #endif |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 775 | &tftp_remote_ip, &net_ip); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 776 | |
| 777 | /* Check if we need to send across this subnet */ |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 778 | if (net_gateway.s_addr && net_netmask.s_addr) { |
| 779 | struct in_addr our_net; |
| 780 | struct in_addr remote_net; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 781 | |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 782 | our_net.s_addr = net_ip.s_addr & net_netmask.s_addr; |
| 783 | remote_net.s_addr = tftp_remote_ip.s_addr & net_netmask.s_addr; |
| 784 | if (our_net.s_addr != remote_net.s_addr) |
| 785 | printf("; sending through gateway %pI4", &net_gateway); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 786 | } |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 787 | putc('\n'); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 788 | |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 789 | printf("Filename '%s'.", tftp_filename); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 790 | |
Joe Hershberger | 290c899 | 2015-04-08 01:41:02 -0500 | [diff] [blame] | 791 | if (net_boot_file_expected_size_in_blocks) { |
| 792 | printf(" Size is 0x%x Bytes = ", |
| 793 | net_boot_file_expected_size_in_blocks << 9); |
| 794 | print_size(net_boot_file_expected_size_in_blocks << 9, ""); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 795 | } |
| 796 | |
Luca Ceresoli | f40538a | 2011-05-14 05:49:57 +0000 | [diff] [blame] | 797 | putc('\n'); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 798 | #ifdef CONFIG_CMD_TFTPPUT |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 799 | tftp_put_active = (protocol == TFTPPUT); |
| 800 | if (tftp_put_active) { |
Simon Glass | 892265d | 2019-12-28 10:45:02 -0700 | [diff] [blame] | 801 | printf("Save address: 0x%lx\n", image_save_addr); |
| 802 | printf("Save size: 0x%lx\n", image_save_size); |
| 803 | net_boot_file_size = image_save_size; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 804 | puts("Saving: *\b"); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 805 | tftp_state = STATE_SEND_WRQ; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 806 | new_transfer(); |
| 807 | } else |
| 808 | #endif |
| 809 | { |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 810 | if (tftp_init_load_addr()) { |
| 811 | eth_halt(); |
| 812 | net_set_state(NETLOOP_FAIL); |
| 813 | puts("\nTFTP error: "); |
| 814 | puts("trying to overwrite reserved memory...\n"); |
| 815 | return; |
| 816 | } |
| 817 | printf("Load address: 0x%lx\n", tftp_load_addr); |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 818 | puts("Loading: *\b"); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 819 | tftp_state = STATE_SEND_RRQ; |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 820 | } |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 821 | |
Simon Glass | cab9a8d | 2012-10-11 13:57:36 +0000 | [diff] [blame] | 822 | time_start = get_timer(0); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 823 | timeout_count_max = tftp_timeout_count_max; |
Bartlomiej Sieka | 371cde7 | 2008-10-01 15:26:29 +0200 | [diff] [blame] | 824 | |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 825 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 826 | net_set_udp_handler(tftp_handler); |
Simon Glass | 2928cd8 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 827 | #ifdef CONFIG_CMD_TFTPPUT |
Simon Glass | 6a398d2 | 2011-10-24 18:00:07 +0000 | [diff] [blame] | 828 | net_set_icmp_handler(icmp_handler); |
Simon Glass | 2928cd8 | 2011-10-26 14:18:38 +0000 | [diff] [blame] | 829 | #endif |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 830 | tftp_remote_port = WELL_KNOWN_PORT; |
| 831 | timeout_count = 0; |
Wolfgang Denk | e3cfce5 | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 832 | /* Use a pseudo-random port unless a specific port is set */ |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 833 | tftp_our_port = 1024 + (get_timer(0) % 3072); |
David Updegraff | 7280da7 | 2007-06-11 10:41:07 -0500 | [diff] [blame] | 834 | |
Wolfgang Denk | e3cfce5 | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 835 | #ifdef CONFIG_TFTP_PORT |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 836 | ep = env_get("tftpdstp"); |
Luca Ceresoli | 35dfb18 | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 837 | if (ep != NULL) |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 838 | tftp_remote_port = simple_strtol(ep, NULL, 10); |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 839 | ep = env_get("tftpsrcp"); |
Luca Ceresoli | 35dfb18 | 2011-05-14 05:50:00 +0000 | [diff] [blame] | 840 | if (ep != NULL) |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 841 | tftp_our_port = simple_strtol(ep, NULL, 10); |
Wolfgang Denk | e3cfce5 | 2005-09-24 22:37:32 +0200 | [diff] [blame] | 842 | #endif |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 843 | tftp_cur_block = 0; |
Ramon Fried | 6e9aa54 | 2020-07-18 23:31:46 +0300 | [diff] [blame] | 844 | tftp_windowsize = 1; |
| 845 | tftp_last_nack = 0; |
wdenk | e6466f6 | 2003-06-05 19:27:42 +0000 | [diff] [blame] | 846 | /* zero out server ether in case the server ip has changed */ |
Joe Hershberger | 8ecdbed | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 847 | memset(net_server_ethaddr, 0, 6); |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 848 | /* Revert tftp_block_size to dflt */ |
| 849 | tftp_block_size = TFTP_BLOCK_SIZE; |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 850 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 851 | tftp_tsize = 0; |
| 852 | tftp_tsize_num_hash = 0; |
Robin Getz | b3b00ed | 2009-08-20 10:50:20 -0400 | [diff] [blame] | 853 | #endif |
wdenk | e6466f6 | 2003-06-05 19:27:42 +0000 | [diff] [blame] | 854 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 855 | tftp_send(); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 856 | } |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 857 | |
| 858 | #ifdef CONFIG_CMD_TFTPSRV |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 859 | void tftp_start_server(void) |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 860 | { |
| 861 | tftp_filename[0] = 0; |
| 862 | |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 863 | if (tftp_init_load_addr()) { |
| 864 | eth_halt(); |
| 865 | net_set_state(NETLOOP_FAIL); |
| 866 | puts("\nTFTP error: trying to overwrite reserved memory...\n"); |
| 867 | return; |
| 868 | } |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 869 | printf("Using %s device\n", eth_get_name()); |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 870 | printf("Listening for TFTP transfer on %pI4\n", &net_ip); |
Simon Goldschmidt | a96cf8f | 2019-01-14 22:38:22 +0100 | [diff] [blame] | 871 | printf("Load address: 0x%lx\n", tftp_load_addr); |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 872 | |
| 873 | puts("Loading: *\b"); |
| 874 | |
Albert ARIBAUD \(3ADEV\) | 8300685 | 2015-10-12 00:02:57 +0200 | [diff] [blame] | 875 | timeout_count_max = tftp_timeout_count_max; |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 876 | timeout_count = 0; |
| 877 | timeout_ms = TIMEOUT; |
Joe Hershberger | c80b41b0 | 2015-04-08 01:41:21 -0500 | [diff] [blame] | 878 | net_set_timeout_handler(timeout_ms, tftp_timeout_handler); |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 879 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 880 | /* Revert tftp_block_size to dflt */ |
| 881 | tftp_block_size = TFTP_BLOCK_SIZE; |
| 882 | tftp_cur_block = 0; |
| 883 | tftp_our_port = WELL_KNOWN_PORT; |
Arjan Minzinga Zijlstra | fc13423 | 2022-03-31 08:03:16 +0000 | [diff] [blame] | 884 | tftp_windowsize = 1; |
| 885 | tftp_next_ack = tftp_windowsize; |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 886 | |
| 887 | #ifdef CONFIG_TFTP_TSIZE |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 888 | tftp_tsize = 0; |
| 889 | tftp_tsize_num_hash = 0; |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 890 | #endif |
| 891 | |
Joe Hershberger | 6470159 | 2015-04-08 01:41:07 -0500 | [diff] [blame] | 892 | tftp_state = STATE_RECV_WRQ; |
Joe Hershberger | 5874dec | 2015-04-08 01:41:01 -0500 | [diff] [blame] | 893 | net_set_udp_handler(tftp_handler); |
Andrew Ruder | 91393c5 | 2013-10-22 19:10:28 -0500 | [diff] [blame] | 894 | |
| 895 | /* zero out server ether in case the server ip has changed */ |
Joe Hershberger | 8ecdbed | 2015-04-08 01:41:04 -0500 | [diff] [blame] | 896 | memset(net_server_ethaddr, 0, 6); |
Luca Ceresoli | b640ed3 | 2011-05-17 00:03:39 +0000 | [diff] [blame] | 897 | } |
| 898 | #endif /* CONFIG_CMD_TFTPSRV */ |