OpenSolaris_b135/common/iscsi/base64.c

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright 2008 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

#include <sys/types.h>
#ifdef _KERNEL
#include <sys/sunddi.h>
#include <sys/errno.h>
#else
#include <string.h>
#include <errno.h>
#endif	/* _KERNEL */

/*
 * base64 decoding table (from uudecode.c)
 */
/* BEGIN CSTYLED */
 static char base64_decode_tab[] = {
	'\377', '\377', '\377', '\377', '\377', '\377', '\377', '\377',
	'\377', '\377', '\377', '\377', '\377', '\377', '\377', '\377',
	'\377', '\377', '\377', '\377', '\377', '\377', '\377', '\377',
	'\377', '\377', '\377', '\377', '\377', '\377', '\377', '\377',
	'\377', '\377', '\377', '\377', '\377', '\377', '\377', '\377',
	'\377', '\377', '\377',     62, '\377', '\377', '\377',     63,
	    52,     53,     54,     55,     56,     57,     58,     59,
	    60,     61, '\377', '\377', '\377', '\377', '\377', '\377',
	'\377',      0,      1,      2,      3,      4,      5,      6,
	     7,      8,      9,     10,     11,     12,     13,     14,
	    15,     16,     17,     18,     19,     20,     21,     22,
	    23,     24,     25, '\377', '\377', '\377', '\377', '\377',
	'\377',     26,     27,     28,     29,     30,     31,     32,
	    33,     34,     35,     36,     37,     38,     39,     40,
	    41,     42,     43,     44,     45,     46,     47,     48,
	    49,     50,     51, '\377', '\377', '\377', '\377', '\377'
};
/* END CSTYLED */

/* true if the character is in the base64 encoding table */
#define	validbase64(c) (('A' <= (c) && (c) <= 'Z') || \
		('a' <= (c) && (c) <= 'z') || \
		('0' <= (c) && (c) <= '9') || \
		(c) == '+' || (c) == '/')

static int
outdec64(unsigned char *out, unsigned char *chr, int num)
{

	unsigned char char1, char2, char3, char4;
	unsigned char *outptr = out;
	int rc = 0;

	switch (num) {
	case 0:
	case 1: 	/* these are impossible */
	default:
		break;
	case 2:		/* 2 base64 bytes == 1 decoded byte */
		char1 = base64_decode_tab[chr[0]] & 0xFF;
		char2 = base64_decode_tab[chr[1]] & 0xFF;
		*(outptr++) = ((char1 << 2) & 0xFC) |
		    ((char2 >> 4) & 0x03);
		rc = 1;
		break;
	case 3:		/* 3 base64 bytes == 2 decoded bytes */
		char1 = base64_decode_tab[chr[0]] & 0xFF;
		char2 = base64_decode_tab[chr[1]] & 0xFF;
		char3 = base64_decode_tab[chr[2]] & 0xFF;
		*(outptr++) = ((char1 << 2) & 0xFC) |
		    ((char2 >> 4) & 0x03);
		*(outptr++) = ((char2 << 4) & 0xF0) |
		    ((char3 >> 2) & 0x0F);
		rc = 2;
		break;
	case 4:		/* 4 base64 bytes == 3 decoded bytes */
		char1 = base64_decode_tab[chr[0]] & 0xFF;
		char2 = base64_decode_tab[chr[1]] & 0xFF;
		char3 = base64_decode_tab[chr[2]] & 0xFF;
		char4 = base64_decode_tab[chr[3]] & 0xFF;
		*(outptr++) = ((char1 << 2) & 0xFC) |
		    ((char2 >> 4) & 0x03);
		*(outptr++) = ((char2 << 4) & 0xF0) |
		    ((char3 >> 2) & 0x0F);
		*(outptr++) = ((char3 << 6) & 0xC0) |
		    (char4 & 0x3F);
		rc = 3;
		break;
	}
	return (rc);
}

#define	BUFSIZE	12

