1 /*$NetBSD: dm_target_stripe.c,v 1.44 2020/01/21 16:27:53 tkusumi Exp $*/
2
3 /*
4 * Copyright (c) 2009 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Adam Hamsik.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 * notice, this list of conditions and the following disclaimer in the
17 * documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31 #include <sys/cdefs.h>
32 __KERNEL_RCSID(0, "$NetBSD: dm_target_stripe.c,v 1.44 2020/01/21 16:27:53 tkusumi Exp $");
33
34 /*
35 * This file implements initial version of device-mapper stripe target.
36 */
37 #include <sys/types.h>
38 #include <sys/param.h>
39 #include <sys/buf.h>
40 #include <sys/kmem.h>
41 #include <sys/lwp.h>
42
43 #include "dm.h"
44
45 typedef struct target_stripe_config {
46 #define DM_STRIPE_DEV_OFFSET 2
47 struct target_linear_devs stripe_devs;
48 uint8_t stripe_num;
49 uint64_t stripe_chunksize;
50 } dm_target_stripe_config_t;
51
52 #ifdef DM_TARGET_MODULE
53 /*
54 * Every target can be compiled directly to dm driver or as a
55 * separate module this part of target is used for loading targets
56 * to dm driver.
57 * Target can be unloaded from kernel only if there are no users of
58 * it e.g. there are no devices which uses that target.
59 */
60 #include <sys/kernel.h>
61 #include <sys/module.h>
62
63 MODULE(MODULE_CLASS_MISC, dm_target_stripe, NULL);
64
65 static int
dm_target_stripe_modcmd(modcmd_t cmd,void * arg)66 dm_target_stripe_modcmd(modcmd_t cmd, void *arg)
67 {
68 dm_target_t *dmt;
69 int r;
70
71 switch (cmd) {
72 case MODULE_CMD_INIT:
73 if ((dmt = dm_target_lookup("striped")) != NULL) {
74 dm_target_unbusy(dmt);
75 return EEXIST;
76 }
77 dmt = dm_target_alloc("striped");
78
79 dmt->version[0] = 1;
80 dmt->version[1] = 0;
81 dmt->version[2] = 0;
82 dmt->init = &dm_target_stripe_init;
83 dmt->info = &dm_target_stripe_info;
84 dmt->table = &dm_target_stripe_table;
85 dmt->strategy = &dm_target_stripe_strategy;
86 dmt->sync = &dm_target_stripe_sync;
87 dmt->destroy = &dm_target_stripe_destroy;
88 //dmt->upcall = &dm_target_stripe_upcall;
89 dmt->secsize = &dm_target_stripe_secsize;
90
91 r = dm_target_insert(dmt);
92
93 break;
94
95 case MODULE_CMD_FINI:
96 r = dm_target_rem("striped");
97 break;
98
99 case MODULE_CMD_STAT:
100 return ENOTTY;
101
102 default:
103 return ENOTTY;
104 }
105
106 return r;
107 }
108 #endif
109
110 static void
dm_target_stripe_fini(dm_target_stripe_config_t * tsc)111 dm_target_stripe_fini(dm_target_stripe_config_t *tsc)
112 {
113 dm_target_linear_config_t *tlc;
114
115 if (tsc == NULL)
116 return;
117
118 while ((tlc = TAILQ_FIRST(&tsc->stripe_devs)) != NULL) {
119 TAILQ_REMOVE(&tsc->stripe_devs, tlc, entries);
120 dm_pdev_decr(tlc->pdev);
121 kmem_free(tlc, sizeof(*tlc));
122 }
123
124 kmem_free(tsc, sizeof(*tsc));
125 }
126
127 /*
128 * Init function called from dm_table_load_ioctl.
129 * DM_STRIPE_DEV_OFFSET should always hold the index of the first device-offset
130 * pair in the parameters.
131 * Example line sent to dm from lvm tools when using striped target.
132 * start length striped #stripes chunk_size device1 offset1 ... deviceN offsetN
133 * 0 65536 striped 2 512 /dev/hda 0 /dev/hdb 0
134 */
135 int
dm_target_stripe_init(dm_table_entry_t * table_en,int argc,char ** argv)136 dm_target_stripe_init(dm_table_entry_t *table_en, int argc, char **argv)
137 {
138 dm_target_linear_config_t *tlc;
139 dm_target_stripe_config_t *tsc;
140 int strpc, strpi;
141
142 if (argc < 2) {
143 printf("Stripe target takes at least 2 args, %d given\n", argc);
144 return EINVAL;
145 }
146
147 printf("Stripe target init function called!!\n");
148 printf("Stripe target chunk size %s number of stripes %s\n",
149 argv[1], argv[0]);
150
151 tsc = kmem_alloc(sizeof(*tsc), KM_SLEEP);
152
153 /* Initialize linked list for striping devices */
154 TAILQ_INIT(&tsc->stripe_devs);
155
156 /* Save length of param string */
157 tsc->stripe_chunksize = atoi64(argv[1]);
158 tsc->stripe_num = (uint8_t) atoi64(argv[0]);
159
160 strpc = DM_STRIPE_DEV_OFFSET + (tsc->stripe_num * 2);
161 for (strpi = DM_STRIPE_DEV_OFFSET; strpi < strpc; strpi += 2) {
162 printf("Stripe target device name %s -- offset %s\n",
163 argv[strpi], argv[strpi+1]);
164
165 tlc = kmem_alloc(sizeof(*tlc), KM_SLEEP);
166 if ((tlc->pdev = dm_pdev_insert(argv[strpi])) == NULL) {
167 kmem_free(tlc, sizeof(*tlc));
168 dm_target_stripe_fini(tsc);
169 return ENOENT;
170 }
171 tlc->offset = atoi64(argv[strpi+1]);
172 dm_table_add_deps(table_en, tlc->pdev);
173
174 /* Insert striping device to linked list. */
175 TAILQ_INSERT_TAIL(&tsc->stripe_devs, tlc, entries);
176 }
177
178 table_en->target_config = tsc;
179
180 return 0;
181 }
182
183 /* Info routine called to get params string. */
184 char *
dm_target_stripe_info(void * target_config)185 dm_target_stripe_info(void *target_config)
186 {
187 dm_target_linear_config_t *tlc;
188 dm_target_stripe_config_t *tsc;
189 char *params, *ptr, buf[256];
190 int ret, i = 0;
191 size_t len;
192
193 tsc = target_config;
194
195 len = DM_MAX_PARAMS_SIZE;
196 params = kmem_alloc(len, KM_SLEEP);
197 ptr = params;
198
199 ret = snprintf(ptr, len, "%d ", tsc->stripe_num);
200 ptr += ret;
201 len -= ret;
202
203 memset(buf, 0, sizeof(buf));
204 TAILQ_FOREACH(tlc, &tsc->stripe_devs, entries) {
205 ret = snprintf(ptr, len, "%s ", tlc->pdev->udev_name);
206 if (0 /*tlc->num_error*/)
207 buf[i] = 'D';
208 else
209 buf[i] = 'A';
210 i++;
211 ptr += ret;
212 len -= ret;
213 }
214
215 ret = snprintf(ptr, len, "1 %s", buf);
216 ptr += ret;
217 len -= ret;
218
219 return params;
220 }
221
222 /* Table routine called to get params string. */
223 char *
dm_target_stripe_table(void * target_config)224 dm_target_stripe_table(void *target_config)
225 {
226 dm_target_linear_config_t *tlc;
227 dm_target_stripe_config_t *tsc;
228 char *params, *tmp;
229
230 tsc = target_config;
231
232 params = kmem_alloc(DM_MAX_PARAMS_SIZE, KM_SLEEP);
233 tmp = kmem_alloc(DM_MAX_PARAMS_SIZE, KM_SLEEP);
234
235 snprintf(params, DM_MAX_PARAMS_SIZE, "%d %" PRIu64,
236 tsc->stripe_num, tsc->stripe_chunksize);
237
238 TAILQ_FOREACH(tlc, &tsc->stripe_devs, entries) {
239 snprintf(tmp, DM_MAX_PARAMS_SIZE, " %s %" PRIu64,
240 tlc->pdev->udev_name, tlc->offset);
241 strcat(params, tmp);
242 }
243
244 kmem_free(tmp, DM_MAX_PARAMS_SIZE);
245
246 return params;
247 }
248
249 /* Strategy routine called from dm_strategy. */
250 int
dm_target_stripe_strategy(dm_table_entry_t * table_en,struct buf * bp)251 dm_target_stripe_strategy(dm_table_entry_t *table_en, struct buf *bp)
252 {
253 dm_target_linear_config_t *tlc;
254 dm_target_stripe_config_t *tsc;
255 struct buf *nestbuf;
256 uint64_t blkno, blkoff;
257 uint64_t stripe, stripe_blknr;
258 uint32_t stripe_off, stripe_rest, num_blks, issue_blks;
259 int i, stripe_devnr;
260
261 tsc = table_en->target_config;
262 if (tsc == NULL)
263 return 0;
264
265 /* calculate extent of request */
266 KASSERT(bp->b_resid % DEV_BSIZE == 0);
267
268 blkno = bp->b_blkno;
269 blkoff = 0;
270 num_blks = bp->b_resid / DEV_BSIZE;
271 for (;;) {
272 /* blockno to stripe piece nr */
273 stripe = blkno / tsc->stripe_chunksize;
274 stripe_off = blkno % tsc->stripe_chunksize;
275
276 /* where we are inside the stripe */
277 stripe_devnr = stripe % tsc->stripe_num;
278 stripe_blknr = stripe / tsc->stripe_num;
279
280 /* how much is left before we hit a boundary */
281 stripe_rest = tsc->stripe_chunksize - stripe_off;
282
283 /* issue this piece on stripe `stripe' */
284 issue_blks = MIN(stripe_rest, num_blks);
285 nestbuf = getiobuf(NULL, true);
286
287 nestiobuf_setup(bp, nestbuf, blkoff, issue_blks * DEV_BSIZE);
288 nestbuf->b_blkno = stripe_blknr * tsc->stripe_chunksize + stripe_off;
289
290 tlc = TAILQ_FIRST(&tsc->stripe_devs);
291 for (i = 0; i < stripe_devnr && tlc != NULL; i++)
292 tlc = TAILQ_NEXT(tlc, entries);
293
294 /* by this point we should have an tlc */
295 KASSERT(tlc != NULL);
296
297 nestbuf->b_blkno += tlc->offset;
298
299 VOP_STRATEGY(tlc->pdev->pdev_vnode, nestbuf);
300
301 blkno += issue_blks;
302 blkoff += issue_blks * DEV_BSIZE;
303 num_blks -= issue_blks;
304
305 if (num_blks <= 0)
306 break;
307 }
308
309 return 0;
310 }
311
312 /* Sync underlying disk caches. */
313 int
dm_target_stripe_sync(dm_table_entry_t * table_en)314 dm_target_stripe_sync(dm_table_entry_t *table_en)
315 {
316 int cmd, err;
317 dm_target_stripe_config_t *tsc;
318 dm_target_linear_config_t *tlc;
319
320 tsc = table_en->target_config;
321
322 err = 0;
323 cmd = 1;
324
325 TAILQ_FOREACH(tlc, &tsc->stripe_devs, entries) {
326 if ((err = VOP_IOCTL(tlc->pdev->pdev_vnode, DIOCCACHESYNC,
327 &cmd, FREAD|FWRITE, kauth_cred_get())) != 0)
328 return err;
329 }
330
331 return err;
332
333 }
334
335 /* Destroy target specific data. */
336 int
dm_target_stripe_destroy(dm_table_entry_t * table_en)337 dm_target_stripe_destroy(dm_table_entry_t *table_en)
338 {
339
340 dm_target_stripe_fini(table_en->target_config);
341
342 /* Unbusy target so we can unload it */
343 dm_target_unbusy(table_en->target);
344
345 return 0;
346 }
347
348 #if 0
349 /* Unsupported for this target. */
350 int
351 dm_target_stripe_upcall(dm_table_entry_t *table_en, struct buf *bp)
352 {
353
354 return 0;
355 }
356 #endif
357
358 /*
359 * Compute physical block size
360 * For a stripe target we chose the maximum sector size of all
361 * stripe devices. For the supported power-of-2 sizes this is equivalent
362 * to the least common multiple.
363 */
364 int
dm_target_stripe_secsize(dm_table_entry_t * table_en,unsigned int * secsizep)365 dm_target_stripe_secsize(dm_table_entry_t *table_en, unsigned int *secsizep)
366 {
367 dm_target_linear_config_t *tlc;
368 dm_target_stripe_config_t *tsc;
369 unsigned int secsize;
370
371 secsize = 0;
372
373 tsc = table_en->target_config;
374 if (tsc != NULL) {
375 TAILQ_FOREACH(tlc, &tsc->stripe_devs, entries) {
376 if (secsize < tlc->pdev->pdev_secsize)
377 secsize = tlc->pdev->pdev_secsize;
378 }
379 }
380
381 *secsizep = secsize;
382
383 return 0;
384 }
385