336 lines
8.0 KiB
C
336 lines
8.0 KiB
C
/* $NetBSD: des_cbc.c,v 1.2 2000/08/31 07:33:04 itojun Exp $ */
|
|
/* $KAME: des_cbc.c,v 1.5 2000/08/31 07:27:27 itojun Exp $ */
|
|
|
|
/*
|
|
* heavily modified by Yoshifumi Nishida <nishida@sfc.wide.ad.jp>.
|
|
* then, completely rewrote by Jun-ichiro itojun Itoh <itojun@itojun.org>,
|
|
* 1997.
|
|
*/
|
|
/* crypto/des/cbc_enc.c */
|
|
/* Copyright (C) 1995-1996 Eric Young (eay@mincom.oz.au)
|
|
* All rights reserved.
|
|
*
|
|
* This file is part of an SSL implementation written
|
|
* by Eric Young (eay@mincom.oz.au).
|
|
* The implementation was written so as to conform with Netscapes SSL
|
|
* specification. This library and applications are
|
|
* FREE FOR COMMERCIAL AND NON-COMMERCIAL USE
|
|
* as long as the following conditions are aheared to.
|
|
*
|
|
* Copyright remains Eric Young's, and as such any Copyright notices in
|
|
* the code are not to be removed. If this code is used in a product,
|
|
* Eric Young should be given attribution as the author of the parts used.
|
|
* This can be in the form of a textual message at program startup or
|
|
* in documentation (online or textual) provided with the package.
|
|
*
|
|
* 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 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. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Eric Young (eay@mincom.oz.au)
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY ERIC YOUNG ``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 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, 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.
|
|
*
|
|
* The licence and distribution terms for any publically available version or
|
|
* derivative of this code cannot be changed. i.e. this code cannot simply be
|
|
* copied and put under another distribution licence
|
|
* [including the GNU Public Licence.]
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/mbuf.h>
|
|
#include <crypto/des/des_locl.h>
|
|
|
|
#define panic(x) do {printf(x); return EINVAL;} while (0)
|
|
|
|
int des_cbc_encrypt(m0, skip, length, schedule, ivec, mode)
|
|
struct mbuf *m0;
|
|
size_t skip;
|
|
size_t length;
|
|
des_key_schedule schedule;
|
|
des_cblock (*ivec);
|
|
int mode;
|
|
{
|
|
u_int8_t inbuf[8], outbuf[8];
|
|
struct mbuf *m;
|
|
size_t off;
|
|
register DES_LONG tin0, tin1;
|
|
register DES_LONG tout0, tout1;
|
|
DES_LONG tin[2];
|
|
u_int8_t *iv;
|
|
|
|
/* sanity checks */
|
|
if (m0->m_pkthdr.len < skip) {
|
|
printf("mbuf length < skip\n");
|
|
return EINVAL;
|
|
}
|
|
if (m0->m_pkthdr.len < length) {
|
|
printf("mbuf length < encrypt length\n");
|
|
return EINVAL;
|
|
}
|
|
if (m0->m_pkthdr.len < skip + length) {
|
|
printf("mbuf length < skip + encrypt length\n");
|
|
return EINVAL;
|
|
}
|
|
if (length % 8) {
|
|
printf("length is not multiple of 8\n");
|
|
return EINVAL;
|
|
}
|
|
|
|
m = m0;
|
|
off = 0;
|
|
|
|
/* skip over the header */
|
|
while (skip) {
|
|
if (!m)
|
|
panic("mbuf chain?\n");
|
|
if (m->m_len <= skip) {
|
|
skip -= m->m_len;
|
|
m = m->m_next;
|
|
off = 0;
|
|
} else {
|
|
off = skip;
|
|
skip = 0;
|
|
}
|
|
}
|
|
|
|
/* initialize */
|
|
tin0 = tin1 = tout0 = tout1 = 0;
|
|
tin[0] = tin[1] = 0;
|
|
|
|
if (mode == DES_ENCRYPT) {
|
|
u_int8_t *in, *out;
|
|
|
|
iv = (u_int8_t *)ivec;
|
|
c2l(iv, tout0);
|
|
c2l(iv, tout1);
|
|
|
|
while (0 < length) {
|
|
if (!m)
|
|
panic("mbuf chain?\n");
|
|
|
|
/*
|
|
* copy the source into input buffer.
|
|
* don't update off or m, since we need to use them * later.
|
|
*/
|
|
if (off + 8 <= m->m_len)
|
|
bcopy(mtod(m, u_int8_t *) + off, &inbuf[0], 8);
|
|
else {
|
|
struct mbuf *n;
|
|
size_t noff;
|
|
u_int8_t *p;
|
|
u_int8_t *in;
|
|
|
|
n = m;
|
|
noff = off;
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
|
|
in = &inbuf[0];
|
|
while (in - &inbuf[0] < 8) {
|
|
if (!p)
|
|
panic("mbuf chain?\n");
|
|
|
|
*in++ = *p++;
|
|
noff++;
|
|
if (noff < n->m_len)
|
|
continue;
|
|
do {
|
|
n = n->m_next;
|
|
} while (n && ! n->m_len);
|
|
noff = 0;
|
|
if (n)
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
else
|
|
p = NULL;
|
|
}
|
|
}
|
|
|
|
in = &inbuf[0];
|
|
out = &outbuf[0];
|
|
c2l(in, tin0);
|
|
c2l(in, tin1);
|
|
|
|
tin0 ^= tout0; tin[0] = tin0;
|
|
tin1 ^= tout1; tin[1] = tin1;
|
|
des_encrypt((DES_LONG *)tin, schedule, DES_ENCRYPT);
|
|
tout0 = tin[0]; l2c(tout0, out);
|
|
tout1 = tin[1]; l2c(tout1, out);
|
|
|
|
/*
|
|
* copy the output buffer into the result.
|
|
* need to update off and m.
|
|
*/
|
|
if (off + 8 < m->m_len) {
|
|
bcopy(&outbuf[0], mtod(m, u_int8_t *) + off, 8);
|
|
off += 8;
|
|
} else if (off + 8 == m->m_len) {
|
|
bcopy(&outbuf[0], mtod(m, u_int8_t *) + off, 8);
|
|
do {
|
|
m = m->m_next;
|
|
} while (m && ! m->m_len);
|
|
off = 0;
|
|
} else {
|
|
struct mbuf *n;
|
|
size_t noff;
|
|
u_int8_t *p;
|
|
u_int8_t *out;
|
|
|
|
n = m;
|
|
noff = off;
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
|
|
out = &outbuf[0];
|
|
while (out - &outbuf[0] < 8) {
|
|
if (!p)
|
|
panic("mbuf chain?");
|
|
*p++ = *out++;
|
|
noff++;
|
|
if (noff < n->m_len)
|
|
continue;
|
|
do {
|
|
n = n->m_next;
|
|
} while (n && ! n->m_len);
|
|
noff = 0;
|
|
if (n)
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
else
|
|
p = NULL;
|
|
}
|
|
|
|
m = n;
|
|
off = noff;
|
|
}
|
|
|
|
length -= 8;
|
|
}
|
|
} else if (mode == DES_DECRYPT) {
|
|
register DES_LONG xor0, xor1;
|
|
u_int8_t *in, *out;
|
|
|
|
xor0 = xor1 = 0;
|
|
iv = (u_int8_t *)ivec;
|
|
c2l(iv, xor0);
|
|
c2l(iv, xor1);
|
|
|
|
while (0 < length) {
|
|
if (!m)
|
|
panic("mbuf chain?\n");
|
|
|
|
/*
|
|
* copy the source into input buffer.
|
|
* don't update off or m, since we need to use them * later.
|
|
*/
|
|
if (off + 8 <= m->m_len)
|
|
bcopy(mtod(m, u_int8_t *) + off, &inbuf[0], 8);
|
|
else {
|
|
struct mbuf *n;
|
|
size_t noff;
|
|
u_int8_t *p;
|
|
u_int8_t *in;
|
|
|
|
n = m;
|
|
noff = off;
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
|
|
in = &inbuf[0];
|
|
while (in - &inbuf[0] < 8) {
|
|
if (!p)
|
|
panic("mbuf chain?\n");
|
|
*in++ = *p++;
|
|
noff++;
|
|
if (noff < n->m_len)
|
|
continue;
|
|
do {
|
|
n = n->m_next;
|
|
} while (n && ! n->m_len);
|
|
noff = 0;
|
|
if (n)
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
else
|
|
p = NULL;
|
|
}
|
|
}
|
|
|
|
in = &inbuf[0];
|
|
out = &outbuf[0];
|
|
c2l(in, tin0); tin[0] = tin0;
|
|
c2l(in, tin1); tin[1] = tin1;
|
|
des_encrypt((DES_LONG *)tin, schedule, DES_DECRYPT);
|
|
tout0 = tin[0] ^ xor0;
|
|
tout1 = tin[1] ^ xor1;
|
|
l2c(tout0, out);
|
|
l2c(tout1, out);
|
|
xor0 = tin0;
|
|
xor1 = tin1;
|
|
|
|
|
|
/*
|
|
* copy the output buffer into the result.
|
|
* need to update off and m.
|
|
*/
|
|
if (off + 8 < m->m_len) {
|
|
bcopy(&outbuf[0], mtod(m, u_int8_t *) + off, 8);
|
|
off += 8;
|
|
} else if (off + 8 == m->m_len) {
|
|
bcopy(&outbuf[0], mtod(m, u_int8_t *) + off, 8);
|
|
do {
|
|
m = m->m_next;
|
|
} while (m && ! m->m_len);
|
|
off = 0;
|
|
} else {
|
|
struct mbuf *n;
|
|
size_t noff;
|
|
u_int8_t *p;
|
|
u_int8_t *out;
|
|
|
|
n = m;
|
|
noff = off;
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
|
|
out = &outbuf[0];
|
|
while (out - &outbuf[0] < 8) {
|
|
if (!p)
|
|
panic("mbuf chain?\n");
|
|
*p++ = *out++;
|
|
noff++;
|
|
if (noff < n->m_len)
|
|
continue;
|
|
do {
|
|
n = n->m_next;
|
|
} while (n && ! n->m_len);
|
|
noff = 0;
|
|
if (n)
|
|
p = mtod(n, u_int8_t *) + noff;
|
|
else
|
|
p = NULL;
|
|
}
|
|
|
|
m = n;
|
|
off = noff;
|
|
}
|
|
|
|
length -= 8;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|