device-mapper.c revision 1.52 1 1.52 tkusumi /* $NetBSD: device-mapper.c,v 1.52 2019/12/15 09:22:28 tkusumi Exp $ */
2 1.2 haad
3 1.2 haad /*
4 1.17 haad * Copyright (c) 2010 The NetBSD Foundation, Inc.
5 1.2 haad * All rights reserved.
6 1.2 haad *
7 1.2 haad * This code is derived from software contributed to The NetBSD Foundation
8 1.2 haad * by Adam Hamsik.
9 1.2 haad *
10 1.2 haad * Redistribution and use in source and binary forms, with or without
11 1.2 haad * modification, are permitted provided that the following conditions
12 1.2 haad * are met:
13 1.2 haad * 1. Redistributions of source code must retain the above copyright
14 1.2 haad * notice, this list of conditions and the following disclaimer.
15 1.2 haad * 2. Redistributions in binary form must reproduce the above copyright
16 1.2 haad * notice, this list of conditions and the following disclaimer in the
17 1.2 haad * documentation and/or other materials provided with the distribution.
18 1.2 haad *
19 1.2 haad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.2 haad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.2 haad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.2 haad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.2 haad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.2 haad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.2 haad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.2 haad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.2 haad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.2 haad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.2 haad * POSSIBILITY OF SUCH DAMAGE.
30 1.2 haad */
31 1.2 haad
32 1.2 haad /*
33 1.2 haad * I want to say thank you to all people who helped me with this project.
34 1.2 haad */
35 1.2 haad
36 1.2 haad #include <sys/types.h>
37 1.2 haad #include <sys/param.h>
38 1.2 haad
39 1.2 haad #include <sys/buf.h>
40 1.2 haad #include <sys/conf.h>
41 1.12 haad #include <sys/device.h>
42 1.2 haad #include <sys/dkio.h>
43 1.2 haad #include <sys/disk.h>
44 1.2 haad #include <sys/disklabel.h>
45 1.2 haad #include <sys/ioctl.h>
46 1.2 haad #include <sys/ioccom.h>
47 1.2 haad #include <sys/kmem.h>
48 1.28 christos #include <sys/kauth.h>
49 1.2 haad
50 1.2 haad #include "netbsd-dm.h"
51 1.2 haad #include "dm.h"
52 1.37 christos #include "ioconf.h"
53 1.2 haad
54 1.2 haad static dev_type_open(dmopen);
55 1.2 haad static dev_type_close(dmclose);
56 1.2 haad static dev_type_read(dmread);
57 1.2 haad static dev_type_write(dmwrite);
58 1.2 haad static dev_type_ioctl(dmioctl);
59 1.2 haad static dev_type_strategy(dmstrategy);
60 1.2 haad static dev_type_size(dmsize);
61 1.2 haad
62 1.2 haad /* attach and detach routines */
63 1.22 jakllsch #ifdef _MODULE
64 1.21 jakllsch static int dmdestroy(void);
65 1.22 jakllsch #endif
66 1.2 haad
67 1.21 jakllsch static void dm_doinit(void);
68 1.19 jakllsch
69 1.2 haad static int dm_cmd_to_fun(prop_dictionary_t);
70 1.2 haad static int disk_ioctl_switch(dev_t, u_long, void *);
71 1.2 haad static int dm_ioctl_switch(u_long);
72 1.2 haad static void dmminphys(struct buf *);
73 1.2 haad
74 1.12 haad /* CF attach/detach functions used for power management */
75 1.12 haad static int dm_detach(device_t, int);
76 1.12 haad static void dm_attach(device_t, device_t, void *);
77 1.12 haad static int dm_match(device_t, cfdata_t, void *);
78 1.12 haad
79 1.2 haad /* ***Variable-definitions*** */
80 1.2 haad const struct bdevsw dm_bdevsw = {
81 1.6 haad .d_open = dmopen,
82 1.6 haad .d_close = dmclose,
83 1.6 haad .d_strategy = dmstrategy,
84 1.6 haad .d_ioctl = dmioctl,
85 1.6 haad .d_dump = nodump,
86 1.6 haad .d_psize = dmsize,
87 1.33 dholland .d_discard = nodiscard,
88 1.6 haad .d_flag = D_DISK | D_MPSAFE
89 1.2 haad };
90 1.2 haad
91 1.2 haad const struct cdevsw dm_cdevsw = {
92 1.6 haad .d_open = dmopen,
93 1.6 haad .d_close = dmclose,
94 1.6 haad .d_read = dmread,
95 1.6 haad .d_write = dmwrite,
96 1.6 haad .d_ioctl = dmioctl,
97 1.6 haad .d_stop = nostop,
98 1.6 haad .d_tty = notty,
99 1.6 haad .d_poll = nopoll,
100 1.6 haad .d_mmap = nommap,
101 1.6 haad .d_kqfilter = nokqfilter,
102 1.34 dholland .d_discard = nodiscard,
103 1.6 haad .d_flag = D_DISK | D_MPSAFE
104 1.6 haad };
105 1.6 haad
106 1.6 haad const struct dkdriver dmdkdriver = {
107 1.6 haad .d_strategy = dmstrategy
108 1.2 haad };
109 1.2 haad
110 1.12 haad CFATTACH_DECL3_NEW(dm, 0,
111 1.12 haad dm_match, dm_attach, dm_detach, NULL, NULL, NULL,
112 1.12 haad DVF_DETACH_SHUTDOWN);
113 1.12 haad
114 1.2 haad /*
115 1.42 tkusumi * This structure is used to translate command sent to kernel driver in
116 1.42 tkusumi * <key>command</key>
117 1.42 tkusumi * <value></value>
118 1.42 tkusumi * to function which I can call, and if the command is allowed for
119 1.42 tkusumi * non-superusers.
120 1.42 tkusumi */
121 1.42 tkusumi /*
122 1.2 haad * This array is used to translate cmd to function pointer.
123 1.2 haad *
124 1.38 msaitoh * Interface between libdevmapper and lvm2tools uses different
125 1.2 haad * names for one IOCTL call because libdevmapper do another thing
126 1.2 haad * then. When I run "info" or "mknodes" libdevmapper will send same
127 1.2 haad * ioctl to kernel but will do another things in userspace.
128 1.2 haad *
129 1.2 haad */
130 1.42 tkusumi static const struct cmd_function {
131 1.42 tkusumi const char *cmd;
132 1.42 tkusumi int (*fn)(prop_dictionary_t);
133 1.42 tkusumi int allowed;
134 1.42 tkusumi } cmd_fn[] = {
135 1.45 tkusumi { .cmd = "version", .fn = NULL, .allowed = 1 },
136 1.28 christos { .cmd = "targets", .fn = dm_list_versions_ioctl, .allowed = 1 },
137 1.28 christos { .cmd = "create", .fn = dm_dev_create_ioctl, .allowed = 0 },
138 1.28 christos { .cmd = "info", .fn = dm_dev_status_ioctl, .allowed = 1 },
139 1.28 christos { .cmd = "mknodes", .fn = dm_dev_status_ioctl, .allowed = 1 },
140 1.28 christos { .cmd = "names", .fn = dm_dev_list_ioctl, .allowed = 1 },
141 1.28 christos { .cmd = "suspend", .fn = dm_dev_suspend_ioctl, .allowed = 0 },
142 1.38 msaitoh { .cmd = "remove", .fn = dm_dev_remove_ioctl, .allowed = 0 },
143 1.28 christos { .cmd = "rename", .fn = dm_dev_rename_ioctl, .allowed = 0 },
144 1.28 christos { .cmd = "resume", .fn = dm_dev_resume_ioctl, .allowed = 0 },
145 1.28 christos { .cmd = "clear", .fn = dm_table_clear_ioctl, .allowed = 0 },
146 1.28 christos { .cmd = "deps", .fn = dm_table_deps_ioctl, .allowed = 1 },
147 1.28 christos { .cmd = "reload", .fn = dm_table_load_ioctl, .allowed = 0 },
148 1.28 christos { .cmd = "status", .fn = dm_table_status_ioctl, .allowed = 1 },
149 1.28 christos { .cmd = "table", .fn = dm_table_status_ioctl, .allowed = 1 },
150 1.47 tkusumi { .cmd = NULL, .fn = NULL, .allowed = 0 },
151 1.2 haad };
152 1.2 haad
153 1.21 jakllsch #ifdef _MODULE
154 1.21 jakllsch #include <sys/module.h>
155 1.21 jakllsch
156 1.21 jakllsch /* Autoconf defines */
157 1.21 jakllsch CFDRIVER_DECL(dm, DV_DISK, NULL);
158 1.21 jakllsch
159 1.32 pgoyette MODULE(MODULE_CLASS_DRIVER, dm, "dk_subr");
160 1.2 haad
161 1.2 haad /* New module handle routine */
162 1.2 haad static int
163 1.2 haad dm_modcmd(modcmd_t cmd, void *arg)
164 1.2 haad {
165 1.23 haad #ifdef _MODULE
166 1.35 justin int error;
167 1.35 justin devmajor_t bmajor, cmajor;
168 1.12 haad
169 1.12 haad error = 0;
170 1.16 jakllsch bmajor = -1;
171 1.16 jakllsch cmajor = -1;
172 1.2 haad
173 1.2 haad switch (cmd) {
174 1.2 haad case MODULE_CMD_INIT:
175 1.12 haad error = config_cfdriver_attach(&dm_cd);
176 1.12 haad if (error)
177 1.12 haad break;
178 1.12 haad
179 1.21 jakllsch error = config_cfattach_attach(dm_cd.cd_name, &dm_ca);
180 1.12 haad if (error) {
181 1.21 jakllsch aprint_error("%s: unable to register cfattach\n",
182 1.21 jakllsch dm_cd.cd_name);
183 1.21 jakllsch return error;
184 1.16 jakllsch }
185 1.12 haad
186 1.16 jakllsch error = devsw_attach(dm_cd.cd_name, &dm_bdevsw, &bmajor,
187 1.16 jakllsch &dm_cdevsw, &cmajor);
188 1.24 haad if (error == EEXIST)
189 1.24 haad error = 0;
190 1.16 jakllsch if (error) {
191 1.16 jakllsch config_cfattach_detach(dm_cd.cd_name, &dm_ca);
192 1.16 jakllsch config_cfdriver_detach(&dm_cd);
193 1.12 haad break;
194 1.12 haad }
195 1.21 jakllsch dm_doinit();
196 1.2 haad break;
197 1.2 haad case MODULE_CMD_FINI:
198 1.4 haad /*
199 1.4 haad * Disable unloading of dm module if there are any devices
200 1.4 haad * defined in driver. This is probably too strong we need
201 1.4 haad * to disable auto-unload only if there is mounted dm device
202 1.4 haad * present.
203 1.38 msaitoh */
204 1.16 jakllsch if (dm_dev_counter > 0)
205 1.4 haad return EBUSY;
206 1.41 tkusumi /* race window here */
207 1.12 haad
208 1.17 haad error = dmdestroy();
209 1.12 haad if (error)
210 1.12 haad break;
211 1.12 haad
212 1.12 haad config_cfdriver_detach(&dm_cd);
213 1.12 haad
214 1.12 haad devsw_detach(&dm_bdevsw, &dm_cdevsw);
215 1.2 haad break;
216 1.2 haad case MODULE_CMD_STAT:
217 1.2 haad return ENOTTY;
218 1.2 haad default:
219 1.2 haad return ENOTTY;
220 1.2 haad }
221 1.2 haad
222 1.12 haad return error;
223 1.23 haad #else
224 1.23 haad return ENOTTY;
225 1.23 haad #endif
226 1.2 haad }
227 1.21 jakllsch #endif /* _MODULE */
228 1.2 haad
229 1.12 haad /*
230 1.12 haad * dm_match:
231 1.12 haad *
232 1.12 haad * Autoconfiguration match function for pseudo-device glue.
233 1.12 haad */
234 1.12 haad static int
235 1.38 msaitoh dm_match(device_t parent, cfdata_t match, void *aux)
236 1.12 haad {
237 1.12 haad
238 1.12 haad /* Pseudo-device; always present. */
239 1.12 haad return (1);
240 1.12 haad }
241 1.12 haad
242 1.12 haad /*
243 1.12 haad * dm_attach:
244 1.12 haad *
245 1.12 haad * Autoconfiguration attach function for pseudo-device glue.
246 1.12 haad */
247 1.12 haad static void
248 1.38 msaitoh dm_attach(device_t parent, device_t self, void *aux)
249 1.12 haad {
250 1.12 haad return;
251 1.12 haad }
252 1.12 haad
253 1.12 haad
254 1.12 haad /*
255 1.12 haad * dm_detach:
256 1.12 haad *
257 1.12 haad * Autoconfiguration detach function for pseudo-device glue.
258 1.12 haad * This routine is called by dm_ioctl::dm_dev_remove_ioctl and by autoconf to
259 1.38 msaitoh * remove devices created in device-mapper.
260 1.12 haad */
261 1.12 haad static int
262 1.12 haad dm_detach(device_t self, int flags)
263 1.12 haad {
264 1.12 haad dm_dev_t *dmv;
265 1.12 haad
266 1.12 haad /* Detach device from global device list */
267 1.12 haad if ((dmv = dm_dev_detach(self)) == NULL)
268 1.12 haad return ENOENT;
269 1.12 haad
270 1.12 haad /* Destroy active table first. */
271 1.12 haad dm_table_destroy(&dmv->table_head, DM_TABLE_ACTIVE);
272 1.12 haad
273 1.12 haad /* Destroy inactive table if exits, too. */
274 1.12 haad dm_table_destroy(&dmv->table_head, DM_TABLE_INACTIVE);
275 1.38 msaitoh
276 1.12 haad dm_table_head_destroy(&dmv->table_head);
277 1.12 haad
278 1.12 haad /* Destroy disk device structure */
279 1.12 haad disk_detach(dmv->diskp);
280 1.12 haad disk_destroy(dmv->diskp);
281 1.12 haad
282 1.12 haad /* Destroy device */
283 1.50 tkusumi dm_dev_free(dmv);
284 1.12 haad
285 1.12 haad /* Decrement device counter After removing device */
286 1.26 haad atomic_dec_32(&dm_dev_counter);
287 1.12 haad
288 1.12 haad return 0;
289 1.12 haad }
290 1.12 haad
291 1.21 jakllsch static void
292 1.21 jakllsch dm_doinit(void)
293 1.2 haad {
294 1.17 haad dm_target_init();
295 1.17 haad dm_dev_init();
296 1.17 haad dm_pdev_init();
297 1.17 haad }
298 1.17 haad
299 1.17 haad /* attach routine */
300 1.18 jakllsch void
301 1.18 jakllsch dmattach(int n)
302 1.17 haad {
303 1.21 jakllsch int error;
304 1.21 jakllsch
305 1.21 jakllsch error = config_cfattach_attach(dm_cd.cd_name, &dm_ca);
306 1.21 jakllsch if (error) {
307 1.21 jakllsch aprint_error("%s: unable to register cfattach\n",
308 1.21 jakllsch dm_cd.cd_name);
309 1.21 jakllsch } else {
310 1.21 jakllsch dm_doinit();
311 1.21 jakllsch }
312 1.2 haad }
313 1.2 haad
314 1.22 jakllsch #ifdef _MODULE
315 1.2 haad /* Destroy routine */
316 1.21 jakllsch static int
317 1.2 haad dmdestroy(void)
318 1.2 haad {
319 1.17 haad int error;
320 1.12 haad
321 1.17 haad error = config_cfattach_detach(dm_cd.cd_name, &dm_ca);
322 1.17 haad if (error)
323 1.17 haad return error;
324 1.38 msaitoh
325 1.2 haad dm_dev_destroy();
326 1.2 haad dm_pdev_destroy();
327 1.2 haad dm_target_destroy();
328 1.2 haad
329 1.17 haad return 0;
330 1.2 haad }
331 1.22 jakllsch #endif /* _MODULE */
332 1.2 haad
333 1.2 haad static int
334 1.2 haad dmopen(dev_t dev, int flags, int mode, struct lwp *l)
335 1.2 haad {
336 1.12 haad
337 1.13 haad aprint_debug("dm open routine called %" PRIu32 "\n", minor(dev));
338 1.2 haad return 0;
339 1.2 haad }
340 1.2 haad
341 1.2 haad static int
342 1.2 haad dmclose(dev_t dev, int flags, int mode, struct lwp *l)
343 1.2 haad {
344 1.12 haad
345 1.13 haad aprint_debug("dm close routine called %" PRIu32 "\n", minor(dev));
346 1.2 haad return 0;
347 1.2 haad }
348 1.2 haad
349 1.2 haad
350 1.2 haad static int
351 1.2 haad dmioctl(dev_t dev, const u_long cmd, void *data, int flag, struct lwp *l)
352 1.2 haad {
353 1.2 haad int r;
354 1.2 haad prop_dictionary_t dm_dict_in;
355 1.2 haad
356 1.2 haad aprint_debug("dmioctl called\n");
357 1.2 haad KASSERT(data != NULL);
358 1.38 msaitoh
359 1.43 tkusumi if ((r = disk_ioctl_switch(dev, cmd, data)) == ENOTTY) {
360 1.48 tkusumi struct plistref *pref = (struct plistref *)data;
361 1.2 haad
362 1.13 haad /* Check if we were called with NETBSD_DM_IOCTL ioctl
363 1.13 haad otherwise quit. */
364 1.13 haad if ((r = dm_ioctl_switch(cmd)) != 0)
365 1.13 haad return r;
366 1.13 haad
367 1.48 tkusumi if ((r = prop_dictionary_copyin_ioctl(pref, cmd, &dm_dict_in))
368 1.38 msaitoh != 0)
369 1.2 haad return r;
370 1.2 haad
371 1.14 haad if ((r = dm_check_version(dm_dict_in)) != 0)
372 1.14 haad goto cleanup_exit;
373 1.2 haad
374 1.2 haad /* run ioctl routine */
375 1.14 haad if ((r = dm_cmd_to_fun(dm_dict_in)) != 0)
376 1.14 haad goto cleanup_exit;
377 1.13 haad
378 1.49 tkusumi cleanup_exit:
379 1.48 tkusumi r = prop_dictionary_copyout_ioctl(pref, cmd, dm_dict_in);
380 1.2 haad prop_object_release(dm_dict_in);
381 1.2 haad }
382 1.2 haad
383 1.2 haad return r;
384 1.2 haad }
385 1.2 haad
386 1.2 haad /*
387 1.2 haad * Translate command sent from libdevmapper to func.
388 1.2 haad */
389 1.2 haad static int
390 1.38 msaitoh dm_cmd_to_fun(prop_dictionary_t dm_dict)
391 1.38 msaitoh {
392 1.2 haad int i, r;
393 1.2 haad prop_string_t command;
394 1.38 msaitoh
395 1.2 haad r = 0;
396 1.13 haad
397 1.2 haad if ((command = prop_dictionary_get(dm_dict, DM_IOCTL_COMMAND)) == NULL)
398 1.2 haad return EINVAL;
399 1.13 haad
400 1.2 haad for(i = 0; cmd_fn[i].cmd != NULL; i++)
401 1.2 haad if (prop_string_equals_cstring(command, cmd_fn[i].cmd))
402 1.2 haad break;
403 1.2 haad
404 1.38 msaitoh if (!cmd_fn[i].allowed &&
405 1.29 elad (r = kauth_authorize_system(kauth_cred_get(),
406 1.29 elad KAUTH_SYSTEM_DEVMAPPER, 0, NULL, NULL, NULL)) != 0)
407 1.28 christos return r;
408 1.28 christos
409 1.2 haad if (cmd_fn[i].cmd == NULL)
410 1.2 haad return EINVAL;
411 1.2 haad
412 1.45 tkusumi aprint_debug("ioctl %s called %p\n", cmd_fn[i].cmd, cmd_fn[i].fn);
413 1.45 tkusumi if (cmd_fn[i].fn == NULL)
414 1.45 tkusumi return 0;
415 1.2 haad r = cmd_fn[i].fn(dm_dict);
416 1.13 haad
417 1.2 haad return r;
418 1.2 haad }
419 1.2 haad
420 1.2 haad /* Call apropriate ioctl handler function. */
421 1.2 haad static int
422 1.2 haad dm_ioctl_switch(u_long cmd)
423 1.2 haad {
424 1.2 haad
425 1.2 haad switch(cmd) {
426 1.2 haad case NETBSD_DM_IOCTL:
427 1.46 tkusumi aprint_debug("dm NETBSD_DM_IOCTL called\n");
428 1.2 haad break;
429 1.2 haad default:
430 1.47 tkusumi aprint_debug("dm unknown ioctl called\n");
431 1.47 tkusumi return ENOTTY;
432 1.47 tkusumi break; /* NOT REACHED */
433 1.2 haad }
434 1.2 haad
435 1.47 tkusumi return 0;
436 1.2 haad }
437 1.2 haad
438 1.47 tkusumi /*
439 1.47 tkusumi * Check for disk specific ioctls.
440 1.47 tkusumi */
441 1.2 haad static int
442 1.2 haad disk_ioctl_switch(dev_t dev, u_long cmd, void *data)
443 1.2 haad {
444 1.2 haad dm_dev_t *dmv;
445 1.13 haad
446 1.20 haad /* disk ioctls make sense only on block devices */
447 1.20 haad if (minor(dev) == 0)
448 1.20 haad return ENOTTY;
449 1.38 msaitoh
450 1.2 haad switch(cmd) {
451 1.2 haad case DIOCGWEDGEINFO:
452 1.2 haad {
453 1.2 haad struct dkwedge_info *dkw = (void *) data;
454 1.52 tkusumi unsigned int secsize;
455 1.2 haad
456 1.2 haad if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
457 1.13 haad return ENODEV;
458 1.13 haad
459 1.9 joerg aprint_debug("DIOCGWEDGEINFO ioctl called\n");
460 1.13 haad
461 1.2 haad strlcpy(dkw->dkw_devname, dmv->name, 16);
462 1.2 haad strlcpy(dkw->dkw_wname, dmv->name, DM_NAME_LEN);
463 1.2 haad strlcpy(dkw->dkw_parent, dmv->name, 16);
464 1.13 haad
465 1.2 haad dkw->dkw_offset = 0;
466 1.27 mlelstv dm_table_disksize(&dmv->table_head, &dkw->dkw_size, &secsize);
467 1.2 haad strcpy(dkw->dkw_ptype, DKW_PTYPE_FFS);
468 1.2 haad
469 1.2 haad dm_dev_unbusy(dmv);
470 1.2 haad break;
471 1.2 haad }
472 1.7 haad
473 1.7 haad case DIOCGDISKINFO:
474 1.2 haad {
475 1.7 haad struct plistref *pref = (struct plistref *) data;
476 1.2 haad
477 1.2 haad if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
478 1.13 haad return ENODEV;
479 1.13 haad
480 1.7 haad if (dmv->diskp->dk_info == NULL) {
481 1.7 haad dm_dev_unbusy(dmv);
482 1.7 haad return ENOTSUP;
483 1.7 haad } else
484 1.7 haad prop_dictionary_copyout_ioctl(pref, cmd,
485 1.7 haad dmv->diskp->dk_info);
486 1.2 haad
487 1.2 haad dm_dev_unbusy(dmv);
488 1.2 haad break;
489 1.2 haad }
490 1.23 haad
491 1.23 haad case DIOCCACHESYNC:
492 1.23 haad {
493 1.23 haad dm_table_entry_t *table_en;
494 1.23 haad dm_table_t *tbl;
495 1.38 msaitoh
496 1.23 haad if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
497 1.23 haad return ENODEV;
498 1.23 haad
499 1.23 haad /* Select active table */
500 1.23 haad tbl = dm_table_get_entry(&dmv->table_head, DM_TABLE_ACTIVE);
501 1.23 haad
502 1.23 haad /*
503 1.23 haad * Call sync target routine for all table entries. Target sync
504 1.23 haad * routine basically call DIOCCACHESYNC on underlying devices.
505 1.23 haad */
506 1.50 tkusumi SLIST_FOREACH(table_en, tbl, next)
507 1.50 tkusumi table_en->target->sync(table_en);
508 1.23 haad dm_table_release(&dmv->table_head, DM_TABLE_ACTIVE);
509 1.23 haad dm_dev_unbusy(dmv);
510 1.23 haad break;
511 1.23 haad }
512 1.38 msaitoh
513 1.40 mlelstv case DIOCGSECTORSIZE:
514 1.40 mlelstv {
515 1.40 mlelstv u_int *valp = data;
516 1.40 mlelstv uint64_t numsec;
517 1.40 mlelstv unsigned int secsize;
518 1.40 mlelstv
519 1.40 mlelstv if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
520 1.40 mlelstv return ENODEV;
521 1.40 mlelstv
522 1.40 mlelstv aprint_debug("DIOCGSECTORSIZE ioctl called\n");
523 1.40 mlelstv
524 1.40 mlelstv dm_table_disksize(&dmv->table_head, &numsec, &secsize);
525 1.40 mlelstv *valp = secsize;
526 1.40 mlelstv
527 1.40 mlelstv dm_dev_unbusy(dmv);
528 1.40 mlelstv break;
529 1.40 mlelstv }
530 1.40 mlelstv
531 1.40 mlelstv case DIOCGMEDIASIZE:
532 1.40 mlelstv {
533 1.40 mlelstv off_t *valp = data;
534 1.40 mlelstv uint64_t numsec;
535 1.40 mlelstv unsigned int secsize;
536 1.40 mlelstv
537 1.40 mlelstv if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
538 1.40 mlelstv return ENODEV;
539 1.40 mlelstv
540 1.40 mlelstv aprint_debug("DIOCGMEDIASIZE ioctl called\n");
541 1.40 mlelstv
542 1.40 mlelstv dm_table_disksize(&dmv->table_head, &numsec, &secsize);
543 1.40 mlelstv *valp = numsec;
544 1.40 mlelstv
545 1.40 mlelstv dm_dev_unbusy(dmv);
546 1.40 mlelstv break;
547 1.40 mlelstv }
548 1.40 mlelstv
549 1.2 haad default:
550 1.2 haad aprint_debug("unknown disk_ioctl called\n");
551 1.13 haad return ENOTTY;
552 1.2 haad break; /* NOT REACHED */
553 1.2 haad }
554 1.13 haad
555 1.2 haad return 0;
556 1.2 haad }
557 1.2 haad
558 1.2 haad /*
559 1.2 haad * Do all IO operations on dm logical devices.
560 1.2 haad */
561 1.2 haad static void
562 1.2 haad dmstrategy(struct buf *bp)
563 1.2 haad {
564 1.2 haad dm_dev_t *dmv;
565 1.2 haad dm_table_t *tbl;
566 1.2 haad dm_table_entry_t *table_en;
567 1.2 haad struct buf *nestbuf;
568 1.2 haad
569 1.2 haad uint64_t buf_start, buf_len, issued_len;
570 1.2 haad uint64_t table_start, table_end;
571 1.2 haad uint64_t start, end;
572 1.13 haad
573 1.2 haad buf_start = bp->b_blkno * DEV_BSIZE;
574 1.2 haad buf_len = bp->b_bcount;
575 1.2 haad
576 1.38 msaitoh tbl = NULL;
577 1.2 haad
578 1.2 haad table_end = 0;
579 1.2 haad issued_len = 0;
580 1.2 haad
581 1.2 haad if ((dmv = dm_dev_lookup(NULL, NULL, minor(bp->b_dev))) == NULL) {
582 1.2 haad bp->b_error = EIO;
583 1.2 haad bp->b_resid = bp->b_bcount;
584 1.2 haad biodone(bp);
585 1.2 haad return;
586 1.38 msaitoh }
587 1.6 haad
588 1.8 jakllsch if (bounds_check_with_mediasize(bp, DEV_BSIZE,
589 1.8 jakllsch dm_table_size(&dmv->table_head)) <= 0) {
590 1.8 jakllsch dm_dev_unbusy(dmv);
591 1.8 jakllsch bp->b_resid = bp->b_bcount;
592 1.8 jakllsch biodone(bp);
593 1.8 jakllsch return;
594 1.8 jakllsch }
595 1.8 jakllsch
596 1.11 haad /*
597 1.11 haad * disk(9) is part of device structure and it can't be used without
598 1.11 haad * mutual exclusion, use diskp_mtx until it will be fixed.
599 1.11 haad */
600 1.11 haad mutex_enter(&dmv->diskp_mtx);
601 1.6 haad disk_busy(dmv->diskp);
602 1.11 haad mutex_exit(&dmv->diskp_mtx);
603 1.13 haad
604 1.2 haad /* Select active table */
605 1.2 haad tbl = dm_table_get_entry(&dmv->table_head, DM_TABLE_ACTIVE);
606 1.2 haad
607 1.2 haad /* Nested buffers count down to zero therefore I have
608 1.2 haad to set bp->b_resid to maximal value. */
609 1.2 haad bp->b_resid = bp->b_bcount;
610 1.13 haad
611 1.2 haad /*
612 1.2 haad * Find out what tables I want to select.
613 1.2 haad */
614 1.43 tkusumi SLIST_FOREACH(table_en, tbl, next) {
615 1.44 tkusumi /* I need number of bytes not blocks. */
616 1.2 haad table_start = table_en->start * DEV_BSIZE;
617 1.2 haad /*
618 1.2 haad * I have to sub 1 from table_en->length to prevent
619 1.2 haad * off by one error
620 1.2 haad */
621 1.44 tkusumi table_end = table_start + table_en->length * DEV_BSIZE;
622 1.2 haad
623 1.2 haad start = MAX(table_start, buf_start);
624 1.2 haad
625 1.2 haad end = MIN(table_end, buf_start + buf_len);
626 1.2 haad
627 1.2 haad aprint_debug("----------------------------------------\n");
628 1.2 haad aprint_debug("table_start %010" PRIu64", table_end %010"
629 1.2 haad PRIu64 "\n", table_start, table_end);
630 1.2 haad aprint_debug("buf_start %010" PRIu64", buf_len %010"
631 1.2 haad PRIu64"\n", buf_start, buf_len);
632 1.2 haad aprint_debug("start-buf_start %010"PRIu64", end %010"
633 1.2 haad PRIu64"\n", start - buf_start, end);
634 1.46 tkusumi aprint_debug("start %010" PRIu64", end %010"
635 1.2 haad PRIu64"\n", start, end);
636 1.46 tkusumi aprint_debug("----------------------------------------\n");
637 1.2 haad
638 1.2 haad if (start < end) {
639 1.2 haad /* create nested buffer */
640 1.2 haad nestbuf = getiobuf(NULL, true);
641 1.2 haad
642 1.2 haad nestiobuf_setup(bp, nestbuf, start - buf_start,
643 1.2 haad (end - start));
644 1.2 haad
645 1.2 haad issued_len += end - start;
646 1.13 haad
647 1.2 haad /* I need number of blocks. */
648 1.2 haad nestbuf->b_blkno = (start - table_start) / DEV_BSIZE;
649 1.2 haad
650 1.2 haad table_en->target->strategy(table_en, nestbuf);
651 1.2 haad }
652 1.8 jakllsch }
653 1.2 haad
654 1.2 haad if (issued_len < buf_len)
655 1.2 haad nestiobuf_done(bp, buf_len - issued_len, EINVAL);
656 1.2 haad
657 1.11 haad mutex_enter(&dmv->diskp_mtx);
658 1.6 haad disk_unbusy(dmv->diskp, buf_len, bp != NULL ? bp->b_flags & B_READ : 0);
659 1.11 haad mutex_exit(&dmv->diskp_mtx);
660 1.13 haad
661 1.2 haad dm_table_release(&dmv->table_head, DM_TABLE_ACTIVE);
662 1.2 haad dm_dev_unbusy(dmv);
663 1.2 haad }
664 1.2 haad
665 1.2 haad
666 1.2 haad static int
667 1.2 haad dmread(dev_t dev, struct uio *uio, int flag)
668 1.2 haad {
669 1.13 haad
670 1.2 haad return (physio(dmstrategy, NULL, dev, B_READ, dmminphys, uio));
671 1.2 haad }
672 1.2 haad
673 1.2 haad static int
674 1.2 haad dmwrite(dev_t dev, struct uio *uio, int flag)
675 1.2 haad {
676 1.13 haad
677 1.2 haad return (physio(dmstrategy, NULL, dev, B_WRITE, dmminphys, uio));
678 1.2 haad }
679 1.2 haad
680 1.2 haad static int
681 1.2 haad dmsize(dev_t dev)
682 1.2 haad {
683 1.2 haad dm_dev_t *dmv;
684 1.2 haad uint64_t size;
685 1.13 haad
686 1.2 haad if ((dmv = dm_dev_lookup(NULL, NULL, minor(dev))) == NULL)
687 1.43 tkusumi return -ENOENT;
688 1.13 haad
689 1.2 haad size = dm_table_size(&dmv->table_head);
690 1.2 haad dm_dev_unbusy(dmv);
691 1.38 msaitoh
692 1.43 tkusumi return size;
693 1.2 haad }
694 1.2 haad
695 1.2 haad static void
696 1.2 haad dmminphys(struct buf *bp)
697 1.2 haad {
698 1.13 haad
699 1.2 haad bp->b_bcount = MIN(bp->b_bcount, MAXPHYS);
700 1.2 haad }
701 1.2 haad
702 1.2 haad void
703 1.7 haad dmgetproperties(struct disk *disk, dm_table_head_t *head)
704 1.2 haad {
705 1.27 mlelstv uint64_t numsec;
706 1.52 tkusumi unsigned int secsize;
707 1.13 haad
708 1.27 mlelstv dm_table_disksize(head, &numsec, &secsize);
709 1.7 haad
710 1.30 christos struct disk_geom *dg = &disk->dk_geom;
711 1.2 haad
712 1.30 christos memset(dg, 0, sizeof(*dg));
713 1.30 christos dg->dg_secperunit = numsec;
714 1.30 christos dg->dg_secsize = secsize;
715 1.30 christos dg->dg_nsectors = 32;
716 1.30 christos dg->dg_ntracks = 64;
717 1.7 haad
718 1.30 christos disk_set_info(NULL, disk, "ESDI");
719 1.27 mlelstv }
720