Linux Audio

Check our new training course

Loading...
v5.4
  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 * multipath.c : Multiple Devices driver for Linux
  4 *
  5 * Copyright (C) 1999, 2000, 2001 Ingo Molnar, Red Hat
  6 *
  7 * Copyright (C) 1996, 1997, 1998 Ingo Molnar, Miguel de Icaza, Gadi Oxman
  8 *
  9 * MULTIPATH management functions.
 10 *
 11 * derived from raid1.c.
 
 
 
 
 
 
 
 
 
 12 */
 13
 14#include <linux/blkdev.h>
 15#include <linux/module.h>
 16#include <linux/raid/md_u.h>
 17#include <linux/seq_file.h>
 18#include <linux/slab.h>
 19#include "md.h"
 20#include "md-multipath.h"
 21
 22#define MAX_WORK_PER_DISK 128
 23
 24#define	NR_RESERVED_BUFS	32
 25
 26static int multipath_map (struct mpconf *conf)
 27{
 28	int i, disks = conf->raid_disks;
 29
 30	/*
 31	 * Later we do read balancing on the read side
 32	 * now we use the first available disk.
 33	 */
 34
 35	rcu_read_lock();
 36	for (i = 0; i < disks; i++) {
 37		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
 38		if (rdev && test_bit(In_sync, &rdev->flags) &&
 39		    !test_bit(Faulty, &rdev->flags)) {
 40			atomic_inc(&rdev->nr_pending);
 41			rcu_read_unlock();
 42			return i;
 43		}
 44	}
 45	rcu_read_unlock();
 46
 47	pr_crit_ratelimited("multipath_map(): no more operational IO paths?\n");
 48	return (-1);
 49}
 50
 51static void multipath_reschedule_retry (struct multipath_bh *mp_bh)
 52{
 53	unsigned long flags;
 54	struct mddev *mddev = mp_bh->mddev;
 55	struct mpconf *conf = mddev->private;
 56
 57	spin_lock_irqsave(&conf->device_lock, flags);
 58	list_add(&mp_bh->retry_list, &conf->retry_list);
 59	spin_unlock_irqrestore(&conf->device_lock, flags);
 60	md_wakeup_thread(mddev->thread);
 61}
 62
 63/*
 64 * multipath_end_bh_io() is called when we have finished servicing a multipathed
 65 * operation and are ready to return a success/failure code to the buffer
 66 * cache layer.
 67 */
 68static void multipath_end_bh_io(struct multipath_bh *mp_bh, blk_status_t status)
 69{
 70	struct bio *bio = mp_bh->master_bio;
 71	struct mpconf *conf = mp_bh->mddev->private;
 72
 73	bio->bi_status = status;
 74	bio_endio(bio);
 75	mempool_free(mp_bh, &conf->pool);
 76}
 77
 78static void multipath_end_request(struct bio *bio)
 79{
 80	struct multipath_bh *mp_bh = bio->bi_private;
 81	struct mpconf *conf = mp_bh->mddev->private;
 82	struct md_rdev *rdev = conf->multipaths[mp_bh->path].rdev;
 83
 84	if (!bio->bi_status)
 85		multipath_end_bh_io(mp_bh, 0);
 86	else if (!(bio->bi_opf & REQ_RAHEAD)) {
 87		/*
 88		 * oops, IO error:
 89		 */
 90		char b[BDEVNAME_SIZE];
 91		md_error (mp_bh->mddev, rdev);
 92		pr_info("multipath: %s: rescheduling sector %llu\n",
 93			bdevname(rdev->bdev,b),
 94			(unsigned long long)bio->bi_iter.bi_sector);
 95		multipath_reschedule_retry(mp_bh);
 96	} else
 97		multipath_end_bh_io(mp_bh, bio->bi_status);
 98	rdev_dec_pending(rdev, conf->mddev);
 99}
