fopsmapper.c revision 1.2 1 1.2 kamil /* $NetBSD: fopsmapper.c,v 1.2 2020/04/01 11:45:53 kamil Exp $ */
2 1.1 kamil
3 1.1 kamil /*-
4 1.1 kamil * Copyright (c) 2020 The NetBSD Foundation, Inc.
5 1.1 kamil * All rights reserved.
6 1.1 kamil *
7 1.1 kamil * Redistribution and use in source and binary forms, with or without
8 1.1 kamil * modification, are permitted provided that the following conditions
9 1.1 kamil * are met:
10 1.1 kamil * 1. Redistributions of source code must retain the above copyright
11 1.1 kamil * notice, this list of conditions and the following disclaimer.
12 1.1 kamil * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 kamil * notice, this list of conditions and the following disclaimer in the
14 1.1 kamil * documentation and/or other materials provided with the distribution.
15 1.1 kamil *
16 1.1 kamil * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.1 kamil * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.1 kamil * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.1 kamil * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.1 kamil * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.1 kamil * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.1 kamil * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.1 kamil * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.1 kamil * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.1 kamil * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.1 kamil * POSSIBILITY OF SUCH DAMAGE.
27 1.1 kamil */
28 1.1 kamil
29 1.1 kamil #include <sys/cdefs.h>
30 1.2 kamil __KERNEL_RCSID(0, "$NetBSD: fopsmapper.c,v 1.2 2020/04/01 11:45:53 kamil Exp $");
31 1.1 kamil
32 1.1 kamil #include <sys/module.h>
33 1.1 kamil #include <sys/param.h>
34 1.1 kamil #include <sys/systm.h>
35 1.1 kamil #include <sys/kernel.h>
36 1.1 kamil
37 1.1 kamil #include <sys/conf.h>
38 1.1 kamil #include <sys/file.h>
39 1.1 kamil #include <sys/filedesc.h>
40 1.1 kamil #include <sys/kmem.h>
41 1.1 kamil #include <sys/mman.h>
42 1.1 kamil #include <sys/mutex.h>
43 1.1 kamil #include <uvm/uvm_extern.h>
44 1.1 kamil
45 1.1 kamil /*
46 1.1 kamil * To use this module you need to:
47 1.1 kamil *
48 1.1 kamil * mknod /dev/fopsmapper c 351 0
49 1.1 kamil *
50 1.1 kamil */
51 1.1 kamil
52 1.1 kamil dev_type_open(fopsmapper_open);
53 1.1 kamil
54 1.1 kamil const struct cdevsw fopsmapper_cdevsw = {
55 1.1 kamil .d_open = fopsmapper_open,
56 1.1 kamil .d_close = noclose,
57 1.1 kamil .d_read = noread,
58 1.1 kamil .d_write = nowrite,
59 1.1 kamil .d_ioctl = noioctl,
60 1.1 kamil .d_stop = nostop,
61 1.1 kamil .d_tty = notty,
62 1.1 kamil .d_poll = nopoll,
63 1.1 kamil .d_mmap = nommap,
64 1.1 kamil .d_kqfilter = nokqfilter,
65 1.1 kamil .d_discard = nodiscard,
66 1.1 kamil .d_flag = D_OTHER
67 1.1 kamil };
68 1.1 kamil
69 1.1 kamil static int fopsmapper_mmap(file_t *, off_t *, size_t,
70 1.1 kamil int, int *, int *,struct uvm_object **, int *);
71 1.1 kamil static int fopsmapper_close(file_t *);
72 1.1 kamil
73 1.1 kamil const struct fileops mapper_fileops = {
74 1.1 kamil .fo_read = fbadop_read,
75 1.1 kamil .fo_write = fbadop_write,
76 1.1 kamil .fo_ioctl = fbadop_ioctl,
77 1.1 kamil .fo_fcntl = fnullop_fcntl,
78 1.1 kamil .fo_poll = fnullop_poll,
79 1.1 kamil .fo_stat = fbadop_stat,
80 1.1 kamil .fo_close = fopsmapper_close,
81 1.1 kamil .fo_kqfilter = fnullop_kqfilter,
82 1.1 kamil .fo_restart = fnullop_restart,
83 1.1 kamil .fo_mmap = fopsmapper_mmap,
84 1.1 kamil };
85 1.1 kamil
86 1.1 kamil typedef struct fopsmapper_softc {
87 1.1 kamil char *buf;
88 1.1 kamil struct uvm_object *uobj;
89 1.1 kamil size_t bufsize;
90 1.1 kamil } fops_t;
91 1.1 kamil
92 1.1 kamil int
93 1.1 kamil fopsmapper_open(dev_t dev, int flag, int mode, struct lwp *l)
94 1.1 kamil {
95 1.1 kamil fops_t *fo;
96 1.1 kamil struct file *fp;
97 1.1 kamil int fd, error;
98 1.1 kamil
99 1.1 kamil if ((error = fd_allocfile(&fp, &fd)) != 0)
100 1.1 kamil return error;
101 1.1 kamil
102 1.1 kamil fo = kmem_zalloc(sizeof(*fo), KM_SLEEP);
103 1.1 kamil
104 1.1 kamil return fd_clone(fp, fd, flag, &mapper_fileops, fo);
105 1.1 kamil }
106 1.1 kamil
107 1.1 kamil int
108 1.1 kamil fopsmapper_mmap(file_t * fp, off_t * offp, size_t size, int prot,
109 1.1 kamil int *flagsp, int *advicep, struct uvm_object **uobjp,
110 1.1 kamil int *maxprotp)
111 1.1 kamil {
112 1.1 kamil fops_t *fo;
113 1.1 kamil int error;
114 1.1 kamil
115 1.1 kamil if (prot & PROT_EXEC)
116 1.1 kamil return EACCES;
117 1.1 kamil
118 1.2 kamil if (size != (size_t)PAGE_SIZE)
119 1.1 kamil return EINVAL;
120 1.1 kamil
121 1.1 kamil if ((fo = fp->f_data) == NULL)
122 1.1 kamil return ENXIO;
123 1.1 kamil
124 1.1 kamil fo->bufsize = size;
125 1.1 kamil fo->uobj = uao_create(size, 0);
126 1.1 kamil
127 1.1 kamil fo->buf = NULL;
128 1.1 kamil /* Map the uvm object into kernel */
129 1.1 kamil error = uvm_map(kernel_map, (vaddr_t *) &fo->buf, fo->bufsize,
130 1.1 kamil fo->uobj, 0, 0,
131 1.1 kamil UVM_MAPFLAG(UVM_PROT_RW, UVM_PROT_RW,
132 1.1 kamil UVM_INH_SHARE,UVM_ADV_RANDOM, 0));
133 1.1 kamil
134 1.1 kamil if (error) {
135 1.1 kamil uao_detach(fo->uobj);
136 1.1 kamil return error;
137 1.1 kamil }
138 1.1 kamil snprintf(fo->buf, 13, "Hey There!");
139 1.1 kamil
140 1.1 kamil /* Get the reference of uobj */
141 1.1 kamil uao_reference(fo->uobj);
142 1.1 kamil
143 1.1 kamil *uobjp = fo->uobj;
144 1.1 kamil *maxprotp = prot;
145 1.1 kamil *advicep = UVM_ADV_RANDOM;
146 1.1 kamil
147 1.1 kamil return 0;
148 1.1 kamil }
149 1.1 kamil
150 1.1 kamil int
151 1.1 kamil fopsmapper_close(file_t * fp)
152 1.1 kamil {
153 1.1 kamil fops_t *fo;
154 1.1 kamil
155 1.1 kamil fo = fp->f_data;
156 1.1 kamil KASSERT(fo != NULL);
157 1.1 kamil
158 1.1 kamil if (fo->buf != NULL)
159 1.1 kamil uvm_deallocate(kernel_map, (vaddr_t)fo->buf, fo->bufsize);
160 1.1 kamil
161 1.1 kamil kmem_free(fo, sizeof(*fo));
162 1.1 kamil
163 1.1 kamil return 0;
164 1.1 kamil }
165 1.1 kamil
166 1.1 kamil MODULE(MODULE_CLASS_MISC, fopsmapper, NULL);
167 1.1 kamil
168 1.1 kamil static int
169 1.1 kamil fopsmapper_modcmd(modcmd_t cmd, void *arg __unused)
170 1.1 kamil {
171 1.1 kamil int cmajor = 351, bmajor = -1;
172 1.1 kamil
173 1.1 kamil switch (cmd) {
174 1.1 kamil case MODULE_CMD_INIT:
175 1.1 kamil if (devsw_attach("fopsmapper", NULL, &bmajor,
176 1.1 kamil &fopsmapper_cdevsw, &cmajor))
177 1.1 kamil return ENXIO;
178 1.1 kamil return 0;
179 1.1 kamil case MODULE_CMD_FINI:
180 1.1 kamil return EBUSY;
181 1.1 kamil default:
182 1.1 kamil return ENOTTY;
183 1.1 kamil }
184 1.1 kamil }
185