Linux Audio

Check our new training course

Loading...
v6.2
  1/*
  2 * Copyright (C) 2003 Sistina Software (UK) Limited.
  3 * Copyright (C) 2004, 2010-2011 Red Hat, Inc. All rights reserved.
  4 *
  5 * This file is released under the GPL.
  6 */
  7
  8#include <linux/device-mapper.h>
  9
 10#include <linux/module.h>
 11#include <linux/init.h>
 12#include <linux/blkdev.h>
 13#include <linux/bio.h>
 14#include <linux/slab.h>
 15
 16#define DM_MSG_PREFIX "flakey"
 17
 18#define all_corrupt_bio_flags_match(bio, fc)	\
 19	(((bio)->bi_opf & (fc)->corrupt_bio_flags) == (fc)->corrupt_bio_flags)
 20
 21/*
 22 * Flakey: Used for testing only, simulates intermittent,
 23 * catastrophic device failure.
 24 */
 25struct flakey_c {
 26	struct dm_dev *dev;
 27	unsigned long start_time;
 28	sector_t start;
 29	unsigned up_interval;
 30	unsigned down_interval;
 31	unsigned long flags;
 32	unsigned corrupt_bio_byte;
 33	unsigned corrupt_bio_rw;
 34	unsigned corrupt_bio_value;
 35	blk_opf_t corrupt_bio_flags;
 36};
 37
 38enum feature_flag_bits {
 39	DROP_WRITES,
 40	ERROR_WRITES
 41};
 42
 43struct per_bio_data {
 44	bool bio_submitted;
 45};
 46
 47static int parse_features(struct dm_arg_set *as, struct flakey_c *fc,
 48			  struct dm_target *ti)
 49{
 50	int r;
 51	unsigned argc;
 52	const char *arg_name;
 53
 54	static const struct dm_arg _args[] = {
 55		{0, 6, "Invalid number of feature args"},
 56		{1, UINT_MAX, "Invalid corrupt bio byte"},
 57		{0, 255, "Invalid corrupt value to write into bio byte (0-255)"},
 58		{0, UINT_MAX, "Invalid corrupt bio flags mask"},
 59	};
 60
 61	/* No feature arguments supplied. */
 62	if (!as->argc)
 63		return 0;
 64
 65	r = dm_read_arg_group(_args, as, &argc, &ti->error);
 66	if (r)
 67		return r;
 68
 69	while (argc) {
 70		arg_name = dm_shift_arg(as);
 71		argc--;
 72
 73		if (!arg_name) {
 74			ti->error = "Insufficient feature arguments";
 75			return -EINVAL;
 76		}
 77
 78		/*
 79		 * drop_writes
 80		 */
 81		if (!strcasecmp(arg_name, "drop_writes")) {
 82			if (test_and_set_bit(DROP_WRITES, &fc->flags)) {
 83				ti->error = "Feature drop_writes duplicated";
 84				return -EINVAL;
 85			} else if (test_bit(ERROR_WRITES, &fc->flags)) {
 86				ti->error = "Feature drop_writes conflicts with feature error_writes";
 87				return -EINVAL;
 88			}
 89
 90			continue;
 91		}
 92
 93		/*
 94		 * error_writes
 95		 */
 96		if (!strcasecmp(arg_name, "error_writes")) {
 97			if (test_and_set_bit(ERROR_WRITES, &fc->flags)) {
 98				ti->error = "Feature error_writes duplicated";
 99				return -EINVAL;
100
101			} else if (test_bit(DROP_WRITES, &fc->flags)) {
102				ti->error = "Feature error_writes conflicts with feature drop_writes";
103				return -EINVAL;
104			}
105
106			continue;
107		}
108
109		/*
110		 * corrupt_bio_byte <Nth_byte> <direction> <value> <bio_flags>
111		 */
112		if (!strcasecmp(arg_name, "corrupt_bio_byte")) {
113			if (!argc) {
114				ti->error = "Feature corrupt_bio_byte requires parameters";
115				return -EINVAL;
116			}
117
118			r = dm_read_arg(_args + 1, as, &fc->corrupt_bio_byte, &ti->error);
119			if (r)
120				return r;
121			argc--;
122
123			/*
124			 * Direction r or w?
125			 */
126			arg_name = dm_shift_arg(as);
127			if (!strcasecmp(arg_name, "w"))
128				fc->corrupt_bio_rw = WRITE;
129			else if (!strcasecmp(arg_name, "r"))
130				fc->corrupt_bio_rw = READ;
131			else {
132				ti->error = "Invalid corrupt bio direction (r or w)";
133				return -EINVAL;
134			}
135			argc--;
136
137			/*
138			 * Value of byte (0-255) to write in place of correct one.
139			 */
140			r = dm_read_arg(_args + 2, as, &fc->corrupt_bio_value, &ti->error);
141			if (r)
142				return r;
143			argc--;
144
145			/*
146			 * Only corrupt bios with these flags set.
147			 */
148			BUILD_BUG_ON(sizeof(fc->corrupt_bio_flags) !=
149				     sizeof(unsigned int));
150			r = dm_read_arg(_args + 3, as,
151				(__force unsigned *)&fc->corrupt_bio_flags,
152				&ti->error);
153			if (r)
154				return r;
155			argc--;
156
157			continue;
158		}
159
160		ti->error = "Unrecognised flakey feature requested";
161		return -EINVAL;
162	}
163
164	if (test_bit(DROP_WRITES, &fc->flags) && (fc->corrupt_bio_rw == WRITE)) {
165		ti->error = "drop_writes is incompatible with corrupt_bio_byte with the WRITE flag set";
166		return -EINVAL;
167
168	} else if (test_bit(ERROR_WRITES, &fc->flags) && (fc->corrupt_bio_rw == WRITE)) {
169		ti->error = "error_writes is incompatible with corrupt_bio_byte with the WRITE flag set";
170		return -EINVAL;
171	}
172
173	return 0;
174}
175
176/*
177 * Construct a flakey mapping:
178 * <dev_path> <offset> <up interval> <down interval> [<#feature args> [<arg>]*]
179 *
180 *   Feature args:
181 *     [drop_writes]
182 *     [corrupt_bio_byte <Nth_byte> <direction> <value> <bio_flags>]
183 *
184 *   Nth_byte starts from 1 for the first byte.
185 *   Direction is r for READ or w for WRITE.
186 *   bio_flags is ignored if 0.
187 */
188static int flakey_ctr(struct dm_target *ti, unsigned int argc, char **argv)
189{
190	static const struct dm_arg _args[] = {
191		{0, UINT_MAX, "Invalid up interval"},
192		{0, UINT_MAX, "Invalid down interval"},
193	};
194
195	int r;
196	struct flakey_c *fc;
197	unsigned long long tmpll;
198	struct dm_arg_set as;
199	const char *devname;
200	char dummy;
201
202	as.argc = argc;
203	as.argv = argv;
204
205	if (argc < 4) {
206		ti->error = "Invalid argument count";
207		return -EINVAL;
208	}
209
210	fc = kzalloc(sizeof(*fc), GFP_KERNEL);
211	if (!fc) {
212		ti->error = "Cannot allocate context";
213		return -ENOMEM;
214	}
215	fc->start_time = jiffies;
216
217	devname = dm_shift_arg(&as);
218
219	r = -EINVAL;
220	if (sscanf(dm_shift_arg(&as), "%llu%c", &tmpll, &dummy) != 1 || tmpll != (sector_t)tmpll) {
221		ti->error = "Invalid device sector";
222		goto bad;
223	}
224	fc->start = tmpll;
225
226	r = dm_read_arg(_args, &as, &fc->up_interval, &ti->error);
227	if (r)
228		goto bad;
229
230	r = dm_read_arg(_args, &as, &fc->down_interval, &ti->error);
231	if (r)
232		goto bad;
233
234	if (!(fc->up_interval + fc->down_interval)) {
235		ti->error = "Total (up + down) interval is zero";
236		r = -EINVAL;
237		goto bad;
238	}
239
240	if (fc->up_interval + fc->down_interval < fc->up_interval) {
241		ti->error = "Interval overflow";
242		r = -EINVAL;
243		goto bad;
244	}
245
246	r = parse_features(&as, fc, ti);
247	if (r)
248		goto bad;
249
250	r = dm_get_device(ti, devname, dm_table_get_mode(ti->table), &fc->dev);
251	if (r) {
252		ti->error = "Device lookup failed";
253		goto bad;
254	}
255
256	ti->num_flush_bios = 1;
257	ti->num_discard_bios = 1;
258	ti->per_io_data_size = sizeof(struct per_bio_data);
259	ti->private = fc;
260	return 0;
261
262bad:
263	kfree(fc);
264	return r;
265}
266
267static void flakey_dtr(struct dm_target *ti)
268{
269	struct flakey_c *fc = ti->private;
270
271	dm_put_device(ti, fc->dev);
272	kfree(fc);
273}
274
275static sector_t flakey_map_sector(struct dm_target *ti, sector_t bi_sector)
276{
277	struct flakey_c *fc = ti->private;
278
279	return fc->start + dm_target_offset(ti, bi_sector);
280}
281
282static void flakey_map_bio(struct dm_target *ti, struct bio *bio)
283{
284	struct flakey_c *fc = ti->private;
285
286	bio_set_dev(bio, fc->dev->bdev);
287	bio->bi_iter.bi_sector = flakey_map_sector(ti, bio->bi_iter.bi_sector);
 
 
288}
289
290static void corrupt_bio_data(struct bio *bio, struct flakey_c *fc)
291{
292	unsigned int corrupt_bio_byte = fc->corrupt_bio_byte - 1;
293
294	struct bvec_iter iter;
295	struct bio_vec bvec;
296
297	if (!bio_has_data(bio))
298		return;
299
300	/*
301	 * Overwrite the Nth byte of the bio's data, on whichever page
302	 * it falls.
303	 */
304	bio_for_each_segment(bvec, bio, iter) {
305		if (bio_iter_len(bio, iter) > corrupt_bio_byte) {
306			char *segment = (page_address(bio_iter_page(bio, iter))
307					 + bio_iter_offset(bio, iter));
308			segment[corrupt_bio_byte] = fc->corrupt_bio_value;
309			DMDEBUG("Corrupting data bio=%p by writing %u to byte %u "
310				"(rw=%c bi_opf=%u bi_sector=%llu size=%u)\n",
311				bio, fc->corrupt_bio_value, fc->corrupt_bio_byte,
312				(bio_data_dir(bio) == WRITE) ? 'w' : 'r', bio->bi_opf,
313				(unsigned long long)bio->bi_iter.bi_sector, bio->bi_iter.bi_size);
314			break;
315		}
316		corrupt_bio_byte -= bio_iter_len(bio, iter);
317	}
318}
319
320static int flakey_map(struct dm_target *ti, struct bio *bio)
321{
322	struct flakey_c *fc = ti->private;
323	unsigned elapsed;
324	struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data));
325	pb->bio_submitted = false;
326
327	if (op_is_zone_mgmt(bio_op(bio)))
328		goto map_bio;
329
330	/* Are we alive ? */
331	elapsed = (jiffies - fc->start_time) / HZ;
332	if (elapsed % (fc->up_interval + fc->down_interval) >= fc->up_interval) {
333		/*
334		 * Flag this bio as submitted while down.
335		 */
336		pb->bio_submitted = true;
337
338		/*
339		 * Error reads if neither corrupt_bio_byte or drop_writes or error_writes are set.
340		 * Otherwise, flakey_end_io() will decide if the reads should be modified.
341		 */
342		if (bio_data_dir(bio) == READ) {
343			if (!fc->corrupt_bio_byte && !test_bit(DROP_WRITES, &fc->flags) &&
344			    !test_bit(ERROR_WRITES, &fc->flags))
345				return DM_MAPIO_KILL;
346			goto map_bio;
347		}
348
349		/*
350		 * Drop or error writes?
351		 */
352		if (test_bit(DROP_WRITES, &fc->flags)) {
353			bio_endio(bio);
354			return DM_MAPIO_SUBMITTED;
355		}
356		else if (test_bit(ERROR_WRITES, &fc->flags)) {
357			bio_io_error(bio);
358			return DM_MAPIO_SUBMITTED;
359		}
360
361		/*
362		 * Corrupt matching writes.
363		 */
364		if (fc->corrupt_bio_byte && (fc->corrupt_bio_rw == WRITE)) {
365			if (all_corrupt_bio_flags_match(bio, fc))
366				corrupt_bio_data(bio, fc);
367			goto map_bio;
368		}
369
370		/*
371		 * By default, error all I/O.
372		 */
373		return DM_MAPIO_KILL;
374	}
375
376map_bio:
377	flakey_map_bio(ti, bio);
378
379	return DM_MAPIO_REMAPPED;
380}
381
382static int flakey_end_io(struct dm_target *ti, struct bio *bio,
383			 blk_status_t *error)
384{
385	struct flakey_c *fc = ti->private;
386	struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data));
387
388	if (op_is_zone_mgmt(bio_op(bio)))
389		return DM_ENDIO_DONE;
390
391	if (!*error && pb->bio_submitted && (bio_data_dir(bio) == READ)) {
392		if (fc->corrupt_bio_byte && (fc->corrupt_bio_rw == READ) &&
393		    all_corrupt_bio_flags_match(bio, fc)) {
394			/*
395			 * Corrupt successful matching READs while in down state.
396			 */
397			corrupt_bio_data(bio, fc);
398
399		} else if (!test_bit(DROP_WRITES, &fc->flags) &&
400			   !test_bit(ERROR_WRITES, &fc->flags)) {
401			/*
402			 * Error read during the down_interval if drop_writes
403			 * and error_writes were not configured.
404			 */
405			*error = BLK_STS_IOERR;
406		}
407	}
408
409	return DM_ENDIO_DONE;
410}
411
412static void flakey_status(struct dm_target *ti, status_type_t type,
413			  unsigned status_flags, char *result, unsigned maxlen)
414{
415	unsigned sz = 0;
416	struct flakey_c *fc = ti->private;
417	unsigned drop_writes, error_writes;
418
419	switch (type) {
420	case STATUSTYPE_INFO:
421		result[0] = '\0';
422		break;
423
424	case STATUSTYPE_TABLE:
425		DMEMIT("%s %llu %u %u ", fc->dev->name,
426		       (unsigned long long)fc->start, fc->up_interval,
427		       fc->down_interval);
428
429		drop_writes = test_bit(DROP_WRITES, &fc->flags);
430		error_writes = test_bit(ERROR_WRITES, &fc->flags);
431		DMEMIT("%u ", drop_writes + error_writes + (fc->corrupt_bio_byte > 0) * 5);
432
433		if (drop_writes)
434			DMEMIT("drop_writes ");
435		else if (error_writes)
436			DMEMIT("error_writes ");
437
438		if (fc->corrupt_bio_byte)
439			DMEMIT("corrupt_bio_byte %u %c %u %u ",
440			       fc->corrupt_bio_byte,
441			       (fc->corrupt_bio_rw == WRITE) ? 'w' : 'r',
442			       fc->corrupt_bio_value, fc->corrupt_bio_flags);
443
444		break;
445
446	case STATUSTYPE_IMA:
447		result[0] = '\0';
448		break;
449	}
450}
451
452static int flakey_prepare_ioctl(struct dm_target *ti, struct block_device **bdev)
 
