[openssh.git] / atomicio.c

/* $OpenBSD: atomicio.c,v 1.22 2006/07/26 02:35:17 stevesk Exp $ */
/*
 * Copyright (c) 2006 Damien Miller. All rights reserved.
 * Copyright (c) 2005 Anil Madhavapeddy. All rights reserved.
 * Copyright (c) 1995,1999 Theo de Raadt.  All rights reserved.
 * All rights reserved.
 *
 * 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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,
 * 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.
 */

#include "includes.h"

#include <sys/param.h>

#include <errno.h>
#include <string.h>

#include "atomicio.h"

/*
 * ensure all of data on socket comes through. f==read || f==vwrite
 */
size_t
atomicio(ssize_t (*f) (int, void *, size_t), int fd, void *_s, size_t n)
{
	char *s = _s;
	size_t pos = 0;
	ssize_t res;

	while (n > pos) {
		res = (f) (fd, s + pos, n - pos);
		switch (res) {
		case -1:
#ifdef EWOULDBLOCK
			if (errno == EINTR || errno == EAGAIN || errno == EWOULDBLOCK)
#else
			if (errno == EINTR || errno == EAGAIN)
#endif
				continue;
			return 0;
		case 0:
			errno = EPIPE;
			return pos;
		default:
			pos += (size_t)res;
		}
	}
	return (pos);
}

/*
 * ensure all of data on socket comes through. f==readv || f==writev
 */
size_t
atomiciov(ssize_t (*f) (int, const struct iovec *, int), int fd,
    const struct iovec *_iov, int iovcnt)
{
	size_t pos = 0, rem;
	ssize_t res;
	struct iovec iov_array[IOV_MAX], *iov = iov_array;

	if (iovcnt > IOV_MAX) {
		errno = EINVAL;
		return 0;
	}
	/* Make a copy of the iov array because we may modify it below */
	memcpy(iov, _iov, iovcnt * sizeof(*_iov));

	for (; iovcnt > 0 && iov[0].iov_len > 0;) {
		res = (f) (fd, iov, iovcnt);
		switch (res) {
		case -1:
			if (errno == EINTR || errno == EAGAIN)
				continue;
			return 0;
		case 0:
			errno = EPIPE;
			return pos;
		default:
			rem = (size_t)res;
			pos += rem;
			/* skip completed iov entries */
			while (iovcnt > 0 && rem >= iov[0].iov_len) {
				rem -= iov[0].iov_len;
				iov++;
				iovcnt--;
			}
			/* This shouldn't happen... */
			if (rem > 0 && (iovcnt <= 0 || rem > iov[0].iov_len)) {
				errno = EFAULT;
				return 0;
			}
			if (iovcnt == 0)
				break;
			/* update pointer in partially complete iov */
			iov[0].iov_base = ((char *)iov[0].iov_base) + rem;
			iov[0].iov_len -= rem;
		}
	}
	return pos;
}
Commit	Line	Data
536c14e8	1	/* $OpenBSD: atomicio.c,v 1.22 2006/07/26 02:35:17 stevesk Exp $ */
521b3913	2	/*
68d86b37	3	* Copyright (c) 2006 Damien Miller. All rights reserved.
05624c18	4	* Copyright (c) 2005 Anil Madhavapeddy. All rights reserved.
f3c7c613	5	* Copyright (c) 1995,1999 Theo de Raadt. All rights reserved.
521b3913	6	* All rights reserved.
	7	*
	8	* Redistribution and use in source and binary forms, with or without
	9	* modification, are permitted provided that the following conditions
	10	* are met:
	11	* 1. Redistributions of source code must retain the above copyright
	12	* notice, this list of conditions and the following disclaimer.
	13	* 2. Redistributions in binary form must reproduce the above copyright
	14	* notice, this list of conditions and the following disclaimer in the
	15	* documentation and/or other materials provided with the distribution.
	16	*
	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	27	*/
	28
	29	#include "includes.h"
521b3913	30
536c14e8	31	#include <sys/param.h>
536c14e8	32
028094f4	33	#include <errno.h>
00146caa	34	#include <string.h>
028094f4	35
42f11eb2	36	#include "atomicio.h"
521b3913	37
521b3913	38	/*
4899ccef	39	* ensure all of data on socket comes through. f==read \|\| f==vwrite
521b3913	40	*/
05624c18	41	size_t
433a97dd	42	atomicio(ssize_t (f) (int, void , size_t), int fd, void *_s, size_t n)
521b3913	43	{
610cd5c6	44	char *s = _s;
05624c18	45	size_t pos = 0;
05624c18	46	ssize_t res;
521b3913	47
521b3913	48	while (n > pos) {
35484284	49	res = (f) (fd, s + pos, n - pos);
521b3913	50	switch (res) {
521b3913	51	case -1:
b28e4a3b	52	#ifdef EWOULDBLOCK
	53	if (errno == EINTR \|\| errno == EAGAIN \|\| errno == EWOULDBLOCK)
	54	#else
521b3913	55	if (errno == EINTR \|\| errno == EAGAIN)
b28e4a3b	56	#endif
521b3913	57	continue;
05624c18	58	return 0;
521b3913	59	case 0:
05624c18	60	errno = EPIPE;
05624c18	61	return pos;
521b3913	62	default:
cfb9181c	63	pos += (size_t)res;
521b3913	64	}
	65	}
	66	return (pos);
	67	}
68d86b37	68
	69	/*
	70	* ensure all of data on socket comes through. f==readv \|\| f==writev
	71	*/
	72	size_t
	73	atomiciov(ssize_t (f) (int, const struct iovec , int), int fd,
	74	const struct iovec *_iov, int iovcnt)
	75	{
	76	size_t pos = 0, rem;
	77	ssize_t res;
	78	struct iovec iov_array[IOV_MAX], *iov = iov_array;
	79
	80	if (iovcnt > IOV_MAX) {
	81	errno = EINVAL;
	82	return 0;
	83	}
	84	/* Make a copy of the iov array because we may modify it below */
	85	memcpy(iov, _iov, iovcnt * sizeof(*_iov));
	86
	87	for (; iovcnt > 0 && iov[0].iov_len > 0;) {
	88	res = (f) (fd, iov, iovcnt);
	89	switch (res) {
	90	case -1:
	91	if (errno == EINTR \|\| errno == EAGAIN)
	92	continue;
	93	return 0;
	94	case 0:
	95	errno = EPIPE;
	96	return pos;
	97	default:
	98	rem = (size_t)res;
	99	pos += rem;
	100	/* skip completed iov entries */
	101	while (iovcnt > 0 && rem >= iov[0].iov_len) {
	102	rem -= iov[0].iov_len;
	103	iov++;
	104	iovcnt--;
	105	}
	106	/* This shouldn't happen... */
7bccebd0	107	if (rem > 0 && (iovcnt <= 0 \|\| rem > iov[0].iov_len)) {
68d86b37	108	errno = EFAULT;
	109	return 0;
	110	}
	111	if (iovcnt == 0)
	112	break;
	113	/* update pointer in partially complete iov */
	114	iov[0].iov_base = ((char *)iov[0].iov_base) + rem;
	115	iov[0].iov_len -= rem;
	116	}
	117	}
	118	return pos;
	119	}