100
101static bool multipath_make_request(struct mddev *mddev, struct bio * bio)
102{
103	struct mpconf *conf = mddev->private;
104	struct multipath_bh * mp_bh;
105	struct multipath_info *multipath;
106
107	if (unlikely(bio->bi_opf & REQ_PREFLUSH)) {
108		md_flush_request(mddev, bio);
109		return true;
110	}
111
112	mp_bh = mempool_alloc(&conf->pool, GFP_NOIO);
113
114	mp_bh->master_bio = bio;
115	mp_bh->mddev = mddev;
116
117	mp_bh->path = multipath_map(conf);
118	if (mp_bh->path < 0) {
119		bio_io_error(bio);
120		mempool_free(mp_bh, &conf->pool);
121		return true;
122	}
123	multipath = conf->multipaths + mp_bh->path;
124
125	bio_init(&mp_bh->bio, NULL, 0);
126	__bio_clone_fast(&mp_bh->bio, bio);
127
128	mp_bh->bio.bi_iter.bi_sector += multipath->rdev->data_offset;
129	bio_set_dev(&mp_bh->bio, multipath->rdev->bdev);
130	mp_bh->bio.bi_opf |= REQ_FAILFAST_TRANSPORT;
131	mp_bh->bio.bi_end_io = multipath_end_request;
132	mp_bh->bio.bi_private = mp_bh;
133	mddev_check_writesame(mddev, &mp_bh->bio);
134	mddev_check_write_zeroes(mddev, &mp_bh->bio);
135	generic_make_request(&mp_bh->bio);
136	return true;
137}
138
139static void multipath_status(struct seq_file *seq, struct mddev *mddev)
140{
141	struct mpconf *conf = mddev->private;
142	int i;
143
144	seq_printf (seq, " [%d/%d] [", conf->raid_disks,
145		    conf->raid_disks - mddev->degraded);
146	rcu_read_lock();
147	for (i = 0; i < conf->raid_disks; i++) {
148		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
149		seq_printf (seq, "%s", rdev && test_bit(In_sync, &rdev->flags) ? "U" : "_");
150	}
151	rcu_read_unlock();
152	seq_putc(seq, ']');
153}
154
155static int multipath_congested(struct mddev *mddev, int bits)
156{
157	struct mpconf *conf = mddev->private;
158	int i, ret = 0;
159
160	rcu_read_lock();
161	for (i = 0; i < mddev->raid_disks ; i++) {
162		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
163		if (rdev && !test_bit(Faulty, &rdev->flags)) {
164			struct request_queue *q = bdev_get_queue(rdev->bdev);
165
166			ret |= bdi_congested(q->backing_dev_info, bits);
167			/* Just like multipath_map, we just check the
168			 * first available device
169			 */
170			break;
171		}
172	}
173	rcu_read_unlock();
174	return ret;
175}
176
177/*
178 * Careful, this can execute in IRQ contexts as well!
179 */
180static void multipath_error (struct mddev *mddev, struct md_rdev *rdev)
181{
182	struct mpconf *conf = mddev->private;
183	char b[BDEVNAME_SIZE];
184
185	if (conf->raid_disks - mddev->degraded <= 1) {
186		/*
187		 * Uh oh, we can do nothing if this is our last path, but
188		 * first check if this is a queued request for a device
189		 * which has just failed.
190		 */
191		pr_warn("multipath: only one IO path left and IO error.\n");
192		/* leave it active... it's all we have */
193		return;
194	}
195	/*
196	 * Mark disk as unusable
197	 */
198	if (test_and_clear_bit(In_sync, &rdev->flags)) {
199		unsigned long flags;
200		spin_lock_irqsave(&conf->device_lock, flags);
201		mddev->degraded++;
202		spin_unlock_irqrestore(&conf->device_lock, flags);
203	}
204	set_bit(Faulty, &rdev->flags);
205	set_bit(MD_SB_CHANGE_DEVS, &mddev->sb_flags);
206	pr_err("multipath: IO failure on %s, disabling IO path.\n"
207	       "multipath: Operation continuing on %d IO paths.\n",
208	       bdevname(rdev->bdev, b),
209	       conf->raid_disks - mddev->degraded);
210}
211
212static void print_multipath_conf (struct mpconf *conf)
213{
214	int i;
215	struct multipath_info *tmp;
216
217	pr_debug("MULTIPATH conf printout:\n");
218	if (!conf) {
219		pr_debug("(conf==NULL)\n");
220		return;
221	}
222	pr_debug(" --- wd:%d rd:%d\n", conf->raid_disks - conf->mddev->degraded,
223		 conf->raid_disks);
224
225	for (i = 0; i < conf->raid_disks; i++) {
226		char b[BDEVNAME_SIZE];
227		tmp = conf->multipaths + i;
228		if (tmp->rdev)
229			pr_debug(" disk%d, o:%d, dev:%s\n",
230				 i,!test_bit(Faulty, &tmp->rdev->flags),
231				 bdevname(tmp->rdev->bdev,b));
232	}
233}
234
235static int multipath_add_disk(struct mddev *mddev, struct md_rdev *rdev)
236{
237	struct mpconf *conf = mddev->private;
238	int err = -EEXIST;
239	int path;
240	struct multipath_info *p;
241	int first = 0;
242	int last = mddev->raid_disks - 1;
243
244	if (rdev->raid_disk >= 0)
245		first = last = rdev->raid_disk;
246
247	print_multipath_conf(conf);
248
249	for (path = first; path <= last; path++)
250		if ((p=conf->multipaths+path)->rdev == NULL) {
251			disk_stack_limits(mddev->gendisk, rdev->bdev,
252					  rdev->data_offset << 9);
253
254			err = md_integrity_add_rdev(rdev, mddev);
255			if (err)
256				break;
257			spin_lock_irq(&conf->device_lock);
258			mddev->degraded--;
259			rdev->raid_disk = path;
260			set_bit(In_sync, &rdev->flags);
261			spin_unlock_irq(&conf->device_lock);
262			rcu_assign_pointer(p->rdev, rdev);
263			err = 0;
264			break;
265		}
266
267	print_multipath_conf(conf);
268
269	return err;
270}
271
272static int multipath_remove_disk(struct mddev *mddev, struct md_rdev *rdev)
273{
274	struct mpconf *conf = mddev->private;
275	int err = 0;
276	int number = rdev->raid_disk;
277	struct multipath_info *p = conf->multipaths + number;
278
279	print_multipath_conf(conf);
280
281	if (rdev == p->rdev) {
282		if (test_bit(In_sync, &rdev->flags) ||
283		    atomic_read(&rdev->nr_pending)) {
284			pr_warn("hot-remove-disk, slot %d is identified but is still operational!\n", number);
285			err = -EBUSY;
286			goto abort;
287		}
288		p->rdev = NULL;
289		if (!test_bit(RemoveSynchronized, &rdev->flags)) {
290			synchronize_rcu();
291			if (atomic_read(&rdev->nr_pending)) {
292				/* lost the race, try later */
293				err = -EBUSY;
294				p->rdev = rdev;
295				goto abort;
296			}
297		}
298		err = md_integrity_register(mddev);
299	}
300abort:
301
302	print_multipath_conf(conf);
303	return err;
304}
305
306/*
307 * This is a kernel thread which:
308 *
309 *	1.	Retries failed read operations on working multipaths.
310 *	2.	Updates the raid superblock when problems encounter.
311 *	3.	Performs writes following reads for array syncronising.
312 */
313
314static void multipathd(struct md_thread *thread)
315{
316	struct mddev *mddev = thread->mddev;
317	struct multipath_bh *mp_bh;
318	struct bio *bio;
319	unsigned long flags;
320	struct mpconf *conf = mddev->private;
321	struct list_head *head = &conf->retry_list;
322
323	md_check_recovery(mddev);
324	for (;;) {
325		char b[BDEVNAME_SIZE];
326		spin_lock_irqsave(&conf->device_lock, flags);
327		if (list_empty(head))
328			break;
329		mp_bh = list_entry(head->prev, struct multipath_bh, retry_list);
330		list_del(head->prev);
331		spin_unlock_irqrestore(&conf->device_lock, flags);
332
333		bio = &mp_bh->bio;
334		bio->bi_iter.bi_sector = mp_bh->master_bio->bi_iter.bi_sector;
335
336		if ((mp_bh->path = multipath_map (conf))<0) {
337			pr_err("multipath: %s: unrecoverable IO read error for block %llu\n",
338			       bio_devname(bio, b),
339			       (unsigned long long)bio->bi_iter.bi_sector);
340			multipath_end_bh_io(mp_bh, BLK_STS_IOERR);
341		} else {
342			pr_err("multipath: %s: redirecting sector %llu to another IO path\n",
343			       bio_devname(bio, b),
344			       (unsigned long long)bio->bi_iter.bi_sector);
345			*bio = *(mp_bh->master_bio);
346			bio->bi_iter.bi_sector +=
347				conf->multipaths[mp_bh->path].rdev->data_offset;
348			bio_set_dev(bio, conf->multipaths[mp_bh->path].rdev->bdev);
349			bio->bi_opf |= REQ_FAILFAST_TRANSPORT;
350			bio->bi_end_io = multipath_end_request;
351			bio->bi_private = mp_bh;
352			generic_make_request(bio);
353		}
354	}
355	spin_unlock_irqrestore(&conf->device_lock, flags);
356}
357
358static sector_t multipath_size(struct mddev *mddev, sector_t sectors, int raid_disks)
359{
360	WARN_ONCE(sectors || raid_disks,
361		  "%s does not support generic reshape\n", __func__);
362
363	return mddev->dev_sectors;
364}
365
366static int multipath_run (struct mddev *mddev)
367{
368	struct mpconf *conf;
369	int disk_idx;
370	struct multipath_info *disk;
371	struct md_rdev *rdev;
372	int working_disks;
373	int ret;
374
375	if (md_check_no_bitmap(mddev))
376		return -EINVAL;
377
378	if (mddev->level != LEVEL_MULTIPATH) {
379		pr_warn("multipath: %s: raid level not set to multipath IO (%d)\n",
380			mdname(mddev), mddev->level);
381		goto out;
382	}
383	/*
384	 * copy the already verified devices into our private MULTIPATH
385	 * bookkeeping area. [whatever we allocate in multipath_run(),
386	 * should be freed in multipath_free()]
387	 */
388
389	conf = kzalloc(sizeof(struct mpconf), GFP_KERNEL);
390	mddev->private = conf;
391	if (!conf)
392		goto out;
393
394	conf->multipaths = kcalloc(mddev->raid_disks,
395				   sizeof(struct multipath_info),
396				   GFP_KERNEL);
397	if (!conf->multipaths)
398		goto out_free_conf;
399
400	working_disks = 0;
401	rdev_for_each(rdev, mddev) {
402		disk_idx = rdev->raid_disk;
403		if (disk_idx < 0 ||
404		    disk_idx >= mddev->raid_disks)
405			continue;
406
407		disk = conf->multipaths + disk_idx;
408		disk->rdev = rdev;
409		disk_stack_limits(mddev->gendisk, rdev->bdev,
410				  rdev->data_offset << 9);
411
412		if (!test_bit(Faulty, &rdev->flags))
413			working_disks++;
414	}
415
416	conf->raid_disks = mddev->raid_disks;
417	conf->mddev = mddev;
418	spin_lock_init(&conf->device_lock);
419	INIT_LIST_HEAD(&conf->retry_list);
420
421	if (!working_disks) {
422		pr_warn("multipath: no operational IO paths for %s\n",
423			mdname(mddev));
424		goto out_free_conf;
425	}
426	mddev->degraded = conf->raid_disks - working_disks;
427
428	ret = mempool_init_kmalloc_pool(&conf->pool, NR_RESERVED_BUFS,
429					sizeof(struct multipath_bh));
430	if (ret)
431		goto out_free_conf;
432
433	mddev->thread = md_register_thread(multipathd, mddev,
434					   "multipath");
435	if (!mddev->thread)
436		goto out_free_conf;
437
438	pr_info("multipath: array %s active with %d out of %d IO paths\n",
439		mdname(mddev), conf->raid_disks - mddev->degraded,
440		mddev->raid_disks);
441	/*
442	 * Ok, everything is just fine now
443	 */
444	md_set_array_sectors(mddev, multipath_size(mddev, 0, 0));
445
446	if (md_integrity_register(mddev))
447		goto out_free_conf;
448
449	return 0;
450
451out_free_conf:
452	mempool_exit(&conf->pool);
453	kfree(conf->multipaths);
454	kfree(conf);
455	mddev->private = NULL;
456out:
457	return -EIO;
458}
459
460static void multipath_free(struct mddev *mddev, void *priv)
461{
462	struct mpconf *conf = priv;
463
464	mempool_exit(&conf->pool);
465	kfree(conf->multipaths);
466	kfree(conf);
467}
468
469static struct md_personality multipath_personality =
470{
471	.name		= "multipath",
472	.level		= LEVEL_MULTIPATH,
473	.owner		= THIS_MODULE,
474	.make_request	= multipath_make_request,
475	.run		= multipath_run,
476	.free		= multipath_free,
477	.status		= multipath_status,
478	.error_handler	= multipath_error,
479	.hot_add_disk	= multipath_add_disk,
480	.hot_remove_disk= multipath_remove_disk,
481	.size		= multipath_size,
482	.congested	= multipath_congested,
483};
484
485static int __init multipath_init (void)
486{
487	return register_md_personality (&multipath_personality);
488}
489
490static void __exit multipath_exit (void)
491{
492	unregister_md_personality (&multipath_personality);
493}
494
495module_init(multipath_init);
496module_exit(multipath_exit);
497MODULE_LICENSE("GPL");
498MODULE_DESCRIPTION("simple multi-path personality for MD");
499MODULE_ALIAS("md-personality-7"); /* MULTIPATH */
500MODULE_ALIAS("md-multipath");
501MODULE_ALIAS("md-level--4");
v4.17
 
  1/*
  2 * multipath.c : Multiple Devices driver for Linux
  3 *
  4 * Copyright (C) 1999, 2000, 2001 Ingo Molnar, Red Hat
  5 *
  6 * Copyright (C) 1996, 1997, 1998 Ingo Molnar, Miguel de Icaza, Gadi Oxman
  7 *
  8 * MULTIPATH management functions.
  9 *
 10 * derived from raid1.c.
 11 *
 12 * This program is free software; you can redistribute it and/or modify
 13 * it under the terms of the GNU General Public License as published by
 14 * the Free Software Foundation; either version 2, or (at your option)
 15 * any later version.
 16 *
 17 * You should have received a copy of the GNU General Public License
 18 * (for example /usr/src/linux/COPYING); if not, write to the Free
 19 * Software Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 20 */
 21
 22#include <linux/blkdev.h>
 23#include <linux/module.h>
 24#include <linux/raid/md_u.h>
 25#include <linux/seq_file.h>
 26#include <linux/slab.h>
 27#include "md.h"
 28#include "md-multipath.h"
 29
 30#define MAX_WORK_PER_DISK 128
 31
 32#define	NR_RESERVED_BUFS	32
 33
 34static int multipath_map (struct mpconf *conf)
 35{
 36	int i, disks = conf->raid_disks;
 37
 38	/*
 39	 * Later we do read balancing on the read side
 40	 * now we use the first available disk.
 41	 */
 42
 43	rcu_read_lock();
 44	for (i = 0; i < disks; i++) {
 45		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
 46		if (rdev && test_bit(In_sync, &rdev->flags) &&
 47		    !test_bit(Faulty, &rdev->flags)) {
 48			atomic_inc(&rdev->nr_pending);
 49			rcu_read_unlock();
 50			return i;
 51		}
 52	}
 53	rcu_read_unlock();
 54
 55	pr_crit_ratelimited("multipath_map(): no more operational IO paths?\n");
 56	return (-1);
 57}
 58
 59static void multipath_reschedule_retry (struct multipath_bh *mp_bh)
 60{
 61	unsigned long flags;
 62	struct mddev *mddev = mp_bh->mddev;
 63	struct mpconf *conf = mddev->private;
 64
 65	spin_lock_irqsave(&conf->device_lock, flags);
 66	list_add(&mp_bh->retry_list, &conf->retry_list);
 67	spin_unlock_irqrestore(&conf->device_lock, flags);
 68	md_wakeup_thread(mddev->thread);
 69}
 70
 71/*
 72 * multipath_end_bh_io() is called when we have finished servicing a multipathed
 73 * operation and are ready to return a success/failure code to the buffer
 74 * cache layer.
 75 */
 76static void multipath_end_bh_io(struct multipath_bh *mp_bh, blk_status_t status)
 77{
 78	struct bio *bio = mp_bh->master_bio;
 79	struct mpconf *conf = mp_bh->mddev->private;
 80
 81	bio->bi_status = status;
 82	bio_endio(bio);
 83	mempool_free(mp_bh, conf->pool);
 84}
 85
 86static void multipath_end_request(struct bio *bio)
 87{
 88	struct multipath_bh *mp_bh = bio->bi_private;
 89	struct mpconf *conf = mp_bh->mddev->private;
 90	struct md_rdev *rdev = conf->multipaths[mp_bh->path].rdev;
 91
 92	if (!bio->bi_status)
 93		multipath_end_bh_io(mp_bh, 0);
 94	else if (!(bio->bi_opf & REQ_RAHEAD)) {
 95		/*
 96		 * oops, IO error:
 97		 */
 98		char b[BDEVNAME_SIZE];
 99		md_error (mp_bh->mddev, rdev);
100		pr_info("multipath: %s: rescheduling sector %llu\n",
101			bdevname(rdev->bdev,b),
102			(unsigned long long)bio->bi_iter.bi_sector);
103		multipath_reschedule_retry(mp_bh);
104	} else
105		multipath_end_bh_io(mp_bh, bio->bi_status);
106	rdev_dec_pending(rdev, conf->mddev);
107}
108
109static bool multipath_make_request(struct mddev *mddev, struct bio * bio)
110{
111	struct mpconf *conf = mddev->private;
112	struct multipath_bh * mp_bh;
113	struct multipath_info *multipath;
114
115	if (unlikely(bio->bi_opf & REQ_PREFLUSH)) {
116		md_flush_request(mddev, bio);
117		return true;
118	}
119
120	mp_bh = mempool_alloc(conf->pool, GFP_NOIO);
121
122	mp_bh->master_bio = bio;
123	mp_bh->mddev = mddev;
124
125	mp_bh->path = multipath_map(conf);
126	if (mp_bh->path < 0) {
127		bio_io_error(bio);
128		mempool_free(mp_bh, conf->pool);
129		return true;
130	}
131	multipath = conf->multipaths + mp_bh->path;
132
133	bio_init(&mp_bh->bio, NULL, 0);
134	__bio_clone_fast(&mp_bh->bio, bio);
135
136	mp_bh->bio.bi_iter.bi_sector += multipath->rdev->data_offset;
137	bio_set_dev(&mp_bh->bio, multipath->rdev->bdev);
138	mp_bh->bio.bi_opf |= REQ_FAILFAST_TRANSPORT;
139	mp_bh->bio.bi_end_io = multipath_end_request;
140	mp_bh->bio.bi_private = mp_bh;
141	mddev_check_writesame(mddev, &mp_bh->bio);
142	mddev_check_write_zeroes(mddev, &mp_bh->bio);
143	generic_make_request(&mp_bh->bio);
144	return true;
145}
146
147static void multipath_status(struct seq_file *seq, struct mddev *mddev)
148{
149	struct mpconf *conf = mddev->private;
150	int i;
151
152	seq_printf (seq, " [%d/%d] [", conf->raid_disks,
153		    conf->raid_disks - mddev->degraded);
154	rcu_read_lock();
155	for (i = 0; i < conf->raid_disks; i++) {
156		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
157		seq_printf (seq, "%s", rdev && test_bit(In_sync, &rdev->flags) ? "U" : "_");
158	}
159	rcu_read_unlock();
160	seq_putc(seq, ']');
161}
162
163static int multipath_congested(struct mddev *mddev, int bits)
164{
165	struct mpconf *conf = mddev->private;
166	int i, ret = 0;
167
168	rcu_read_lock();
169	for (i = 0; i < mddev->raid_disks ; i++) {
170		struct md_rdev *rdev = rcu_dereference(conf->multipaths[i].rdev);
171		if (rdev && !test_bit(Faulty, &rdev->flags)) {
172			struct request_queue *q = bdev_get_queue(rdev->bdev);
173
174			ret |= bdi_congested(q->backing_dev_info, bits);
175			/* Just like multipath_map, we just check the
176			 * first available device
177			 */
178			break;
179		}
180	}
181	rcu_read_unlock();
182	return ret;
183}
184
185/*
186 * Careful, this can execute in IRQ contexts as well!
187 */
188static void multipath_error (struct mddev *mddev, struct md_rdev *rdev)
189{
190	struct mpconf *conf = mddev->private;
191	char b[BDEVNAME_SIZE];
192
193	if (conf->raid_disks - mddev->degraded <= 1) {
194		/*
195		 * Uh oh, we can do nothing if this is our last path, but
196		 * first check if this is a queued request for a device
197		 * which has just failed.
198		 */
199		pr_warn("multipath: only one IO path left and IO error.\n");
200		/* leave it active... it's all we have */
201		return;
202	}
203	/*
204	 * Mark disk as unusable
205	 */
206	if (test_and_clear_bit(In_sync, &rdev->flags)) {
207		unsigned long flags;
208		spin_lock_irqsave(&conf->device_lock, flags);
209		mddev->degraded++;
210		spin_unlock_irqrestore(&conf->device_lock, flags);
211	}
212	set_bit(Faulty, &rdev->flags);
213	set_bit(MD_SB_CHANGE_DEVS, &mddev->sb_flags);
214	pr_err("multipath: IO failure on %s, disabling IO path.\n"
215	       "multipath: Operation continuing on %d IO paths.\n",
216	       bdevname(rdev->bdev, b),
217	       conf->raid_disks - mddev->degraded);
218}
219
220static void print_multipath_conf (struct mpconf *conf)
221{
222	int i;
223	struct multipath_info *tmp;
224
225	pr_debug("MULTIPATH conf printout:\n");
226	if (!conf) {
227		pr_debug("(conf==NULL)\n");
228		return;
229	}
230	pr_debug(" --- wd:%d rd:%d\n", conf->raid_disks - conf->mddev->degraded,
231		 conf->raid_disks);
232
233	for (i = 0; i < conf->raid_disks; i++) {
234		char b[BDEVNAME_SIZE];
235		tmp = conf->multipaths + i;
236		if (tmp->rdev)
237			pr_debug(" disk%d, o:%d, dev:%s\n",
238				 i,!test_bit(Faulty, &tmp->rdev->flags),
239				 bdevname(tmp->rdev->bdev,b));
240	}
241}
242
243static int multipath_add_disk(struct mddev *mddev, struct md_rdev *rdev)
244{
245	struct mpconf *conf = mddev->private;
246	int err = -EEXIST;
247	int path;
248	struct multipath_info *p;
249	int first = 0;
250	int last = mddev->raid_disks - 1;
251
252	if (rdev->raid_disk >= 0)
253		first = last = rdev->raid_disk;
254
255	print_multipath_conf(conf);
256
257	for (path = first; path <= last; path++)
258		if ((p=conf->multipaths+path)->rdev == NULL) {
259			disk_stack_limits(mddev->gendisk, rdev->bdev,
260					  rdev->data_offset << 9);
261
262			err = md_integrity_add_rdev(rdev, mddev);
263			if (err)
264				break;
265			spin_lock_irq(&conf->device_lock);
266			mddev->degraded--;
267			rdev->raid_disk = path;
268			set_bit(In_sync, &rdev->flags);
269			spin_unlock_irq(&conf->device_lock);
270			rcu_assign_pointer(p->rdev, rdev);
271			err = 0;
272			break;
273		}
274
275	print_multipath_conf(conf);
276
277	return err;
278}
279
280static int multipath_remove_disk(struct mddev *mddev, struct md_rdev *rdev)
281{
282	struct mpconf *conf = mddev->private;
283	int err = 0;
284	int number = rdev->raid_disk;
285	struct multipath_info *p = conf->multipaths + number;
286
287	print_multipath_conf(conf);
288
289	if (rdev == p->rdev) {
290		if (test_bit(In_sync, &rdev->flags) ||
291		    atomic_read(&rdev->nr_pending)) {
292			pr_warn("hot-remove-disk, slot %d is identified but is still operational!\n", number);
293			err = -EBUSY;
294			goto abort;
295		}
296		p->rdev = NULL;
297		if (!test_bit(RemoveSynchronized, &rdev->flags)) {
298			synchronize_rcu();
299			if (atomic_read(&rdev->nr_pending)) {
300				/* lost the race, try later */
301				err = -EBUSY;
302				p->rdev = rdev;
303				goto abort;
304			}
305		}
306		err = md_integrity_register(mddev);
307	}
308abort:
309
310	print_multipath_conf(conf);
311	return err;
312}
313
314/*
315 * This is a kernel thread which:
316 *
317 *	1.	Retries failed read operations on working multipaths.
318 *	2.	Updates the raid superblock when problems encounter.
319 *	3.	Performs writes following reads for array syncronising.
320 */
321
322static void multipathd(struct md_thread *thread)
323{
324	struct mddev *mddev = thread->mddev;
325	struct multipath_bh *mp_bh;
326	struct bio *bio;
327	unsigned long flags;
328	struct mpconf *conf = mddev->private;
329	struct list_head *head = &conf->retry_list;
330
331	md_check_recovery(mddev);
332	for (;;) {
333		char b[BDEVNAME_SIZE];
334		spin_lock_irqsave(&conf->device_lock, flags);
335		if (list_empty(head))
336			break;
337		mp_bh = list_entry(head->prev, struct multipath_bh, retry_list);
338		list_del(head->prev);
339		spin_unlock_irqrestore(&conf->device_lock, flags);
340
341		bio = &mp_bh->bio;
342		bio->bi_iter.bi_sector = mp_bh->master_bio->bi_iter.bi_sector;
343
344		if ((mp_bh->path = multipath_map (conf))<0) {
345			pr_err("multipath: %s: unrecoverable IO read error for block %llu\n",
346			       bio_devname(bio, b),
347			       (unsigned long long)bio->bi_iter.bi_sector);
348			multipath_end_bh_io(mp_bh, BLK_STS_IOERR);
349		} else {
350			pr_err("multipath: %s: redirecting sector %llu to another IO path\n",
351			       bio_devname(bio, b),
352			       (unsigned long long)bio->bi_iter.bi_sector);
353			*bio = *(mp_bh->master_bio);
354			bio->bi_iter.bi_sector +=
355				conf->multipaths[mp_bh->path].rdev->data_offset;
356			bio_set_dev(bio, conf->multipaths[mp_bh->path].rdev->bdev);
357			bio->bi_opf |= REQ_FAILFAST_TRANSPORT;
358			bio->bi_end_io = multipath_end_request;
359			bio->bi_private = mp_bh;
360			generic_make_request(bio);
361		}
362	}
363	spin_unlock_irqrestore(&conf->device_lock, flags);
364}
365
366static sector_t multipath_size(struct mddev *mddev, sector_t sectors, int raid_disks)
367{
368	WARN_ONCE(sectors || raid_disks,
369		  "%s does not support generic reshape\n", __func__);
370
371	return mddev->dev_sectors;
372}
373
374static int multipath_run (struct mddev *mddev)
375{
376	struct mpconf *conf;
377	int disk_idx;
378	struct multipath_info *disk;
379	struct md_rdev *rdev;
380	int working_disks;
 
381
382	if (md_check_no_bitmap(mddev))
383		return -EINVAL;
384
385	if (mddev->level != LEVEL_MULTIPATH) {
386		pr_warn("multipath: %s: raid level not set to multipath IO (%d)\n",
387			mdname(mddev), mddev->level);
388		goto out;
389	}
390	/*
391	 * copy the already verified devices into our private MULTIPATH
392	 * bookkeeping area. [whatever we allocate in multipath_run(),
393	 * should be freed in multipath_free()]
394	 */
395
396	conf = kzalloc(sizeof(struct mpconf), GFP_KERNEL);
397	mddev->private = conf;
398	if (!conf)
399		goto out;
400
401	conf->multipaths = kzalloc(sizeof(struct multipath_info)*mddev->raid_disks,
 
402				   GFP_KERNEL);
403	if (!conf->multipaths)
404		goto out_free_conf;
405
406	working_disks = 0;
407	rdev_for_each(rdev, mddev) {
408		disk_idx = rdev->raid_disk;
409		if (disk_idx < 0 ||
410		    disk_idx >= mddev->raid_disks)
411			continue;
412
413		disk = conf->multipaths + disk_idx;
414		disk->rdev = rdev;
415		disk_stack_limits(mddev->gendisk, rdev->bdev,
416				  rdev->data_offset << 9);
417
418		if (!test_bit(Faulty, &rdev->flags))
419			working_disks++;
420	}
421
422	conf->raid_disks = mddev->raid_disks;
423	conf->mddev = mddev;
424	spin_lock_init(&conf->device_lock);
425	INIT_LIST_HEAD(&conf->retry_list);
426
427	if (!working_disks) {
428		pr_warn("multipath: no operational IO paths for %s\n",
429			mdname(mddev));
430		goto out_free_conf;
431	}
432	mddev->degraded = conf->raid_disks - working_disks;
433
434	conf->pool = mempool_create_kmalloc_pool(NR_RESERVED_BUFS,
435						 sizeof(struct multipath_bh));
436	if (conf->pool == NULL)
437		goto out_free_conf;
438
439	mddev->thread = md_register_thread(multipathd, mddev,
440					   "multipath");
441	if (!mddev->thread)
442		goto out_free_conf;
443
444	pr_info("multipath: array %s active with %d out of %d IO paths\n",
445		mdname(mddev), conf->raid_disks - mddev->degraded,
446		mddev->raid_disks);
447	/*
448	 * Ok, everything is just fine now
449	 */
450	md_set_array_sectors(mddev, multipath_size(mddev, 0, 0));
451
452	if (md_integrity_register(mddev))
453		goto out_free_conf;
454
455	return 0;
456
457out_free_conf:
458	mempool_destroy(conf->pool);
459	kfree(conf->multipaths);
460	kfree(conf);
461	mddev->private = NULL;
462out:
463	return -EIO;
464}
465
466static void multipath_free(struct mddev *mddev, void *priv)
467{
468	struct mpconf *conf = priv;
469
470	mempool_destroy(conf->pool);
471	kfree(conf->multipaths);
472	kfree(conf);
473}
474
475static struct md_personality multipath_personality =
476{
477	.name		= "multipath",
478	.level		= LEVEL_MULTIPATH,
479	.owner		= THIS_MODULE,
480	.make_request	= multipath_make_request,
481	.run		= multipath_run,
482	.free		= multipath_free,
483	.status		= multipath_status,
484	.error_handler	= multipath_error,
485	.hot_add_disk	= multipath_add_disk,
486	.hot_remove_disk= multipath_remove_disk,
487	.size		= multipath_size,
488	.congested	= multipath_congested,
489};
490
491static int __init multipath_init (void)
492{
493	return register_md_personality (&multipath_personality);
494}
495
496static void __exit multipath_exit (void)
497{
498	unregister_md_personality (&multipath_personality);
499}
500
501module_init(multipath_init);
502module_exit(multipath_exit);
503MODULE_LICENSE("GPL");
504MODULE_DESCRIPTION("simple multi-path personality for MD");
505MODULE_ALIAS("md-personality-7"); /* MULTIPATH */
506MODULE_ALIAS("md-multipath");
507MODULE_ALIAS("md-level--4");