diff options
author | Eric Andersen <andersen@codepoet.org> | 2001-08-20 17:47:49 +0000 |
---|---|---|
committer | Eric Andersen <andersen@codepoet.org> | 2001-08-20 17:47:49 +0000 |
commit | 76fa8ea7903bd730b4b6157960647a7b8451983b (patch) | |
tree | be4599fd8f405c1ad27f3bdc25bf2943026bb2ce | |
parent | bac490fe533e16a6f24735f18ed9427e5d4ed8f0 (diff) | |
download | busybox-w32-76fa8ea7903bd730b4b6157960647a7b8451983b.tar.gz busybox-w32-76fa8ea7903bd730b4b6157960647a7b8451983b.tar.bz2 busybox-w32-76fa8ea7903bd730b4b6157960647a7b8451983b.zip |
Apply Glenn's tftp rewrite
-rw-r--r-- | networking/tftp.c | 243 | ||||
-rw-r--r-- | tftp.c | 243 |
2 files changed, 212 insertions, 274 deletions
diff --git a/networking/tftp.c b/networking/tftp.c index bb75c88ec..999b5d706 100644 --- a/networking/tftp.c +++ b/networking/tftp.c | |||
@@ -47,37 +47,6 @@ | |||
47 | 47 | ||
48 | //#define BB_FEATURE_TFTP_DEBUG | 48 | //#define BB_FEATURE_TFTP_DEBUG |
49 | 49 | ||
50 | /* we don't need #ifdefs with these constants and optimization... */ | ||
51 | |||
52 | #ifdef BB_FEATURE_TFTP_GET | ||
53 | #define BB_TFTP_GET (1 << 0) | ||
54 | #else | ||
55 | #define BB_TFTP_GET 0 | ||
56 | #endif | ||
57 | |||
58 | #ifdef BB_FEATURE_TFTP_PUT | ||
59 | #define BB_TFTP_PUT (1 << 1) | ||
60 | #else | ||
61 | #define BB_TFTP_PUT 0 | ||
62 | #endif | ||
63 | |||
64 | #ifdef BB_FEATURE_TFTP_DEBUG | ||
65 | #define BB_TFTP_DEBUG 1 | ||
66 | #else | ||
67 | #define BB_TFTP_DEBUG 0 | ||
68 | #endif | ||
69 | |||
70 | #define BB_TFTP_NO_RETRIES 5 | ||
71 | #define BB_TFTP_TIMEOUT 5 /* seconds */ | ||
72 | |||
73 | #define RRQ 1 /* read request */ | ||
74 | #define WRQ 2 /* write request */ | ||
75 | #define DATA 3 /* data packet */ | ||
76 | #define ACK 4 /* acknowledgement */ | ||
77 | #define ERROR 5 /* error code */ | ||
78 | |||
79 | #define BUFSIZE (512+4) | ||
80 | |||
81 | static const char *tftp_error_msg[] = { | 50 | static const char *tftp_error_msg[] = { |
82 | "Undefined error", | 51 | "Undefined error", |
83 | "File not found", | 52 | "File not found", |
@@ -89,24 +58,32 @@ static const char *tftp_error_msg[] = { | |||
89 | "No such user" | 58 | "No such user" |
90 | }; | 59 | }; |
91 | 60 | ||
92 | static inline int tftp(int cmd, struct hostent *host, | 61 | const int tftp_cmd_get = 1; |
93 | char *serverfile, int localfd, int port) | 62 | const int tftp_cmd_put = 2; |
63 | |||
64 | static inline int tftp(const int cmd, const struct hostent *host, | ||
65 | const char *serverfile, int localfd, const int port, int tftp_bufsize) | ||
94 | { | 66 | { |
67 | const int cmd_get = cmd & tftp_cmd_get; | ||
68 | const int cmd_put = cmd & tftp_cmd_put; | ||
69 | const int bb_tftp_num_retries = 5; | ||
70 | |||
95 | struct sockaddr_in sa; | 71 | struct sockaddr_in sa; |
96 | int socketfd; | ||
97 | struct timeval tv; | ||
98 | fd_set rfds; | ||
99 | struct sockaddr_in from; | 72 | struct sockaddr_in from; |
73 | struct timeval tv; | ||
100 | socklen_t fromlen; | 74 | socklen_t fromlen; |
75 | fd_set rfds; | ||
101 | char *cp; | 76 | char *cp; |
102 | unsigned short tmp; | 77 | unsigned short tmp; |
103 | int len, opcode, finished; | 78 | int socketfd; |
104 | int timeout, block_nr; | 79 | int len; |
105 | 80 | int opcode = 0; | |
106 | RESERVE_BB_BUFFER(buf, BUFSIZE); | 81 | int finished = 0; |
82 | int timeout = bb_tftp_num_retries; | ||
83 | int block_nr = 1; | ||
84 | RESERVE_BB_BUFFER(buf, tftp_bufsize + 4); // Why 4 ? | ||
107 | 85 | ||
108 | opcode = finished = timeout = 0; | 86 | tftp_bufsize += 4; |
109 | block_nr = 1; | ||
110 | 87 | ||
111 | if ((socketfd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { | 88 | if ((socketfd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { |
112 | perror_msg("socket"); | 89 | perror_msg("socket"); |
@@ -125,12 +102,12 @@ static inline int tftp(int cmd, struct hostent *host, | |||
125 | 102 | ||
126 | /* build opcode */ | 103 | /* build opcode */ |
127 | 104 | ||
128 | if (cmd & BB_TFTP_GET) { | 105 | if (cmd_get) { |
129 | opcode = RRQ; | 106 | opcode = 1; // read request = 1 |
130 | } | 107 | } |
131 | 108 | ||
132 | if (cmd & BB_TFTP_PUT) { | 109 | if (cmd_put) { |
133 | opcode = WRQ; | 110 | opcode = 2; // write request = 2 |
134 | } | 111 | } |
135 | 112 | ||
136 | while (1) { | 113 | while (1) { |
@@ -147,16 +124,17 @@ static inline int tftp(int cmd, struct hostent *host, | |||
147 | 124 | ||
148 | /* add filename and mode */ | 125 | /* add filename and mode */ |
149 | 126 | ||
150 | if ((BB_TFTP_GET && (opcode == RRQ)) || | 127 | if ((cmd_get && (opcode == 1)) || // read request = 1 |
151 | (BB_TFTP_PUT && (opcode == WRQ))) { | 128 | (cmd_put && (opcode == 2))) { // write request = 2 |
152 | 129 | ||
153 | while (cp != &buf[BUFSIZE - 1]) { | 130 | /* what is this trying to do ? */ |
131 | while (cp != &buf[tftp_bufsize - 1]) { | ||
154 | if ((*cp = *serverfile++) == '\0') | 132 | if ((*cp = *serverfile++) == '\0') |
155 | break; | 133 | break; |
156 | cp++; | 134 | cp++; |
157 | } | 135 | } |
158 | 136 | /* and this ? */ | |
159 | if ((*cp != '\0') || (&buf[BUFSIZE - 1] - cp) < 7) { | 137 | if ((*cp != '\0') || (&buf[tftp_bufsize - 1] - cp) < 7) { |
160 | error_msg("too long server-filename"); | 138 | error_msg("too long server-filename"); |
161 | break; | 139 | break; |
162 | } | 140 | } |
@@ -167,8 +145,8 @@ static inline int tftp(int cmd, struct hostent *host, | |||
167 | 145 | ||
168 | /* add ack and data */ | 146 | /* add ack and data */ |
169 | 147 | ||
170 | if ((BB_TFTP_GET && (opcode == ACK)) || | 148 | if ((cmd_get && (opcode == 4)) || // acknowledgement = 4 |
171 | (BB_TFTP_PUT && (opcode == DATA))) { | 149 | (cmd_put && (opcode == 3))) { // data packet == 3 |
172 | 150 | ||
173 | *((unsigned short *) cp) = htons(block_nr); | 151 | *((unsigned short *) cp) = htons(block_nr); |
174 | 152 | ||
@@ -176,15 +154,15 @@ static inline int tftp(int cmd, struct hostent *host, | |||
176 | 154 | ||
177 | block_nr++; | 155 | block_nr++; |
178 | 156 | ||
179 | if (BB_TFTP_PUT && (opcode == DATA)) { | 157 | if (cmd_put && (opcode == 3)) { // data packet == 3 |
180 | len = read(localfd, cp, BUFSIZE - 4); | 158 | len = read(localfd, cp, tftp_bufsize - 4); |
181 | 159 | ||
182 | if (len < 0) { | 160 | if (len < 0) { |
183 | perror_msg("read"); | 161 | perror_msg("read"); |
184 | break; | 162 | break; |
185 | } | 163 | } |
186 | 164 | ||
187 | if (len != (BUFSIZE - 4)) { | 165 | if (len != (tftp_bufsize - 4)) { |
188 | finished++; | 166 | finished++; |
189 | } | 167 | } |
190 | 168 | ||
@@ -202,16 +180,14 @@ static inline int tftp(int cmd, struct hostent *host, | |||
202 | 180 | ||
203 | len = cp - buf; | 181 | len = cp - buf; |
204 | 182 | ||
205 | if (BB_TFTP_DEBUG) { | 183 | #ifdef BB_FEATURE_TFTP_DEBUG |
206 | printf("sending %u bytes\n", len); | 184 | printf("sending %u bytes\n", len); |
207 | 185 | for (cp = buf; cp < &buf[len]; cp++) | |
208 | for (cp = buf; cp < &buf[len]; cp++) | 186 | printf("%02x ", *cp); |
209 | printf("%02x ", *cp); | 187 | printf("\n"); |
210 | printf("\n"); | 188 | #endif |
211 | } | ||
212 | |||
213 | if (sendto(socketfd, buf, len, 0, | 189 | if (sendto(socketfd, buf, len, 0, |
214 | (struct sockaddr *) &sa, sizeof(sa)) < 0) { | 190 | (struct sockaddr *) &sa, sizeof(sa)) < 0) { |
215 | perror_msg("send"); | 191 | perror_msg("send"); |
216 | len = -1; | 192 | len = -1; |
217 | break; | 193 | break; |
@@ -224,7 +200,7 @@ static inline int tftp(int cmd, struct hostent *host, | |||
224 | memset(&from, 0, sizeof(from)); | 200 | memset(&from, 0, sizeof(from)); |
225 | fromlen = sizeof(from); | 201 | fromlen = sizeof(from); |
226 | 202 | ||
227 | tv.tv_sec = BB_TFTP_TIMEOUT; | 203 | tv.tv_sec = 5; // BB_TFPT_TIMEOUT = 5 |
228 | tv.tv_usec = 0; | 204 | tv.tv_usec = 0; |
229 | 205 | ||
230 | FD_ZERO(&rfds); | 206 | FD_ZERO(&rfds); |
@@ -232,9 +208,8 @@ static inline int tftp(int cmd, struct hostent *host, | |||
232 | 208 | ||
233 | switch (select(FD_SETSIZE, &rfds, NULL, NULL, &tv)) { | 209 | switch (select(FD_SETSIZE, &rfds, NULL, NULL, &tv)) { |
234 | case 1: | 210 | case 1: |
235 | len = recvfrom(socketfd, buf, | 211 | len = recvfrom(socketfd, buf, tftp_bufsize, 0, |
236 | BUFSIZE, 0, | 212 | (struct sockaddr *) &from, &fromlen); |
237 | (struct sockaddr *) &from, &fromlen); | ||
238 | 213 | ||
239 | if (len < 0) { | 214 | if (len < 0) { |
240 | perror_msg("recvfrom"); | 215 | perror_msg("recvfrom"); |
@@ -245,28 +220,23 @@ static inline int tftp(int cmd, struct hostent *host, | |||
245 | 220 | ||
246 | if (sa.sin_port == htons(port)) { | 221 | if (sa.sin_port == htons(port)) { |
247 | sa.sin_port = from.sin_port; | 222 | sa.sin_port = from.sin_port; |
248 | break; | ||
249 | } | 223 | } |
250 | |||
251 | if (sa.sin_port == from.sin_port) { | 224 | if (sa.sin_port == from.sin_port) { |
252 | break; | 225 | break; |
253 | } | 226 | } |
254 | 227 | ||
255 | /* fall-through for bad packets! */ | 228 | /* fall-through for bad packets! */ |
256 | /* discard the packet - treat as timeout */ | 229 | /* discard the packet - treat as timeout */ |
230 | timeout = bb_tftp_num_retries; | ||
257 | 231 | ||
258 | case 0: | 232 | case 0: |
259 | error_msg("timeout"); | 233 | error_msg("timeout"); |
260 | 234 | ||
261 | if (!timeout) { | 235 | if (timeout == 0) { |
262 | timeout = BB_TFTP_NO_RETRIES; | ||
263 | } else { | ||
264 | timeout--; | ||
265 | } | ||
266 | |||
267 | if (!timeout) { | ||
268 | len = -1; | 236 | len = -1; |
269 | error_msg("last timeout"); | 237 | error_msg("last timeout"); |
238 | } else { | ||
239 | timeout--; | ||
270 | } | 240 | } |
271 | break; | 241 | break; |
272 | 242 | ||
@@ -287,11 +257,11 @@ static inline int tftp(int cmd, struct hostent *host, | |||
287 | opcode = ntohs(*((unsigned short *) buf)); | 257 | opcode = ntohs(*((unsigned short *) buf)); |
288 | tmp = ntohs(*((unsigned short *) &buf[2])); | 258 | tmp = ntohs(*((unsigned short *) &buf[2])); |
289 | 259 | ||
290 | if (BB_TFTP_DEBUG) { | 260 | #ifdef BB_FEATURE_TFTP_DEBUG |
291 | printf("received %d bytes: %04x %04x\n", len, opcode, tmp); | 261 | printf("received %d bytes: %04x %04x\n", len, opcode, tmp); |
292 | } | 262 | #endif |
293 | 263 | ||
294 | if (BB_TFTP_GET && (opcode == DATA)) { | 264 | if (cmd_get && (opcode == 3)) { // data packet == 3 |
295 | 265 | ||
296 | if (tmp == block_nr) { | 266 | if (tmp == block_nr) { |
297 | len = write(localfd, &buf[4], len - 4); | 267 | len = write(localfd, &buf[4], len - 4); |
@@ -301,33 +271,33 @@ static inline int tftp(int cmd, struct hostent *host, | |||
301 | break; | 271 | break; |
302 | } | 272 | } |
303 | 273 | ||
304 | if (len != (BUFSIZE - 4)) { | 274 | if (len != (tftp_bufsize - 4)) { |
305 | finished++; | 275 | finished++; |
306 | } | 276 | } |
307 | 277 | ||
308 | opcode = ACK; | 278 | opcode = 4; // acknowledgement = 4 |
309 | continue; | 279 | continue; |
310 | } | 280 | } |
311 | } | 281 | } |
312 | 282 | ||
313 | if (BB_TFTP_PUT && (opcode == ACK)) { | 283 | if (cmd_put && (opcode == 4)) { // acknowledgement = 4 |
314 | 284 | ||
315 | if (tmp == (block_nr - 1)) { | 285 | if (tmp == (block_nr - 1)) { |
316 | if (finished) { | 286 | if (finished) { |
317 | break; | 287 | break; |
318 | } | 288 | } |
319 | 289 | ||
320 | opcode = DATA; | 290 | opcode = 3; // data packet == 3 |
321 | continue; | 291 | continue; |
322 | } | 292 | } |
323 | } | 293 | } |
324 | 294 | ||
325 | if (opcode == ERROR) { | 295 | if (opcode == 5) { // error code == 5 |
326 | char *msg = NULL; | 296 | char *msg = NULL; |
327 | 297 | ||
328 | if (buf[4] != '\0') { | 298 | if (buf[4] != '\0') { |
329 | msg = &buf[4]; | 299 | msg = &buf[4]; |
330 | buf[BUFSIZE - 1] = '\0'; | 300 | buf[tftp_bufsize - 1] = '\0'; |
331 | } else if (tmp < (sizeof(tftp_error_msg) / sizeof(char *))) { | 301 | } else if (tmp < (sizeof(tftp_error_msg) / sizeof(char *))) { |
332 | msg = (char *) tftp_error_msg[tmp]; | 302 | msg = (char *) tftp_error_msg[tmp]; |
333 | } | 303 | } |
@@ -347,68 +317,67 @@ static inline int tftp(int cmd, struct hostent *host, | |||
347 | 317 | ||
348 | int tftp_main(int argc, char **argv) | 318 | int tftp_main(int argc, char **argv) |
349 | { | 319 | { |
350 | char *cp, *s; | 320 | struct hostent *host = NULL; |
351 | char *serverstr; | 321 | char *localfile = NULL; |
352 | struct hostent *host; | 322 | char *remotefile = NULL; |
353 | char *serverfile; | 323 | int port = 69; |
354 | char *localfile; | 324 | int cmd = 0; |
355 | int cmd, flags, fd, bad; | 325 | int fd = -1; |
356 | 326 | int flags = 0; | |
357 | host = (void *) serverstr = serverfile = localfile = NULL; | 327 | int opt; |
358 | flags = cmd = 0; | 328 | int result; |
359 | bad = 1; | 329 | int blocksize = 512; |
360 | 330 | ||
361 | if (argc > 3) { | 331 | while ((opt = getopt(argc, argv, "b:gpl:r:")) != -1) { |
362 | if (BB_TFTP_GET && (strcmp(argv[1], "get") == 0)) { | 332 | switch (opt) { |
363 | cmd = BB_TFTP_GET; | 333 | case 'b': |
334 | blocksize = atoi(optarg); | ||
335 | break; | ||
336 | #ifdef BB_FEATURE_TFTP_GET | ||
337 | case 'g': | ||
338 | cmd = tftp_cmd_get; | ||
364 | flags = O_WRONLY | O_CREAT; | 339 | flags = O_WRONLY | O_CREAT; |
365 | serverstr = argv[2]; | 340 | break; |
366 | localfile = argv[3]; | 341 | #endif |
367 | } | 342 | #ifdef BB_FEATURE_TFTP_PUT |
368 | 343 | case 'p': | |
369 | if (BB_TFTP_PUT && (strcmp(argv[1], "put") == 0)) { | 344 | cmd = tftp_cmd_put; |
370 | cmd = BB_TFTP_PUT; | ||
371 | flags = O_RDONLY; | 345 | flags = O_RDONLY; |
372 | localfile = argv[2]; | 346 | break; |
373 | serverstr = argv[3]; | 347 | #endif |
348 | case 'l': | ||
349 | localfile = xstrdup(optarg); | ||
350 | break; | ||
351 | case 'r': | ||
352 | remotefile = xstrdup(optarg); | ||
353 | break; | ||
374 | } | 354 | } |
375 | |||
376 | } | 355 | } |
377 | 356 | ||
378 | if (!(cmd & (BB_TFTP_GET | BB_TFTP_PUT))) { | 357 | if ((cmd == 0) || (optind == argc)) { |
379 | show_usage(); | 358 | show_usage(); |
380 | } | 359 | } |
381 | 360 | ||
382 | for (cp = serverstr; *cp != '\0'; cp++) | 361 | fd = open(localfile, flags, 0644); |
383 | if (*cp == ':') | 362 | if (fd < 0) { |
384 | break; | 363 | perror_msg_and_die("local file"); |
385 | |||
386 | if (*cp == ':') { | ||
387 | |||
388 | serverfile = cp + 1; | ||
389 | |||
390 | s = xstrdup(serverstr); | ||
391 | s[cp - serverstr] = '\0'; | ||
392 | |||
393 | host = xgethostbyname(s); | ||
394 | |||
395 | free(s); | ||
396 | } | 364 | } |
397 | 365 | ||
398 | if (BB_TFTP_DEBUG) { | 366 | host = xgethostbyname(argv[optind]); |
399 | printf("using server \"%s\", serverfile \"%s\"," | ||
400 | "localfile \"%s\".\n", | ||
401 | inet_ntoa(*((struct in_addr *) host->h_addr)), | ||
402 | serverfile, localfile); | ||
403 | } | ||
404 | 367 | ||
405 | if ((fd = open(localfile, flags, 0644)) < 0) { | 368 | if (optind + 2 == argc) { |
406 | perror_msg_and_die("local file"); | 369 | port = atoi(argv[optind + 1]); |
407 | } | 370 | } |
408 | 371 | ||
409 | flags = tftp(cmd, host, serverfile, fd, 69); | 372 | #ifdef BB_FEATURE_TFTP_DEBUG |
373 | printf("using server \"%s\", serverfile \"%s\"," | ||
374 | "localfile \"%s\".\n", | ||
375 | inet_ntoa(*((struct in_addr *) host->h_addr)), | ||
376 | remotefile, localfile); | ||
377 | #endif | ||
410 | 378 | ||
379 | result = tftp(cmd, host, remotefile, fd, port, blocksize); | ||
411 | close(fd); | 380 | close(fd); |
412 | 381 | ||
413 | return flags; | 382 | return(result); |
414 | } | 383 | } \ No newline at end of file |
@@ -47,37 +47,6 @@ | |||
47 | 47 | ||
48 | //#define BB_FEATURE_TFTP_DEBUG | 48 | //#define BB_FEATURE_TFTP_DEBUG |
49 | 49 | ||
50 | /* we don't need #ifdefs with these constants and optimization... */ | ||
51 | |||
52 | #ifdef BB_FEATURE_TFTP_GET | ||
53 | #define BB_TFTP_GET (1 << 0) | ||
54 | #else | ||
55 | #define BB_TFTP_GET 0 | ||
56 | #endif | ||
57 | |||
58 | #ifdef BB_FEATURE_TFTP_PUT | ||
59 | #define BB_TFTP_PUT (1 << 1) | ||
60 | #else | ||
61 | #define BB_TFTP_PUT 0 | ||
62 | #endif | ||
63 | |||
64 | #ifdef BB_FEATURE_TFTP_DEBUG | ||
65 | #define BB_TFTP_DEBUG 1 | ||
66 | #else | ||
67 | #define BB_TFTP_DEBUG 0 | ||
68 | #endif | ||
69 | |||
70 | #define BB_TFTP_NO_RETRIES 5 | ||
71 | #define BB_TFTP_TIMEOUT 5 /* seconds */ | ||
72 | |||
73 | #define RRQ 1 /* read request */ | ||
74 | #define WRQ 2 /* write request */ | ||
75 | #define DATA 3 /* data packet */ | ||
76 | #define ACK 4 /* acknowledgement */ | ||
77 | #define ERROR 5 /* error code */ | ||
78 | |||
79 | #define BUFSIZE (512+4) | ||
80 | |||
81 | static const char *tftp_error_msg[] = { | 50 | static const char *tftp_error_msg[] = { |
82 | "Undefined error", | 51 | "Undefined error", |
83 | "File not found", | 52 | "File not found", |
@@ -89,24 +58,32 @@ static const char *tftp_error_msg[] = { | |||
89 | "No such user" | 58 | "No such user" |
90 | }; | 59 | }; |
91 | 60 | ||
92 | static inline int tftp(int cmd, struct hostent *host, | 61 | const int tftp_cmd_get = 1; |
93 | char *serverfile, int localfd, int port) | 62 | const int tftp_cmd_put = 2; |
63 | |||
64 | static inline int tftp(const int cmd, const struct hostent *host, | ||
65 | const char *serverfile, int localfd, const int port, int tftp_bufsize) | ||
94 | { | 66 | { |
67 | const int cmd_get = cmd & tftp_cmd_get; | ||
68 | const int cmd_put = cmd & tftp_cmd_put; | ||
69 | const int bb_tftp_num_retries = 5; | ||
70 | |||
95 | struct sockaddr_in sa; | 71 | struct sockaddr_in sa; |
96 | int socketfd; | ||
97 | struct timeval tv; | ||
98 | fd_set rfds; | ||
99 | struct sockaddr_in from; | 72 | struct sockaddr_in from; |
73 | struct timeval tv; | ||
100 | socklen_t fromlen; | 74 | socklen_t fromlen; |
75 | fd_set rfds; | ||
101 | char *cp; | 76 | char *cp; |
102 | unsigned short tmp; | 77 | unsigned short tmp; |
103 | int len, opcode, finished; | 78 | int socketfd; |
104 | int timeout, block_nr; | 79 | int len; |
105 | 80 | int opcode = 0; | |
106 | RESERVE_BB_BUFFER(buf, BUFSIZE); | 81 | int finished = 0; |
82 | int timeout = bb_tftp_num_retries; | ||
83 | int block_nr = 1; | ||
84 | RESERVE_BB_BUFFER(buf, tftp_bufsize + 4); // Why 4 ? | ||
107 | 85 | ||
108 | opcode = finished = timeout = 0; | 86 | tftp_bufsize += 4; |
109 | block_nr = 1; | ||
110 | 87 | ||
111 | if ((socketfd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { | 88 | if ((socketfd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) { |
112 | perror_msg("socket"); | 89 | perror_msg("socket"); |
@@ -125,12 +102,12 @@ static inline int tftp(int cmd, struct hostent *host, | |||
125 | 102 | ||
126 | /* build opcode */ | 103 | /* build opcode */ |
127 | 104 | ||
128 | if (cmd & BB_TFTP_GET) { | 105 | if (cmd_get) { |
129 | opcode = RRQ; | 106 | opcode = 1; // read request = 1 |
130 | } | 107 | } |
131 | 108 | ||
132 | if (cmd & BB_TFTP_PUT) { | 109 | if (cmd_put) { |
133 | opcode = WRQ; | 110 | opcode = 2; // write request = 2 |
134 | } | 111 | } |
135 | 112 | ||
136 | while (1) { | 113 | while (1) { |
@@ -147,16 +124,17 @@ static inline int tftp(int cmd, struct hostent *host, | |||
147 | 124 | ||
148 | /* add filename and mode */ | 125 | /* add filename and mode */ |
149 | 126 | ||
150 | if ((BB_TFTP_GET && (opcode == RRQ)) || | 127 | if ((cmd_get && (opcode == 1)) || // read request = 1 |
151 | (BB_TFTP_PUT && (opcode == WRQ))) { | 128 | (cmd_put && (opcode == 2))) { // write request = 2 |
152 | 129 | ||
153 | while (cp != &buf[BUFSIZE - 1]) { | 130 | /* what is this trying to do ? */ |
131 | while (cp != &buf[tftp_bufsize - 1]) { | ||
154 | if ((*cp = *serverfile++) == '\0') | 132 | if ((*cp = *serverfile++) == '\0') |
155 | break; | 133 | break; |
156 | cp++; | 134 | cp++; |
157 | } | 135 | } |
158 | 136 | /* and this ? */ | |
159 | if ((*cp != '\0') || (&buf[BUFSIZE - 1] - cp) < 7) { | 137 | if ((*cp != '\0') || (&buf[tftp_bufsize - 1] - cp) < 7) { |
160 | error_msg("too long server-filename"); | 138 | error_msg("too long server-filename"); |
161 | break; | 139 | break; |
162 | } | 140 | } |
@@ -167,8 +145,8 @@ static inline int tftp(int cmd, struct hostent *host, | |||
167 | 145 | ||
168 | /* add ack and data */ | 146 | /* add ack and data */ |
169 | 147 | ||
170 | if ((BB_TFTP_GET && (opcode == ACK)) || | 148 | if ((cmd_get && (opcode == 4)) || // acknowledgement = 4 |
171 | (BB_TFTP_PUT && (opcode == DATA))) { | 149 | (cmd_put && (opcode == 3))) { // data packet == 3 |
172 | 150 | ||
173 | *((unsigned short *) cp) = htons(block_nr); | 151 | *((unsigned short *) cp) = htons(block_nr); |
174 | 152 | ||
@@ -176,15 +154,15 @@ static inline int tftp(int cmd, struct hostent *host, | |||
176 | 154 | ||
177 | block_nr++; | 155 | block_nr++; |
178 | 156 | ||
179 | if (BB_TFTP_PUT && (opcode == DATA)) { | 157 | if (cmd_put && (opcode == 3)) { // data packet == 3 |
180 | len = read(localfd, cp, BUFSIZE - 4); | 158 | len = read(localfd, cp, tftp_bufsize - 4); |
181 | 159 | ||
182 | if (len < 0) { | 160 | if (len < 0) { |
183 | perror_msg("read"); | 161 | perror_msg("read"); |
184 | break; | 162 | break; |
185 | } | 163 | } |
186 | 164 | ||
187 | if (len != (BUFSIZE - 4)) { | 165 | if (len != (tftp_bufsize - 4)) { |
188 | finished++; | 166 | finished++; |
189 | } | 167 | } |
190 | 168 | ||
@@ -202,16 +180,14 @@ static inline int tftp(int cmd, struct hostent *host, | |||
202 | 180 | ||
203 | len = cp - buf; | 181 | len = cp - buf; |
204 | 182 | ||
205 | if (BB_TFTP_DEBUG) { | 183 | #ifdef BB_FEATURE_TFTP_DEBUG |
206 | printf("sending %u bytes\n", len); | 184 | printf("sending %u bytes\n", len); |
207 | 185 | for (cp = buf; cp < &buf[len]; cp++) | |
208 | for (cp = buf; cp < &buf[len]; cp++) | 186 | printf("%02x ", *cp); |
209 | printf("%02x ", *cp); | 187 | printf("\n"); |
210 | printf("\n"); | 188 | #endif |
211 | } | ||
212 | |||
213 | if (sendto(socketfd, buf, len, 0, | 189 | if (sendto(socketfd, buf, len, 0, |
214 | (struct sockaddr *) &sa, sizeof(sa)) < 0) { | 190 | (struct sockaddr *) &sa, sizeof(sa)) < 0) { |
215 | perror_msg("send"); | 191 | perror_msg("send"); |
216 | len = -1; | 192 | len = -1; |
217 | break; | 193 | break; |
@@ -224,7 +200,7 @@ static inline int tftp(int cmd, struct hostent *host, | |||
224 | memset(&from, 0, sizeof(from)); | 200 | memset(&from, 0, sizeof(from)); |
225 | fromlen = sizeof(from); | 201 | fromlen = sizeof(from); |
226 | 202 | ||
227 | tv.tv_sec = BB_TFTP_TIMEOUT; | 203 | tv.tv_sec = 5; // BB_TFPT_TIMEOUT = 5 |
228 | tv.tv_usec = 0; | 204 | tv.tv_usec = 0; |
229 | 205 | ||
230 | FD_ZERO(&rfds); | 206 | FD_ZERO(&rfds); |
@@ -232,9 +208,8 @@ static inline int tftp(int cmd, struct hostent *host, | |||
232 | 208 | ||
233 | switch (select(FD_SETSIZE, &rfds, NULL, NULL, &tv)) { | 209 | switch (select(FD_SETSIZE, &rfds, NULL, NULL, &tv)) { |
234 | case 1: | 210 | case 1: |
235 | len = recvfrom(socketfd, buf, | 211 | len = recvfrom(socketfd, buf, tftp_bufsize, 0, |
236 | BUFSIZE, 0, | 212 | (struct sockaddr *) &from, &fromlen); |
237 | (struct sockaddr *) &from, &fromlen); | ||
238 | 213 | ||
239 | if (len < 0) { | 214 | if (len < 0) { |
240 | perror_msg("recvfrom"); | 215 | perror_msg("recvfrom"); |
@@ -245,28 +220,23 @@ static inline int tftp(int cmd, struct hostent *host, | |||
245 | 220 | ||
246 | if (sa.sin_port == htons(port)) { | 221 | if (sa.sin_port == htons(port)) { |
247 | sa.sin_port = from.sin_port; | 222 | sa.sin_port = from.sin_port; |
248 | break; | ||
249 | } | 223 | } |
250 | |||
251 | if (sa.sin_port == from.sin_port) { | 224 | if (sa.sin_port == from.sin_port) { |
252 | break; | 225 | break; |
253 | } | 226 | } |
254 | 227 | ||
255 | /* fall-through for bad packets! */ | 228 | /* fall-through for bad packets! */ |
256 | /* discard the packet - treat as timeout */ | 229 | /* discard the packet - treat as timeout */ |
230 | timeout = bb_tftp_num_retries; | ||
257 | 231 | ||
258 | case 0: | 232 | case 0: |
259 | error_msg("timeout"); | 233 | error_msg("timeout"); |
260 | 234 | ||
261 | if (!timeout) { | 235 | if (timeout == 0) { |
262 | timeout = BB_TFTP_NO_RETRIES; | ||
263 | } else { | ||
264 | timeout--; | ||
265 | } | ||
266 | |||
267 | if (!timeout) { | ||
268 | len = -1; | 236 | len = -1; |
269 | error_msg("last timeout"); | 237 | error_msg("last timeout"); |
238 | } else { | ||
239 | timeout--; | ||
270 | } | 240 | } |
271 | break; | 241 | break; |
272 | 242 | ||
@@ -287,11 +257,11 @@ static inline int tftp(int cmd, struct hostent *host, | |||
287 | opcode = ntohs(*((unsigned short *) buf)); | 257 | opcode = ntohs(*((unsigned short *) buf)); |
288 | tmp = ntohs(*((unsigned short *) &buf[2])); | 258 | tmp = ntohs(*((unsigned short *) &buf[2])); |
289 | 259 | ||
290 | if (BB_TFTP_DEBUG) { | 260 | #ifdef BB_FEATURE_TFTP_DEBUG |
291 | printf("received %d bytes: %04x %04x\n", len, opcode, tmp); | 261 | printf("received %d bytes: %04x %04x\n", len, opcode, tmp); |
292 | } | 262 | #endif |
293 | 263 | ||
294 | if (BB_TFTP_GET && (opcode == DATA)) { | 264 | if (cmd_get && (opcode == 3)) { // data packet == 3 |
295 | 265 | ||
296 | if (tmp == block_nr) { | 266 | if (tmp == block_nr) { |
297 | len = write(localfd, &buf[4], len - 4); | 267 | len = write(localfd, &buf[4], len - 4); |
@@ -301,33 +271,33 @@ static inline int tftp(int cmd, struct hostent *host, | |||
301 | break; | 271 | break; |
302 | } | 272 | } |
303 | 273 | ||
304 | if (len != (BUFSIZE - 4)) { | 274 | if (len != (tftp_bufsize - 4)) { |
305 | finished++; | 275 | finished++; |
306 | } | 276 | } |
307 | 277 | ||
308 | opcode = ACK; | 278 | opcode = 4; // acknowledgement = 4 |
309 | continue; | 279 | continue; |
310 | } | 280 | } |
311 | } | 281 | } |
312 | 282 | ||
313 | if (BB_TFTP_PUT && (opcode == ACK)) { | 283 | if (cmd_put && (opcode == 4)) { // acknowledgement = 4 |
314 | 284 | ||
315 | if (tmp == (block_nr - 1)) { | 285 | if (tmp == (block_nr - 1)) { |
316 | if (finished) { | 286 | if (finished) { |
317 | break; | 287 | break; |
318 | } | 288 | } |
319 | 289 | ||
320 | opcode = DATA; | 290 | opcode = 3; // data packet == 3 |
321 | continue; | 291 | continue; |
322 | } | 292 | } |
323 | } | 293 | } |
324 | 294 | ||
325 | if (opcode == ERROR) { | 295 | if (opcode == 5) { // error code == 5 |
326 | char *msg = NULL; | 296 | char *msg = NULL; |
327 | 297 | ||
328 | if (buf[4] != '\0') { | 298 | if (buf[4] != '\0') { |
329 | msg = &buf[4]; | 299 | msg = &buf[4]; |
330 | buf[BUFSIZE - 1] = '\0'; | 300 | buf[tftp_bufsize - 1] = '\0'; |
331 | } else if (tmp < (sizeof(tftp_error_msg) / sizeof(char *))) { | 301 | } else if (tmp < (sizeof(tftp_error_msg) / sizeof(char *))) { |
332 | msg = (char *) tftp_error_msg[tmp]; | 302 | msg = (char *) tftp_error_msg[tmp]; |
333 | } | 303 | } |
@@ -347,68 +317,67 @@ static inline int tftp(int cmd, struct hostent *host, | |||
347 | 317 | ||
348 | int tftp_main(int argc, char **argv) | 318 | int tftp_main(int argc, char **argv) |
349 | { | 319 | { |
350 | char *cp, *s; | 320 | struct hostent *host = NULL; |
351 | char *serverstr; | 321 | char *localfile = NULL; |
352 | struct hostent *host; | 322 | char *remotefile = NULL; |
353 | char *serverfile; | 323 | int port = 69; |
354 | char *localfile; | 324 | int cmd = 0; |
355 | int cmd, flags, fd, bad; | 325 | int fd = -1; |
356 | 326 | int flags = 0; | |
357 | host = (void *) serverstr = serverfile = localfile = NULL; | 327 | int opt; |
358 | flags = cmd = 0; | 328 | int result; |
359 | bad = 1; | 329 | int blocksize = 512; |
360 | 330 | ||
361 | if (argc > 3) { | 331 | while ((opt = getopt(argc, argv, "b:gpl:r:")) != -1) { |
362 | if (BB_TFTP_GET && (strcmp(argv[1], "get") == 0)) { | 332 | switch (opt) { |
363 | cmd = BB_TFTP_GET; | 333 | case 'b': |
334 | blocksize = atoi(optarg); | ||
335 | break; | ||
336 | #ifdef BB_FEATURE_TFTP_GET | ||
337 | case 'g': | ||
338 | cmd = tftp_cmd_get; | ||
364 | flags = O_WRONLY | O_CREAT; | 339 | flags = O_WRONLY | O_CREAT; |
365 | serverstr = argv[2]; | 340 | break; |
366 | localfile = argv[3]; | 341 | #endif |
367 | } | 342 | #ifdef BB_FEATURE_TFTP_PUT |
368 | 343 | case 'p': | |
369 | if (BB_TFTP_PUT && (strcmp(argv[1], "put") == 0)) { | 344 | cmd = tftp_cmd_put; |
370 | cmd = BB_TFTP_PUT; | ||
371 | flags = O_RDONLY; | 345 | flags = O_RDONLY; |
372 | localfile = argv[2]; | 346 | break; |
373 | serverstr = argv[3]; | 347 | #endif |
348 | case 'l': | ||
349 | localfile = xstrdup(optarg); | ||
350 | break; | ||
351 | case 'r': | ||
352 | remotefile = xstrdup(optarg); | ||
353 | break; | ||
374 | } | 354 | } |
375 | |||
376 | } | 355 | } |
377 | 356 | ||
378 | if (!(cmd & (BB_TFTP_GET | BB_TFTP_PUT))) { | 357 | if ((cmd == 0) || (optind == argc)) { |
379 | show_usage(); | 358 | show_usage(); |
380 | } | 359 | } |
381 | 360 | ||
382 | for (cp = serverstr; *cp != '\0'; cp++) | 361 | fd = open(localfile, flags, 0644); |
383 | if (*cp == ':') | 362 | if (fd < 0) { |
384 | break; | 363 | perror_msg_and_die("local file"); |
385 | |||
386 | if (*cp == ':') { | ||
387 | |||
388 | serverfile = cp + 1; | ||
389 | |||
390 | s = xstrdup(serverstr); | ||
391 | s[cp - serverstr] = '\0'; | ||
392 | |||
393 | host = xgethostbyname(s); | ||
394 | |||
395 | free(s); | ||
396 | } | 364 | } |
397 | 365 | ||
398 | if (BB_TFTP_DEBUG) { | 366 | host = xgethostbyname(argv[optind]); |
399 | printf("using server \"%s\", serverfile \"%s\"," | ||
400 | "localfile \"%s\".\n", | ||
401 | inet_ntoa(*((struct in_addr *) host->h_addr)), | ||
402 | serverfile, localfile); | ||
403 | } | ||
404 | 367 | ||
405 | if ((fd = open(localfile, flags, 0644)) < 0) { | 368 | if (optind + 2 == argc) { |
406 | perror_msg_and_die("local file"); | 369 | port = atoi(argv[optind + 1]); |
407 | } | 370 | } |
408 | 371 | ||
409 | flags = tftp(cmd, host, serverfile, fd, 69); | 372 | #ifdef BB_FEATURE_TFTP_DEBUG |
373 | printf("using server \"%s\", serverfile \"%s\"," | ||
374 | "localfile \"%s\".\n", | ||
375 | inet_ntoa(*((struct in_addr *) host->h_addr)), | ||
376 | remotefile, localfile); | ||
377 | #endif | ||
410 | 378 | ||
379 | result = tftp(cmd, host, remotefile, fd, port, blocksize); | ||
411 | close(fd); | 380 | close(fd); |
412 | 381 | ||
413 | return flags; | 382 | return(result); |
414 | } | 383 | } \ No newline at end of file |