128993443SEd Schouten /*-
251369649SPedro F. Giffuni * SPDX-License-Identifier: BSD-3-Clause
351369649SPedro F. Giffuni *
428993443SEd Schouten * Copyright (c) 1982, 1986, 1991, 1993
528993443SEd Schouten * The Regents of the University of California. All rights reserved.
628993443SEd Schouten * (c) UNIX System Laboratories, Inc.
728993443SEd Schouten * All or some portions of this file are derived from material licensed
828993443SEd Schouten * to the University of California by American Telephone and Telegraph
928993443SEd Schouten * Co. or Unix System Laboratories, Inc. and are reproduced herein with
1028993443SEd Schouten * the permission of UNIX System Laboratories, Inc.
1128993443SEd Schouten *
124f3dc900SKonstantin Belousov * Copyright (c) 2014 The FreeBSD Foundation
134f3dc900SKonstantin Belousov *
144f3dc900SKonstantin Belousov * Portions of this software were developed by Konstantin Belousov
154f3dc900SKonstantin Belousov * under sponsorship from the FreeBSD Foundation.
164f3dc900SKonstantin Belousov *
1728993443SEd Schouten * Redistribution and use in source and binary forms, with or without
1828993443SEd Schouten * modification, are permitted provided that the following conditions
1928993443SEd Schouten * are met:
2028993443SEd Schouten * 1. Redistributions of source code must retain the above copyright
2128993443SEd Schouten * notice, this list of conditions and the following disclaimer.
2228993443SEd Schouten * 2. Redistributions in binary form must reproduce the above copyright
2328993443SEd Schouten * notice, this list of conditions and the following disclaimer in the
2428993443SEd Schouten * documentation and/or other materials provided with the distribution.
2569a28758SEd Maste * 3. Neither the name of the University nor the names of its contributors
2628993443SEd Schouten * may be used to endorse or promote products derived from this software
2728993443SEd Schouten * without specific prior written permission.
2828993443SEd Schouten *
2928993443SEd Schouten * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
3028993443SEd Schouten * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
3128993443SEd Schouten * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
3228993443SEd Schouten * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
3328993443SEd Schouten * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
3428993443SEd Schouten * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
3528993443SEd Schouten * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
3628993443SEd Schouten * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
3728993443SEd Schouten * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
3828993443SEd Schouten * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
3928993443SEd Schouten * SUCH DAMAGE.
4028993443SEd Schouten */
4128993443SEd Schouten
4228993443SEd Schouten #include <sys/param.h>
4328993443SEd Schouten #include <sys/systm.h>
4428993443SEd Schouten #include <sys/kernel.h>
4528993443SEd Schouten #include <sys/limits.h>
4628993443SEd Schouten #include <sys/lock.h>
470f502d1cSKonstantin Belousov #include <sys/mman.h>
4828993443SEd Schouten #include <sys/proc.h>
490f502d1cSKonstantin Belousov #include <sys/resourcevar.h>
5089f6b863SAttilio Rao #include <sys/rwlock.h>
5128993443SEd Schouten #include <sys/sched.h>
5228993443SEd Schouten #include <sys/sysctl.h>
5328993443SEd Schouten #include <sys/vnode.h>
5428993443SEd Schouten
5528993443SEd Schouten #include <vm/vm.h>
561c771f92SKonstantin Belousov #include <vm/vm_param.h>
570f502d1cSKonstantin Belousov #include <vm/vm_extern.h>
5828993443SEd Schouten #include <vm/vm_page.h>
59e946b949SAttilio Rao #include <vm/vm_pageout.h>
6028993443SEd Schouten #include <vm/vm_map.h>
6128993443SEd Schouten
62a9934668SKenneth D. Merry #include <machine/bus.h>
63a9934668SKenneth D. Merry
64f0188618SHans Petter Selasky SYSCTL_INT(_kern, KERN_IOV_MAX, iov_max, CTLFLAG_RD, SYSCTL_NULL_INT_PTR, UIO_MAXIOV,
6528993443SEd Schouten "Maximum number of elements in an I/O vector; sysconf(_SC_IOV_MAX)");
6628993443SEd Schouten
672801687dSKonstantin Belousov static int uiomove_faultflag(void *cp, int n, struct uio *uio, int nofault);
682801687dSKonstantin Belousov
6928993443SEd Schouten int
copyin_nofault(const void * udaddr,void * kaddr,size_t len)702801687dSKonstantin Belousov copyin_nofault(const void *udaddr, void *kaddr, size_t len)
712801687dSKonstantin Belousov {
722801687dSKonstantin Belousov int error, save;
732801687dSKonstantin Belousov
742801687dSKonstantin Belousov save = vm_fault_disable_pagefaults();
752801687dSKonstantin Belousov error = copyin(udaddr, kaddr, len);
762801687dSKonstantin Belousov vm_fault_enable_pagefaults(save);
772801687dSKonstantin Belousov return (error);
782801687dSKonstantin Belousov }
792801687dSKonstantin Belousov
802801687dSKonstantin Belousov int
copyout_nofault(const void * kaddr,void * udaddr,size_t len)812801687dSKonstantin Belousov copyout_nofault(const void *kaddr, void *udaddr, size_t len)
822801687dSKonstantin Belousov {
832801687dSKonstantin Belousov int error, save;
842801687dSKonstantin Belousov
852801687dSKonstantin Belousov save = vm_fault_disable_pagefaults();
862801687dSKonstantin Belousov error = copyout(kaddr, udaddr, len);
872801687dSKonstantin Belousov vm_fault_enable_pagefaults(save);
882801687dSKonstantin Belousov return (error);
892801687dSKonstantin Belousov }
902801687dSKonstantin Belousov
91dd0b4fb6SKonstantin Belousov #define PHYS_PAGE_COUNT(len) (howmany(len, PAGE_SIZE) + 1)
92dd0b4fb6SKonstantin Belousov
93dd0b4fb6SKonstantin Belousov int
physcopyin(void * src,vm_paddr_t dst,size_t len)94dd0b4fb6SKonstantin Belousov physcopyin(void *src, vm_paddr_t dst, size_t len)
95dd0b4fb6SKonstantin Belousov {
96dd0b4fb6SKonstantin Belousov vm_page_t m[PHYS_PAGE_COUNT(len)];
97dd0b4fb6SKonstantin Belousov struct iovec iov[1];
98dd0b4fb6SKonstantin Belousov struct uio uio;
99dd0b4fb6SKonstantin Belousov int i;
100dd0b4fb6SKonstantin Belousov
101dd0b4fb6SKonstantin Belousov iov[0].iov_base = src;
102dd0b4fb6SKonstantin Belousov iov[0].iov_len = len;
103dd0b4fb6SKonstantin Belousov uio.uio_iov = iov;
104dd0b4fb6SKonstantin Belousov uio.uio_iovcnt = 1;
105dd0b4fb6SKonstantin Belousov uio.uio_offset = 0;
106dd0b4fb6SKonstantin Belousov uio.uio_resid = len;
107dd0b4fb6SKonstantin Belousov uio.uio_segflg = UIO_SYSSPACE;
108dd0b4fb6SKonstantin Belousov uio.uio_rw = UIO_WRITE;
109dd0b4fb6SKonstantin Belousov for (i = 0; i < PHYS_PAGE_COUNT(len); i++, dst += PAGE_SIZE)
110dd0b4fb6SKonstantin Belousov m[i] = PHYS_TO_VM_PAGE(dst);
111dd0b4fb6SKonstantin Belousov return (uiomove_fromphys(m, dst & PAGE_MASK, len, &uio));
112dd0b4fb6SKonstantin Belousov }
113dd0b4fb6SKonstantin Belousov
114dd0b4fb6SKonstantin Belousov int
physcopyout(vm_paddr_t src,void * dst,size_t len)115dd0b4fb6SKonstantin Belousov physcopyout(vm_paddr_t src, void *dst, size_t len)
116dd0b4fb6SKonstantin Belousov {
117dd0b4fb6SKonstantin Belousov vm_page_t m[PHYS_PAGE_COUNT(len)];
118dd0b4fb6SKonstantin Belousov struct iovec iov[1];
119dd0b4fb6SKonstantin Belousov struct uio uio;
120dd0b4fb6SKonstantin Belousov int i;
121dd0b4fb6SKonstantin Belousov
122dd0b4fb6SKonstantin Belousov iov[0].iov_base = dst;
123dd0b4fb6SKonstantin Belousov iov[0].iov_len = len;
124dd0b4fb6SKonstantin Belousov uio.uio_iov = iov;
125dd0b4fb6SKonstantin Belousov uio.uio_iovcnt = 1;
126dd0b4fb6SKonstantin Belousov uio.uio_offset = 0;
127dd0b4fb6SKonstantin Belousov uio.uio_resid = len;
128dd0b4fb6SKonstantin Belousov uio.uio_segflg = UIO_SYSSPACE;
129dd0b4fb6SKonstantin Belousov uio.uio_rw = UIO_READ;
130dd0b4fb6SKonstantin Belousov for (i = 0; i < PHYS_PAGE_COUNT(len); i++, src += PAGE_SIZE)
131dd0b4fb6SKonstantin Belousov m[i] = PHYS_TO_VM_PAGE(src);
132dd0b4fb6SKonstantin Belousov return (uiomove_fromphys(m, src & PAGE_MASK, len, &uio));
133dd0b4fb6SKonstantin Belousov }
134dd0b4fb6SKonstantin Belousov
135dd0b4fb6SKonstantin Belousov #undef PHYS_PAGE_COUNT
136dd0b4fb6SKonstantin Belousov
1372801687dSKonstantin Belousov int
physcopyin_vlist(bus_dma_segment_t * src,off_t offset,vm_paddr_t dst,size_t len)138a9934668SKenneth D. Merry physcopyin_vlist(bus_dma_segment_t *src, off_t offset, vm_paddr_t dst,
139a9934668SKenneth D. Merry size_t len)
140a9934668SKenneth D. Merry {
141a9934668SKenneth D. Merry size_t seg_len;
142a9934668SKenneth D. Merry int error;
143a9934668SKenneth D. Merry
144a9934668SKenneth D. Merry error = 0;
145a9934668SKenneth D. Merry while (offset >= src->ds_len) {
146a9934668SKenneth D. Merry offset -= src->ds_len;
147a9934668SKenneth D. Merry src++;
148a9934668SKenneth D. Merry }
149a9934668SKenneth D. Merry
150a9934668SKenneth D. Merry while (len > 0 && error == 0) {
151a9934668SKenneth D. Merry seg_len = MIN(src->ds_len - offset, len);
152a9934668SKenneth D. Merry error = physcopyin((void *)(uintptr_t)(src->ds_addr + offset),
153a9934668SKenneth D. Merry dst, seg_len);
154a9934668SKenneth D. Merry offset = 0;
155a9934668SKenneth D. Merry src++;
156a9934668SKenneth D. Merry len -= seg_len;
157a9934668SKenneth D. Merry dst += seg_len;
158a9934668SKenneth D. Merry }
159a9934668SKenneth D. Merry
160a9934668SKenneth D. Merry return (error);
161a9934668SKenneth D. Merry }
162a9934668SKenneth D. Merry
163a9934668SKenneth D. Merry int
physcopyout_vlist(vm_paddr_t src,bus_dma_segment_t * dst,off_t offset,size_t len)164a9934668SKenneth D. Merry physcopyout_vlist(vm_paddr_t src, bus_dma_segment_t *dst, off_t offset,
165a9934668SKenneth D. Merry size_t len)
166a9934668SKenneth D. Merry {
167a9934668SKenneth D. Merry size_t seg_len;
168a9934668SKenneth D. Merry int error;
169a9934668SKenneth D. Merry
170a9934668SKenneth D. Merry error = 0;
171a9934668SKenneth D. Merry while (offset >= dst->ds_len) {
172a9934668SKenneth D. Merry offset -= dst->ds_len;
173a9934668SKenneth D. Merry dst++;
174a9934668SKenneth D. Merry }
175a9934668SKenneth D. Merry
176a9934668SKenneth D. Merry while (len > 0 && error == 0) {
177a9934668SKenneth D. Merry seg_len = MIN(dst->ds_len - offset, len);
178a9934668SKenneth D. Merry error = physcopyout(src, (void *)(uintptr_t)(dst->ds_addr +
179a9934668SKenneth D. Merry offset), seg_len);
180a9934668SKenneth D. Merry offset = 0;
181a9934668SKenneth D. Merry dst++;
182a9934668SKenneth D. Merry len -= seg_len;
183a9934668SKenneth D. Merry src += seg_len;
184a9934668SKenneth D. Merry }
185a9934668SKenneth D. Merry
186a9934668SKenneth D. Merry return (error);
187a9934668SKenneth D. Merry }
188a9934668SKenneth D. Merry
189a9934668SKenneth D. Merry int
uiomove(void * cp,int n,struct uio * uio)19028993443SEd Schouten uiomove(void *cp, int n, struct uio *uio)
19128993443SEd Schouten {
1922801687dSKonstantin Belousov
1932801687dSKonstantin Belousov return (uiomove_faultflag(cp, n, uio, 0));
1942801687dSKonstantin Belousov }
1952801687dSKonstantin Belousov
1962801687dSKonstantin Belousov int
uiomove_nofault(void * cp,int n,struct uio * uio)1972801687dSKonstantin Belousov uiomove_nofault(void *cp, int n, struct uio *uio)
1982801687dSKonstantin Belousov {
1992801687dSKonstantin Belousov
2002801687dSKonstantin Belousov return (uiomove_faultflag(cp, n, uio, 1));
2012801687dSKonstantin Belousov }
2022801687dSKonstantin Belousov
2032801687dSKonstantin Belousov static int
uiomove_faultflag(void * cp,int n,struct uio * uio,int nofault)2042801687dSKonstantin Belousov uiomove_faultflag(void *cp, int n, struct uio *uio, int nofault)
2052801687dSKonstantin Belousov {
20628993443SEd Schouten struct iovec *iov;
207526d0bd5SKonstantin Belousov size_t cnt;
2082801687dSKonstantin Belousov int error, newflags, save;
2092801687dSKonstantin Belousov
210bfd0eacbSMatt Macy save = error = 0;
21128993443SEd Schouten
21228993443SEd Schouten KASSERT(uio->uio_rw == UIO_READ || uio->uio_rw == UIO_WRITE,
21328993443SEd Schouten ("uiomove: mode"));
214a5169546SAndrew Gallatin KASSERT(uio->uio_segflg != UIO_USERSPACE || uio->uio_td == curthread,
21528993443SEd Schouten ("uiomove proc"));
2168fd0ec53SMark Johnston KASSERT(uio->uio_resid >= 0,
2178fd0ec53SMark Johnston ("%s: uio %p resid underflow", __func__, uio));
21828993443SEd Schouten
219a5169546SAndrew Gallatin if (uio->uio_segflg == UIO_USERSPACE) {
2202801687dSKonstantin Belousov newflags = TDP_DEADLKTREAT;
221a5169546SAndrew Gallatin if (nofault) {
2225730afc9SAlan Cox /*
2235730afc9SAlan Cox * Fail if a non-spurious page fault occurs.
2245730afc9SAlan Cox */
2255730afc9SAlan Cox newflags |= TDP_NOFAULTING | TDP_RESETSPUR;
226a5169546SAndrew Gallatin } else {
227a5169546SAndrew Gallatin WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL,
228a5169546SAndrew Gallatin "Calling uiomove()");
2295730afc9SAlan Cox }
2302801687dSKonstantin Belousov save = curthread_pflags_set(newflags);
231a5169546SAndrew Gallatin } else {
232a5169546SAndrew Gallatin KASSERT(nofault == 0, ("uiomove: nofault"));
233a5169546SAndrew Gallatin }
23428993443SEd Schouten
23528993443SEd Schouten while (n > 0 && uio->uio_resid) {
2368fd0ec53SMark Johnston KASSERT(uio->uio_iovcnt > 0,
2378fd0ec53SMark Johnston ("%s: uio %p iovcnt underflow", __func__, uio));
2388fd0ec53SMark Johnston
23928993443SEd Schouten iov = uio->uio_iov;
24028993443SEd Schouten cnt = iov->iov_len;
24128993443SEd Schouten if (cnt == 0) {
24228993443SEd Schouten uio->uio_iov++;
24328993443SEd Schouten uio->uio_iovcnt--;
24428993443SEd Schouten continue;
24528993443SEd Schouten }
24628993443SEd Schouten if (cnt > n)
24728993443SEd Schouten cnt = n;
24828993443SEd Schouten
24928993443SEd Schouten switch (uio->uio_segflg) {
25028993443SEd Schouten case UIO_USERSPACE:
25108b163faSMatthew D Fleming maybe_yield();
252*473c90acSJohn Baldwin switch (uio->uio_rw) {
253*473c90acSJohn Baldwin case UIO_READ:
25428993443SEd Schouten error = copyout(cp, iov->iov_base, cnt);
255*473c90acSJohn Baldwin break;
256*473c90acSJohn Baldwin case UIO_WRITE:
25728993443SEd Schouten error = copyin(iov->iov_base, cp, cnt);
258*473c90acSJohn Baldwin break;
259*473c90acSJohn Baldwin }
26028993443SEd Schouten if (error)
26128993443SEd Schouten goto out;
26228993443SEd Schouten break;
26328993443SEd Schouten
26428993443SEd Schouten case UIO_SYSSPACE:
265*473c90acSJohn Baldwin switch (uio->uio_rw) {
266*473c90acSJohn Baldwin case UIO_READ:
26728993443SEd Schouten bcopy(cp, iov->iov_base, cnt);
268*473c90acSJohn Baldwin break;
269*473c90acSJohn Baldwin case UIO_WRITE:
27028993443SEd Schouten bcopy(iov->iov_base, cp, cnt);
27128993443SEd Schouten break;
272*473c90acSJohn Baldwin }
273*473c90acSJohn Baldwin break;
27428993443SEd Schouten case UIO_NOCOPY:
27528993443SEd Schouten break;
27628993443SEd Schouten }
27728993443SEd Schouten iov->iov_base = (char *)iov->iov_base + cnt;
27828993443SEd Schouten iov->iov_len -= cnt;
27928993443SEd Schouten uio->uio_resid -= cnt;
28028993443SEd Schouten uio->uio_offset += cnt;
28128993443SEd Schouten cp = (char *)cp + cnt;
28228993443SEd Schouten n -= cnt;
28328993443SEd Schouten }
28428993443SEd Schouten out:
285bfd0eacbSMatt Macy if (save)
2862801687dSKonstantin Belousov curthread_pflags_restore(save);
28728993443SEd Schouten return (error);
28828993443SEd Schouten }
28928993443SEd Schouten
29028993443SEd Schouten /*
29128993443SEd Schouten * Wrapper for uiomove() that validates the arguments against a known-good
29228993443SEd Schouten * kernel buffer. Currently, uiomove accepts a signed (n) argument, which
29328993443SEd Schouten * is almost definitely a bad thing, so we catch that here as well. We
29428993443SEd Schouten * return a runtime failure, but it might be desirable to generate a runtime
29528993443SEd Schouten * assertion failure instead.
29628993443SEd Schouten */
29728993443SEd Schouten int
uiomove_frombuf(void * buf,int buflen,struct uio * uio)29828993443SEd Schouten uiomove_frombuf(void *buf, int buflen, struct uio *uio)
29928993443SEd Schouten {
300526d0bd5SKonstantin Belousov size_t offset, n;
30128993443SEd Schouten
30228993443SEd Schouten if (uio->uio_offset < 0 || uio->uio_resid < 0 ||
30328993443SEd Schouten (offset = uio->uio_offset) != uio->uio_offset)
30428993443SEd Schouten return (EINVAL);
30528993443SEd Schouten if (buflen <= 0 || offset >= buflen)
30628993443SEd Schouten return (0);
307526d0bd5SKonstantin Belousov if ((n = buflen - offset) > IOSIZE_MAX)
30828993443SEd Schouten return (EINVAL);
30928993443SEd Schouten return (uiomove((char *)buf + offset, n, uio));
31028993443SEd Schouten }
31128993443SEd Schouten
31228993443SEd Schouten /*
31328993443SEd Schouten * Give next character to user as result of read.
31428993443SEd Schouten */
31528993443SEd Schouten int
ureadc(int c,struct uio * uio)31628993443SEd Schouten ureadc(int c, struct uio *uio)
31728993443SEd Schouten {
31828993443SEd Schouten struct iovec *iov;
31928993443SEd Schouten char *iov_base;
32028993443SEd Schouten
32128993443SEd Schouten WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL,
32228993443SEd Schouten "Calling ureadc()");
32328993443SEd Schouten
32428993443SEd Schouten again:
32528993443SEd Schouten if (uio->uio_iovcnt == 0 || uio->uio_resid == 0)
32628993443SEd Schouten panic("ureadc");
32728993443SEd Schouten iov = uio->uio_iov;
32828993443SEd Schouten if (iov->iov_len == 0) {
32928993443SEd Schouten uio->uio_iovcnt--;
33028993443SEd Schouten uio->uio_iov++;
33128993443SEd Schouten goto again;
33228993443SEd Schouten }
33328993443SEd Schouten switch (uio->uio_segflg) {
33428993443SEd Schouten case UIO_USERSPACE:
33528993443SEd Schouten if (subyte(iov->iov_base, c) < 0)
33628993443SEd Schouten return (EFAULT);
33728993443SEd Schouten break;
33828993443SEd Schouten
33928993443SEd Schouten case UIO_SYSSPACE:
34028993443SEd Schouten iov_base = iov->iov_base;
34128993443SEd Schouten *iov_base = c;
34228993443SEd Schouten break;
34328993443SEd Schouten
34428993443SEd Schouten case UIO_NOCOPY:
34528993443SEd Schouten break;
34628993443SEd Schouten }
34728993443SEd Schouten iov->iov_base = (char *)iov->iov_base + 1;
34828993443SEd Schouten iov->iov_len--;
34928993443SEd Schouten uio->uio_resid--;
35028993443SEd Schouten uio->uio_offset++;
35128993443SEd Schouten return (0);
35228993443SEd Schouten }
35328993443SEd Schouten
35428993443SEd Schouten int
copyiniov(const struct iovec * iovp,u_int iovcnt,struct iovec ** iov,int error)355cfb09e00SAlfred Perlstein copyiniov(const struct iovec *iovp, u_int iovcnt, struct iovec **iov, int error)
35628993443SEd Schouten {
35728993443SEd Schouten u_int iovlen;
35828993443SEd Schouten
35928993443SEd Schouten *iov = NULL;
36028993443SEd Schouten if (iovcnt > UIO_MAXIOV)
36128993443SEd Schouten return (error);
36228993443SEd Schouten iovlen = iovcnt * sizeof(struct iovec);
36328993443SEd Schouten *iov = malloc(iovlen, M_IOV, M_WAITOK);
36428993443SEd Schouten error = copyin(iovp, *iov, iovlen);
36528993443SEd Schouten if (error) {
36628993443SEd Schouten free(*iov, M_IOV);
36728993443SEd Schouten *iov = NULL;
36828993443SEd Schouten }
36928993443SEd Schouten return (error);
37028993443SEd Schouten }
37128993443SEd Schouten
37228993443SEd Schouten int
copyinuio(const struct iovec * iovp,u_int iovcnt,struct uio ** uiop)373cfb09e00SAlfred Perlstein copyinuio(const struct iovec *iovp, u_int iovcnt, struct uio **uiop)
37428993443SEd Schouten {
37528993443SEd Schouten struct iovec *iov;
37628993443SEd Schouten struct uio *uio;
37728993443SEd Schouten u_int iovlen;
37828993443SEd Schouten int error, i;
37928993443SEd Schouten
38028993443SEd Schouten *uiop = NULL;
38128993443SEd Schouten if (iovcnt > UIO_MAXIOV)
38228993443SEd Schouten return (EINVAL);
38328993443SEd Schouten iovlen = iovcnt * sizeof(struct iovec);
38461cc4830SAlfredo Mazzinghi uio = allocuio(iovcnt);
38561cc4830SAlfredo Mazzinghi iov = uio->uio_iov;
38628993443SEd Schouten error = copyin(iovp, iov, iovlen);
38761cc4830SAlfredo Mazzinghi if (error != 0) {
38861cc4830SAlfredo Mazzinghi freeuio(uio);
38928993443SEd Schouten return (error);
39028993443SEd Schouten }
39128993443SEd Schouten uio->uio_iovcnt = iovcnt;
39228993443SEd Schouten uio->uio_segflg = UIO_USERSPACE;
39328993443SEd Schouten uio->uio_offset = -1;
39428993443SEd Schouten uio->uio_resid = 0;
39528993443SEd Schouten for (i = 0; i < iovcnt; i++) {
396526d0bd5SKonstantin Belousov if (iov->iov_len > IOSIZE_MAX - uio->uio_resid) {
39761cc4830SAlfredo Mazzinghi freeuio(uio);
39828993443SEd Schouten return (EINVAL);
39928993443SEd Schouten }
40028993443SEd Schouten uio->uio_resid += iov->iov_len;
40128993443SEd Schouten iov++;
40228993443SEd Schouten }
40328993443SEd Schouten *uiop = uio;
40428993443SEd Schouten return (0);
40528993443SEd Schouten }
40628993443SEd Schouten
40728993443SEd Schouten struct uio *
allocuio(u_int iovcnt)40861cc4830SAlfredo Mazzinghi allocuio(u_int iovcnt)
40928993443SEd Schouten {
41028993443SEd Schouten struct uio *uio;
41128993443SEd Schouten int iovlen;
41228993443SEd Schouten
41361cc4830SAlfredo Mazzinghi KASSERT(iovcnt <= UIO_MAXIOV,
41461cc4830SAlfredo Mazzinghi ("Requested %u iovecs exceed UIO_MAXIOV", iovcnt));
41561cc4830SAlfredo Mazzinghi iovlen = iovcnt * sizeof(struct iovec);
416f82e9823SAlfredo Mazzinghi uio = malloc(iovlen + sizeof(*uio), M_IOV, M_WAITOK);
41728993443SEd Schouten uio->uio_iov = (struct iovec *)(uio + 1);
41861cc4830SAlfredo Mazzinghi
41961cc4830SAlfredo Mazzinghi return (uio);
42061cc4830SAlfredo Mazzinghi }
42161cc4830SAlfredo Mazzinghi
42261cc4830SAlfredo Mazzinghi void
freeuio(struct uio * uio)42361cc4830SAlfredo Mazzinghi freeuio(struct uio *uio)
42461cc4830SAlfredo Mazzinghi {
42561cc4830SAlfredo Mazzinghi free(uio, M_IOV);
42661cc4830SAlfredo Mazzinghi }
42761cc4830SAlfredo Mazzinghi
42861cc4830SAlfredo Mazzinghi struct uio *
cloneuio(struct uio * uiop)42961cc4830SAlfredo Mazzinghi cloneuio(struct uio *uiop)
43061cc4830SAlfredo Mazzinghi {
43161cc4830SAlfredo Mazzinghi struct iovec *iov;
43261cc4830SAlfredo Mazzinghi struct uio *uio;
43361cc4830SAlfredo Mazzinghi int iovlen;
43461cc4830SAlfredo Mazzinghi
43561cc4830SAlfredo Mazzinghi iovlen = uiop->uio_iovcnt * sizeof(struct iovec);
43661cc4830SAlfredo Mazzinghi uio = allocuio(uiop->uio_iovcnt);
43761cc4830SAlfredo Mazzinghi iov = uio->uio_iov;
43861cc4830SAlfredo Mazzinghi *uio = *uiop;
43961cc4830SAlfredo Mazzinghi uio->uio_iov = iov;
44028993443SEd Schouten bcopy(uiop->uio_iov, uio->uio_iov, iovlen);
44128993443SEd Schouten return (uio);
44228993443SEd Schouten }
4430f502d1cSKonstantin Belousov
4440f502d1cSKonstantin Belousov /*
4450f502d1cSKonstantin Belousov * Map some anonymous memory in user space of size sz, rounded up to the page
4460f502d1cSKonstantin Belousov * boundary.
4470f502d1cSKonstantin Belousov */
4480f502d1cSKonstantin Belousov int
copyout_map(struct thread * td,vm_offset_t * addr,size_t sz)4490f502d1cSKonstantin Belousov copyout_map(struct thread *td, vm_offset_t *addr, size_t sz)
4500f502d1cSKonstantin Belousov {
451cce6e354SKonstantin Belousov struct vmspace *vms;
4520f502d1cSKonstantin Belousov int error;
4530f502d1cSKonstantin Belousov vm_size_t size;
4540f502d1cSKonstantin Belousov
455cce6e354SKonstantin Belousov vms = td->td_proc->p_vmspace;
456cce6e354SKonstantin Belousov
4570f502d1cSKonstantin Belousov /*
4580f502d1cSKonstantin Belousov * Map somewhere after heap in process memory.
4590f502d1cSKonstantin Belousov */
4600f502d1cSKonstantin Belousov *addr = round_page((vm_offset_t)vms->vm_daddr +
461f6f6d240SMateusz Guzik lim_max(td, RLIMIT_DATA));
4620f502d1cSKonstantin Belousov
463e3043798SPedro F. Giffuni /* round size up to page boundary */
4640f502d1cSKonstantin Belousov size = (vm_size_t)round_page(sz);
465f2277b64SKonstantin Belousov if (size == 0)
466f2277b64SKonstantin Belousov return (EINVAL);
467f2277b64SKonstantin Belousov error = vm_mmap_object(&vms->vm_map, addr, size, VM_PROT_READ |
468f2277b64SKonstantin Belousov VM_PROT_WRITE, VM_PROT_ALL, MAP_PRIVATE | MAP_ANON, NULL, 0,
469f2277b64SKonstantin Belousov FALSE, td);
4700f502d1cSKonstantin Belousov return (error);
4710f502d1cSKonstantin Belousov }
4720f502d1cSKonstantin Belousov
4730f502d1cSKonstantin Belousov /*
4740f502d1cSKonstantin Belousov * Unmap memory in user space.
4750f502d1cSKonstantin Belousov */
4760f502d1cSKonstantin Belousov int
copyout_unmap(struct thread * td,vm_offset_t addr,size_t sz)4770f502d1cSKonstantin Belousov copyout_unmap(struct thread *td, vm_offset_t addr, size_t sz)
4780f502d1cSKonstantin Belousov {
4790f502d1cSKonstantin Belousov vm_map_t map;
4800f502d1cSKonstantin Belousov vm_size_t size;
4810f502d1cSKonstantin Belousov
482937060a8SKonstantin Belousov if (sz == 0)
483937060a8SKonstantin Belousov return (0);
484937060a8SKonstantin Belousov
4850f502d1cSKonstantin Belousov map = &td->td_proc->p_vmspace->vm_map;
4860f502d1cSKonstantin Belousov size = (vm_size_t)round_page(sz);
4870f502d1cSKonstantin Belousov
488cea8f30aSKonstantin Belousov if (vm_map_remove(map, addr, addr + size) != KERN_SUCCESS)
4890f502d1cSKonstantin Belousov return (EINVAL);
4900f502d1cSKonstantin Belousov
4910f502d1cSKonstantin Belousov return (0);
4920f502d1cSKonstantin Belousov }
4934f3dc900SKonstantin Belousov
4944f3dc900SKonstantin Belousov int32_t
fuword32(volatile const void * addr)4952361c6d1SKonstantin Belousov fuword32(volatile const void *addr)
4964f3dc900SKonstantin Belousov {
4974f3dc900SKonstantin Belousov int rv;
4984f3dc900SKonstantin Belousov int32_t val;
4994f3dc900SKonstantin Belousov
5004f3dc900SKonstantin Belousov rv = fueword32(addr, &val);
5014f3dc900SKonstantin Belousov return (rv == -1 ? -1 : val);
5024f3dc900SKonstantin Belousov }
5034f3dc900SKonstantin Belousov
5044f3dc900SKonstantin Belousov #ifdef _LP64
5054f3dc900SKonstantin Belousov int64_t
fuword64(volatile const void * addr)5062361c6d1SKonstantin Belousov fuword64(volatile const void *addr)
5074f3dc900SKonstantin Belousov {
5084f3dc900SKonstantin Belousov int rv;
5094f3dc900SKonstantin Belousov int64_t val;
5104f3dc900SKonstantin Belousov
5114f3dc900SKonstantin Belousov rv = fueword64(addr, &val);
5124f3dc900SKonstantin Belousov return (rv == -1 ? -1 : val);
5134f3dc900SKonstantin Belousov }
5144f3dc900SKonstantin Belousov #endif /* _LP64 */
5154f3dc900SKonstantin Belousov
5164f3dc900SKonstantin Belousov long
fuword(volatile const void * addr)5172361c6d1SKonstantin Belousov fuword(volatile const void *addr)
5184f3dc900SKonstantin Belousov {
5194f3dc900SKonstantin Belousov long val;
5204f3dc900SKonstantin Belousov int rv;
5214f3dc900SKonstantin Belousov
5224f3dc900SKonstantin Belousov rv = fueword(addr, &val);
5234f3dc900SKonstantin Belousov return (rv == -1 ? -1 : val);
5244f3dc900SKonstantin Belousov }
5254f3dc900SKonstantin Belousov
5264f3dc900SKonstantin Belousov uint32_t
casuword32(volatile uint32_t * addr,uint32_t old,uint32_t new)5274f3dc900SKonstantin Belousov casuword32(volatile uint32_t *addr, uint32_t old, uint32_t new)
5284f3dc900SKonstantin Belousov {
5294f3dc900SKonstantin Belousov int rv;
5304f3dc900SKonstantin Belousov uint32_t val;
5314f3dc900SKonstantin Belousov
5324f3dc900SKonstantin Belousov rv = casueword32(addr, old, &val, new);
5334f3dc900SKonstantin Belousov return (rv == -1 ? -1 : val);
5344f3dc900SKonstantin Belousov }
5354f3dc900SKonstantin Belousov
5364f3dc900SKonstantin Belousov u_long
casuword(volatile u_long * addr,u_long old,u_long new)5374f3dc900SKonstantin Belousov casuword(volatile u_long *addr, u_long old, u_long new)
5384f3dc900SKonstantin Belousov {
5394f3dc900SKonstantin Belousov int rv;
5404f3dc900SKonstantin Belousov u_long val;
5414f3dc900SKonstantin Belousov
5424f3dc900SKonstantin Belousov rv = casueword(addr, old, &val, new);
5434f3dc900SKonstantin Belousov return (rv == -1 ? -1 : val);
5444f3dc900SKonstantin Belousov }
545