567 lines
17 KiB
C
567 lines
17 KiB
C
/****************************************************************************
|
|
* netuils/tftp/tftpc_put.c
|
|
*
|
|
* Copyright (C) 2008 Gregory Nutt. All rights reserved.
|
|
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in
|
|
* the documentation and/or other materials provided with the
|
|
* distribution.
|
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
|
* used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
|
* OF USE, TFTP_DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Compilation Switches
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include <net/uip/uipopt.h>
|
|
#include <net/uip/uip.h>
|
|
#include <net/uip/tftp.h>
|
|
|
|
#include "tftpc_internal.h"
|
|
|
|
#if defined(CONFIG_NET) && defined(CONFIG_NET_UDP) && CONFIG_NFILE_DESCRIPTORS > 0
|
|
|
|
/****************************************************************************
|
|
* Definitions
|
|
****************************************************************************/
|
|
|
|
#define TFTP_RETRIES 3
|
|
|
|
/****************************************************************************
|
|
* Private Function Prototypes
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: tftp_incrndx
|
|
****************************************************************************/
|
|
|
|
#if CONFIG_NETUTILS_TFTP_ACKPACKETS > 1
|
|
static inline int tftp_incrndx(int ndx)
|
|
{
|
|
if (++ndx >= TFTP_MAXACKPACKETS)
|
|
{
|
|
ndx = 0;
|
|
}
|
|
return ndx;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: tftp_read
|
|
****************************************************************************/
|
|
|
|
static inline ssize_t tftp_read(int fd, ubyte *buf, size_t buflen)
|
|
{
|
|
ssize_t nbytesread;
|
|
ssize_t totalread;
|
|
|
|
while (totalread < buflen)
|
|
{
|
|
/* Read the data... repeating the read in the event that it was
|
|
* interrupted by a signal.
|
|
*/
|
|
|
|
do
|
|
{
|
|
nbytesread = read(fd, buf, buflen - totalread);
|
|
}
|
|
while (nbytesread < 0 && errno == EINTR);
|
|
|
|
/* Check for non-EINTR errors */
|
|
|
|
if (nbytesread < 0)
|
|
{
|
|
ndbg(g_tftpcallfailed, "read", errno);
|
|
return ERROR;
|
|
}
|
|
|
|
/* Check for end of file */
|
|
|
|
else if (nbytesread == 0)
|
|
{
|
|
break;
|
|
}
|
|
|
|
/* Handle partial reads. Partial reads can happen normally
|
|
* when the source is some device driver that returns data
|
|
* in bits and pieces as received (such as a pipe)
|
|
*/
|
|
|
|
totalread += nbytesread;
|
|
buf += nbytesread;
|
|
}
|
|
return totalread;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: tftp_mkdatapacket
|
|
*
|
|
* Description:
|
|
* DATA message format:
|
|
*
|
|
* 2 bytes: Opcode (network order == big-endian)
|
|
* 2 bytes: Block number (network order == big-endian)
|
|
* N bytes: Data (where N <= 512)
|
|
*
|
|
* Input Parameters:
|
|
* fd - File descriptor used to read from the file
|
|
* offset - File offset to read from
|
|
* packet - Buffer to write the data packet into
|
|
* blockno - The block number of the packet
|
|
*
|
|
* Return Value:
|
|
* Number of bytes read into the packet. <TFTP_PACKETSIZE means end of file;
|
|
* <1 if an error occurs.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int tftp_mkdatapacket(int fd, off_t offset, ubyte *packet, uint16 blockno)
|
|
{
|
|
off_t tmp;
|
|
int nbytesread;
|
|
|
|
/* Format the DATA message header */
|
|
|
|
packet[0] = TFTP_DATA >> 8;
|
|
packet[1] = TFTP_DATA & 0xff;
|
|
packet[2] = blockno >> 8;
|
|
packet[3] = blockno & 0xff;
|
|
|
|
/* Seek to the correct offset in the file */
|
|
|
|
tmp = lseek(fd, offset, SEEK_SET);
|
|
if (tmp == (off_t)-1)
|
|
{
|
|
ndbg(g_tftpcallfailed, "lseek", errno);
|
|
return ERROR;
|
|
}
|
|
|
|
/* Read the file data into the packet buffer */
|
|
|
|
nbytesread = tftp_read(fd, &packet[TFTP_DATAHEADERSIZE], TFTP_DATASIZE);
|
|
if (nbytesread < 0)
|
|
{
|
|
return ERROR;
|
|
}
|
|
return nbytesread + TFTP_DATAHEADERSIZE;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: tftp_rcvack
|
|
*
|
|
* Description:
|
|
* ACK message format:
|
|
*
|
|
* 2 bytes: Opcode (network order == big-endian)
|
|
* 2 bytes: Block number (network order == big-endian)
|
|
*
|
|
* Input Parameters:
|
|
* sd - Socket descriptor to use in in the transfer
|
|
* packet - buffer to use for the tranfers
|
|
* server - The address of the server
|
|
* port - The port number of the server (0 if not yet known)
|
|
* blockno - The block number of the ACK
|
|
*
|
|
* Returned Value:
|
|
* OK:success and blockno valid, ERROR:failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static int tftp_rcvack(int sd, ubyte *packet, struct sockaddr_in *server,
|
|
uint16 *port, uint16 *blockno)
|
|
{
|
|
struct sockaddr_in from; /* The address the last UDP message recv'd from */
|
|
ssize_t nbytes; /* The number of bytes received. */
|
|
uint16 opcode; /* The received opcode */
|
|
uint16 rblockno; /* The received block number */
|
|
int packetlen; /* Packet length */
|
|
int retry; /* Retry counter */
|
|
|
|
/* Try up to TFTP_RETRIES times */
|
|
|
|
for (retry = 0; retry < TFTP_RETRIES; retry++)
|
|
{
|
|
/* Try for until a valid ACK is received or some error occurs */
|
|
|
|
for (;;)
|
|
{
|
|
/* Receive the next UDP packet from the server */
|
|
|
|
nbytes = tftp_recvfrom(sd, packet, TFTP_IOBUFSIZE, &from);
|
|
if (nbytes >= TFTP_ACKHEADERSIZE)
|
|
{
|
|
/* Get the port being used by the server if that has not yet been established */
|
|
|
|
if (!*port)
|
|
{
|
|
*port = from.sin_port;
|
|
server->sin_port = from.sin_port;
|
|
}
|
|
|
|
/* Verify that the packet was received from the correct host and port */
|
|
|
|
if (server->sin_addr.s_addr != from.sin_addr.s_addr)
|
|
{
|
|
nvdbg(g_tftpaddress, "recvfrom");
|
|
continue;
|
|
}
|
|
|
|
if (*port != server->sin_port)
|
|
{
|
|
nvdbg(g_tftpport, "recvfrom");
|
|
packetlen = tftp_mkerrpacket(packet, TFTP_ERR_UNKID, TFTP_ERRST_UNKID);
|
|
(void)tftp_sendto(sd, packet, packetlen, server);
|
|
continue;
|
|
}
|
|
|
|
/* Parse the error message */
|
|
|
|
opcode = (uint16)packet[0] << 8 | (uint16)packet[1];
|
|
rblockno = (uint16)packet[2] << 8 | (uint16)packet[3];
|
|
|
|
/* Verify that the message that we received is an ACK for the
|
|
* expected block number.
|
|
*/
|
|
|
|
if (opcode != TFTP_ACK)
|
|
{
|
|
nvdbg("Bad opcode%d\n");
|
|
#if defined(CONFIG_DEBUG) && defined(CONFIG_DEBUG_NET)
|
|
if (opcode == TFTP_ERR)
|
|
{
|
|
(void)tftp_parseerrpacket(packet);
|
|
}
|
|
else
|
|
#endif
|
|
if (opcode > TFTP_MAXRFC1350)
|
|
{
|
|
packetlen = tftp_mkerrpacket(packet, TFTP_ERR_ILLEGALOP, TFTP_ERRST_ILLEGALOP);
|
|
(void)tftp_sendto(sd, packet, packetlen, server);
|
|
}
|
|
|
|
/* Break out an bump up the retry count */
|
|
|
|
break;
|
|
}
|
|
|
|
/* Success! */
|
|
|
|
nvdbg("Received ACK for block %d\n", rblockno);
|
|
*blockno = rblockno;
|
|
return OK;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* We have tried TFTP_RETRIES times */
|
|
|
|
ndbg("Timeout, No ACK for block %d\n", blockno);
|
|
return ERROR; /* Will never get here */
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: tftpput
|
|
*
|
|
* Input Parameters:
|
|
* local - Path to the file system object to be sent.
|
|
* remote - The name of the file on the TFTP server.
|
|
* addr - The IP address of the server in network order
|
|
* binary - TRUE: Perform binary ('octect') transfer
|
|
* FALSE: Perform text ('netascii') transfer
|
|
*
|
|
****************************************************************************/
|
|
|
|
int tftpput(const char *local, const char *remote, in_addr_t addr, boolean binary)
|
|
{
|
|
struct sockaddr_in server; /* The address of the TFTP server */
|
|
boolean eof = FALSE; /* TRUE: at end of file */
|
|
ubyte *packet; /* Allocated memory to hold one packet */
|
|
uint16 blockno = 0; /* The current transfer block number */
|
|
uint16 rblockno; /* The ACK'ed block number */
|
|
uint16 port = 0; /* This is the port number for the transfer */
|
|
int packetlen; /* The length of the data packet */
|
|
int sd; /* Socket descriptor for socket I/O */
|
|
int fd; /* File descriptor for file I/O */
|
|
int result = ERROR; /* Assume failure */
|
|
int ret; /* Generic return status */
|
|
|
|
#if CONFIG_NETUTILS_TFTP_ACKPACKETS > 1
|
|
off_t offsets[TFTP_MAXACKPACKETS]; /* Offsets into source file (circular) */
|
|
int head; /* Head index into offsets[] */
|
|
int tail; /* Tail index into offsets[] */
|
|
int hblockno; /* Block number at the head of offsets[] */
|
|
int tmp; /* For temporary usage */
|
|
#else
|
|
off_t offset; /* Offset into source file */
|
|
off_t next; /* Offset to the next block */
|
|
#endif
|
|
|
|
/* Allocate the buffer to used for socket/disk I/O */
|
|
|
|
packet = (ubyte*)zalloc(TFTP_IOBUFSIZE);
|
|
if (!packet)
|
|
{
|
|
ndbg(g_tftpnomemory, "packet");
|
|
errno = ENOMEM;
|
|
goto errout;
|
|
}
|
|
|
|
/* Open the file for reading */
|
|
|
|
fd = open(local, O_RDONLY);
|
|
if (fd < 0)
|
|
{
|
|
ndbg(g_tftpcallfailed, "open", errno);
|
|
goto errout_with_packet;
|
|
}
|
|
|
|
/* Initialize a UDP socket and setup the server addresss */
|
|
|
|
sd = tftp_sockinit(&server, addr);
|
|
if (sd < 0)
|
|
{
|
|
goto errout_with_fd;
|
|
}
|
|
|
|
/* Send the write request */
|
|
|
|
packetlen = tftp_mkreqpacket(packet, TFTP_WRQ, remote, binary);
|
|
ret = tftp_sendto(sd, packet, packetlen, &server);
|
|
if (ret != packetlen)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
|
|
/* Receive the ACK for the write request */
|
|
|
|
(void)tftp_rcvack(sd, packet, &server, &port, NULL);
|
|
|
|
/* Then loop sending the entire file to the server in chunks */
|
|
|
|
#if CONFIG_NETUTILS_TFTP_ACKPACKETS > 1
|
|
head = 0;
|
|
tail = 0;
|
|
offsets[0] = 0;
|
|
hblockno = 1;
|
|
#else
|
|
offset = 0;
|
|
next = 0;
|
|
#endif
|
|
|
|
for (;;)
|
|
{
|
|
if (!eof)
|
|
{
|
|
#if CONFIG_NETUTILS_TFTP_ACKPACKETS > 1
|
|
/* Construct the next data packet */
|
|
|
|
packetlen = tftp_mkdatapacket(fd, offsets[tail], packet, blockno);
|
|
if (packetlen < 0)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
|
|
/* Check for end of file */
|
|
|
|
if (packetlen < TFTP_PACKETSIZE)
|
|
{
|
|
eof = TRUE;
|
|
}
|
|
|
|
/* Update counts */
|
|
|
|
blockno++;
|
|
|
|
/* Increment the tail (and probably the tail) index of the
|
|
* cicular offset list.
|
|
*/
|
|
|
|
tmp = tail;
|
|
tail = tftp_incrndx(tail);
|
|
|
|
/* Make sure that incrementing the tail doesn't make the
|
|
* buffer appear empty.
|
|
*/
|
|
|
|
if (head == tail)
|
|
{
|
|
head = tftp_incrndx(head);
|
|
hblockno++;
|
|
}
|
|
|
|
/* Now calculate the next file offset */
|
|
|
|
offsets[tail] = offsets[tmp] + packetlen;
|
|
#else
|
|
/* Construct the next data packet */
|
|
|
|
packetlen = tftp_mkdatapacket(fd, offset, packet, blockno);
|
|
if (packetlen < 0)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
|
|
/* Check for end of file */
|
|
|
|
if (packetlen < TFTP_PACKETSIZE)
|
|
{
|
|
eof = TRUE;
|
|
}
|
|
|
|
/* Now calculate the next file offset */
|
|
|
|
next = offset + packetlen;
|
|
#endif
|
|
|
|
/* Send the next data block */
|
|
|
|
ret = tftp_sendto(sd, packet, packetlen, &server);
|
|
if (ret != packetlen)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
}
|
|
|
|
/* Check for an ACK for any of the preceding data chunks */
|
|
|
|
#if CONFIG_NETUTILS_TFTP_ACKPACKETS > 1
|
|
if (blockno - hblockno >= CONFIG_NETUTILS_TFTP_ACKPACKETS || eof)
|
|
{
|
|
int ndx;
|
|
|
|
/* Get the next ACK from the wire */
|
|
|
|
if (tftp_rcvack(sd, packet, &server, &port, &rblockno) == OK)
|
|
{
|
|
while (hblockno < rblockno && tail != head)
|
|
{
|
|
head = tftp_incrndx(head);
|
|
hblockno++;
|
|
}
|
|
}
|
|
|
|
/* If we are at the end of the file and if all of the packets
|
|
* have been ACKed, then we are done.
|
|
*/
|
|
|
|
if (eof && head == tail)
|
|
{
|
|
break;
|
|
}
|
|
|
|
/* Otherwise, resend all un-acknowledged packets */
|
|
|
|
for (ndx = head, rblockno = hblockno;
|
|
ndx != tail;
|
|
ndx = tftp_incrndx(ndx), hblockno++)
|
|
{
|
|
/* Format the data packet, re-reading the data from the file */
|
|
|
|
packetlen = tftp_mkdatapacket(fd, offsets[ndx], packet, rblockno);
|
|
if (packetlen < 0)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
|
|
/* Re-send the data packet */
|
|
|
|
ret = tftp_sendto(sd, packet, packetlen, &server);
|
|
if (ret != packetlen)
|
|
{
|
|
goto errout_with_sd;
|
|
}
|
|
}
|
|
}
|
|
#else
|
|
/* Get the next ACK from the wire */
|
|
|
|
if (tftp_rcvack(sd, packet, &server, &port, &rblockno) == OK)
|
|
{
|
|
/* If we are at the end of the file and if all of the packets
|
|
* have been ACKed, then we are done.
|
|
*/
|
|
|
|
if (eof)
|
|
{
|
|
break;
|
|
}
|
|
|
|
/* Check if the packet that we just sent was ACK'ed. If not,
|
|
* we just loop to resend the same packet (same blockno, same
|
|
* file offset.
|
|
*/
|
|
|
|
if (rblockno == blockno)
|
|
{
|
|
/* Yes.. set up for the next block */
|
|
|
|
blockno++;
|
|
offset = next;
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/* Return success */
|
|
|
|
result = OK;
|
|
|
|
errout_with_sd:
|
|
close(sd);
|
|
errout_with_fd:
|
|
close(fd);
|
|
errout_with_packet:
|
|
free(packet);
|
|
errout:
|
|
return result;
|
|
}
|
|
|
|
#endif /* CONFIG_NET && CONFIG_NET_UDP && CONFIG_NFILE_DESCRIPTORS > 0 */
|