453{
454	struct flakey_c *fc = ti->private;
455
456	*bdev = fc->dev->bdev;
457
458	/*
459	 * Only pass ioctls through if the device sizes match exactly.
460	 */
461	if (fc->start || ti->len != bdev_nr_sectors((*bdev)))
 
462		return 1;
463	return 0;
464}
465
466#ifdef CONFIG_BLK_DEV_ZONED
467static int flakey_report_zones(struct dm_target *ti,
468		struct dm_report_zones_args *args, unsigned int nr_zones)
469{
470	struct flakey_c *fc = ti->private;
471
472	return dm_report_zones(fc->dev->bdev, fc->start,
473			       flakey_map_sector(ti, args->next_sector),
474			       args, nr_zones);
475}
476#else
477#define flakey_report_zones NULL
478#endif
479
480static int flakey_iterate_devices(struct dm_target *ti, iterate_devices_callout_fn fn, void *data)
481{
482	struct flakey_c *fc = ti->private;
483
484	return fn(ti, fc->dev, fc->start, ti->len, data);
485}
486
487static struct target_type flakey_target = {
488	.name   = "flakey",
489	.version = {1, 5, 0},
490	.features = DM_TARGET_ZONED_HM | DM_TARGET_PASSES_CRYPTO,
491	.report_zones = flakey_report_zones,
492	.module = THIS_MODULE,
493	.ctr    = flakey_ctr,
494	.dtr    = flakey_dtr,
495	.map    = flakey_map,
496	.end_io = flakey_end_io,
497	.status = flakey_status,
498	.prepare_ioctl = flakey_prepare_ioctl,
499	.iterate_devices = flakey_iterate_devices,
500};
501
502static int __init dm_flakey_init(void)
503{
504	int r = dm_register_target(&flakey_target);
505
506	if (r < 0)
507		DMERR("register failed %d", r);
508
509	return r;
510}
511
512static void __exit dm_flakey_exit(void)
513{
514	dm_unregister_target(&flakey_target);
515}
516
517/* Module hooks */
518module_init(dm_flakey_init);
519module_exit(dm_flakey_exit);
520
521MODULE_DESCRIPTION(DM_NAME " flakey target");
522MODULE_AUTHOR("Joe Thornber <dm-devel@redhat.com>");
523MODULE_LICENSE("GPL");
v4.10.11
  1/*
  2 * Copyright (C) 2003 Sistina Software (UK) Limited.
  3 * Copyright (C) 2004, 2010-2011 Red Hat, Inc. All rights reserved.
  4 *
  5 * This file is released under the GPL.
  6 */
  7
  8#include <linux/device-mapper.h>
  9
 10#include <linux/module.h>
 11#include <linux/init.h>
 12#include <linux/blkdev.h>
 13#include <linux/bio.h>
 14#include <linux/slab.h>
 15
 16#define DM_MSG_PREFIX "flakey"
 17
 18#define all_corrupt_bio_flags_match(bio, fc)	\
 19	(((bio)->bi_opf & (fc)->corrupt_bio_flags) == (fc)->corrupt_bio_flags)
 20
 21/*
 22 * Flakey: Used for testing only, simulates intermittent,
 23 * catastrophic device failure.
 24 */
 25struct flakey_c {
 26	struct dm_dev *dev;
 27	unsigned long start_time;
 28	sector_t start;
 29	unsigned up_interval;
 30	unsigned down_interval;
 31	unsigned long flags;
 32	unsigned corrupt_bio_byte;
 33	unsigned corrupt_bio_rw;
 34	unsigned corrupt_bio_value;
 35	unsigned corrupt_bio_flags;
 36};
 37
 38enum feature_flag_bits {
 39	DROP_WRITES,
 40	ERROR_WRITES
 41};
 42
 43struct per_bio_data {
 44	bool bio_submitted;
 45};
 46
 47static int parse_features(struct dm_arg_set *as, struct flakey_c *fc,
 48			  struct dm_target *ti)
 49{
 50	int r;
 51	unsigned argc;
 52	const char *arg_name;
 53
 54	static struct dm_arg _args[] = {
 55		{0, 6, "Invalid number of feature args"},
 56		{1, UINT_MAX, "Invalid corrupt bio byte"},
 57		{0, 255, "Invalid corrupt value to write into bio byte (0-255)"},
 58		{0, UINT_MAX, "Invalid corrupt bio flags mask"},
 59	};
 60
 61	/* No feature arguments supplied. */
 62	if (!as->argc)
 63		return 0;
 64
 65	r = dm_read_arg_group(_args, as, &argc, &ti->error);
 66	if (r)
 67		return r;
 68
 69	while (argc) {
 70		arg_name = dm_shift_arg(as);
 71		argc--;
 72
 
 
 
 
 
 73		/*
 74		 * drop_writes
 75		 */
 76		if (!strcasecmp(arg_name, "drop_writes")) {
 77			if (test_and_set_bit(DROP_WRITES, &fc->flags)) {
 78				ti->error = "Feature drop_writes duplicated";
 79				return -EINVAL;
 80			} else if (test_bit(ERROR_WRITES, &fc->flags)) {
 81				ti->error = "Feature drop_writes conflicts with feature error_writes";
 82				return -EINVAL;
 83			}
 84
 85			continue;
 86		}
 87
 88		/*
 89		 * error_writes
 90		 */
 91		if (!strcasecmp(arg_name, "error_writes")) {
 92			if (test_and_set_bit(ERROR_WRITES, &fc->flags)) {
 93				ti->error = "Feature error_writes duplicated";
 94				return -EINVAL;
 95
 96			} else if (test_bit(DROP_WRITES, &fc->flags)) {
 97				ti->error = "Feature error_writes conflicts with feature drop_writes";
 98				return -EINVAL;
 99			}
100
101			continue;
102		}
103
104		/*
105		 * corrupt_bio_byte <Nth_byte> <direction> <value> <bio_flags>
106		 */
107		if (!strcasecmp(arg_name, "corrupt_bio_byte")) {
108			if (!argc) {
109				ti->error = "Feature corrupt_bio_byte requires parameters";
110				return -EINVAL;
111			}
112
113			r = dm_read_arg(_args + 1, as, &fc->corrupt_bio_byte, &ti->error);
114			if (r)
115				return r;
116			argc--;
117
118			/*
119			 * Direction r or w?
120			 */
121			arg_name = dm_shift_arg(as);
122			if (!strcasecmp(arg_name, "w"))
123				fc->corrupt_bio_rw = WRITE;
124			else if (!strcasecmp(arg_name, "r"))
125				fc->corrupt_bio_rw = READ;
126			else {
127				ti->error = "Invalid corrupt bio direction (r or w)";
128				return -EINVAL;
129			}
130			argc--;
131
132			/*
133			 * Value of byte (0-255) to write in place of correct one.
134			 */
135			r = dm_read_arg(_args + 2, as, &fc->corrupt_bio_value, &ti->error);
136			if (r)
137				return r;
138			argc--;
139
140			/*
141			 * Only corrupt bios with these flags set.
142			 */
143			r = dm_read_arg(_args + 3, as, &fc->corrupt_bio_flags, &ti->error);
 
 
 
 
144			if (r)
145				return r;
146			argc--;
147
148			continue;
149		}
150
151		ti->error = "Unrecognised flakey feature requested";
152		return -EINVAL;
153	}
154
155	if (test_bit(DROP_WRITES, &fc->flags) && (fc->corrupt_bio_rw == WRITE)) {
156		ti->error = "drop_writes is incompatible with corrupt_bio_byte with the WRITE flag set";
157		return -EINVAL;
158
159	} else if (test_bit(ERROR_WRITES, &fc->flags) && (fc->corrupt_bio_rw == WRITE)) {
160		ti->error = "error_writes is incompatible with corrupt_bio_byte with the WRITE flag set";
161		return -EINVAL;
162	}
163
164	return 0;
165}
166
167/*
168 * Construct a flakey mapping:
169 * <dev_path> <offset> <up interval> <down interval> [<#feature args> [<arg>]*]
170 *
171 *   Feature args:
172 *     [drop_writes]
173 *     [corrupt_bio_byte <Nth_byte> <direction> <value> <bio_flags>]
174 *
175 *   Nth_byte starts from 1 for the first byte.
176 *   Direction is r for READ or w for WRITE.
177 *   bio_flags is ignored if 0.
178 */
179static int flakey_ctr(struct dm_target *ti, unsigned int argc, char **argv)
180{
181	static struct dm_arg _args[] = {
182		{0, UINT_MAX, "Invalid up interval"},
183		{0, UINT_MAX, "Invalid down interval"},
184	};
185
186	int r;
187	struct flakey_c *fc;
188	unsigned long long tmpll;
189	struct dm_arg_set as;
190	const char *devname;
191	char dummy;
192
193	as.argc = argc;
194	as.argv = argv;
195
196	if (argc < 4) {
197		ti->error = "Invalid argument count";
198		return -EINVAL;
199	}
200
201	fc = kzalloc(sizeof(*fc), GFP_KERNEL);
202	if (!fc) {
203		ti->error = "Cannot allocate context";
204		return -ENOMEM;
205	}
206	fc->start_time = jiffies;
207
208	devname = dm_shift_arg(&as);
209
210	r = -EINVAL;
211	if (sscanf(dm_shift_arg(&as), "%llu%c", &tmpll, &dummy) != 1) {
212		ti->error = "Invalid device sector";
213		goto bad;
214	}
215	fc->start = tmpll;
216
217	r = dm_read_arg(_args, &as, &fc->up_interval, &ti->error);
218	if (r)
219		goto bad;
220
221	r = dm_read_arg(_args, &as, &fc->down_interval, &ti->error);
222	if (r)
223		goto bad;
224
225	if (!(fc->up_interval + fc->down_interval)) {
226		ti->error = "Total (up + down) interval is zero";
227		r = -EINVAL;
228		goto bad;
229	}
230
231	if (fc->up_interval + fc->down_interval < fc->up_interval) {
232		ti->error = "Interval overflow";
233		r = -EINVAL;
234		goto bad;
235	}
236
237	r = parse_features(&as, fc, ti);
238	if (r)
239		goto bad;
240
241	r = dm_get_device(ti, devname, dm_table_get_mode(ti->table), &fc->dev);
242	if (r) {
243		ti->error = "Device lookup failed";
244		goto bad;
245	}
246
247	ti->num_flush_bios = 1;
248	ti->num_discard_bios = 1;
249	ti->per_io_data_size = sizeof(struct per_bio_data);
250	ti->private = fc;
251	return 0;
252
253bad:
254	kfree(fc);
255	return r;
256}
257
258static void flakey_dtr(struct dm_target *ti)
259{
260	struct flakey_c *fc = ti->private;
261
262	dm_put_device(ti, fc->dev);
263	kfree(fc);
264}
265
266static sector_t flakey_map_sector(struct dm_target *ti, sector_t bi_sector)
267{
268	struct flakey_c *fc = ti->private;
269
270	return fc->start + dm_target_offset(ti, bi_sector);
271}
272
273static void flakey_map_bio(struct dm_target *ti, struct bio *bio)
274{
275	struct flakey_c *fc = ti->private;
276
277	bio->bi_bdev = fc->dev->bdev;
278	if (bio_sectors(bio))
279		bio->bi_iter.bi_sector =
280			flakey_map_sector(ti, bio->bi_iter.bi_sector);
281}
282
283static void corrupt_bio_data(struct bio *bio, struct flakey_c *fc)
284{
285	unsigned bio_bytes = bio_cur_bytes(bio);
286	char *data = bio_data(bio);
 
 
 
 
 
287
288	/*
289	 * Overwrite the Nth byte of the data returned.
 
290	 */
291	if (data && bio_bytes >= fc->corrupt_bio_byte) {
292		data[fc->corrupt_bio_byte - 1] = fc->corrupt_bio_value;
293
294		DMDEBUG("Corrupting data bio=%p by writing %u to byte %u "
295			"(rw=%c bi_opf=%u bi_sector=%llu cur_bytes=%u)\n",
296			bio, fc->corrupt_bio_value, fc->corrupt_bio_byte,
297			(bio_data_dir(bio) == WRITE) ? 'w' : 'r', bio->bi_opf,
298			(unsigned long long)bio->bi_iter.bi_sector, bio_bytes);
 
 
 
 
 
299	}
300}
301
302static int flakey_map(struct dm_target *ti, struct bio *bio)
303{
304	struct flakey_c *fc = ti->private;
305	unsigned elapsed;
306	struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data));
307	pb->bio_submitted = false;
308
 
 
 
