mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-08-20 22:25:33 +03:00
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@32672 3c298f89-4303-0410-b956-a3cf2f4a3e73
216 lines
5.8 KiB
C
216 lines
5.8 KiB
C
/* $OpenBSD: criov.c,v 1.9 2002/01/29 15:48:29 jason Exp $ */
|
|
|
|
/*
|
|
* Linux port done by David McCullough <david_mccullough@mcafee.com>
|
|
* Copyright (C) 2006-2010 David McCullough
|
|
* Copyright (C) 2004-2005 Intel Corporation.
|
|
* The license and original author are listed below.
|
|
*
|
|
* Copyright (c) 1999 Theo de Raadt
|
|
*
|
|
* 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. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* 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.
|
|
*
|
|
__FBSDID("$FreeBSD: src/sys/opencrypto/criov.c,v 1.5 2006/06/04 22:15:13 pjd Exp $");
|
|
*/
|
|
|
|
#include <linux/version.h>
|
|
#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,38) && !defined(AUTOCONF_INCLUDED)
|
|
#include <linux/config.h>
|
|
#endif
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/uio.h>
|
|
#include <linux/skbuff.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/mm.h>
|
|
#include <asm/io.h>
|
|
|
|
#include <uio.h>
|
|
#include <cryptodev.h>
|
|
|
|
/*
|
|
* This macro is only for avoiding code duplication, as we need to skip
|
|
* given number of bytes in the same way in three functions below.
|
|
*/
|
|
#define CUIO_SKIP() do { \
|
|
KASSERT(off >= 0, ("%s: off %d < 0", __func__, off)); \
|
|
KASSERT(len >= 0, ("%s: len %d < 0", __func__, len)); \
|
|
while (off > 0) { \
|
|
KASSERT(iol >= 0, ("%s: empty in skip", __func__)); \
|
|
if (off < iov->iov_len) \
|
|
break; \
|
|
off -= iov->iov_len; \
|
|
iol--; \
|
|
iov++; \
|
|
} \
|
|
} while (0)
|
|
|
|
void
|
|
cuio_copydata(struct uio* uio, int off, int len, caddr_t cp)
|
|
{
|
|
struct iovec *iov = uio->uio_iov;
|
|
int iol = uio->uio_iovcnt;
|
|
unsigned count;
|
|
|
|
CUIO_SKIP();
|
|
while (len > 0) {
|
|
KASSERT(iol >= 0, ("%s: empty", __func__));
|
|
count = min((int)(iov->iov_len - off), len);
|
|
memcpy(cp, ((caddr_t)iov->iov_base) + off, count);
|
|
len -= count;
|
|
cp += count;
|
|
off = 0;
|
|
iol--;
|
|
iov++;
|
|
}
|
|
}
|
|
|
|
void
|
|
cuio_copyback(struct uio* uio, int off, int len, caddr_t cp)
|
|
{
|
|
struct iovec *iov = uio->uio_iov;
|
|
int iol = uio->uio_iovcnt;
|
|
unsigned count;
|
|
|
|
CUIO_SKIP();
|
|
while (len > 0) {
|
|
KASSERT(iol >= 0, ("%s: empty", __func__));
|
|
count = min((int)(iov->iov_len - off), len);
|
|
memcpy(((caddr_t)iov->iov_base) + off, cp, count);
|
|
len -= count;
|
|
cp += count;
|
|
off = 0;
|
|
iol--;
|
|
iov++;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Return a pointer to iov/offset of location in iovec list.
|
|
*/
|
|
struct iovec *
|
|
cuio_getptr(struct uio *uio, int loc, int *off)
|
|
{
|
|
struct iovec *iov = uio->uio_iov;
|
|
int iol = uio->uio_iovcnt;
|
|
|
|
while (loc >= 0) {
|
|
/* Normal end of search */
|
|
if (loc < iov->iov_len) {
|
|
*off = loc;
|
|
return (iov);
|
|
}
|
|
|
|
loc -= iov->iov_len;
|
|
if (iol == 0) {
|
|
if (loc == 0) {
|
|
/* Point at the end of valid data */
|
|
*off = iov->iov_len;
|
|
return (iov);
|
|
} else
|
|
return (NULL);
|
|
} else {
|
|
iov++, iol--;
|
|
}
|
|
}
|
|
|
|
return (NULL);
|
|
}
|
|
|
|
EXPORT_SYMBOL(cuio_copyback);
|
|
EXPORT_SYMBOL(cuio_copydata);
|
|
EXPORT_SYMBOL(cuio_getptr);
|
|
|
|
static void
|
|
skb_copy_bits_back(struct sk_buff *skb, int offset, caddr_t cp, int len)
|
|
{
|
|
int i;
|
|
if (offset < skb_headlen(skb)) {
|
|
memcpy(skb->data + offset, cp, min_t(int, skb_headlen(skb), len));
|
|
len -= skb_headlen(skb);
|
|
cp += skb_headlen(skb);
|
|
}
|
|
offset -= skb_headlen(skb);
|
|
for (i = 0; len > 0 && i < skb_shinfo(skb)->nr_frags; i++) {
|
|
if (offset < skb_shinfo(skb)->frags[i].size) {
|
|
memcpy(page_address(skb_frag_page(&skb_shinfo(skb)->frags[i])) +
|
|
skb_shinfo(skb)->frags[i].page_offset,
|
|
cp, min_t(int, skb_shinfo(skb)->frags[i].size, len));
|
|
len -= skb_shinfo(skb)->frags[i].size;
|
|
cp += skb_shinfo(skb)->frags[i].size;
|
|
}
|
|
offset -= skb_shinfo(skb)->frags[i].size;
|
|
}
|
|
}
|
|
|
|
void
|
|
crypto_copyback(int flags, caddr_t buf, int off, int size, caddr_t in)
|
|
{
|
|
|
|
if ((flags & CRYPTO_F_SKBUF) != 0)
|
|
skb_copy_bits_back((struct sk_buff *)buf, off, in, size);
|
|
else if ((flags & CRYPTO_F_IOV) != 0)
|
|
cuio_copyback((struct uio *)buf, off, size, in);
|
|
else
|
|
bcopy(in, buf + off, size);
|
|
}
|
|
|
|
void
|
|
crypto_copydata(int flags, caddr_t buf, int off, int size, caddr_t out)
|
|
{
|
|
|
|
if ((flags & CRYPTO_F_SKBUF) != 0)
|
|
skb_copy_bits((struct sk_buff *)buf, off, out, size);
|
|
else if ((flags & CRYPTO_F_IOV) != 0)
|
|
cuio_copydata((struct uio *)buf, off, size, out);
|
|
else
|
|
bcopy(buf + off, out, size);
|
|
}
|
|
|
|
int
|
|
crypto_apply(int flags, caddr_t buf, int off, int len,
|
|
int (*f)(void *, void *, u_int), void *arg)
|
|
{
|
|
#if 0
|
|
int error;
|
|
|
|
if ((flags & CRYPTO_F_SKBUF) != 0)
|
|
error = XXXXXX((struct mbuf *)buf, off, len, f, arg);
|
|
else if ((flags & CRYPTO_F_IOV) != 0)
|
|
error = cuio_apply((struct uio *)buf, off, len, f, arg);
|
|
else
|
|
error = (*f)(arg, buf + off, len);
|
|
return (error);
|
|
#else
|
|
KASSERT(0, ("crypto_apply not implemented!\n"));
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
EXPORT_SYMBOL(crypto_copyback);
|
|
EXPORT_SYMBOL(crypto_copydata);
|
|
EXPORT_SYMBOL(crypto_apply);
|
|
|