tftp.c revision 1.22 1 1.22 ross /* $NetBSD: tftp.c,v 1.22 2005/11/20 19:28:23 ross Exp $ */
2 1.4 jtc
3 1.1 cgd /*
4 1.4 jtc * Copyright (c) 1983, 1993
5 1.4 jtc * The Regents of the University of California. All rights reserved.
6 1.1 cgd *
7 1.1 cgd * Redistribution and use in source and binary forms, with or without
8 1.1 cgd * modification, are permitted provided that the following conditions
9 1.1 cgd * are met:
10 1.1 cgd * 1. Redistributions of source code must retain the above copyright
11 1.1 cgd * notice, this list of conditions and the following disclaimer.
12 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 cgd * notice, this list of conditions and the following disclaimer in the
14 1.1 cgd * documentation and/or other materials provided with the distribution.
15 1.18 agc * 3. Neither the name of the University nor the names of its contributors
16 1.1 cgd * may be used to endorse or promote products derived from this software
17 1.1 cgd * without specific prior written permission.
18 1.1 cgd *
19 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
20 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
23 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 1.1 cgd * SUCH DAMAGE.
30 1.1 cgd */
31 1.1 cgd
32 1.6 mrg #include <sys/cdefs.h>
33 1.1 cgd #ifndef lint
34 1.4 jtc #if 0
35 1.4 jtc static char sccsid[] = "@(#)tftp.c 8.1 (Berkeley) 6/6/93";
36 1.6 mrg #else
37 1.22 ross __RCSID("$NetBSD: tftp.c,v 1.22 2005/11/20 19:28:23 ross Exp $");
38 1.4 jtc #endif
39 1.1 cgd #endif /* not lint */
40 1.1 cgd
41 1.1 cgd /* Many bug fixes are from Jim Guyton <guyton@rand-unix> */
42 1.1 cgd
43 1.1 cgd /*
44 1.1 cgd * TFTP User Program -- Protocol Machines
45 1.1 cgd */
46 1.1 cgd #include <sys/types.h>
47 1.17 briggs #include <sys/param.h>
48 1.1 cgd #include <sys/socket.h>
49 1.17 briggs #include <sys/stat.h>
50 1.1 cgd #include <sys/time.h>
51 1.1 cgd
52 1.1 cgd #include <netinet/in.h>
53 1.1 cgd
54 1.1 cgd #include <arpa/tftp.h>
55 1.1 cgd
56 1.7 lukem #include <err.h>
57 1.4 jtc #include <errno.h>
58 1.4 jtc #include <setjmp.h>
59 1.1 cgd #include <signal.h>
60 1.1 cgd #include <stdio.h>
61 1.17 briggs #include <stdlib.h>
62 1.5 cgd #include <string.h>
63 1.4 jtc #include <unistd.h>
64 1.15 itojun #include <netdb.h>
65 1.4 jtc
66 1.4 jtc #include "extern.h"
67 1.4 jtc #include "tftpsubs.h"
68 1.1 cgd
69 1.1 cgd char ackbuf[PKTSIZE];
70 1.1 cgd int timeout;
71 1.1 cgd jmp_buf toplevel;
72 1.1 cgd jmp_buf timeoutbuf;
73 1.1 cgd
74 1.10 itojun static void nak __P((int, struct sockaddr *));
75 1.17 briggs static int makerequest __P((int, const char *, struct tftphdr *, const char *, off_t));
76 1.4 jtc static void printstats __P((const char *, unsigned long));
77 1.4 jtc static void startclock __P((void));
78 1.4 jtc static void stopclock __P((void));
79 1.4 jtc static void timer __P((int));
80 1.4 jtc static void tpacket __P((const char *, struct tftphdr *, int));
81 1.15 itojun static int cmpport __P((struct sockaddr *, struct sockaddr *));
82 1.1 cgd
83 1.17 briggs static void get_options(struct tftphdr *, int);
84 1.17 briggs
85 1.17 briggs static void
86 1.17 briggs get_options(struct tftphdr *ap, int size)
87 1.17 briggs {
88 1.17 briggs unsigned long val;
89 1.17 briggs char *opt, *endp, *nextopt, *valp;
90 1.17 briggs int l;
91 1.17 briggs
92 1.17 briggs size -= 2; /* skip over opcode */
93 1.17 briggs opt = ap->th_stuff;
94 1.17 briggs endp = opt + size - 1;
95 1.17 briggs *endp = '\0';
96 1.17 briggs
97 1.17 briggs while (opt < endp) {
98 1.17 briggs l = strlen(opt) + 1;
99 1.17 briggs valp = opt + l;
100 1.17 briggs if (valp < endp) {
101 1.17 briggs val = strtoul(valp, NULL, 10);
102 1.17 briggs l = strlen(valp) + 1;
103 1.17 briggs nextopt = valp + l;
104 1.17 briggs if (val == ULONG_MAX && errno == ERANGE) {
105 1.17 briggs /* Report illegal value */
106 1.17 briggs opt = nextopt;
107 1.17 briggs continue;
108 1.17 briggs }
109 1.17 briggs } else {
110 1.17 briggs /* Badly formed OACK */
111 1.17 briggs break;
112 1.17 briggs }
113 1.17 briggs if (strcmp(opt, "tsize") == 0) {
114 1.17 briggs /* cool, but we'll ignore it */
115 1.17 briggs } else if (strcmp(opt, "timeout") == 0) {
116 1.17 briggs if (val >= 1 && val <= 255) {
117 1.17 briggs rexmtval = val;
118 1.17 briggs } else {
119 1.17 briggs /* Report error? */
120 1.17 briggs }
121 1.17 briggs } else if (strcmp(opt, "blksize") == 0) {
122 1.17 briggs if (val >= 8 && val <= MAXSEGSIZE) {
123 1.17 briggs blksize = val;
124 1.17 briggs } else {
125 1.17 briggs /* Report error? */
126 1.17 briggs }
127 1.17 briggs } else {
128 1.17 briggs /* unknown option */
129 1.17 briggs }
130 1.17 briggs opt = nextopt;
131 1.17 briggs }
132 1.17 briggs }
133 1.17 briggs
134 1.1 cgd /*
135 1.1 cgd * Send the requested file.
136 1.1 cgd */
137 1.4 jtc void
138 1.1 cgd sendfile(fd, name, mode)
139 1.1 cgd int fd;
140 1.1 cgd char *name;
141 1.1 cgd char *mode;
142 1.1 cgd {
143 1.7 lukem struct tftphdr *ap; /* data and ack packets */
144 1.6 mrg struct tftphdr *dp;
145 1.20 he int j, n;
146 1.13 dogcow volatile unsigned int block;
147 1.13 dogcow volatile int size, convert;
148 1.4 jtc volatile unsigned long amount;
149 1.10 itojun struct sockaddr_storage from;
150 1.17 briggs struct stat sbuf;
151 1.17 briggs off_t filesize=0;
152 1.1 cgd int fromlen;
153 1.1 cgd FILE *file;
154 1.10 itojun struct sockaddr_storage peer;
155 1.15 itojun struct sockaddr_storage serv; /* valid server port number */
156 1.1 cgd
157 1.4 jtc startclock(); /* start stat's clock */
158 1.4 jtc dp = r_init(); /* reset fillbuf/read-ahead code */
159 1.1 cgd ap = (struct tftphdr *)ackbuf;
160 1.17 briggs if (tsize) {
161 1.17 briggs if (fstat(fd, &sbuf) == 0) {
162 1.17 briggs filesize = sbuf.st_size;
163 1.17 briggs } else {
164 1.17 briggs filesize = -1ULL;
165 1.17 briggs }
166 1.17 briggs }
167 1.1 cgd file = fdopen(fd, "r");
168 1.1 cgd convert = !strcmp(mode, "netascii");
169 1.4 jtc block = 0;
170 1.4 jtc amount = 0;
171 1.10 itojun memcpy(&peer, &peeraddr, peeraddr.ss_len);
172 1.15 itojun memset(&serv, 0, sizeof(serv));
173 1.1 cgd
174 1.1 cgd signal(SIGALRM, timer);
175 1.1 cgd do {
176 1.1 cgd if (block == 0)
177 1.17 briggs size = makerequest(WRQ, name, dp, mode, filesize) - 4;
178 1.1 cgd else {
179 1.4 jtc /* size = read(fd, dp->th_data, SEGSIZE); */
180 1.17 briggs size = readit(file, &dp, blksize, convert);
181 1.1 cgd if (size < 0) {
182 1.10 itojun nak(errno + 100, (struct sockaddr *)&peer);
183 1.1 cgd break;
184 1.1 cgd }
185 1.1 cgd dp->th_opcode = htons((u_short)DATA);
186 1.1 cgd dp->th_block = htons((u_short)block);
187 1.1 cgd }
188 1.1 cgd timeout = 0;
189 1.1 cgd (void) setjmp(timeoutbuf);
190 1.1 cgd send_data:
191 1.1 cgd if (trace)
192 1.1 cgd tpacket("sent", dp, size + 4);
193 1.1 cgd n = sendto(f, dp, size + 4, 0,
194 1.10 itojun (struct sockaddr *)&peer, peer.ss_len);
195 1.1 cgd if (n != size + 4) {
196 1.7 lukem warn("sendto");
197 1.1 cgd goto abort;
198 1.1 cgd }
199 1.17 briggs if (block)
200 1.17 briggs read_ahead(file, blksize, convert);
201 1.1 cgd for ( ; ; ) {
202 1.1 cgd alarm(rexmtval);
203 1.1 cgd do {
204 1.4 jtc fromlen = sizeof(from);
205 1.4 jtc n = recvfrom(f, ackbuf, sizeof(ackbuf), 0,
206 1.1 cgd (struct sockaddr *)&from, &fromlen);
207 1.1 cgd } while (n <= 0);
208 1.1 cgd alarm(0);
209 1.1 cgd if (n < 0) {
210 1.7 lukem warn("recvfrom");
211 1.1 cgd goto abort;
212 1.1 cgd }
213 1.15 itojun if (!serv.ss_family)
214 1.15 itojun serv = from;
215 1.15 itojun else if (!cmpport((struct sockaddr *)&serv,
216 1.15 itojun (struct sockaddr *)&from)) {
217 1.15 itojun warn("server port mismatch");
218 1.15 itojun goto abort;
219 1.10 itojun }
220 1.15 itojun peer = from;
221 1.1 cgd if (trace)
222 1.1 cgd tpacket("received", ap, n);
223 1.1 cgd /* should verify packet came from server */
224 1.1 cgd ap->th_opcode = ntohs(ap->th_opcode);
225 1.1 cgd if (ap->th_opcode == ERROR) {
226 1.1 cgd printf("Error code %d: %s\n", ap->th_code,
227 1.1 cgd ap->th_msg);
228 1.1 cgd goto abort;
229 1.1 cgd }
230 1.1 cgd if (ap->th_opcode == ACK) {
231 1.19 erh ap->th_block = ntohs(ap->th_block);
232 1.1 cgd
233 1.17 briggs if (ap->th_block == 0) {
234 1.17 briggs /*
235 1.17 briggs * If the extended options are enabled,
236 1.17 briggs * the server just refused 'em all.
237 1.17 briggs * The only one that _really_
238 1.17 briggs * matters is blksize, but we'll
239 1.17 briggs * clear timeout, too.
240 1.17 briggs */
241 1.17 briggs blksize = def_blksize;
242 1.17 briggs rexmtval = def_rexmtval;
243 1.17 briggs }
244 1.1 cgd if (ap->th_block == block) {
245 1.1 cgd break;
246 1.1 cgd }
247 1.1 cgd /* On an error, try to synchronize
248 1.1 cgd * both sides.
249 1.1 cgd */
250 1.17 briggs j = synchnet(f, blksize+4);
251 1.1 cgd if (j && trace) {
252 1.1 cgd printf("discarded %d packets\n",
253 1.1 cgd j);
254 1.1 cgd }
255 1.1 cgd if (ap->th_block == (block-1)) {
256 1.1 cgd goto send_data;
257 1.1 cgd }
258 1.1 cgd }
259 1.17 briggs if (ap->th_opcode == OACK) {
260 1.17 briggs if (block == 0) {
261 1.17 briggs blksize = def_blksize;
262 1.17 briggs rexmtval = def_rexmtval;
263 1.17 briggs get_options(ap, n);
264 1.17 briggs break;
265 1.17 briggs }
266 1.17 briggs }
267 1.1 cgd }
268 1.1 cgd if (block > 0)
269 1.1 cgd amount += size;
270 1.1 cgd block++;
271 1.17 briggs } while (size == blksize || block == 1);
272 1.1 cgd abort:
273 1.1 cgd fclose(file);
274 1.1 cgd stopclock();
275 1.1 cgd if (amount > 0)
276 1.1 cgd printstats("Sent", amount);
277 1.1 cgd }
278 1.1 cgd
279 1.1 cgd /*
280 1.1 cgd * Receive a file.
281 1.1 cgd */
282 1.4 jtc void
283 1.1 cgd recvfile(fd, name, mode)
284 1.1 cgd int fd;
285 1.1 cgd char *name;
286 1.1 cgd char *mode;
287 1.1 cgd {
288 1.7 lukem struct tftphdr *ap;
289 1.6 mrg struct tftphdr *dp;
290 1.20 he int j, n, oack=0;
291 1.13 dogcow volatile unsigned int block;
292 1.13 dogcow volatile int size, firsttrip;
293 1.4 jtc volatile unsigned long amount;
294 1.10 itojun struct sockaddr_storage from;
295 1.17 briggs int fromlen, readlen;
296 1.1 cgd FILE *file;
297 1.4 jtc volatile int convert; /* true if converting crlf -> lf */
298 1.10 itojun struct sockaddr_storage peer;
299 1.15 itojun struct sockaddr_storage serv; /* valid server port number */
300 1.1 cgd
301 1.1 cgd startclock();
302 1.1 cgd dp = w_init();
303 1.1 cgd ap = (struct tftphdr *)ackbuf;
304 1.1 cgd file = fdopen(fd, "w");
305 1.1 cgd convert = !strcmp(mode, "netascii");
306 1.4 jtc block = 1;
307 1.4 jtc firsttrip = 1;
308 1.4 jtc amount = 0;
309 1.10 itojun memcpy(&peer, &peeraddr, peeraddr.ss_len);
310 1.15 itojun memset(&serv, 0, sizeof(serv));
311 1.1 cgd
312 1.1 cgd signal(SIGALRM, timer);
313 1.1 cgd do {
314 1.1 cgd if (firsttrip) {
315 1.17 briggs size = makerequest(RRQ, name, ap, mode, 0);
316 1.17 briggs readlen = PKTSIZE;
317 1.1 cgd firsttrip = 0;
318 1.1 cgd } else {
319 1.1 cgd ap->th_opcode = htons((u_short)ACK);
320 1.1 cgd ap->th_block = htons((u_short)(block));
321 1.17 briggs readlen = blksize+4;
322 1.1 cgd size = 4;
323 1.1 cgd block++;
324 1.1 cgd }
325 1.1 cgd timeout = 0;
326 1.1 cgd (void) setjmp(timeoutbuf);
327 1.1 cgd send_ack:
328 1.1 cgd if (trace)
329 1.1 cgd tpacket("sent", ap, size);
330 1.10 itojun if (sendto(f, ackbuf, size, 0, (struct sockaddr *)&peer,
331 1.10 itojun peer.ss_len) != size) {
332 1.1 cgd alarm(0);
333 1.7 lukem warn("sendto");
334 1.1 cgd goto abort;
335 1.1 cgd }
336 1.1 cgd write_behind(file, convert);
337 1.1 cgd for ( ; ; ) {
338 1.1 cgd alarm(rexmtval);
339 1.1 cgd do {
340 1.4 jtc fromlen = sizeof(from);
341 1.17 briggs n = recvfrom(f, dp, readlen, 0,
342 1.1 cgd (struct sockaddr *)&from, &fromlen);
343 1.1 cgd } while (n <= 0);
344 1.1 cgd alarm(0);
345 1.1 cgd if (n < 0) {
346 1.7 lukem warn("recvfrom");
347 1.1 cgd goto abort;
348 1.1 cgd }
349 1.15 itojun if (!serv.ss_family)
350 1.15 itojun serv = from;
351 1.15 itojun else if (!cmpport((struct sockaddr *)&serv,
352 1.15 itojun (struct sockaddr *)&from)) {
353 1.15 itojun warn("server port mismatch");
354 1.15 itojun goto abort;
355 1.10 itojun }
356 1.15 itojun peer = from;
357 1.1 cgd if (trace)
358 1.1 cgd tpacket("received", dp, n);
359 1.1 cgd /* should verify client address */
360 1.1 cgd dp->th_opcode = ntohs(dp->th_opcode);
361 1.1 cgd if (dp->th_opcode == ERROR) {
362 1.1 cgd printf("Error code %d: %s\n", dp->th_code,
363 1.1 cgd dp->th_msg);
364 1.1 cgd goto abort;
365 1.1 cgd }
366 1.1 cgd if (dp->th_opcode == DATA) {
367 1.19 erh dp->th_block = ntohs(dp->th_block);
368 1.1 cgd
369 1.17 briggs if (dp->th_block == 1 && !oack) {
370 1.17 briggs /* no OACK, revert to defaults */
371 1.17 briggs blksize = def_blksize;
372 1.17 briggs rexmtval = def_rexmtval;
373 1.17 briggs }
374 1.1 cgd if (dp->th_block == block) {
375 1.4 jtc break; /* have next packet */
376 1.1 cgd }
377 1.1 cgd /* On an error, try to synchronize
378 1.1 cgd * both sides.
379 1.1 cgd */
380 1.17 briggs j = synchnet(f, blksize);
381 1.1 cgd if (j && trace) {
382 1.1 cgd printf("discarded %d packets\n", j);
383 1.1 cgd }
384 1.1 cgd if (dp->th_block == (block-1)) {
385 1.4 jtc goto send_ack; /* resend ack */
386 1.1 cgd }
387 1.1 cgd }
388 1.17 briggs if (dp->th_opcode == OACK) {
389 1.17 briggs if (block == 1) {
390 1.17 briggs oack = 1;
391 1.17 briggs blksize = def_blksize;
392 1.17 briggs rexmtval = def_rexmtval;
393 1.17 briggs get_options(dp, n);
394 1.17 briggs ap->th_opcode = htons(ACK);
395 1.17 briggs ap->th_block = 0;
396 1.17 briggs readlen = blksize+4;
397 1.17 briggs size = 4;
398 1.17 briggs goto send_ack;
399 1.17 briggs }
400 1.17 briggs }
401 1.1 cgd }
402 1.4 jtc /* size = write(fd, dp->th_data, n - 4); */
403 1.1 cgd size = writeit(file, &dp, n - 4, convert);
404 1.1 cgd if (size < 0) {
405 1.10 itojun nak(errno + 100, (struct sockaddr *)&peer);
406 1.1 cgd break;
407 1.1 cgd }
408 1.1 cgd amount += size;
409 1.19 erh } while (size == blksize);
410 1.4 jtc abort: /* ok to ack, since user */
411 1.4 jtc ap->th_opcode = htons((u_short)ACK); /* has seen err msg */
412 1.1 cgd ap->th_block = htons((u_short)block);
413 1.10 itojun (void) sendto(f, ackbuf, 4, 0, (struct sockaddr *)&peer,
414 1.10 itojun peer.ss_len);
415 1.4 jtc write_behind(file, convert); /* flush last buffer */
416 1.1 cgd fclose(file);
417 1.1 cgd stopclock();
418 1.1 cgd if (amount > 0)
419 1.1 cgd printstats("Received", amount);
420 1.1 cgd }
421 1.1 cgd
422 1.4 jtc static int
423 1.17 briggs makerequest(request, name, tp, mode, filesize)
424 1.1 cgd int request;
425 1.4 jtc const char *name;
426 1.1 cgd struct tftphdr *tp;
427 1.4 jtc const char *mode;
428 1.17 briggs off_t filesize;
429 1.1 cgd {
430 1.7 lukem char *cp;
431 1.1 cgd
432 1.1 cgd tp->th_opcode = htons((u_short)request);
433 1.9 christos #ifndef __SVR4
434 1.1 cgd cp = tp->th_stuff;
435 1.9 christos #else
436 1.9 christos cp = (void *)&tp->th_stuff;
437 1.9 christos #endif
438 1.1 cgd strcpy(cp, name);
439 1.1 cgd cp += strlen(name);
440 1.1 cgd *cp++ = '\0';
441 1.1 cgd strcpy(cp, mode);
442 1.1 cgd cp += strlen(mode);
443 1.1 cgd *cp++ = '\0';
444 1.17 briggs if (tsize) {
445 1.17 briggs strcpy(cp, "tsize");
446 1.17 briggs cp += strlen(cp);
447 1.17 briggs *cp++ = '\0';
448 1.17 briggs sprintf(cp, "%lu", (unsigned long) filesize);
449 1.17 briggs cp += strlen(cp);
450 1.17 briggs *cp++ = '\0';
451 1.17 briggs }
452 1.17 briggs if (tout) {
453 1.17 briggs strcpy(cp, "timeout");
454 1.17 briggs cp += strlen(cp);
455 1.17 briggs *cp++ = '\0';
456 1.17 briggs sprintf(cp, "%d", rexmtval);
457 1.17 briggs cp += strlen(cp);
458 1.17 briggs *cp++ = '\0';
459 1.17 briggs }
460 1.17 briggs if (blksize != SEGSIZE) {
461 1.17 briggs strcpy(cp, "blksize");
462 1.17 briggs cp += strlen(cp);
463 1.17 briggs *cp++ = '\0';
464 1.17 briggs sprintf(cp, "%d", blksize);
465 1.17 briggs cp += strlen(cp);
466 1.17 briggs *cp++ = '\0';
467 1.17 briggs }
468 1.1 cgd return (cp - (char *)tp);
469 1.1 cgd }
470 1.1 cgd
471 1.8 mycroft const struct errmsg {
472 1.1 cgd int e_code;
473 1.8 mycroft const char *e_msg;
474 1.1 cgd } errmsgs[] = {
475 1.1 cgd { EUNDEF, "Undefined error code" },
476 1.1 cgd { ENOTFOUND, "File not found" },
477 1.1 cgd { EACCESS, "Access violation" },
478 1.1 cgd { ENOSPACE, "Disk full or allocation exceeded" },
479 1.1 cgd { EBADOP, "Illegal TFTP operation" },
480 1.1 cgd { EBADID, "Unknown transfer ID" },
481 1.1 cgd { EEXISTS, "File already exists" },
482 1.1 cgd { ENOUSER, "No such user" },
483 1.17 briggs { EOPTNEG, "Option negotiation failed" },
484 1.1 cgd { -1, 0 }
485 1.1 cgd };
486 1.1 cgd
487 1.1 cgd /*
488 1.1 cgd * Send a nak packet (error message).
489 1.1 cgd * Error code passed in is one of the
490 1.1 cgd * standard TFTP codes, or a UNIX errno
491 1.1 cgd * offset by 100.
492 1.1 cgd */
493 1.4 jtc static void
494 1.10 itojun nak(error, peer)
495 1.1 cgd int error;
496 1.10 itojun struct sockaddr *peer;
497 1.1 cgd {
498 1.8 mycroft const struct errmsg *pe;
499 1.7 lukem struct tftphdr *tp;
500 1.1 cgd int length;
501 1.14 itojun size_t msglen;
502 1.1 cgd
503 1.1 cgd tp = (struct tftphdr *)ackbuf;
504 1.1 cgd tp->th_opcode = htons((u_short)ERROR);
505 1.14 itojun msglen = sizeof(ackbuf) - (&tp->th_msg[0] - ackbuf);
506 1.1 cgd for (pe = errmsgs; pe->e_code >= 0; pe++)
507 1.1 cgd if (pe->e_code == error)
508 1.1 cgd break;
509 1.1 cgd if (pe->e_code < 0) {
510 1.1 cgd tp->th_code = EUNDEF;
511 1.14 itojun strlcpy(tp->th_msg, strerror(error - 100), msglen);
512 1.8 mycroft } else {
513 1.8 mycroft tp->th_code = htons((u_short)error);
514 1.14 itojun strlcpy(tp->th_msg, pe->e_msg, msglen);
515 1.1 cgd }
516 1.14 itojun length = strlen(tp->th_msg);
517 1.14 itojun msglen = &tp->th_msg[length + 1] - ackbuf;
518 1.1 cgd if (trace)
519 1.14 itojun tpacket("sent", tp, (int)msglen);
520 1.16 wiz if (sendto(f, ackbuf, msglen, 0, peer, peer->sa_len) != msglen)
521 1.7 lukem warn("nak");
522 1.1 cgd }
523 1.1 cgd
524 1.4 jtc static void
525 1.1 cgd tpacket(s, tp, n)
526 1.4 jtc const char *s;
527 1.1 cgd struct tftphdr *tp;
528 1.1 cgd int n;
529 1.1 cgd {
530 1.22 ross static const char *opcodes[] =
531 1.17 briggs { "#0", "RRQ", "WRQ", "DATA", "ACK", "ERROR", "OACK" };
532 1.22 ross char *cp, *file, *endp, *opt = NULL;
533 1.22 ross const char *spc;
534 1.1 cgd u_short op = ntohs(tp->th_opcode);
535 1.17 briggs int i, o;
536 1.1 cgd
537 1.17 briggs if (op < RRQ || op > OACK)
538 1.1 cgd printf("%s opcode=%x ", s, op);
539 1.1 cgd else
540 1.1 cgd printf("%s %s ", s, opcodes[op]);
541 1.1 cgd switch (op) {
542 1.1 cgd
543 1.1 cgd case RRQ:
544 1.1 cgd case WRQ:
545 1.1 cgd n -= 2;
546 1.9 christos #ifndef __SVR4
547 1.9 christos cp = tp->th_stuff;
548 1.9 christos #else
549 1.9 christos cp = (void *) &tp->th_stuff;
550 1.9 christos #endif
551 1.17 briggs endp = cp + n - 1;
552 1.17 briggs if (*endp != '\0') { /* Shouldn't happen, but... */
553 1.17 briggs *endp = '\0';
554 1.17 briggs }
555 1.9 christos file = cp;
556 1.17 briggs cp = strchr(cp, '\0') + 1;
557 1.17 briggs printf("<file=%s, mode=%s", file, cp);
558 1.17 briggs cp = strchr(cp, '\0') + 1;
559 1.17 briggs o = 0;
560 1.17 briggs while (cp < endp) {
561 1.17 briggs i = strlen(cp) + 1;
562 1.17 briggs if (o) {
563 1.17 briggs printf(", %s=%s", opt, cp);
564 1.17 briggs } else {
565 1.17 briggs opt = cp;
566 1.17 briggs }
567 1.17 briggs o = (o+1) % 2;
568 1.17 briggs cp += i;
569 1.17 briggs }
570 1.17 briggs printf(">\n");
571 1.1 cgd break;
572 1.1 cgd
573 1.1 cgd case DATA:
574 1.1 cgd printf("<block=%d, %d bytes>\n", ntohs(tp->th_block), n - 4);
575 1.1 cgd break;
576 1.1 cgd
577 1.1 cgd case ACK:
578 1.1 cgd printf("<block=%d>\n", ntohs(tp->th_block));
579 1.1 cgd break;
580 1.1 cgd
581 1.1 cgd case ERROR:
582 1.1 cgd printf("<code=%d, msg=%s>\n", ntohs(tp->th_code), tp->th_msg);
583 1.17 briggs break;
584 1.17 briggs
585 1.17 briggs case OACK:
586 1.17 briggs o = 0;
587 1.17 briggs n -= 2;
588 1.17 briggs cp = tp->th_stuff;
589 1.17 briggs endp = cp + n - 1;
590 1.17 briggs if (*endp != '\0') { /* Shouldn't happen, but... */
591 1.17 briggs *endp = '\0';
592 1.17 briggs }
593 1.17 briggs printf("<");
594 1.17 briggs spc = "";
595 1.17 briggs while (cp < endp) {
596 1.17 briggs i = strlen(cp) + 1;
597 1.17 briggs if (o) {
598 1.17 briggs printf("%s%s=%s", spc, opt, cp);
599 1.17 briggs spc = ", ";
600 1.17 briggs } else {
601 1.17 briggs opt = cp;
602 1.17 briggs }
603 1.17 briggs o = (o+1) % 2;
604 1.17 briggs cp += i;
605 1.17 briggs }
606 1.17 briggs printf(">\n");
607 1.1 cgd break;
608 1.1 cgd }
609 1.1 cgd }
610 1.1 cgd
611 1.1 cgd struct timeval tstart;
612 1.1 cgd struct timeval tstop;
613 1.1 cgd
614 1.4 jtc static void
615 1.4 jtc startclock()
616 1.4 jtc {
617 1.4 jtc
618 1.4 jtc (void)gettimeofday(&tstart, NULL);
619 1.1 cgd }
620 1.1 cgd
621 1.4 jtc static void
622 1.4 jtc stopclock()
623 1.4 jtc {
624 1.4 jtc
625 1.4 jtc (void)gettimeofday(&tstop, NULL);
626 1.1 cgd }
627 1.1 cgd
628 1.4 jtc static void
629 1.1 cgd printstats(direction, amount)
630 1.4 jtc const char *direction;
631 1.4 jtc unsigned long amount;
632 1.1 cgd {
633 1.1 cgd double delta;
634 1.6 mrg
635 1.6 mrg /* compute delta in 1/10's second units */
636 1.1 cgd delta = ((tstop.tv_sec*10.)+(tstop.tv_usec/100000)) -
637 1.1 cgd ((tstart.tv_sec*10.)+(tstart.tv_usec/100000));
638 1.1 cgd delta = delta/10.; /* back to seconds */
639 1.6 mrg printf("%s %ld bytes in %.1f seconds", direction, amount, delta);
640 1.1 cgd if (verbose)
641 1.1 cgd printf(" [%.0f bits/sec]", (amount*8.)/delta);
642 1.1 cgd putchar('\n');
643 1.1 cgd }
644 1.1 cgd
645 1.4 jtc static void
646 1.4 jtc timer(sig)
647 1.4 jtc int sig;
648 1.4 jtc {
649 1.4 jtc
650 1.4 jtc timeout += rexmtval;
651 1.4 jtc if (timeout >= maxtimeout) {
652 1.4 jtc printf("Transfer timed out.\n");
653 1.4 jtc longjmp(toplevel, -1);
654 1.4 jtc }
655 1.4 jtc longjmp(timeoutbuf, 1);
656 1.15 itojun }
657 1.15 itojun
658 1.15 itojun static int
659 1.15 itojun cmpport(sa, sb)
660 1.15 itojun struct sockaddr *sa;
661 1.15 itojun struct sockaddr *sb;
662 1.15 itojun {
663 1.15 itojun char a[NI_MAXSERV], b[NI_MAXSERV];
664 1.15 itojun
665 1.15 itojun if (getnameinfo(sa, sa->sa_len, NULL, 0, a, sizeof(a), NI_NUMERICSERV))
666 1.15 itojun return 0;
667 1.15 itojun if (getnameinfo(sb, sb->sa_len, NULL, 0, b, sizeof(b), NI_NUMERICSERV))
668 1.15 itojun return 0;
669 1.15 itojun if (strcmp(a, b) != 0)
670 1.15 itojun return 0;
671 1.15 itojun
672 1.15 itojun return 1;
673 1.4 jtc }
674