int
iscsi_base64_str_to_binary(char *hstr, int hstr_len,
    uint8_t *binary, int binary_buf_len, int *out_len)
{
	char	*iptr;
	uint8_t	tmp_out[BUFSIZE];
	int	octets, endseen, numbase64chars;
	unsigned char chr[4], curchr;

	/*
	 * base64 decode algorith, adapted from uudecode.c
	 *
	 * A valid base64 string is a multiple of 4 bytes in length
	 */
	if ((hstr_len % 4) != 0)
		return (EINVAL);

	endseen = numbase64chars = 0;
	*out_len = 0;
	iptr = hstr;

	while (((curchr = *(iptr++)) != NULL) &&
	    (((uintptr_t)iptr - (uintptr_t)hstr) <= hstr_len)) {
		/* decode chars */
		if (curchr == '=') /* if end */
			endseen++;

		if (validbase64(curchr))
			chr[numbase64chars++] = curchr;
		/*
		 * if we've gathered 4 base64 octets
		 * we need to decode and output them
		 */
		if (numbase64chars == 4) {
			octets = outdec64(tmp_out, chr, 4);
			numbase64chars = 0;

			if (*out_len + octets > binary_buf_len)
				return (E2BIG);

			(void) memcpy(binary + *out_len, tmp_out, octets);
			*out_len += octets;
		}

		/*
		 * handle any remaining base64 octets at end
		 */
		if (endseen && numbase64chars > 0) {
			octets = outdec64(tmp_out, chr, numbase64chars);
			numbase64chars = 0;
			if (*out_len + octets > binary_buf_len)
				return (E2BIG);

			(void) memcpy(binary + *out_len, tmp_out, octets);
			*out_len += octets;
		}
	}

	return (0);
}


static char base64_encode_tab[] =
	"ABCDEFGHIJKLMNOPQRSTUVWXYZ"
	"abcdefghijklmnopqrstuvwxyz0123456789+/";

#define	ENC(c)	base64_encode_tab[(c) & 0x3f]

#define	BASE64_BUF_HAS_ROOM(bytes_needed) \
	((optr + (bytes_needed)) <= base64_str_buf + base64_buf_len)

int
iscsi_binary_to_base64_str(uint8_t *in_buf, int in_buf_len,
    char *base64_str_buf, int base64_buf_len)
{
	uint8_t 	*iptr;
	char		*optr;
	int		in_bytes_remaining;

	/* base64 encode algorith, adapted from uuencode.c */
	iptr = in_buf;
	optr = base64_str_buf;

	/*
	 * read must be a multiple of 3 bytes for
	 * this algorithm to work, and also must
	 * be small enough that read_size * (4/3)
	 * will always be 76 bytes or less, since
	 * base64 lines can be no longer than that
	 */
	while (iptr + 3 <= in_buf + in_buf_len) {
		if (!BASE64_BUF_HAS_ROOM(4))
			return (E2BIG);

		*(optr++) = ENC(*iptr >> 2);
		*(optr++) = ENC((*iptr << 4) & 060 |
		    (*(iptr + 1) >> 4) & 017);
		*(optr++) = ENC((*(iptr + 1) << 2)
		    & 074 | (*(iptr + 2) >> 6) & 03);
		*(optr++) = ENC(*(iptr + 2) & 077);

		iptr += 3;
	}

	/* need output padding ? */
	in_bytes_remaining = ((uintptr_t)in_buf + in_buf_len) - (uintptr_t)iptr;
	/* ASSERT(in_bytes_remaining < 3); */
	switch (in_bytes_remaining) {
	case 0:
		/* no-op  - 24 bits of data encoded */
		if (!BASE64_BUF_HAS_ROOM(1))
			return (E2BIG);
		*(optr++) = '\0';
		break;
	case 1:
		/* 8 bits encoded - pad with 2 '=' */
		if (!BASE64_BUF_HAS_ROOM(5))
			return (E2BIG);
		*(optr++) = ENC((*iptr & 0xFC) >> 2);
		*(optr++) = ENC((*iptr & 0x03) << 4);
		*(optr++) = '=';
		*(optr++) = '=';
		*(optr++) = '\0';
		break;
	case 2:
		/* 16 bits encoded - pad with 1 '=' */
		if (!BASE64_BUF_HAS_ROOM(5))
			return (E2BIG);
		*(optr++) = ENC((*iptr & 0xFC) >> 2);
		*(optr++) = ENC(((*iptr & 0x03) << 4) |
		    ((*(iptr + 1) & 0xF0) >> 4));
		*(optr++) = ENC((*(iptr + 1) & 0x0F) << 2);
		*(optr++) = '=';
		*(optr++) = '\0';
		break;
	default:
		/* impossible */
		break;
	}

	return (0);
}