Home | History | Annotate | Line # | Download | only in libsa
tftp.c revision 1.14.2.1
      1  1.14.2.1     skrll /*	$NetBSD: tftp.c,v 1.14.2.1 2004/08/03 10:53:53 skrll Exp $	 */
      2       1.1  drochner 
      3       1.1  drochner /*
      4       1.1  drochner  * Copyright (c) 1996
      5       1.1  drochner  *	Matthias Drochner.  All rights reserved.
      6       1.1  drochner  *
      7       1.1  drochner  * Redistribution and use in source and binary forms, with or without
      8       1.1  drochner  * modification, are permitted provided that the following conditions
      9       1.1  drochner  * are met:
     10       1.1  drochner  * 1. Redistributions of source code must retain the above copyright
     11       1.1  drochner  *    notice, this list of conditions and the following disclaimer.
     12       1.1  drochner  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1  drochner  *    notice, this list of conditions and the following disclaimer in the
     14       1.1  drochner  *    documentation and/or other materials provided with the distribution.
     15       1.1  drochner  *
     16       1.1  drochner  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17       1.1  drochner  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18       1.1  drochner  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19       1.1  drochner  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20       1.1  drochner  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21       1.1  drochner  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22       1.1  drochner  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23       1.1  drochner  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24       1.1  drochner  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25       1.1  drochner  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26       1.1  drochner  *
     27       1.1  drochner  */
     28       1.1  drochner 
     29       1.1  drochner /*
     30       1.1  drochner  * Simple TFTP implementation for libsa.
     31       1.1  drochner  * Assumes:
     32       1.1  drochner  *  - socket descriptor (int) at open_file->f_devdata
     33       1.1  drochner  *  - server host IP in global servip
     34       1.1  drochner  * Restrictions:
     35       1.1  drochner  *  - read only
     36       1.1  drochner  *  - lseek only with SEEK_SET or SEEK_CUR
     37       1.1  drochner  *  - no big time differences between transfers (<tftp timeout)
     38       1.1  drochner  */
     39       1.1  drochner 
     40       1.6       cgd /*
     41       1.6       cgd  * XXX Does not currently implement:
     42       1.6       cgd  * XXX
     43       1.6       cgd  * XXX LIBSA_NO_FS_CLOSE
     44       1.6       cgd  * XXX LIBSA_NO_FS_SEEK
     45       1.6       cgd  * XXX LIBSA_NO_FS_WRITE
     46       1.6       cgd  * XXX LIBSA_NO_FS_SYMLINK (does this even make sense?)
     47       1.6       cgd  * XXX LIBSA_FS_SINGLECOMPONENT (does this even make sense?)
     48       1.6       cgd  */
     49       1.6       cgd 
     50       1.1  drochner #include <sys/types.h>
     51       1.1  drochner #include <sys/stat.h>
     52       1.1  drochner #include <netinet/in.h>
     53       1.1  drochner #include <netinet/udp.h>
     54       1.1  drochner #include <netinet/in_systm.h>
     55       1.9   thorpej #include <lib/libkern/libkern.h>
     56       1.1  drochner 
     57       1.1  drochner #include "stand.h"
     58       1.1  drochner #include "net.h"
     59       1.1  drochner 
     60       1.1  drochner #include "tftp.h"
     61       1.1  drochner 
     62       1.1  drochner extern struct in_addr servip;
     63       1.1  drochner 
     64       1.1  drochner static int      tftpport = 2000;
     65       1.1  drochner 
     66       1.1  drochner #define RSPACE 520		/* max data packet, rounded up */
     67       1.1  drochner 
     68       1.1  drochner struct tftp_handle {
     69       1.1  drochner 	struct iodesc  *iodesc;
     70       1.1  drochner 	int             currblock;	/* contents of lastdata */
     71       1.1  drochner 	int             islastblock;	/* flag */
     72       1.1  drochner 	int             validsize;
     73       1.1  drochner 	int             off;
     74  1.14.2.1     skrll 	const char     *path;	/* saved for re-requests */
     75       1.1  drochner 	struct {
     76       1.1  drochner 		u_char header[HEADER_SIZE];
     77       1.1  drochner 		struct tftphdr t;
     78       1.1  drochner 		u_char space[RSPACE];
     79       1.1  drochner 	} lastdata;
     80       1.1  drochner };
     81       1.1  drochner 
     82      1.14   mycroft static const int tftperrors[8] = {
     83       1.1  drochner 	0,			/* ??? */
     84       1.1  drochner 	ENOENT,
     85       1.1  drochner 	EPERM,
     86       1.1  drochner 	ENOSPC,
     87       1.1  drochner 	EINVAL,			/* ??? */
     88       1.1  drochner 	EINVAL,			/* ??? */
     89       1.1  drochner 	EEXIST,
     90       1.1  drochner 	EINVAL			/* ??? */
     91       1.1  drochner };
     92       1.3  christos 
     93       1.4       kim static ssize_t recvtftp __P((struct iodesc *, void *, size_t, time_t));
     94       1.3  christos static int tftp_makereq __P((struct tftp_handle *));
     95       1.3  christos static int tftp_getnextblock __P((struct tftp_handle *));
     96       1.3  christos #ifndef TFTP_NOTERMINATE
     97       1.3  christos static void tftp_terminate __P((struct tftp_handle *));
     98       1.3  christos #endif
     99       1.1  drochner 
    100       1.1  drochner static ssize_t
    101       1.1  drochner recvtftp(d, pkt, len, tleft)
    102      1.10  augustss 	struct iodesc *d;
    103      1.10  augustss 	void  *pkt;
    104      1.10  augustss 	size_t len;
    105       1.1  drochner 	time_t          tleft;
    106       1.1  drochner {
    107       1.7  drochner 	ssize_t n;
    108       1.1  drochner 	struct tftphdr *t;
    109       1.1  drochner 
    110       1.1  drochner 	errno = 0;
    111       1.1  drochner 
    112       1.7  drochner 	n = readudp(d, pkt, len, tleft);
    113       1.1  drochner 
    114       1.7  drochner 	if (n < 4)
    115       1.1  drochner 		return (-1);
    116       1.1  drochner 
    117       1.1  drochner 	t = (struct tftphdr *) pkt;
    118       1.1  drochner 	switch (ntohs(t->th_opcode)) {
    119       1.7  drochner 	case DATA:
    120       1.1  drochner 		if (htons(t->th_block) != d->xid) {
    121       1.1  drochner 			/*
    122       1.1  drochner 			 * Expected block?
    123       1.1  drochner 			 */
    124       1.1  drochner 			return (-1);
    125       1.1  drochner 		}
    126       1.1  drochner 		if (d->xid == 1) {
    127       1.1  drochner 			/*
    128       1.1  drochner 			 * First data packet from new port.
    129       1.1  drochner 			 */
    130      1.10  augustss 			struct udphdr *uh;
    131       1.1  drochner 			uh = (struct udphdr *) pkt - 1;
    132       1.1  drochner 			d->destport = uh->uh_sport;
    133       1.1  drochner 		} /* else check uh_sport has not changed??? */
    134       1.7  drochner 		return (n - (t->th_data - (char *)t));
    135       1.1  drochner 	case ERROR:
    136       1.1  drochner 		if ((unsigned) ntohs(t->th_code) >= 8) {
    137       1.1  drochner 			printf("illegal tftp error %d\n", ntohs(t->th_code));
    138       1.1  drochner 			errno = EIO;
    139       1.1  drochner 		} else {
    140       1.1  drochner #ifdef DEBUG
    141       1.1  drochner 			printf("tftp-error %d\n", ntohs(t->th_code));
    142       1.1  drochner #endif
    143       1.1  drochner 			errno = tftperrors[ntohs(t->th_code)];
    144       1.1  drochner 		}
    145       1.1  drochner 		return (-1);
    146       1.1  drochner 	default:
    147       1.1  drochner #ifdef DEBUG
    148       1.1  drochner 		printf("tftp type %d not handled\n", ntohs(t->th_opcode));
    149       1.1  drochner #endif
    150       1.1  drochner 		return (-1);
    151       1.1  drochner 	}
    152       1.1  drochner }
    153       1.1  drochner 
    154       1.1  drochner /* send request, expect first block (or error) */
    155       1.1  drochner static int
    156       1.1  drochner tftp_makereq(h)
    157       1.1  drochner 	struct tftp_handle *h;
    158       1.1  drochner {
    159       1.1  drochner 	struct {
    160       1.1  drochner 		u_char header[HEADER_SIZE];
    161       1.1  drochner 		struct tftphdr  t;
    162       1.1  drochner 		u_char space[FNAME_SIZE + 6];
    163       1.1  drochner 	} wbuf;
    164       1.1  drochner 	char           *wtail;
    165       1.1  drochner 	int             l;
    166       1.1  drochner 	ssize_t         res;
    167       1.1  drochner 	struct tftphdr *t;
    168       1.1  drochner 
    169       1.1  drochner 	wbuf.t.th_opcode = htons((u_short) RRQ);
    170       1.1  drochner 	wtail = wbuf.t.th_stuff;
    171       1.1  drochner 	l = strlen(h->path);
    172       1.1  drochner 	bcopy(h->path, wtail, l + 1);
    173       1.1  drochner 	wtail += l + 1;
    174       1.1  drochner 	bcopy("octet", wtail, 6);
    175       1.1  drochner 	wtail += 6;
    176       1.1  drochner 
    177       1.1  drochner 	t = &h->lastdata.t;
    178       1.1  drochner 
    179       1.1  drochner 	/* h->iodesc->myport = htons(--tftpport); */
    180       1.1  drochner 	h->iodesc->myport = htons(tftpport + (getsecs() & 0x3ff));
    181       1.1  drochner 	h->iodesc->destport = htons(IPPORT_TFTP);
    182       1.1  drochner 	h->iodesc->xid = 1;	/* expected block */
    183       1.1  drochner 
    184       1.1  drochner 	res = sendrecv(h->iodesc, sendudp, &wbuf.t, wtail - (char *) &wbuf.t,
    185       1.1  drochner 		       recvtftp, t, sizeof(*t) + RSPACE);
    186       1.1  drochner 
    187       1.1  drochner 	if (res == -1)
    188       1.1  drochner 		return (errno);
    189       1.1  drochner 
    190       1.1  drochner 	h->currblock = 1;
    191       1.1  drochner 	h->validsize = res;
    192       1.1  drochner 	h->islastblock = 0;
    193       1.1  drochner 	if (res < SEGSIZE)
    194       1.1  drochner 		h->islastblock = 1;	/* very short file */
    195       1.1  drochner 	return (0);
    196       1.1  drochner }
    197       1.1  drochner 
    198       1.1  drochner /* ack block, expect next */
    199       1.1  drochner static int
    200       1.1  drochner tftp_getnextblock(h)
    201       1.1  drochner 	struct tftp_handle *h;
    202       1.1  drochner {
    203       1.1  drochner 	struct {
    204       1.1  drochner 		u_char header[HEADER_SIZE];
    205       1.1  drochner 		struct tftphdr t;
    206       1.1  drochner 	} wbuf;
    207       1.1  drochner 	char           *wtail;
    208       1.1  drochner 	int             res;
    209       1.1  drochner 	struct tftphdr *t;
    210       1.1  drochner 
    211       1.1  drochner 	wbuf.t.th_opcode = htons((u_short) ACK);
    212       1.1  drochner 	wbuf.t.th_block = htons((u_short) h->currblock);
    213       1.1  drochner 	wtail = (char *) &wbuf.t.th_data;
    214       1.1  drochner 
    215       1.1  drochner 	t = &h->lastdata.t;
    216       1.1  drochner 
    217       1.1  drochner 	h->iodesc->xid = h->currblock + 1;	/* expected block */
    218       1.1  drochner 
    219       1.1  drochner 	res = sendrecv(h->iodesc, sendudp, &wbuf.t, wtail - (char *) &wbuf.t,
    220       1.1  drochner 		       recvtftp, t, sizeof(*t) + RSPACE);
    221       1.1  drochner 
    222       1.1  drochner 	if (res == -1)		/* 0 is OK! */
    223       1.1  drochner 		return (errno);
    224       1.1  drochner 
    225       1.1  drochner 	h->currblock++;
    226       1.1  drochner 	h->validsize = res;
    227       1.1  drochner 	if (res < SEGSIZE)
    228       1.1  drochner 		h->islastblock = 1;	/* EOF */
    229       1.1  drochner 	return (0);
    230       1.1  drochner }
    231       1.1  drochner 
    232       1.1  drochner #ifndef TFTP_NOTERMINATE
    233       1.1  drochner static void
    234       1.1  drochner tftp_terminate(h)
    235       1.1  drochner 	struct tftp_handle *h;
    236       1.1  drochner {
    237       1.1  drochner 	struct {
    238       1.1  drochner 		u_char header[HEADER_SIZE];
    239       1.1  drochner 		struct tftphdr t;
    240       1.1  drochner 	} wbuf;
    241       1.1  drochner 	char           *wtail;
    242       1.1  drochner 
    243       1.1  drochner 	if (h->islastblock) {
    244       1.1  drochner 		wbuf.t.th_opcode = htons((u_short) ACK);
    245       1.1  drochner 		wbuf.t.th_block = htons((u_short) h->currblock);
    246       1.1  drochner 	} else {
    247       1.1  drochner 		wbuf.t.th_opcode = htons((u_short) ERROR);
    248       1.1  drochner 		wbuf.t.th_code = htons((u_short) ENOSPACE); /* ??? */
    249       1.1  drochner 	}
    250       1.1  drochner 	wtail = (char *) &wbuf.t.th_data;
    251       1.1  drochner 
    252       1.1  drochner 	(void) sendudp(h->iodesc, &wbuf.t, wtail - (char *) &wbuf.t);
    253       1.1  drochner }
    254       1.1  drochner #endif
    255       1.1  drochner 
    256       1.1  drochner int
    257       1.1  drochner tftp_open(path, f)
    258  1.14.2.1     skrll 	const char           *path;
    259       1.1  drochner 	struct open_file *f;
    260       1.1  drochner {
    261       1.1  drochner 	struct tftp_handle *tftpfile;
    262       1.1  drochner 	struct iodesc  *io;
    263       1.1  drochner 	int             res;
    264       1.1  drochner 
    265       1.1  drochner 	tftpfile = (struct tftp_handle *) alloc(sizeof(*tftpfile));
    266       1.1  drochner 	if (!tftpfile)
    267       1.1  drochner 		return (ENOMEM);
    268       1.1  drochner 
    269       1.1  drochner 	tftpfile->iodesc = io = socktodesc(*(int *) (f->f_devdata));
    270       1.1  drochner 	io->destip = servip;
    271       1.1  drochner 	tftpfile->off = 0;
    272       1.1  drochner 	tftpfile->path = path;	/* XXXXXXX we hope it's static */
    273       1.1  drochner 
    274       1.4       kim 	res = tftp_makereq(tftpfile);
    275       1.1  drochner 
    276       1.1  drochner 	if (res) {
    277       1.1  drochner 		free(tftpfile, sizeof(*tftpfile));
    278       1.1  drochner 		return (res);
    279       1.1  drochner 	}
    280       1.1  drochner 	f->f_fsdata = (void *) tftpfile;
    281       1.1  drochner 	return (0);
    282       1.1  drochner }
    283       1.1  drochner 
    284       1.1  drochner int
    285       1.1  drochner tftp_read(f, addr, size, resid)
    286       1.1  drochner 	struct open_file *f;
    287       1.1  drochner 	void           *addr;
    288       1.1  drochner 	size_t          size;
    289       1.1  drochner 	size_t         *resid;	/* out */
    290       1.1  drochner {
    291       1.1  drochner 	struct tftp_handle *tftpfile;
    292       1.6       cgd #if !defined(LIBSA_NO_TWIDDLE)
    293       1.1  drochner 	static int      tc = 0;
    294       1.6       cgd #endif
    295       1.1  drochner 	tftpfile = (struct tftp_handle *) f->f_fsdata;
    296       1.1  drochner 
    297       1.1  drochner 	while (size > 0) {
    298  1.14.2.1     skrll 		int needblock;
    299  1.14.2.1     skrll 		size_t count;
    300       1.1  drochner 
    301       1.6       cgd #if !defined(LIBSA_NO_TWIDDLE)
    302       1.1  drochner 		if (!(tc++ % 16))
    303       1.1  drochner 			twiddle();
    304       1.6       cgd #endif
    305       1.1  drochner 
    306       1.1  drochner 		needblock = tftpfile->off / SEGSIZE + 1;
    307       1.1  drochner 
    308       1.1  drochner 		if (tftpfile->currblock > needblock) {	/* seek backwards */
    309       1.1  drochner #ifndef TFTP_NOTERMINATE
    310       1.1  drochner 			tftp_terminate(tftpfile);
    311       1.1  drochner #endif
    312       1.1  drochner 			tftp_makereq(tftpfile);	/* no error check, it worked
    313       1.1  drochner 						 * for open */
    314       1.1  drochner 		}
    315       1.1  drochner 
    316       1.1  drochner 		while (tftpfile->currblock < needblock) {
    317       1.1  drochner 			int res;
    318       1.1  drochner 
    319       1.1  drochner 			res = tftp_getnextblock(tftpfile);
    320       1.1  drochner 			if (res) {	/* no answer */
    321       1.1  drochner #ifdef DEBUG
    322       1.1  drochner 				printf("tftp: read error (block %d->%d)\n",
    323       1.1  drochner 				       tftpfile->currblock, needblock);
    324       1.1  drochner #endif
    325       1.1  drochner 				return (res);
    326       1.1  drochner 			}
    327       1.1  drochner 			if (tftpfile->islastblock)
    328       1.1  drochner 				break;
    329       1.1  drochner 		}
    330       1.1  drochner 
    331       1.1  drochner 		if (tftpfile->currblock == needblock) {
    332  1.14.2.1     skrll 			size_t offinblock, inbuffer;
    333       1.1  drochner 
    334       1.1  drochner 			offinblock = tftpfile->off % SEGSIZE;
    335       1.1  drochner 
    336       1.1  drochner 			inbuffer = tftpfile->validsize - offinblock;
    337       1.1  drochner 			if (inbuffer < 0) {
    338       1.1  drochner #ifdef DEBUG
    339       1.1  drochner 				printf("tftp: invalid offset %d\n",
    340       1.1  drochner 				    tftpfile->off);
    341       1.1  drochner #endif
    342       1.1  drochner 				return (EINVAL);
    343       1.1  drochner 			}
    344       1.1  drochner 			count = (size < inbuffer ? size : inbuffer);
    345       1.1  drochner 			bcopy(tftpfile->lastdata.t.th_data + offinblock,
    346       1.1  drochner 			    addr, count);
    347       1.1  drochner 
    348       1.5       dbj 			addr = (caddr_t)addr + count;
    349       1.1  drochner 			tftpfile->off += count;
    350       1.1  drochner 			size -= count;
    351       1.1  drochner 
    352       1.1  drochner 			if ((tftpfile->islastblock) && (count == inbuffer))
    353       1.1  drochner 				break;	/* EOF */
    354       1.1  drochner 		} else {
    355       1.1  drochner #ifdef DEBUG
    356       1.1  drochner 			printf("tftp: block %d not found\n", needblock);
    357       1.1  drochner #endif
    358       1.1  drochner 			return (EINVAL);
    359       1.1  drochner 		}
    360       1.1  drochner 
    361       1.1  drochner 	}
    362       1.1  drochner 
    363       1.1  drochner 	if (resid)
    364       1.1  drochner 		*resid = size;
    365       1.1  drochner 	return (0);
    366       1.1  drochner }
    367       1.1  drochner 
    368       1.1  drochner int
    369       1.1  drochner tftp_close(f)
    370       1.1  drochner 	struct open_file *f;
    371       1.1  drochner {
    372       1.1  drochner 	struct tftp_handle *tftpfile;
    373       1.1  drochner 	tftpfile = (struct tftp_handle *) f->f_fsdata;
    374       1.1  drochner 
    375       1.1  drochner #ifdef TFTP_NOTERMINATE
    376       1.1  drochner 	/* let it time out ... */
    377       1.1  drochner #else
    378       1.1  drochner 	tftp_terminate(tftpfile);
    379       1.1  drochner #endif
    380       1.1  drochner 
    381       1.1  drochner 	free(tftpfile, sizeof(*tftpfile));
    382       1.1  drochner 	return (0);
    383       1.1  drochner }
    384       1.1  drochner 
    385       1.1  drochner int
    386       1.1  drochner tftp_write(f, start, size, resid)
    387       1.1  drochner 	struct open_file *f;
    388       1.1  drochner 	void           *start;
    389       1.1  drochner 	size_t          size;
    390       1.1  drochner 	size_t         *resid;	/* out */
    391       1.1  drochner {
    392       1.1  drochner 	return (EROFS);
    393       1.1  drochner }
    394       1.1  drochner 
    395       1.1  drochner int
    396       1.1  drochner tftp_stat(f, sb)
    397       1.1  drochner 	struct open_file *f;
    398       1.1  drochner 	struct stat    *sb;
    399       1.1  drochner {
    400       1.1  drochner 	struct tftp_handle *tftpfile;
    401       1.1  drochner 	tftpfile = (struct tftp_handle *) f->f_fsdata;
    402       1.1  drochner 
    403       1.1  drochner 	sb->st_mode = 0444;
    404       1.1  drochner 	sb->st_nlink = 1;
    405       1.1  drochner 	sb->st_uid = 0;
    406       1.1  drochner 	sb->st_gid = 0;
    407       1.1  drochner 	sb->st_size = -1;
    408       1.1  drochner 	return (0);
    409       1.1  drochner }
    410       1.1  drochner 
    411       1.1  drochner off_t
    412       1.1  drochner tftp_seek(f, offset, where)
    413       1.1  drochner 	struct open_file *f;
    414       1.1  drochner 	off_t           offset;
    415       1.1  drochner 	int             where;
    416       1.1  drochner {
    417       1.1  drochner 	struct tftp_handle *tftpfile;
    418       1.1  drochner 	tftpfile = (struct tftp_handle *) f->f_fsdata;
    419       1.1  drochner 
    420       1.1  drochner 	switch (where) {
    421       1.1  drochner 	case SEEK_SET:
    422       1.1  drochner 		tftpfile->off = offset;
    423       1.1  drochner 		break;
    424       1.1  drochner 	case SEEK_CUR:
    425       1.1  drochner 		tftpfile->off += offset;
    426       1.1  drochner 		break;
    427       1.1  drochner 	default:
    428       1.1  drochner 		errno = EOFFSET;
    429       1.1  drochner 		return (-1);
    430       1.1  drochner 	}
    431       1.1  drochner 	return (tftpfile->off);
    432       1.1  drochner }
    433