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