309	/* Are we alive ? */
310	elapsed = (jiffies - fc->start_time) / HZ;
311	if (elapsed % (fc->up_interval + fc->down_interval) >= fc->up_interval) {
312		/*
313		 * Flag this bio as submitted while down.
314		 */
315		pb->bio_submitted = true;
316
317		/*
318		 * Error reads if neither corrupt_bio_byte or drop_writes or error_writes are set.
319		 * Otherwise, flakey_end_io() will decide if the reads should be modified.
320		 */
321		if (bio_data_dir(bio) == READ) {
322			if (!fc->corrupt_bio_byte && !test_bit(DROP_WRITES, &fc->flags) &&
323			    !test_bit(ERROR_WRITES, &fc->flags))
324				return -EIO;
325			goto map_bio;
326		}
327
328		/*
329		 * Drop or error writes?
330		 */
331		if (test_bit(DROP_WRITES, &fc->flags)) {
332			bio_endio(bio);
333			return DM_MAPIO_SUBMITTED;
334		}
335		else if (test_bit(ERROR_WRITES, &fc->flags)) {
336			bio_io_error(bio);
337			return DM_MAPIO_SUBMITTED;
338		}
339
340		/*
341		 * Corrupt matching writes.
342		 */
343		if (fc->corrupt_bio_byte && (fc->corrupt_bio_rw == WRITE)) {
344			if (all_corrupt_bio_flags_match(bio, fc))
345				corrupt_bio_data(bio, fc);
346			goto map_bio;
347		}
348
349		/*
350		 * By default, error all I/O.
351		 */
352		return -EIO;
353	}
354
355map_bio:
356	flakey_map_bio(ti, bio);
357
358	return DM_MAPIO_REMAPPED;
359}
360
361static int flakey_end_io(struct dm_target *ti, struct bio *bio, int error)
 
