1/* $NetBSD: criov.c,v 1.8 2011/02/24 19:28:03 drochner Exp $ */
2/* $OpenBSD: criov.c,v 1.11 2002/06/10 19:36:43 espie Exp $ */
3
4/*
5 * Copyright (c) 1999 Theo de Raadt
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
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 * 3. The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31#include <sys/cdefs.h>
32__KERNEL_RCSID(0, "$NetBSD: criov.c,v 1.8 2011/02/24 19:28:03 drochner Exp $");
33
34#include <sys/param.h>
35#include <sys/systm.h>
36#include <sys/proc.h>
37#include <sys/errno.h>
38#include <sys/malloc.h>
39#include <sys/kernel.h>
40#include <sys/mbuf.h>
41
42#include <uvm/uvm_extern.h>
43
44#include <opencrypto/cryptodev.h>
45int cuio_getindx(struct uio *uio, int loc, int *off);
46
47
48void
49cuio_copydata(struct uio *uio, int off, int len, void *cp)
50{
51 struct iovec *iov = uio->uio_iov;
52 int iol = uio->uio_iovcnt;
53 unsigned count;
54
55 if (off < 0)
56 panic("cuio_copydata: off %d < 0", off);
57 if (len < 0)
58 panic("cuio_copydata: len %d < 0", len);
59 while (off > 0) {
60 if (iol == 0)
61 panic("iov_copydata: empty in skip");
62 if (off < iov->iov_len)
63 break;
64 off -= iov->iov_len;
65 iol--;
66 iov++;
67 }
68 while (len > 0) {
69 if (iol == 0)
70 panic("cuio_copydata: empty");
71 count = min(iov->iov_len - off, len);
72 memcpy(cp, (char *)iov->iov_base + off, count);
73 len -= count;
74 cp = (char *)cp + count;
75 off = 0;
76 iol--;
77 iov++;
78 }
79}
80
81void
82cuio_copyback(struct uio *uio, int off, int len, void *cp)
83{
84 struct iovec *iov = uio->uio_iov;
85 int iol = uio->uio_iovcnt;
86 unsigned count;
87
88 if (off < 0)
89 panic("cuio_copyback: off %d < 0", off);
90 if (len < 0)
91 panic("cuio_copyback: len %d < 0", len);
92 while (off > 0) {
93 if (iol == 0) {
94#ifdef DEBUG
95 printf("cuio_copyback: empty in skip\n");
96#endif
97 return;
98 }
99 if (off < iov->iov_len)
100 break;
101 off -= iov->iov_len;
102 iol--;
103 iov++;
104 }
105 while (len > 0) {
106 if (iol == 0) {
107#ifdef DEBUG
108 printf("uio_copyback: empty\n");
109#endif
110 return;
111 }
112 count = min(iov->iov_len - off, len);
113 memcpy((char *)iov->iov_base + off, cp, count);
114 len -= count;
115 cp = (char *)cp + count;
116 off = 0;
117 iol--;
118 iov++;
119 }
120}
121
122/*
123 * Return a pointer to iov/offset of location in iovec list.
124 */
125
126int
127cuio_getptr(struct uio *uio, int loc, int *off)
128{
129 int ind, len;
130
131 ind = 0;
132 while (loc >= 0 && ind < uio->uio_iovcnt) {
133 len = uio->uio_iov[ind].iov_len;
134 if (len > loc) {
135 *off = loc;
136 return (ind);
137 }
138 loc -= len;
139 ind++;
140 }
141
142 if (ind > 0 && loc == 0) {
143 ind--;
144 *off = uio->uio_iov[ind].iov_len;
145 return (ind);
146 }
147
148 return (-1);
149}
150
151int
152cuio_apply(struct uio *uio, int off, int len,
153 int (*f)(void *, void *, unsigned int), void *fstate)
154{
155 int rval, ind, uiolen;
156 unsigned int count;
157
158 if (len < 0)
159 panic("%s: len %d < 0", __func__, len);
160 if (off < 0)
161 panic("%s: off %d < 0", __func__, off);
162
163 ind = 0;
164 while (off > 0) {
165 if (ind >= uio->uio_iovcnt)
166 panic("cuio_apply: out of ivecs before data in uio");
167 uiolen = uio->uio_iov[ind].iov_len;
168 if (off < uiolen)
169 break;
170 off -= uiolen;
171 ind++;
172 }
173 while (len > 0) {
174 if (ind >= uio->uio_iovcnt)
175 panic("cuio_apply: out of ivecs when processing uio");
176 count = min(uio->uio_iov[ind].iov_len - off, len);
177
178 rval = f(fstate,
179 ((char *)uio->uio_iov[ind].iov_base + off), count);
180 if (rval)
181 return (rval);
182
183 len -= count;
184 off = 0;
185 ind++;
186 }
187
188 return (0);
189}
190