1 /* $NetBSD: tftp.c,v 1.4 1997/09/17 16:57:07 drochner Exp $ */
5 * Matthias Drochner. All rights reserved.
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed for the NetBSD Project
18 * by Matthias Drochner.
19 * 4. The name of the author may not be used to endorse or promote products
20 * derived from this software without specific prior written permission.
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
33 * $FreeBSD: src/lib/libstand/tftp.c,v 1.2.6.4 2001/07/14 14:00:03 mikeh Exp $
34 * $DragonFly: src/lib/libstand/tftp.c,v 1.5 2005/12/11 02:27:26 swildner Exp $
38 * Simple TFTP implementation for libsa.
40 * - socket descriptor (int) at open_file->f_devdata
41 * - server host IP in global servip
44 * - lseek only with SEEK_SET or SEEK_CUR
45 * - no big time differences between transfers (<tftp timeout)
48 #include <sys/param.h>
50 #include <netinet/in.h>
51 #include <netinet/udp.h>
52 #include <netinet/ip.h>
53 #include <netinet/in_systm.h>
54 #include <arpa/tftp.h>
64 static int tftp_open(const char *path
, struct open_file
*f
);
65 static int tftp_close(struct open_file
*f
);
66 static int tftp_read(struct open_file
*f
, void *buf
, size_t size
, size_t *resid
);
67 static int tftp_write(struct open_file
*f
, void *buf
, size_t size
, size_t *resid
);
68 static off_t
tftp_seek(struct open_file
*f
, off_t offset
, int where
);
69 static int tftp_stat(struct open_file
*f
, struct stat
*sb
);
71 struct fs_ops tftp_fsops
= {
82 extern struct in_addr servip
;
84 static int tftpport
= 2000;
86 #define RSPACE 520 /* max data packet, rounded up */
89 struct iodesc
*iodesc
;
90 int currblock
; /* contents of lastdata */
91 int islastblock
; /* flag */
94 char *path
; /* saved for re-requests */
96 u_char header
[HEADER_SIZE
];
99 } __packed
__aligned(4) lastdata
;
102 static int tftperrors
[8] = {
114 recvtftp(struct iodesc
*d
, void *pkt
, size_t max_len
, time_t tleft
)
121 * Note: errno of 0 with -1 return means udp poll failed or
122 * packet was not for us.
124 * We may end up broadcasting the initial TFTP request. Take the
125 * first DATA result and save any ERROR result in case we do not
132 while ((tmp_len
= readudp(d
, pkt
, max_len
, tleft
)) > 0) {
134 t
= (struct tftphdr
*)pkt
;
135 if (ntohs(t
->th_opcode
) == DATA
)
139 len
= readudp(d
, pkt
, max_len
, tleft
);
141 if ((int)len
< (int)sizeof(*t
))
143 t
= (struct tftphdr
*)pkt
;
146 switch (ntohs(t
->th_opcode
)) {
150 if (htons(t
->th_block
) != d
->xid
) {
158 * First data packet from new port. Set destip in
159 * case we got replies from multiple hosts, so only
160 * one host is selected.
165 uh
= (struct udphdr
*) pkt
- 1;
166 ip
= (struct ip
*)uh
- 1;
167 d
->destport
= uh
->uh_sport
;
168 d
->destip
= ip
->ip_src
;
169 } /* else check uh_sport has not changed??? */
170 got
= len
- (t
->th_data
- (char *)t
);
174 if ((unsigned) ntohs(t
->th_code
) >= 8) {
175 printf("illegal tftp error %d\n", ntohs(t
->th_code
));
179 printf("tftp-error %d\n", ntohs(t
->th_code
));
181 errno
= tftperrors
[ntohs(t
->th_code
)];
186 printf("tftp type %d not handled\n", ntohs(t
->th_opcode
));
192 /* send request, expect first block (or error) */
194 tftp_makereq(struct tftp_handle
*h
)
197 u_char header
[HEADER_SIZE
];
199 u_char space
[FNAME_SIZE
+ 6];
200 } __packed
__aligned(4) wbuf
;
206 wbuf
.t
.th_opcode
= htons((u_short
) RRQ
);
207 wtail
= wbuf
.t
.th_stuff
;
209 bcopy(h
->path
, wtail
, l
+ 1);
211 bcopy("octet", wtail
, 6);
216 /* h->iodesc->myport = htons(--tftpport); */
217 h
->iodesc
->myport
= htons(tftpport
+ (getsecs() & 0x3ff));
218 h
->iodesc
->destport
= htons(IPPORT_TFTP
);
219 h
->iodesc
->xid
= 1; /* expected block */
221 res
= sendrecv(h
->iodesc
, sendudp
, &wbuf
.t
, wtail
- (char *) &wbuf
.t
,
222 recvtftp
, t
, sizeof(*t
) + RSPACE
);
231 h
->islastblock
= 1; /* very short file */
235 /* ack block, expect next */
237 tftp_getnextblock(struct tftp_handle
*h
)
240 u_char header
[HEADER_SIZE
];
242 } __packed
__aligned(4) wbuf
;
250 wbuf
.t
.th_opcode
= htons((u_short
) ACK
);
251 wtail
= (char *) &wbuf
.t
.th_block
;
252 wbuf
.t
.th_block
= htons((u_short
) h
->currblock
);
257 h
->iodesc
->xid
= h
->currblock
+ 1; /* expected block */
259 res
= sendrecv(h
->iodesc
, sendudp
, &wbuf
.t
, wtail
- (char *) &wbuf
.t
,
260 recvtftp
, t
, sizeof(*t
) + RSPACE
);
262 if (res
== -1) /* 0 is OK! */
268 h
->islastblock
= 1; /* EOF */
273 tftp_open(const char *path
, struct open_file
*f
)
275 struct tftp_handle
*tftpfile
;
279 tftpfile
= (struct tftp_handle
*) malloc(sizeof(*tftpfile
));
283 tftpfile
->iodesc
= io
= socktodesc(*(int *) (f
->f_devdata
));
289 tftpfile
->path
= strdup(path
);
290 if (tftpfile
->path
== NULL
) {
295 res
= tftp_makereq(tftpfile
);
298 free(tftpfile
->path
);
302 f
->f_fsdata
= (void *) tftpfile
;
311 tftp_read(struct open_file
*f
, void *addr
, size_t size
, size_t *resid
)
313 struct tftp_handle
*tftpfile
;
315 tftpfile
= (struct tftp_handle
*) f
->f_fsdata
;
318 int needblock
, count
;
323 needblock
= tftpfile
->off
/ SEGSIZE
+ 1;
325 if (tftpfile
->currblock
> needblock
) /* seek backwards */
326 tftp_makereq(tftpfile
); /* no error check, it worked
329 while (tftpfile
->currblock
< needblock
) {
332 res
= tftp_getnextblock(tftpfile
);
333 if (res
) { /* no answer */
335 printf("tftp: read error\n");
339 if (tftpfile
->islastblock
)
343 if (tftpfile
->currblock
== needblock
) {
344 int offinblock
, inbuffer
;
346 offinblock
= tftpfile
->off
% SEGSIZE
;
348 inbuffer
= tftpfile
->validsize
- offinblock
;
351 printf("tftp: invalid offset %d\n",
356 count
= (size
< inbuffer
? size
: inbuffer
);
357 bcopy(tftpfile
->lastdata
.t
.th_data
+ offinblock
,
360 addr
= (char *)addr
+ count
;
361 tftpfile
->off
+= count
;
364 if ((tftpfile
->islastblock
) && (count
== inbuffer
))
368 printf("tftp: block %d not found\n", needblock
);
381 tftp_close(struct open_file
*f
)
383 struct tftp_handle
*tftpfile
;
384 tftpfile
= (struct tftp_handle
*) f
->f_fsdata
;
386 /* let it time out ... */
389 free(tftpfile
->path
);
401 tftp_write(struct open_file
*f
, void *start
, size_t size
, size_t *resid
)
407 tftp_stat(struct open_file
*f
, struct stat
*sb
)
409 struct tftp_handle
*tftpfile
;
410 tftpfile
= (struct tftp_handle
*) f
->f_fsdata
;
412 sb
->st_mode
= 0444 | S_IFREG
;
421 tftp_seek(struct open_file
*f
, off_t offset
, int where
)
423 struct tftp_handle
*tftpfile
;
424 tftpfile
= (struct tftp_handle
*) f
->f_fsdata
;
428 tftpfile
->off
= offset
;
431 tftpfile
->off
+= offset
;
437 return (tftpfile
->off
);