1e5acd89cSAndrew Turner /*-
2e5acd89cSAndrew Turner * Copyright (c) 2014 Andrew Turner
3e5acd89cSAndrew Turner * All rights reserved.
4e5acd89cSAndrew Turner *
5e5acd89cSAndrew Turner * Redistribution and use in source and binary forms, with or without
6e5acd89cSAndrew Turner * modification, are permitted provided that the following conditions
7e5acd89cSAndrew Turner * are met:
8e5acd89cSAndrew Turner * 1. Redistributions of source code must retain the above copyright
9e5acd89cSAndrew Turner * notice, this list of conditions and the following disclaimer.
10e5acd89cSAndrew Turner * 2. Redistributions in binary form must reproduce the above copyright
11e5acd89cSAndrew Turner * notice, this list of conditions and the following disclaimer in the
12e5acd89cSAndrew Turner * documentation and/or other materials provided with the distribution.
13e5acd89cSAndrew Turner *
14e5acd89cSAndrew Turner * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15e5acd89cSAndrew Turner * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16e5acd89cSAndrew Turner * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17e5acd89cSAndrew Turner * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18e5acd89cSAndrew Turner * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19e5acd89cSAndrew Turner * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20e5acd89cSAndrew Turner * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21e5acd89cSAndrew Turner * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22e5acd89cSAndrew Turner * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23e5acd89cSAndrew Turner * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24e5acd89cSAndrew Turner * SUCH DAMAGE.
25e5acd89cSAndrew Turner *
26e5acd89cSAndrew Turner */
27e5acd89cSAndrew Turner
28e5acd89cSAndrew Turner #include <sys/param.h>
29e5acd89cSAndrew Turner #include <sys/systm.h>
30e5acd89cSAndrew Turner #include <sys/conf.h>
31e5acd89cSAndrew Turner #include <sys/malloc.h>
32e5acd89cSAndrew Turner #include <sys/memrange.h>
33872df665SAndrew Turner #include <sys/uio.h>
34e5acd89cSAndrew Turner
35e5acd89cSAndrew Turner #include <machine/memdev.h>
36872df665SAndrew Turner #include <machine/vmparam.h>
37872df665SAndrew Turner
38872df665SAndrew Turner #include <vm/vm.h>
39872df665SAndrew Turner #include <vm/pmap.h>
40872df665SAndrew Turner #include <vm/vm_extern.h>
41872df665SAndrew Turner #include <vm/vm_page.h>
42e5acd89cSAndrew Turner
43e5acd89cSAndrew Turner struct mem_range_softc mem_range_softc;
44e5acd89cSAndrew Turner
45e5acd89cSAndrew Turner int
memrw(struct cdev * dev,struct uio * uio,int flags)46e5acd89cSAndrew Turner memrw(struct cdev *dev, struct uio *uio, int flags)
47e5acd89cSAndrew Turner {
48872df665SAndrew Turner struct iovec *iov;
49872df665SAndrew Turner struct vm_page m;
50872df665SAndrew Turner vm_page_t marr;
51872df665SAndrew Turner vm_offset_t off, v;
52*473c90acSJohn Baldwin vm_prot_t prot;
53872df665SAndrew Turner u_int cnt;
54872df665SAndrew Turner int error;
55e5acd89cSAndrew Turner
56872df665SAndrew Turner error = 0;
57872df665SAndrew Turner
58872df665SAndrew Turner while (uio->uio_resid > 0 && error == 0) {
59872df665SAndrew Turner iov = uio->uio_iov;
60872df665SAndrew Turner if (iov->iov_len == 0) {
61872df665SAndrew Turner uio->uio_iov++;
62872df665SAndrew Turner uio->uio_iovcnt--;
63872df665SAndrew Turner if (uio->uio_iovcnt < 0)
64872df665SAndrew Turner panic("memrw");
65872df665SAndrew Turner continue;
66872df665SAndrew Turner }
67872df665SAndrew Turner
68872df665SAndrew Turner v = uio->uio_offset;
69872df665SAndrew Turner off = v & PAGE_MASK;
70872df665SAndrew Turner cnt = ulmin(iov->iov_len, PAGE_SIZE - (u_int)off);
71872df665SAndrew Turner if (cnt == 0)
72872df665SAndrew Turner continue;
73872df665SAndrew Turner
74872df665SAndrew Turner switch(dev2unit(dev)) {
75872df665SAndrew Turner case CDEV_MINOR_KMEM:
76872df665SAndrew Turner /* If the address is in the DMAP just copy it */
77872df665SAndrew Turner if (VIRT_IN_DMAP(v)) {
78872df665SAndrew Turner error = uiomove((void *)v, cnt, uio);
79872df665SAndrew Turner break;
80872df665SAndrew Turner }
81872df665SAndrew Turner
82*473c90acSJohn Baldwin switch (uio->uio_rw) {
83*473c90acSJohn Baldwin case UIO_READ:
84*473c90acSJohn Baldwin prot = VM_PROT_READ;
85*473c90acSJohn Baldwin break;
86*473c90acSJohn Baldwin case UIO_WRITE:
87*473c90acSJohn Baldwin prot = VM_PROT_WRITE;
88*473c90acSJohn Baldwin break;
89*473c90acSJohn Baldwin }
90*473c90acSJohn Baldwin
91*473c90acSJohn Baldwin if (!kernacc((void *)v, cnt, prot)) {
92872df665SAndrew Turner error = EFAULT;
93872df665SAndrew Turner break;
94872df665SAndrew Turner }
95872df665SAndrew Turner
96872df665SAndrew Turner /* Get the physical address to read */
97872df665SAndrew Turner v = pmap_extract(kernel_pmap, v);
98872df665SAndrew Turner if (v == 0) {
99872df665SAndrew Turner error = EFAULT;
100872df665SAndrew Turner break;
101872df665SAndrew Turner }
102872df665SAndrew Turner
103872df665SAndrew Turner /* FALLTHROUGH */
104872df665SAndrew Turner case CDEV_MINOR_MEM:
105872df665SAndrew Turner /* If within the DMAP use this to copy from */
106872df665SAndrew Turner if (PHYS_IN_DMAP(v)) {
107872df665SAndrew Turner v = PHYS_TO_DMAP(v);
108872df665SAndrew Turner error = uiomove((void *)v, cnt, uio);
109872df665SAndrew Turner break;
110872df665SAndrew Turner }
111872df665SAndrew Turner
112872df665SAndrew Turner /* Have uiomove_fromphys handle the data */
113872df665SAndrew Turner m.phys_addr = trunc_page(v);
114872df665SAndrew Turner marr = &m;
115872df665SAndrew Turner uiomove_fromphys(&marr, off, cnt, uio);
116872df665SAndrew Turner break;
117872df665SAndrew Turner }
118872df665SAndrew Turner }
119872df665SAndrew Turner
120872df665SAndrew Turner return (error);
121e5acd89cSAndrew Turner }
122e5acd89cSAndrew Turner
12307b8a571SAndrew Turner /*
12407b8a571SAndrew Turner * allow user processes to MMAP some memory sections
12507b8a571SAndrew Turner * instead of going through read/write
12607b8a571SAndrew Turner */
12707b8a571SAndrew Turner /* ARGSUSED */
12807b8a571SAndrew Turner int
memmmap(struct cdev * dev,vm_ooffset_t offset,vm_paddr_t * paddr,int prot __unused,vm_memattr_t * memattr __unused)12907b8a571SAndrew Turner memmmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr,
13007b8a571SAndrew Turner int prot __unused, vm_memattr_t *memattr __unused)
13107b8a571SAndrew Turner {
13231dc1e96SJohn Baldwin if (dev2unit(dev) == CDEV_MINOR_MEM) {
13307b8a571SAndrew Turner *paddr = offset;
13407b8a571SAndrew Turner return (0);
13507b8a571SAndrew Turner }
13631dc1e96SJohn Baldwin return (-1);
13731dc1e96SJohn Baldwin }
1382d838cd8SMark Johnston
1392d838cd8SMark Johnston int
memioctl_md(struct cdev * dev __unused,u_long cmd __unused,caddr_t data __unused,int flags __unused,struct thread * td __unused)1402d838cd8SMark Johnston memioctl_md(struct cdev *dev __unused, u_long cmd __unused,
1412d838cd8SMark Johnston caddr_t data __unused, int flags __unused, struct thread *td __unused)
1422d838cd8SMark Johnston {
1432d838cd8SMark Johnston return (ENOTTY);
1442d838cd8SMark Johnston }
145