362{
363	struct flakey_c *fc = ti->private;
364	struct per_bio_data *pb = dm_per_bio_data(bio, sizeof(struct per_bio_data));
365
366	if (!error && pb->bio_submitted && (bio_data_dir(bio) == READ)) {
 
 
 
367		if (fc->corrupt_bio_byte && (fc->corrupt_bio_rw == READ) &&
368		    all_corrupt_bio_flags_match(bio, fc)) {
369			/*
370			 * Corrupt successful matching READs while in down state.
371			 */
372			corrupt_bio_data(bio, fc);
373
374		} else if (!test_bit(DROP_WRITES, &fc->flags) &&
375			   !test_bit(ERROR_WRITES, &fc->flags)) {
376			/*
377			 * Error read during the down_interval if drop_writes
378			 * and error_writes were not configured.
379			 */
380			return -EIO;
381		}
382	}
383
384	return error;
385}
386
387static void flakey_status(struct dm_target *ti, status_type_t type,
388			  unsigned status_flags, char *result, unsigned maxlen)
389{
390	unsigned sz = 0;
391	struct flakey_c *fc = ti->private;
392	unsigned drop_writes, error_writes;
393
394	switch (type) {
395	case STATUSTYPE_INFO:
396		result[0] = '\0';
397		break;
398
399	case STATUSTYPE_TABLE:
400		DMEMIT("%s %llu %u %u ", fc->dev->name,
401		       (unsigned long long)fc->start, fc->up_interval,
402		       fc->down_interval);
403
404		drop_writes = test_bit(DROP_WRITES, &fc->flags);
405		error_writes = test_bit(ERROR_WRITES, &fc->flags);
406		DMEMIT("%u ", drop_writes + error_writes + (fc->corrupt_bio_byte > 0) * 5);
407
408		if (drop_writes)
409			DMEMIT("drop_writes ");
410		else if (error_writes)
411			DMEMIT("error_writes ");
412
413		if (fc->corrupt_bio_byte)
414			DMEMIT("corrupt_bio_byte %u %c %u %u ",
415			       fc->corrupt_bio_byte,
416			       (fc->corrupt_bio_rw == WRITE) ? 'w' : 'r',
417			       fc->corrupt_bio_value, fc->corrupt_bio_flags);
418
419		break;
 
 
 
 
420	}
421}
422
423static int flakey_prepare_ioctl(struct dm_target *ti,
424		struct block_device **bdev, fmode_t *mode)
425{
426	struct flakey_c *fc = ti->private;
427
428	*bdev = fc->dev->bdev;
429
430	/*
431	 * Only pass ioctls through if the device sizes match exactly.
432	 */
433	if (fc->start ||
434	    ti->len != i_size_read((*bdev)->bd_inode) >> SECTOR_SHIFT)
435		return 1;
436	return 0;
437}
438
 
 
 
 
 
 
 
 
 
 
 
 
 
 
439static int flakey_iterate_devices(struct dm_target *ti, iterate_devices_callout_fn fn, void *data)
440{
441	struct flakey_c *fc = ti->private;
442
443	return fn(ti, fc->dev, fc->start, ti->len, data);
444}
445
446static struct target_type flakey_target = {
447	.name   = "flakey",
448	.version = {1, 4, 0},
 
 
449	.module = THIS_MODULE,
450	.ctr    = flakey_ctr,
451	.dtr    = flakey_dtr,
452	.map    = flakey_map,
453	.end_io = flakey_end_io,
454	.status = flakey_status,
455	.prepare_ioctl = flakey_prepare_ioctl,
456	.iterate_devices = flakey_iterate_devices,
457};
458
459static int __init dm_flakey_init(void)
460{
461	int r = dm_register_target(&flakey_target);
462
463	if (r < 0)
464		DMERR("register failed %d", r);
465
466	return r;
467}
468
469static void __exit dm_flakey_exit(void)
470{
471	dm_unregister_target(&flakey_target);
472}
473
474/* Module hooks */
475module_init(dm_flakey_init);
476module_exit(dm_flakey_exit);
477
478MODULE_DESCRIPTION(DM_NAME " flakey target");
479MODULE_AUTHOR("Joe Thornber <dm-devel@redhat.com>");
480MODULE_LICENSE("GPL");