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